input/joystick/interact.c

17 #include <linux/gameport.h>
35 	struct gameport *gameport;
72 static int interact_read_packet(struct gameport *gameport, int length, u32 *data)
81 	t = gameport_time(gameport, INTERACT_MAX_START);
82 	s = gameport_time(gameport, INTERACT_MAX_STROBE);
85 	gameport_trigger(gameport);
86 	v = gameport_read(gameport);
90 		u = v; v = gameport_read(gameport);
109 static void interact_poll(struct gameport *gameport)
111 	struct interact *interact = gameport_get_drvdata(gameport);
118 	if (interact_read_packet(interact->gameport, interact->length, data) < interact->length) {
168 	gameport_start_polling(interact->gameport);
180 	gameport_stop_polling(interact->gameport);
187 static int interact_connect(struct gameport *gameport, struct gameport_driver *drv)
202 	interact->gameport = gameport;
205 	gameport_set_drvdata(gameport, interact);
207 	err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
211 	i = interact_read_packet(gameport, INTERACT_MAX_LENGTH * 2, data);
224 			gameport->phys, i, data[0], data[1], data[2]);
229 	gameport_set_poll_handler(gameport, interact_poll);
230 	gameport_set_poll_interval(gameport, 20);
232 	snprintf(interact->phys, sizeof(interact->phys), "%s/input0", gameport->phys);
243 	input_dev->dev.parent = &gameport->dev;
268 fail2:	gameport_close(gameport);
269 fail1:  gameport_set_drvdata(gameport, NULL);
275 static void interact_disconnect(struct gameport *gameport)
277 	struct interact *interact = gameport_get_drvdata(gameport);
280 	gameport_close(gameport);
281 	gameport_set_drvdata(gameport, NULL);