input/joystick/cobra.c

13 #include <linux/gameport.h>
29 	struct gameport *gameport;
37 static unsigned char cobra_read_packet(struct gameport *gameport, unsigned int *data)
45 	int strobe = gameport_time(gameport, COBRA_MAX_STROBE);
54 	u = gameport_read(gameport);
58 		v = gameport_read(gameport);
91 static void cobra_poll(struct gameport *gameport)
93 	struct cobra *cobra = gameport_get_drvdata(gameport);
100 	if ((r = cobra_read_packet(gameport, data)) != cobra->exists) {
125 	gameport_start_polling(cobra->gameport);
133 	gameport_stop_polling(cobra->gameport);
136 static int cobra_connect(struct gameport *gameport, struct gameport_driver *drv)
148 	cobra->gameport = gameport;
150 	gameport_set_drvdata(gameport, cobra);
152 	err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
156 	cobra->exists = cobra_read_packet(gameport, data);
161 				" Contact vojtech@ucw.cz\n", i, gameport->phys, (data[i] >> 2) & 7);
170 	gameport_set_poll_handler(gameport, cobra_poll);
171 	gameport_set_poll_interval(gameport, 20);
184 			 "%s/input%d", gameport->phys, i);
192 		input_dev->dev.parent = &gameport->dev;
216  fail2:	gameport_close(gameport);
217  fail1:	gameport_set_drvdata(gameport, NULL);
222 static void cobra_disconnect(struct gameport *gameport)
224 	struct cobra *cobra = gameport_get_drvdata(gameport);
230 	gameport_close(gameport);
231 	gameport_set_drvdata(gameport, NULL);