input/joystick/grip.c

13 #include <linux/gameport.h>
36 	struct gameport *gameport;
65 static int grip_gpp_read_packet(struct gameport *gameport, int shift, unsigned int *data)
72 	int strobe = gameport_time(gameport, GRIP_STROBE_GPP);
80 	v = gameport_read(gameport) >> shift;
84 		u = v; v = (gameport_read(gameport) >> shift) & 3;
105 static int grip_xt_read_packet(struct gameport *gameport, int shift, unsigned int *data)
113 	int strobe = gameport_time(gameport, GRIP_STROBE_XT);
121 	v = w = (gameport_read(gameport) >> shift) & 3;
125 		u = (gameport_read(gameport) >> shift) & 3;
163 static void grip_poll(struct gameport *gameport)
165 	struct grip *grip = gameport_get_drvdata(gameport);
182 				if (grip_gpp_read_packet(grip->gameport, (i << 1) + 4, data)) {
198 				if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
217 				if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
239 				if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
268 	gameport_start_polling(grip->gameport);
276 	gameport_stop_polling(grip->gameport);
279 static int grip_connect(struct gameport *gameport, struct gameport_driver *drv)
290 	grip->gameport = gameport;
292 	gameport_set_drvdata(gameport, grip);
294 	err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
299 		if (!grip_gpp_read_packet(gameport, (i << 1) + 4, data)) {
303 		if (!grip_xt_read_packet(gameport, (i << 1) + 4, data)) {
322 	gameport_set_poll_handler(gameport, grip_poll);
323 	gameport_set_poll_interval(gameport, 20);
336 			 "%s/input%d", gameport->phys, i);
344 		input_dev->dev.parent = &gameport->dev;
378  fail2:	gameport_close(gameport);
379  fail1:	gameport_set_drvdata(gameport, NULL);
384 static void grip_disconnect(struct gameport *gameport)
386 	struct grip *grip = gameport_get_drvdata(gameport);
392 	gameport_close(gameport);
393 	gameport_set_drvdata(gameport, NULL);