input/joystick/a3d.c

13 #include <linux/gameport.h>
36 	struct gameport *gameport;
37 	struct gameport *adc;
52 static int a3d_read_packet(struct gameport *gameport, int length, char *data)
60 	t = gameport_time(gameport, A3D_MAX_START);
61 	s = gameport_time(gameport, A3D_MAX_STROBE);
64 	gameport_trigger(gameport);
65 	v = gameport_read(gameport);
69 		u = v; v = gameport_read(gameport);
159 static void a3d_poll(struct gameport *gameport)
161 	struct a3d *a3d = gameport_get_drvdata(gameport);
165 	if (a3d_read_packet(a3d->gameport, a3d->length, data) != a3d->length ||
178 static int a3d_adc_cooked_read(struct gameport *gameport, int *axes, int *buttons)
180 	struct a3d *a3d = gameport->port_data;
190  * a3d_adc_open() is the gameport open routine. It refuses to serve
194 static int a3d_adc_open(struct gameport *gameport, int mode)
196 	struct a3d *a3d = gameport->port_data;
201 	gameport_start_polling(a3d->gameport);
209 static void a3d_adc_close(struct gameport *gameport)
211 	struct a3d *a3d = gameport->port_data;
213 	gameport_stop_polling(a3d->gameport);
224 	gameport_start_polling(a3d->gameport);
236 	gameport_stop_polling(a3d->gameport);
243 static int a3d_connect(struct gameport *gameport, struct gameport_driver *drv)
247 	struct gameport *adc;
260 	a3d->gameport = gameport;
262 	gameport_set_drvdata(gameport, a3d);
264 	err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
268 	i = a3d_read_packet(gameport, A3D_MAX_LENGTH, data);
279 			"(%s, id=%d), contact <vojtech@ucw.cz>\n", gameport->phys, a3d->mode);
284 	gameport_set_poll_handler(gameport, a3d_poll);
285 	gameport_set_poll_interval(gameport, 20);
287 	snprintf(a3d->phys, sizeof(a3d->phys), "%s/input0", gameport->phys);
295 	input_dev->dev.parent = &gameport->dev;
352 			gameport_set_phys(adc, "%s/gameport0", gameport->phys);
353 			adc->dev.parent = &gameport->dev;
367  fail2:	gameport_close(gameport);
368  fail1:	gameport_set_drvdata(gameport, NULL);
374 static void a3d_disconnect(struct gameport *gameport)
376 	struct a3d *a3d = gameport_get_drvdata(gameport);
381 	gameport_close(gameport);
382 	gameport_set_drvdata(gameport, NULL);