11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds * Copyright (c) 1998-2001 Vojtech Pavlik
41da177e4SLinus Torvalds */
51da177e4SLinus Torvalds
61da177e4SLinus Torvalds /*
71da177e4SLinus Torvalds * Gravis/Kensington GrIP protocol joystick and gamepad driver for Linux
81da177e4SLinus Torvalds */
91da177e4SLinus Torvalds
101da177e4SLinus Torvalds #include <linux/kernel.h>
111da177e4SLinus Torvalds #include <linux/module.h>
121da177e4SLinus Torvalds #include <linux/slab.h>
131da177e4SLinus Torvalds #include <linux/gameport.h>
141da177e4SLinus Torvalds #include <linux/input.h>
154e57b681STim Schmielau #include <linux/jiffies.h>
161da177e4SLinus Torvalds
171da177e4SLinus Torvalds #define DRIVER_DESC "Gravis GrIP protocol joystick driver"
181da177e4SLinus Torvalds
191da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
201da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC);
211da177e4SLinus Torvalds MODULE_LICENSE("GPL");
221da177e4SLinus Torvalds
231da177e4SLinus Torvalds #define GRIP_MODE_GPP 1
241da177e4SLinus Torvalds #define GRIP_MODE_BD 2
251da177e4SLinus Torvalds #define GRIP_MODE_XT 3
261da177e4SLinus Torvalds #define GRIP_MODE_DC 4
271da177e4SLinus Torvalds
281da177e4SLinus Torvalds #define GRIP_LENGTH_GPP 24
291da177e4SLinus Torvalds #define GRIP_STROBE_GPP 200 /* 200 us */
301da177e4SLinus Torvalds #define GRIP_LENGTH_XT 4
311da177e4SLinus Torvalds #define GRIP_STROBE_XT 64 /* 64 us */
321da177e4SLinus Torvalds #define GRIP_MAX_CHUNKS_XT 10
331da177e4SLinus Torvalds #define GRIP_MAX_BITS_XT 30
341da177e4SLinus Torvalds
351da177e4SLinus Torvalds struct grip {
361da177e4SLinus Torvalds struct gameport *gameport;
3717dd3f0fSDmitry Torokhov struct input_dev *dev[2];
381da177e4SLinus Torvalds unsigned char mode[2];
391da177e4SLinus Torvalds int reads;
401da177e4SLinus Torvalds int bads;
411da177e4SLinus Torvalds char phys[2][32];
421da177e4SLinus Torvalds };
431da177e4SLinus Torvalds
441da177e4SLinus Torvalds static int grip_btn_gpp[] = { BTN_START, BTN_SELECT, BTN_TR2, BTN_Y, 0, BTN_TL2, BTN_A, BTN_B, BTN_X, 0, BTN_TL, BTN_TR, -1 };
451da177e4SLinus Torvalds static int grip_btn_bd[] = { BTN_THUMB, BTN_THUMB2, BTN_TRIGGER, BTN_TOP, BTN_BASE, -1 };
461da177e4SLinus Torvalds static int grip_btn_xt[] = { BTN_TRIGGER, BTN_THUMB, BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_SELECT, BTN_START, BTN_MODE, -1 };
471da177e4SLinus Torvalds static int grip_btn_dc[] = { BTN_TRIGGER, BTN_THUMB, BTN_TOP, BTN_TOP2, BTN_BASE, BTN_BASE2, BTN_BASE3, BTN_BASE4, BTN_BASE5, -1 };
481da177e4SLinus Torvalds
491da177e4SLinus Torvalds static int grip_abs_gpp[] = { ABS_X, ABS_Y, -1 };
501da177e4SLinus Torvalds static int grip_abs_bd[] = { ABS_X, ABS_Y, ABS_THROTTLE, ABS_HAT0X, ABS_HAT0Y, -1 };
511da177e4SLinus Torvalds static int grip_abs_xt[] = { ABS_X, ABS_Y, ABS_BRAKE, ABS_GAS, ABS_THROTTLE, ABS_HAT0X, ABS_HAT0Y, ABS_HAT1X, ABS_HAT1Y, -1 };
521da177e4SLinus Torvalds static int grip_abs_dc[] = { ABS_X, ABS_Y, ABS_RX, ABS_RY, ABS_THROTTLE, ABS_HAT0X, ABS_HAT0Y, -1 };
531da177e4SLinus Torvalds
541da177e4SLinus Torvalds static char *grip_name[] = { NULL, "Gravis GamePad Pro", "Gravis Blackhawk Digital",
551da177e4SLinus Torvalds "Gravis Xterminator Digital", "Gravis Xterminator DualControl" };
561da177e4SLinus Torvalds static int *grip_abs[] = { NULL, grip_abs_gpp, grip_abs_bd, grip_abs_xt, grip_abs_dc };
571da177e4SLinus Torvalds static int *grip_btn[] = { NULL, grip_btn_gpp, grip_btn_bd, grip_btn_xt, grip_btn_dc };
581da177e4SLinus Torvalds static char grip_anx[] = { 0, 0, 3, 5, 5 };
591da177e4SLinus Torvalds static char grip_cen[] = { 0, 0, 2, 2, 4 };
601da177e4SLinus Torvalds
611da177e4SLinus Torvalds /*
621da177e4SLinus Torvalds * grip_gpp_read_packet() reads a Gravis GamePad Pro packet.
631da177e4SLinus Torvalds */
641da177e4SLinus Torvalds
grip_gpp_read_packet(struct gameport * gameport,int shift,unsigned int * data)651da177e4SLinus Torvalds static int grip_gpp_read_packet(struct gameport *gameport, int shift, unsigned int *data)
661da177e4SLinus Torvalds {
671da177e4SLinus Torvalds unsigned long flags;
681da177e4SLinus Torvalds unsigned char u, v;
691da177e4SLinus Torvalds unsigned int t;
701da177e4SLinus Torvalds int i;
711da177e4SLinus Torvalds
721da177e4SLinus Torvalds int strobe = gameport_time(gameport, GRIP_STROBE_GPP);
731da177e4SLinus Torvalds
741da177e4SLinus Torvalds data[0] = 0;
751da177e4SLinus Torvalds t = strobe;
761da177e4SLinus Torvalds i = 0;
771da177e4SLinus Torvalds
781da177e4SLinus Torvalds local_irq_save(flags);
791da177e4SLinus Torvalds
801da177e4SLinus Torvalds v = gameport_read(gameport) >> shift;
811da177e4SLinus Torvalds
821da177e4SLinus Torvalds do {
831da177e4SLinus Torvalds t--;
841da177e4SLinus Torvalds u = v; v = (gameport_read(gameport) >> shift) & 3;
851da177e4SLinus Torvalds if (~v & u & 1) {
861da177e4SLinus Torvalds data[0] |= (v >> 1) << i++;
871da177e4SLinus Torvalds t = strobe;
881da177e4SLinus Torvalds }
891da177e4SLinus Torvalds } while (i < GRIP_LENGTH_GPP && t > 0);
901da177e4SLinus Torvalds
911da177e4SLinus Torvalds local_irq_restore(flags);
921da177e4SLinus Torvalds
931da177e4SLinus Torvalds if (i < GRIP_LENGTH_GPP) return -1;
941da177e4SLinus Torvalds
951da177e4SLinus Torvalds for (i = 0; i < GRIP_LENGTH_GPP && (data[0] & 0xfe4210) ^ 0x7c0000; i++)
961da177e4SLinus Torvalds data[0] = data[0] >> 1 | (data[0] & 1) << (GRIP_LENGTH_GPP - 1);
971da177e4SLinus Torvalds
981da177e4SLinus Torvalds return -(i == GRIP_LENGTH_GPP);
991da177e4SLinus Torvalds }
1001da177e4SLinus Torvalds
1011da177e4SLinus Torvalds /*
1021da177e4SLinus Torvalds * grip_xt_read_packet() reads a Gravis Xterminator packet.
1031da177e4SLinus Torvalds */
1041da177e4SLinus Torvalds
grip_xt_read_packet(struct gameport * gameport,int shift,unsigned int * data)1051da177e4SLinus Torvalds static int grip_xt_read_packet(struct gameport *gameport, int shift, unsigned int *data)
1061da177e4SLinus Torvalds {
1071da177e4SLinus Torvalds unsigned int i, j, buf, crc;
1081da177e4SLinus Torvalds unsigned char u, v, w;
1091da177e4SLinus Torvalds unsigned long flags;
1101da177e4SLinus Torvalds unsigned int t;
1111da177e4SLinus Torvalds char status;
1121da177e4SLinus Torvalds
1131da177e4SLinus Torvalds int strobe = gameport_time(gameport, GRIP_STROBE_XT);
1141da177e4SLinus Torvalds
1151da177e4SLinus Torvalds data[0] = data[1] = data[2] = data[3] = 0;
1161da177e4SLinus Torvalds status = buf = i = j = 0;
1171da177e4SLinus Torvalds t = strobe;
1181da177e4SLinus Torvalds
1191da177e4SLinus Torvalds local_irq_save(flags);
1201da177e4SLinus Torvalds
1211da177e4SLinus Torvalds v = w = (gameport_read(gameport) >> shift) & 3;
1221da177e4SLinus Torvalds
1231da177e4SLinus Torvalds do {
1241da177e4SLinus Torvalds t--;
1251da177e4SLinus Torvalds u = (gameport_read(gameport) >> shift) & 3;
1261da177e4SLinus Torvalds
1271da177e4SLinus Torvalds if (u ^ v) {
1281da177e4SLinus Torvalds
1291da177e4SLinus Torvalds if ((u ^ v) & 1) {
1301da177e4SLinus Torvalds buf = (buf << 1) | (u >> 1);
1311da177e4SLinus Torvalds t = strobe;
1321da177e4SLinus Torvalds i++;
1331da177e4SLinus Torvalds } else
1341da177e4SLinus Torvalds
1351da177e4SLinus Torvalds if ((((u ^ v) & (v ^ w)) >> 1) & ~(u | v | w) & 1) {
1361da177e4SLinus Torvalds if (i == 20) {
1371da177e4SLinus Torvalds crc = buf ^ (buf >> 7) ^ (buf >> 14);
1381da177e4SLinus Torvalds if (!((crc ^ (0x25cb9e70 >> ((crc >> 2) & 0x1c))) & 0xf)) {
1391da177e4SLinus Torvalds data[buf >> 18] = buf >> 4;
1401da177e4SLinus Torvalds status |= 1 << (buf >> 18);
1411da177e4SLinus Torvalds }
1421da177e4SLinus Torvalds j++;
1431da177e4SLinus Torvalds }
1441da177e4SLinus Torvalds t = strobe;
1451da177e4SLinus Torvalds buf = 0;
1461da177e4SLinus Torvalds i = 0;
1471da177e4SLinus Torvalds }
1481da177e4SLinus Torvalds w = v;
1491da177e4SLinus Torvalds v = u;
1501da177e4SLinus Torvalds }
1511da177e4SLinus Torvalds
1521da177e4SLinus Torvalds } while (status != 0xf && i < GRIP_MAX_BITS_XT && j < GRIP_MAX_CHUNKS_XT && t > 0);
1531da177e4SLinus Torvalds
1541da177e4SLinus Torvalds local_irq_restore(flags);
1551da177e4SLinus Torvalds
1561da177e4SLinus Torvalds return -(status != 0xf);
1571da177e4SLinus Torvalds }
1581da177e4SLinus Torvalds
1591da177e4SLinus Torvalds /*
1601da177e4SLinus Torvalds * grip_timer() repeatedly polls the joysticks and generates events.
1611da177e4SLinus Torvalds */
1621da177e4SLinus Torvalds
grip_poll(struct gameport * gameport)1631da177e4SLinus Torvalds static void grip_poll(struct gameport *gameport)
1641da177e4SLinus Torvalds {
1651da177e4SLinus Torvalds struct grip *grip = gameport_get_drvdata(gameport);
1661da177e4SLinus Torvalds unsigned int data[GRIP_LENGTH_XT];
1671da177e4SLinus Torvalds struct input_dev *dev;
1681da177e4SLinus Torvalds int i, j;
1691da177e4SLinus Torvalds
1701da177e4SLinus Torvalds for (i = 0; i < 2; i++) {
1711da177e4SLinus Torvalds
17217dd3f0fSDmitry Torokhov dev = grip->dev[i];
1733575c341SDmitry Torokhov if (!dev)
1743575c341SDmitry Torokhov continue;
1753575c341SDmitry Torokhov
1761da177e4SLinus Torvalds grip->reads++;
1771da177e4SLinus Torvalds
1781da177e4SLinus Torvalds switch (grip->mode[i]) {
1791da177e4SLinus Torvalds
1801da177e4SLinus Torvalds case GRIP_MODE_GPP:
1811da177e4SLinus Torvalds
1821da177e4SLinus Torvalds if (grip_gpp_read_packet(grip->gameport, (i << 1) + 4, data)) {
1831da177e4SLinus Torvalds grip->bads++;
1841da177e4SLinus Torvalds break;
1851da177e4SLinus Torvalds }
1861da177e4SLinus Torvalds
1871da177e4SLinus Torvalds input_report_abs(dev, ABS_X, ((*data >> 15) & 1) - ((*data >> 16) & 1));
1881da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, ((*data >> 13) & 1) - ((*data >> 12) & 1));
1891da177e4SLinus Torvalds
1901da177e4SLinus Torvalds for (j = 0; j < 12; j++)
1911da177e4SLinus Torvalds if (grip_btn_gpp[j])
1921da177e4SLinus Torvalds input_report_key(dev, grip_btn_gpp[j], (*data >> j) & 1);
1931da177e4SLinus Torvalds
1941da177e4SLinus Torvalds break;
1951da177e4SLinus Torvalds
1961da177e4SLinus Torvalds case GRIP_MODE_BD:
1971da177e4SLinus Torvalds
1981da177e4SLinus Torvalds if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
1991da177e4SLinus Torvalds grip->bads++;
2001da177e4SLinus Torvalds break;
2011da177e4SLinus Torvalds }
2021da177e4SLinus Torvalds
2031da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data[0] >> 2) & 0x3f);
2041da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, 63 - ((data[0] >> 8) & 0x3f));
2051da177e4SLinus Torvalds input_report_abs(dev, ABS_THROTTLE, (data[2] >> 8) & 0x3f);
2061da177e4SLinus Torvalds
2071da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0X, ((data[2] >> 1) & 1) - ( data[2] & 1));
2081da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0Y, ((data[2] >> 2) & 1) - ((data[2] >> 3) & 1));
2091da177e4SLinus Torvalds
2101da177e4SLinus Torvalds for (j = 0; j < 5; j++)
2111da177e4SLinus Torvalds input_report_key(dev, grip_btn_bd[j], (data[3] >> (j + 4)) & 1);
2121da177e4SLinus Torvalds
2131da177e4SLinus Torvalds break;
2141da177e4SLinus Torvalds
2151da177e4SLinus Torvalds case GRIP_MODE_XT:
2161da177e4SLinus Torvalds
2171da177e4SLinus Torvalds if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
2181da177e4SLinus Torvalds grip->bads++;
2191da177e4SLinus Torvalds break;
2201da177e4SLinus Torvalds }
2211da177e4SLinus Torvalds
2221da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data[0] >> 2) & 0x3f);
2231da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, 63 - ((data[0] >> 8) & 0x3f));
2241da177e4SLinus Torvalds input_report_abs(dev, ABS_BRAKE, (data[1] >> 2) & 0x3f);
2251da177e4SLinus Torvalds input_report_abs(dev, ABS_GAS, (data[1] >> 8) & 0x3f);
2261da177e4SLinus Torvalds input_report_abs(dev, ABS_THROTTLE, (data[2] >> 8) & 0x3f);
2271da177e4SLinus Torvalds
2281da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0X, ((data[2] >> 1) & 1) - ( data[2] & 1));
2291da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0Y, ((data[2] >> 2) & 1) - ((data[2] >> 3) & 1));
2301da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT1X, ((data[2] >> 5) & 1) - ((data[2] >> 4) & 1));
2311da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT1Y, ((data[2] >> 6) & 1) - ((data[2] >> 7) & 1));
2321da177e4SLinus Torvalds
2331da177e4SLinus Torvalds for (j = 0; j < 11; j++)
2341da177e4SLinus Torvalds input_report_key(dev, grip_btn_xt[j], (data[3] >> (j + 3)) & 1);
2351da177e4SLinus Torvalds break;
2361da177e4SLinus Torvalds
2371da177e4SLinus Torvalds case GRIP_MODE_DC:
2381da177e4SLinus Torvalds
2391da177e4SLinus Torvalds if (grip_xt_read_packet(grip->gameport, (i << 1) + 4, data)) {
2401da177e4SLinus Torvalds grip->bads++;
2411da177e4SLinus Torvalds break;
2421da177e4SLinus Torvalds }
2431da177e4SLinus Torvalds
2441da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data[0] >> 2) & 0x3f);
2451da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data[0] >> 8) & 0x3f);
2461da177e4SLinus Torvalds input_report_abs(dev, ABS_RX, (data[1] >> 2) & 0x3f);
2471da177e4SLinus Torvalds input_report_abs(dev, ABS_RY, (data[1] >> 8) & 0x3f);
2481da177e4SLinus Torvalds input_report_abs(dev, ABS_THROTTLE, (data[2] >> 8) & 0x3f);
2491da177e4SLinus Torvalds
2501da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0X, ((data[2] >> 1) & 1) - ( data[2] & 1));
2511da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0Y, ((data[2] >> 2) & 1) - ((data[2] >> 3) & 1));
2521da177e4SLinus Torvalds
2531da177e4SLinus Torvalds for (j = 0; j < 9; j++)
2541da177e4SLinus Torvalds input_report_key(dev, grip_btn_dc[j], (data[3] >> (j + 3)) & 1);
2551da177e4SLinus Torvalds break;
2561da177e4SLinus Torvalds
2571da177e4SLinus Torvalds
2581da177e4SLinus Torvalds }
2591da177e4SLinus Torvalds
2601da177e4SLinus Torvalds input_sync(dev);
2611da177e4SLinus Torvalds }
2621da177e4SLinus Torvalds }
2631da177e4SLinus Torvalds
grip_open(struct input_dev * dev)2641da177e4SLinus Torvalds static int grip_open(struct input_dev *dev)
2651da177e4SLinus Torvalds {
2668715c1cfSDmitry Torokhov struct grip *grip = input_get_drvdata(dev);
2671da177e4SLinus Torvalds
2681da177e4SLinus Torvalds gameport_start_polling(grip->gameport);
2691da177e4SLinus Torvalds return 0;
2701da177e4SLinus Torvalds }
2711da177e4SLinus Torvalds
grip_close(struct input_dev * dev)2721da177e4SLinus Torvalds static void grip_close(struct input_dev *dev)
2731da177e4SLinus Torvalds {
2748715c1cfSDmitry Torokhov struct grip *grip = input_get_drvdata(dev);
2751da177e4SLinus Torvalds
2761da177e4SLinus Torvalds gameport_stop_polling(grip->gameport);
2771da177e4SLinus Torvalds }
2781da177e4SLinus Torvalds
grip_connect(struct gameport * gameport,struct gameport_driver * drv)2791da177e4SLinus Torvalds static int grip_connect(struct gameport *gameport, struct gameport_driver *drv)
2801da177e4SLinus Torvalds {
2811da177e4SLinus Torvalds struct grip *grip;
28217dd3f0fSDmitry Torokhov struct input_dev *input_dev;
2831da177e4SLinus Torvalds unsigned int data[GRIP_LENGTH_XT];
2841da177e4SLinus Torvalds int i, j, t;
2851da177e4SLinus Torvalds int err;
2861da177e4SLinus Torvalds
287*4654c4ccSErick Archer grip = kzalloc(sizeof(*grip), GFP_KERNEL);
288*4654c4ccSErick Archer if (!grip)
2891da177e4SLinus Torvalds return -ENOMEM;
2901da177e4SLinus Torvalds
2911da177e4SLinus Torvalds grip->gameport = gameport;
2921da177e4SLinus Torvalds
2931da177e4SLinus Torvalds gameport_set_drvdata(gameport, grip);
2941da177e4SLinus Torvalds
2951da177e4SLinus Torvalds err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
2961da177e4SLinus Torvalds if (err)
2971da177e4SLinus Torvalds goto fail1;
2981da177e4SLinus Torvalds
2991da177e4SLinus Torvalds for (i = 0; i < 2; i++) {
3001da177e4SLinus Torvalds if (!grip_gpp_read_packet(gameport, (i << 1) + 4, data)) {
3011da177e4SLinus Torvalds grip->mode[i] = GRIP_MODE_GPP;
3021da177e4SLinus Torvalds continue;
3031da177e4SLinus Torvalds }
3041da177e4SLinus Torvalds if (!grip_xt_read_packet(gameport, (i << 1) + 4, data)) {
3051da177e4SLinus Torvalds if (!(data[3] & 7)) {
3061da177e4SLinus Torvalds grip->mode[i] = GRIP_MODE_BD;
3071da177e4SLinus Torvalds continue;
3081da177e4SLinus Torvalds }
3091da177e4SLinus Torvalds if (!(data[2] & 0xf0)) {
3101da177e4SLinus Torvalds grip->mode[i] = GRIP_MODE_XT;
3111da177e4SLinus Torvalds continue;
3121da177e4SLinus Torvalds }
3131da177e4SLinus Torvalds grip->mode[i] = GRIP_MODE_DC;
3141da177e4SLinus Torvalds continue;
3151da177e4SLinus Torvalds }
3161da177e4SLinus Torvalds }
3171da177e4SLinus Torvalds
3181da177e4SLinus Torvalds if (!grip->mode[0] && !grip->mode[1]) {
3191da177e4SLinus Torvalds err = -ENODEV;
3201da177e4SLinus Torvalds goto fail2;
3211da177e4SLinus Torvalds }
3221da177e4SLinus Torvalds
3231da177e4SLinus Torvalds gameport_set_poll_handler(gameport, grip_poll);
3241da177e4SLinus Torvalds gameport_set_poll_interval(gameport, 20);
3251da177e4SLinus Torvalds
32617dd3f0fSDmitry Torokhov for (i = 0; i < 2; i++) {
32717dd3f0fSDmitry Torokhov if (!grip->mode[i])
32817dd3f0fSDmitry Torokhov continue;
32917dd3f0fSDmitry Torokhov
33017dd3f0fSDmitry Torokhov grip->dev[i] = input_dev = input_allocate_device();
33117dd3f0fSDmitry Torokhov if (!input_dev) {
33217dd3f0fSDmitry Torokhov err = -ENOMEM;
33317dd3f0fSDmitry Torokhov goto fail3;
33417dd3f0fSDmitry Torokhov }
3351da177e4SLinus Torvalds
33610ca4c0aSDmitry Torokhov snprintf(grip->phys[i], sizeof(grip->phys[i]),
33710ca4c0aSDmitry Torokhov "%s/input%d", gameport->phys, i);
3381da177e4SLinus Torvalds
33917dd3f0fSDmitry Torokhov input_dev->name = grip_name[grip->mode[i]];
34017dd3f0fSDmitry Torokhov input_dev->phys = grip->phys[i];
34117dd3f0fSDmitry Torokhov input_dev->id.bustype = BUS_GAMEPORT;
34217dd3f0fSDmitry Torokhov input_dev->id.vendor = GAMEPORT_ID_VENDOR_GRAVIS;
34317dd3f0fSDmitry Torokhov input_dev->id.product = grip->mode[i];
34417dd3f0fSDmitry Torokhov input_dev->id.version = 0x0100;
345935e658eSDmitry Torokhov input_dev->dev.parent = &gameport->dev;
3468715c1cfSDmitry Torokhov
3478715c1cfSDmitry Torokhov input_set_drvdata(input_dev, grip);
3481da177e4SLinus Torvalds
34917dd3f0fSDmitry Torokhov input_dev->open = grip_open;
35017dd3f0fSDmitry Torokhov input_dev->close = grip_close;
3511da177e4SLinus Torvalds
3527b19ada2SJiri Slaby input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
3531da177e4SLinus Torvalds
3541da177e4SLinus Torvalds for (j = 0; (t = grip_abs[grip->mode[i]][j]) >= 0; j++) {
3551da177e4SLinus Torvalds
3561da177e4SLinus Torvalds if (j < grip_cen[grip->mode[i]])
35717dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, t, 14, 52, 1, 2);
3581da177e4SLinus Torvalds else if (j < grip_anx[grip->mode[i]])
35917dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, t, 3, 57, 1, 0);
3601da177e4SLinus Torvalds else
36117dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, t, -1, 1, 0, 0);
3621da177e4SLinus Torvalds }
3631da177e4SLinus Torvalds
3641da177e4SLinus Torvalds for (j = 0; (t = grip_btn[grip->mode[i]][j]) >= 0; j++)
3651da177e4SLinus Torvalds if (t > 0)
36617dd3f0fSDmitry Torokhov set_bit(t, input_dev->keybit);
3671da177e4SLinus Torvalds
3680399adddSDmitry Torokhov err = input_register_device(grip->dev[i]);
3690399adddSDmitry Torokhov if (err)
3700399adddSDmitry Torokhov goto fail4;
3711da177e4SLinus Torvalds }
3721da177e4SLinus Torvalds
3731da177e4SLinus Torvalds return 0;
3741da177e4SLinus Torvalds
3750399adddSDmitry Torokhov fail4: input_free_device(grip->dev[i]);
3760399adddSDmitry Torokhov fail3: while (--i >= 0)
37717dd3f0fSDmitry Torokhov if (grip->dev[i])
37817dd3f0fSDmitry Torokhov input_unregister_device(grip->dev[i]);
3791da177e4SLinus Torvalds fail2: gameport_close(gameport);
3801da177e4SLinus Torvalds fail1: gameport_set_drvdata(gameport, NULL);
3811da177e4SLinus Torvalds kfree(grip);
3821da177e4SLinus Torvalds return err;
3831da177e4SLinus Torvalds }
3841da177e4SLinus Torvalds
grip_disconnect(struct gameport * gameport)3851da177e4SLinus Torvalds static void grip_disconnect(struct gameport *gameport)
3861da177e4SLinus Torvalds {
3871da177e4SLinus Torvalds struct grip *grip = gameport_get_drvdata(gameport);
3881da177e4SLinus Torvalds int i;
3891da177e4SLinus Torvalds
3901da177e4SLinus Torvalds for (i = 0; i < 2; i++)
39117dd3f0fSDmitry Torokhov if (grip->dev[i])
39217dd3f0fSDmitry Torokhov input_unregister_device(grip->dev[i]);
3931da177e4SLinus Torvalds gameport_close(gameport);
3941da177e4SLinus Torvalds gameport_set_drvdata(gameport, NULL);
3951da177e4SLinus Torvalds kfree(grip);
3961da177e4SLinus Torvalds }
3971da177e4SLinus Torvalds
3981da177e4SLinus Torvalds static struct gameport_driver grip_drv = {
3991da177e4SLinus Torvalds .driver = {
4001da177e4SLinus Torvalds .name = "grip",
4010399adddSDmitry Torokhov .owner = THIS_MODULE,
4021da177e4SLinus Torvalds },
4031da177e4SLinus Torvalds .description = DRIVER_DESC,
4041da177e4SLinus Torvalds .connect = grip_connect,
4051da177e4SLinus Torvalds .disconnect = grip_disconnect,
4061da177e4SLinus Torvalds };
4071da177e4SLinus Torvalds
40898a84131SAxel Lin module_gameport_driver(grip_drv);
409