input/joystick/gamecon.c

70 struct gc {
84 static struct gc *gc_base[3];
130 static void gc_n64_send_command(struct gc *gc, unsigned long cmd,
133 	struct parport *port = gc->pd->port;
144 static void gc_n64_send_stop_bit(struct gc *gc, unsigned char target)
146 	struct parport *port = gc->pd->port;
162 static void gc_n64_read_packet(struct gc *gc, unsigned char *data)
172 	gc_n64_send_command(gc, GC_N64_REQUEST_DATA, GC_N64_OUT);
173 	gc_n64_send_stop_bit(gc, GC_N64_OUT);
188 		parport_write_data(gc->pd->port, GC_N64_POWER_R);
190 		data[i] = parport_read_status(gc->pd->port);
191 		parport_write_data(gc->pd->port, GC_N64_POWER_R | GC_N64_CLOCK);
202 static void gc_n64_process_packet(struct gc *gc)
209 	gc_n64_read_packet(gc, data);
213 		if (gc->pads[i].type != GC_N64)
216 		dev = gc->pads[i].dev;
252 	struct gc *gc = input_get_drvdata(dev);
265 		gc_n64_send_command(gc, GC_N64_CMD_03, target);
266 		gc_n64_send_command(gc, GC_N64_CMD_80, target);
267 		gc_n64_send_command(gc, GC_N64_CMD_01, target);
269 			gc_n64_send_command(gc, GC_N64_CMD_80, target);
270 		gc_n64_send_stop_bit(gc, target);
275 		gc_n64_send_command(gc, GC_N64_CMD_03, target);
276 		gc_n64_send_command(gc, GC_N64_CMD_c0, target);
277 		gc_n64_send_command(gc, GC_N64_CMD_1b, target);
279 			gc_n64_send_command(gc, cmd, target);
280 		gc_n64_send_stop_bit(gc, target);
338 static void gc_nes_read_packet(struct gc *gc, int length, unsigned char *data)
342 	parport_write_data(gc->pd->port, GC_NES_POWER | GC_NES_CLOCK | GC_NES_LATCH);
344 	parport_write_data(gc->pd->port, GC_NES_POWER | GC_NES_CLOCK);
348 		parport_write_data(gc->pd->port, GC_NES_POWER);
349 		data[i] = parport_read_status(gc->pd->port) ^ 0x7f;
351 		parport_write_data(gc->pd->port, GC_NES_POWER | GC_NES_CLOCK);
355 static void gc_nes_process_packet(struct gc *gc)
363 	len = gc->pad_count[GC_SNESMOUSE] ? GC_SNESMOUSE_LENGTH :
364 			(gc->pad_count[GC_SNES] ? GC_SNES_LENGTH : GC_NES_LENGTH);
366 	gc_nes_read_packet(gc, len, data);
370 		pad = &gc->pads[i];
457 static void gc_multi_read_packet(struct gc *gc, int length, unsigned char *data)
462 		parport_write_data(gc->pd->port, ~(1 << i));
463 		data[i] = parport_read_status(gc->pd->port) ^ 0x7f;
467 static void gc_multi_process_packet(struct gc *gc)
470 	int data_len = gc->pad_count[GC_MULTI2] ? GC_MULTI2_LENGTH : GC_MULTI_LENGTH;
475 	gc_multi_read_packet(gc, data_len, data);
478 		pad = &gc->pads[i];
547 static void gc_psx_command(struct gc *gc, int b, unsigned char *data)
549 	struct parport *port = gc->pd->port;
562 			struct gc_pad *pad = &gc->pads[j];
568 		parport_write_data(gc->pd->port, cmd | GC_PSX_CLOCK | GC_PSX_POWER);
578 static void gc_psx_read_packet(struct gc *gc,
587 	parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_SELECT | GC_PSX_POWER);
590 	parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_POWER);
595 	gc_psx_command(gc, 0x01, data2);	/* Access pad */
596 	gc_psx_command(gc, 0x42, id);		/* Get device ids */
597 	gc_psx_command(gc, 0, data2);		/* Dump status */
601 		struct gc_pad *pad = &gc->pads[i];
612 		gc_psx_command(gc, 0, data2);
619 	parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_SELECT | GC_PSX_POWER);
707 static void gc_psx_process_packet(struct gc *gc)
714 	gc_psx_read_packet(gc, data, id);
717 		pad = &gc->pads[i];
729 	struct gc *gc = from_timer(gc, t, timer);
735 	if (gc->pad_count[GC_N64])
736 		gc_n64_process_packet(gc);
742 	if (gc->pad_count[GC_NES] ||
743 	    gc->pad_count[GC_SNES] ||
744 	    gc->pad_count[GC_SNESMOUSE]) {
745 		gc_nes_process_packet(gc);
752 	if (gc->pad_count[GC_MULTI] || gc->pad_count[GC_MULTI2])
753 		gc_multi_process_packet(gc);
759 	if (gc->pad_count[GC_PSX] || gc->pad_count[GC_DDR])
760 		gc_psx_process_packet(gc);
762 	mod_timer(&gc->timer, jiffies + GC_REFRESH_TIME);
767 	struct gc *gc = input_get_drvdata(dev);
770 	err = mutex_lock_interruptible(&gc->mutex);
774 	if (!gc->used++) {
775 		parport_claim(gc->pd);
776 		parport_write_control(gc->pd->port, 0x04);
777 		mod_timer(&gc->timer, jiffies + GC_REFRESH_TIME);
780 	mutex_unlock(&gc->mutex);
786 	struct gc *gc = input_get_drvdata(dev);
788 	mutex_lock(&gc->mutex);
789 	if (!--gc->used) {
790 		del_timer_sync(&gc->timer);
791 		parport_write_control(gc->pd->port, 0x00);
792 		parport_release(gc->pd);
794 	mutex_unlock(&gc->mutex);
797 static int gc_setup_pad(struct gc *gc, int idx, int pad_type)
799 	struct gc_pad *pad = &gc->pads[idx];
818 		 "%s/input%d", gc->pd->port->name, idx);
827 	input_set_drvdata(input_dev, gc);
840 	gc->pad_count[pad_type]++;
921 	struct gc *gc;
953 	gc = kzalloc(sizeof(struct gc), GFP_KERNEL);
954 	if (!gc) {
959 	mutex_init(&gc->mutex);
960 	gc->pd = pd;
961 	gc->parportno = pp->number;
962 	timer_setup(&gc->timer, gc_timer, 0);
968 		if (gc_setup_pad(gc, i, pads[i]))
979 	gc_base[port_idx] = gc;
984 		if (gc->pads[i].dev)
985 			input_unregister_device(gc->pads[i].dev);
987 	kfree(gc);
995 	struct gc *gc;
1005 	gc = gc_base[i];
1009 		if (gc->pads[i].dev)
1010 			input_unregister_device(gc->pads[i].dev);
1011 	parport_unregister_device(gc->pd);
1012 	kfree(gc);