input/joystick/tmdc.c

17 #include <linux/gameport.h>
105 	struct gameport *gameport;
127 static int tmdc_read_packet(struct gameport *gameport, unsigned char data[2][TMDC_MAX_LENGTH])
133 	p = gameport_time(gameport, TMDC_MAX_STROBE);
136 		t[k] = gameport_time(gameport, TMDC_MAX_START);
141 	gameport_trigger(gameport);
143 	w = gameport_read(gameport) >> 4;
147 		w = gameport_read(gameport) >> 4;
220 static void tmdc_poll(struct gameport *gameport)
223 	struct tmdc *tmdc = gameport_get_drvdata(gameport);
229 	if ((r = tmdc_read_packet(tmdc->gameport, data)) != tmdc->exists)
248 	gameport_start_polling(tmdc->gameport);
256 	gameport_stop_polling(tmdc->gameport);
297 	snprintf(port->phys, sizeof(port->phys), "%s/input%d", tmdc->gameport->phys, i);
307 	input_dev->dev.parent = &tmdc->gameport->dev;
344 static int tmdc_connect(struct gameport *gameport, struct gameport_driver *drv)
354 	tmdc->gameport = gameport;
356 	gameport_set_drvdata(gameport, tmdc);
358 	err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
362 	if (!(tmdc->exists = tmdc_read_packet(gameport, data))) {
367 	gameport_set_poll_handler(gameport, tmdc_poll);
368 	gameport_set_poll_interval(gameport, 20);
387  fail2:	gameport_close(gameport);
388  fail1:	gameport_set_drvdata(gameport, NULL);
393 static void tmdc_disconnect(struct gameport *gameport)
395 	struct tmdc *tmdc = gameport_get_drvdata(gameport);
404 	gameport_close(gameport);
405 	gameport_set_drvdata(gameport, NULL);