vserver 1.9.3
[linux-2.6.git] / drivers / input / joystick / gamecon.c
index 02ee05a..46326b7 100644 (file)
@@ -1,28 +1,25 @@
 /*
- * $Id: gamecon.c,v 1.22 2002/07/01 15:42:25 vojtech Exp $
+ * NES, SNES, N64, MultiSystem, PSX gamepad driver for Linux
  *
- *  Copyright (c) 1999-2001 Vojtech Pavlik
+ *  Copyright (c) 1999-2004    Vojtech Pavlik <vojtech@suse.cz>
+ *  Copyright (c) 2004                 Peter Nelson <rufus-kernel@hackish.org>
  *
  *  Based on the work of:
  *     Andree Borrmann         John Dahlstrom
  *     David Kuder             Nathan Hand
  */
 
-/*
- * NES, SNES, N64, MultiSystem, PSX gamepad driver for Linux
- */
-
 /*
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or 
+ * the Free Software Foundation; either version 2 of the License, or
  * (at your option) any later version.
- * 
+ *
  * This program is distributed in the hope that it will be useful,
  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  * GNU General Public License for more details.
- * 
+ *
  * You should have received a copy of the GNU General Public License
  * along with this program; if not, write to the Free Software
  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
@@ -70,13 +67,14 @@ __obsolete_setup("gc_3=");
 #define GC_NES4                3
 #define GC_MULTI       4
 #define GC_MULTI2      5
-#define GC_N64         6       
+#define GC_N64         6
 #define GC_PSX         7
+#define GC_DDR         8
 
-#define GC_MAX         7
+#define GC_MAX         8
 
 #define GC_REFRESH_TIME        HZ/100
+
 struct gc {
        struct pardevice *pd;
        struct input_dev dev[5];
@@ -91,7 +89,8 @@ static struct gc *gc_base[3];
 static int gc_status_bit[] = { 0x40, 0x80, 0x20, 0x10, 0x08 };
 
 static char *gc_names[] = { NULL, "SNES pad", "NES pad", "NES FourPort", "Multisystem joystick",
-                               "Multisystem 2-button joystick", "N64 controller", "PSX controller" };
+                               "Multisystem 2-button joystick", "N64 controller", "PSX controller"
+                               "PSX DDR controller" };
 /*
  * N64 support.
  */
@@ -104,7 +103,7 @@ static short gc_n64_btn[] = { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL,
 #define GC_N64_DELAY           133             /* delay between transmit request, and response ready (us) */
 #define GC_N64_REQUEST         0x1dd1111111ULL /* the request data command (encoded for 000000011) */
 #define GC_N64_DWS             3               /* delay between write segments (required for sound playback because of ISA DMA) */
-                                               /* GC_N64_DWS > 24 is known to fail */ 
+                                               /* GC_N64_DWS > 24 is known to fail */
 #define GC_N64_POWER_W         0xe2            /* power during write (transmit request) */
 #define GC_N64_POWER_R         0xfd            /* power during read */
 #define GC_N64_OUT             0x1d            /* output bits to the 4 pads */
@@ -113,8 +112,8 @@ static short gc_n64_btn[] = { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL,
                                                /* than 123 us */
 #define GC_N64_CLOCK           0x02            /* clock bits for read */
 
-/* 
- * gc_n64_read_packet() reads an N64 packet. 
+/*
+ * gc_n64_read_packet() reads an N64 packet.
  * Each pad uses one bit per byte. So all pads connected to this port are read in parallel.
  */
 
@@ -224,7 +223,7 @@ static void gc_multi_read_packet(struct gc *gc, int length, unsigned char *data)
  *     http://www.dim.com/~mackys/psxmemcard/ps-eng2.txt
  *     http://www.gamesx.com/controldata/psxcont/psxcont.htm
  *     ftp://milano.usal.es/pablo/
- *     
+ *
  */
 
 #define GC_PSX_DELAY   25              /* 25 usec */
@@ -237,7 +236,7 @@ static void gc_multi_read_packet(struct gc *gc, int length, unsigned char *data)
 #define GC_PSX_RUMBLE  7               /* Rumble in Red mode */
 
 #define GC_PSX_CLOCK   0x04            /* Pin 4 */
-#define GC_PSX_COMMAND 0x01            /* Pin 1 */
+#define GC_PSX_COMMAND 0x01            /* Pin 2 */
 #define GC_PSX_POWER   0xf8            /* Pins 5-9 */
 #define GC_PSX_SELECT  0x02            /* Pin 3 */
 
@@ -253,25 +252,29 @@ __obsolete_setup("gc_psx_delay=");
 static short gc_psx_abs[] = { ABS_X, ABS_Y, ABS_RX, ABS_RY, ABS_HAT0X, ABS_HAT0Y };
 static short gc_psx_btn[] = { BTN_TL, BTN_TR, BTN_TL2, BTN_TR2, BTN_A, BTN_B, BTN_X, BTN_Y,
                                BTN_START, BTN_SELECT, BTN_THUMBL, BTN_THUMBR };
+static short gc_psx_ddr_btn[] = { BTN_0, BTN_1, BTN_2, BTN_3 };
 
 /*
  * gc_psx_command() writes 8bit command and reads 8bit data from
  * the psx pad.
  */
 
-static int gc_psx_command(struct gc *gc, int b)
+static void gc_psx_command(struct gc *gc, int b, unsigned char data[GC_PSX_LENGTH])
 {
-       int i, cmd, data = 0;
+       int i, j, cmd, read;
+       for (i = 0; i < 5; i++)
+               data[i] = 0;
 
        for (i = 0; i < 8; i++, b >>= 1) {
                cmd = (b & 1) ? GC_PSX_COMMAND : 0;
                parport_write_data(gc->pd->port, cmd | GC_PSX_POWER);
                udelay(gc_psx_delay);
-               data |= ((parport_read_status(gc->pd->port) ^ 0x80) & gc->pads[GC_PSX]) ? (1 << i) : 0;
+               read = parport_read_status(gc->pd->port) ^ 0x80;
+               for (j = 0; j < 5; j++)
+                       data[j] |= (read & gc_status_bit[j] & gc->pads[GC_PSX]) ? (1 << i) : 0;
                parport_write_data(gc->pd->port, cmd | GC_PSX_CLOCK | GC_PSX_POWER);
                udelay(gc_psx_delay);
        }
-       return data;
 }
 
 /*
@@ -279,30 +282,39 @@ static int gc_psx_command(struct gc *gc, int b)
  * device identifier code.
  */
 
-static int gc_psx_read_packet(struct gc *gc, unsigned char *data)
+static void gc_psx_read_packet(struct gc *gc, unsigned char data[5][GC_PSX_LENGTH], unsigned char id[5])
 {
-       int i, id;
+       int i, j, max_len = 0;
        unsigned long flags;
+       unsigned char data2[5];
 
        parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_SELECT | GC_PSX_POWER);  /* Select pad */
-       udelay(gc_psx_delay * 2);
+       udelay(gc_psx_delay);
        parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_POWER);                  /* Deselect, begin command */
-       udelay(gc_psx_delay * 2);
+       udelay(gc_psx_delay);
 
        local_irq_save(flags);
 
-       gc_psx_command(gc, 0x01);                                                       /* Access pad */
-       id = gc_psx_command(gc, 0x42);                                                  /* Get device id */
-       if (gc_psx_command(gc, 0) == 0x5a) {                                            /* Okay? */
-               for (i = 0; i < GC_PSX_LEN(id) * 2; i++)
-                       data[i] = gc_psx_command(gc, 0);
-       } else id = 0;
+       gc_psx_command(gc, 0x01, data2);                                                /* Access pad */
+       gc_psx_command(gc, 0x42, id);                                                   /* Get device ids */
+       gc_psx_command(gc, 0, data2);                                                   /* Dump status */
+
+       for (i =0; i < 5; i++)                                                          /* Find the longest pad */
+               if((gc_status_bit[i] & gc->pads[GC_PSX]) && (GC_PSX_LEN(id[i]) > max_len))
+                       max_len = GC_PSX_LEN(id[i]);
+
+       for (i = 0; i < max_len * 2; i++) {                                             /* Read in all the data */
+               gc_psx_command(gc, 0, data2);
+               for (j = 0; j < 5; j++)
+                       data[j][i] = data2[j];
+       }
 
        local_irq_restore(flags);
 
        parport_write_data(gc->pd->port, GC_PSX_CLOCK | GC_PSX_SELECT | GC_PSX_POWER);
 
-       return GC_PSX_ID(id);
+       for(i = 0; i < 5; i++)                                                          /* Set id's to the real value */
+               id[i] = GC_PSX_ID(id[i]);
 }
 
 /*
@@ -316,6 +328,7 @@ static void gc_timer(unsigned long private)
        struct gc *gc = (void *) private;
        struct input_dev *dev = gc->dev;
        unsigned char data[GC_MAX_LENGTH];
+       unsigned char data_psx[5][GC_PSX_LENGTH];
        int i, j, s;
 
 /*
@@ -331,13 +344,13 @@ static void gc_timer(unsigned long private)
                        s = gc_status_bit[i];
 
                        if (s & gc->pads[GC_N64] & ~(data[8] | data[9])) {
-       
+
                                signed char axes[2];
                                axes[0] = axes[1] = 0;
 
                                for (j = 0; j < 8; j++) {
-                                       if (data[23 - j] & s) axes[0] |= 1 << j; 
-                                       if (data[31 - j] & s) axes[1] |= 1 << j; 
+                                       if (data[23 - j] & s) axes[0] |= 1 << j;
+                                       if (data[31 - j] & s) axes[1] |= 1 << j;
                                }
 
                                input_report_abs(dev + i, ABS_X,  axes[0]);
@@ -412,53 +425,72 @@ static void gc_timer(unsigned long private)
  * PSX controllers
  */
 
-       if (gc->pads[GC_PSX]) {
+       if (gc->pads[GC_PSX] || gc->pads[GC_DDR]) {
 
-               for (i = 0; i < 5; i++)
-                       if (gc->pads[GC_PSX] & gc_status_bit[i])
-                               break;
+               gc_psx_read_packet(gc, data_psx, data);
 
-               switch (gc_psx_read_packet(gc, data)) {
+               for (i = 0; i < 5; i++) {
+                       switch (data[i]) {
 
-                       case GC_PSX_RUMBLE:
+                               case GC_PSX_RUMBLE:
 
-                               input_report_key(dev + i, BTN_THUMBL, ~data[0] & 0x04);
-                               input_report_key(dev + i, BTN_THUMBR, ~data[0] & 0x02);
-                               input_sync(dev + i);
+                                       input_report_key(dev + i, BTN_THUMBL, ~data_psx[i][0] & 0x04);
+                                       input_report_key(dev + i, BTN_THUMBR, ~data_psx[i][0] & 0x02);
 
-                       case GC_PSX_NEGCON:
-                       case GC_PSX_ANALOG:
+                               case GC_PSX_NEGCON:
+                               case GC_PSX_ANALOG:
 
-                               for (j = 0; j < 4; j++)
-                                       input_report_abs(dev + i, gc_psx_abs[j], data[j + 2]);
+                                       if(gc->pads[GC_DDR] & gc_status_bit[i]) {
+                                               for(j = 0; j < 4; j++)
+                                                       input_report_key(dev + i, gc_psx_ddr_btn[j], ~data_psx[i][0] & (0x10 << j));
+                                       } else {
+                                               for (j = 0; j < 4; j++)
+                                                       input_report_abs(dev + i, gc_psx_abs[j+2], data_psx[i][j + 2]);
 
-                               input_report_abs(dev + i, ABS_HAT0X, !(data[0] & 0x20) - !(data[0] & 0x80));
-                               input_report_abs(dev + i, ABS_HAT0Y, !(data[0] & 0x40) - !(data[0] & 0x10));
+                                               input_report_abs(dev + i, ABS_X, 128 + !(data_psx[i][0] & 0x20) * 127 - !(data_psx[i][0] & 0x80) * 128);
+                                               input_report_abs(dev + i, ABS_Y, 128 + !(data_psx[i][0] & 0x40) * 127 - !(data_psx[i][0] & 0x10) * 128);
+                                       }
 
-                               for (j = 0; j < 8; j++)
-                                       input_report_key(dev + i, gc_psx_btn[j], ~data[1] & (1 << j));
+                                       for (j = 0; j < 8; j++)
+                                               input_report_key(dev + i, gc_psx_btn[j], ~data_psx[i][1] & (1 << j));
 
-                               input_report_key(dev + i, BTN_START,  ~data[0] & 0x08);
-                               input_report_key(dev + i, BTN_SELECT, ~data[0] & 0x01);
+                                       input_report_key(dev + i, BTN_START,  ~data_psx[i][0] & 0x08);
+                                       input_report_key(dev + i, BTN_SELECT, ~data_psx[i][0] & 0x01);
 
-                               input_sync(dev + i);
+                                       input_sync(dev + i);
 
-                               break;
+                                       break;
 
-                       case GC_PSX_NORMAL:
+                               case GC_PSX_NORMAL:
+                                       if(gc->pads[GC_DDR] & gc_status_bit[i]) {
+                                               for(j = 0; j < 4; j++)
+                                                       input_report_key(dev + i, gc_psx_ddr_btn[j], ~data_psx[i][0] & (0x10 << j));
+                                       } else {
+                                               input_report_abs(dev + i, ABS_X, 128 + !(data_psx[i][0] & 0x20) * 127 - !(data_psx[i][0] & 0x80) * 128);
+                                               input_report_abs(dev + i, ABS_Y, 128 + !(data_psx[i][0] & 0x40) * 127 - !(data_psx[i][0] & 0x10) * 128);
 
-                               input_report_abs(dev + i, ABS_X, 128 + !(data[0] & 0x20) * 127 - !(data[0] & 0x80) * 128);
-                               input_report_abs(dev + i, ABS_Y, 128 + !(data[0] & 0x40) * 127 - !(data[0] & 0x10) * 128);
+                                               /* for some reason if the extra axes are left unset they drift */
+                                               /* for (j = 0; j < 4; j++)
+                                                       input_report_abs(dev + i, gc_psx_abs[j+2], 128);
+                                                * This needs to be debugged properly,
+                                                * maybe fuzz processing needs to be done in input_sync()
+                                                *                               --vojtech
+                                                */
+                                       }
 
-                               for (j = 0; j < 8; j++)
-                                       input_report_key(dev + i, gc_psx_btn[j], ~data[1] & (1 << j));
+                                       for (j = 0; j < 8; j++)
+                                               input_report_key(dev + i, gc_psx_btn[j], ~data_psx[i][1] & (1 << j));
 
-                               input_report_key(dev + i, BTN_START,  ~data[0] & 0x08);
-                               input_report_key(dev + i, BTN_SELECT, ~data[0] & 0x01);
+                                       input_report_key(dev + i, BTN_START,  ~data_psx[i][0] & 0x08);
+                                       input_report_key(dev + i, BTN_SELECT, ~data_psx[i][0] & 0x01);
 
-                               input_sync(dev + i);
+                                       input_sync(dev + i);
 
-                               break;
+                                       break;
+
+                               case 0: /* not a pad, ignore */
+                                       break;
+                       }
                }
        }
 
@@ -490,8 +522,7 @@ static struct gc __init *gc_probe(int *config, int nargs)
 {
        struct gc *gc;
        struct parport *pp;
-       int i, j, psx;
-       unsigned char data[32];
+       int i, j;
 
        if (config[0] < 0)
                return NULL;
@@ -588,48 +619,27 @@ static struct gc __init *gc_probe(int *config, int nargs)
                                break;
 
                        case GC_PSX:
-                               
-                               psx = gc_psx_read_packet(gc, data);
-
-                               switch(psx) {
-                                       case GC_PSX_NEGCON:
-                                       case GC_PSX_NORMAL:
-                                       case GC_PSX_ANALOG:
-                                       case GC_PSX_RUMBLE:
-
-                                               for (j = 0; j < 6; j++) {
-                                                       psx = gc_psx_abs[j];
-                                                       set_bit(psx, gc->dev[i].absbit);
-                                                       if (j < 4) {
-                                                               gc->dev[i].absmin[psx] = 4;
-                                                               gc->dev[i].absmax[psx] = 252;
-                                                               gc->dev[i].absflat[psx] = 2;
-                                                       } else {
-                                                               gc->dev[i].absmin[psx] = -1;
-                                                               gc->dev[i].absmax[psx] = 1;
-                                                       }
-                                               }
-
-                                               for (j = 0; j < 12; j++)
-                                                       set_bit(gc_psx_btn[j], gc->dev[i].keybit);
-
-                                               break;
-
-                                       case 0:
-                                               gc->pads[GC_PSX] &= ~gc_status_bit[i];
-                                               printk(KERN_ERR "gamecon.c: No PSX controller found.\n");
-                                               break;
-
-                                       default:
-                                               gc->pads[GC_PSX] &= ~gc_status_bit[i];
-                                               printk(KERN_WARNING "gamecon.c: Unsupported PSX controller %#x,"
-                                                       " please report to <vojtech@ucw.cz>.\n", psx);
+                       case GC_DDR:
+                               if(config[i + 1] == GC_DDR) {
+                                       for (j = 0; j < 4; j++)
+                                               set_bit(gc_psx_ddr_btn[j], gc->dev[i].keybit);
+                               } else {
+                                       for (j = 0; j < 6; j++) {
+                                               set_bit(gc_psx_abs[j], gc->dev[i].absbit);
+                                               gc->dev[i].absmin[gc_psx_abs[j]] = 4;
+                                               gc->dev[i].absmax[gc_psx_abs[j]] = 252;
+                                               gc->dev[i].absflat[gc_psx_abs[j]] = 2;
+                                       }
                                }
+
+                               for (j = 0; j < 12; j++)
+                                       set_bit(gc_psx_btn[j], gc->dev[i].keybit);
+
                                break;
                }
 
                sprintf(gc->phys[i], "%s/input%d", gc->pd->port->name, i);
-               
+
                 gc->dev[i].name = gc_names[config[i + 1]];
                gc->dev[i].phys = gc->phys[i];
                 gc->dev[i].id.bustype = BUS_PARPORT;
@@ -646,7 +656,7 @@ static struct gc __init *gc_probe(int *config, int nargs)
                return NULL;
        }
 
-       for (i = 0; i < 5; i++) 
+       for (i = 0; i < 5; i++)
                if (gc->pads[0] & gc_status_bit[i]) {
                        input_register_device(gc->dev + i);
                        printk(KERN_INFO "input: %s on %s\n", gc->dev[i].name, gc->pd->port->name);
@@ -675,7 +685,7 @@ void __exit gc_exit(void)
                if (gc_base[i]) {
                        for (j = 0; j < 5; j++)
                                if (gc_base[i]->pads[0] & gc_status_bit[j])
-                                       input_unregister_device(gc_base[i]->dev + j); 
+                                       input_unregister_device(gc_base[i]->dev + j);
                        parport_unregister_device(gc_base[i]->pd);
                }
 }