11a59d1b8SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
21da177e4SLinus Torvalds /*
31da177e4SLinus Torvalds * Copyright (c) 1999-2001 Vojtech Pavlik
41da177e4SLinus Torvalds *
51da177e4SLinus Torvalds * Based on the work of:
696de0e25SJan Engelhardt * Andree Borrmann Mats Sjövall
71da177e4SLinus Torvalds */
81da177e4SLinus Torvalds
91da177e4SLinus Torvalds /*
101da177e4SLinus Torvalds * Atari, Amstrad, Commodore, Amiga, Sega, etc. joystick driver for Linux
111da177e4SLinus Torvalds */
121da177e4SLinus Torvalds
131da177e4SLinus Torvalds #include <linux/kernel.h>
141da177e4SLinus Torvalds #include <linux/module.h>
151da177e4SLinus Torvalds #include <linux/delay.h>
161da177e4SLinus Torvalds #include <linux/init.h>
171da177e4SLinus Torvalds #include <linux/parport.h>
181da177e4SLinus Torvalds #include <linux/input.h>
1972ba9f0cSIngo Molnar #include <linux/mutex.h>
205a0e3ad6STejun Heo #include <linux/slab.h>
211da177e4SLinus Torvalds
221da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
231da177e4SLinus Torvalds MODULE_DESCRIPTION("Atari, Amstrad, Commodore, Amiga, Sega, etc. joystick driver");
241da177e4SLinus Torvalds MODULE_LICENSE("GPL");
251da177e4SLinus Torvalds
2617dd3f0fSDmitry Torokhov struct db9_config {
2717dd3f0fSDmitry Torokhov int args[2];
2878167236SDmitry Torokhov unsigned int nargs;
2917dd3f0fSDmitry Torokhov };
3017dd3f0fSDmitry Torokhov
3117dd3f0fSDmitry Torokhov #define DB9_MAX_PORTS 3
322260c419SSudip Mukherjee static struct db9_config db9_cfg[DB9_MAX_PORTS];
3317dd3f0fSDmitry Torokhov
3478167236SDmitry Torokhov module_param_array_named(dev, db9_cfg[0].args, int, &db9_cfg[0].nargs, 0);
351da177e4SLinus Torvalds MODULE_PARM_DESC(dev, "Describes first attached device (<parport#>,<type>)");
360e2a4fd2SDmitry Torokhov module_param_array_named(dev2, db9_cfg[1].args, int, &db9_cfg[1].nargs, 0);
371da177e4SLinus Torvalds MODULE_PARM_DESC(dev2, "Describes second attached device (<parport#>,<type>)");
3878167236SDmitry Torokhov module_param_array_named(dev3, db9_cfg[2].args, int, &db9_cfg[2].nargs, 0);
391da177e4SLinus Torvalds MODULE_PARM_DESC(dev3, "Describes third attached device (<parport#>,<type>)");
401da177e4SLinus Torvalds
4117dd3f0fSDmitry Torokhov #define DB9_ARG_PARPORT 0
4217dd3f0fSDmitry Torokhov #define DB9_ARG_MODE 1
4317dd3f0fSDmitry Torokhov
441da177e4SLinus Torvalds #define DB9_MULTI_STICK 0x01
451da177e4SLinus Torvalds #define DB9_MULTI2_STICK 0x02
461da177e4SLinus Torvalds #define DB9_GENESIS_PAD 0x03
471da177e4SLinus Torvalds #define DB9_GENESIS5_PAD 0x05
481da177e4SLinus Torvalds #define DB9_GENESIS6_PAD 0x06
491da177e4SLinus Torvalds #define DB9_SATURN_PAD 0x07
501da177e4SLinus Torvalds #define DB9_MULTI_0802 0x08
511da177e4SLinus Torvalds #define DB9_MULTI_0802_2 0x09
521da177e4SLinus Torvalds #define DB9_CD32_PAD 0x0A
531da177e4SLinus Torvalds #define DB9_SATURN_DPP 0x0B
541da177e4SLinus Torvalds #define DB9_SATURN_DPP_2 0x0C
551da177e4SLinus Torvalds #define DB9_MAX_PAD 0x0D
561da177e4SLinus Torvalds
571da177e4SLinus Torvalds #define DB9_UP 0x01
581da177e4SLinus Torvalds #define DB9_DOWN 0x02
591da177e4SLinus Torvalds #define DB9_LEFT 0x04
601da177e4SLinus Torvalds #define DB9_RIGHT 0x08
611da177e4SLinus Torvalds #define DB9_FIRE1 0x10
621da177e4SLinus Torvalds #define DB9_FIRE2 0x20
631da177e4SLinus Torvalds #define DB9_FIRE3 0x40
641da177e4SLinus Torvalds #define DB9_FIRE4 0x80
651da177e4SLinus Torvalds
661da177e4SLinus Torvalds #define DB9_NORMAL 0x0a
671da177e4SLinus Torvalds #define DB9_NOSELECT 0x08
681da177e4SLinus Torvalds
691da177e4SLinus Torvalds #define DB9_GENESIS6_DELAY 14
701da177e4SLinus Torvalds #define DB9_REFRESH_TIME HZ/100
711da177e4SLinus Torvalds
7217dd3f0fSDmitry Torokhov #define DB9_MAX_DEVICES 2
7317dd3f0fSDmitry Torokhov
7417dd3f0fSDmitry Torokhov struct db9_mode_data {
7517dd3f0fSDmitry Torokhov const char *name;
7617dd3f0fSDmitry Torokhov const short *buttons;
7717dd3f0fSDmitry Torokhov int n_buttons;
7817dd3f0fSDmitry Torokhov int n_pads;
7917dd3f0fSDmitry Torokhov int n_axis;
8017dd3f0fSDmitry Torokhov int bidirectional;
8117dd3f0fSDmitry Torokhov int reverse;
8217dd3f0fSDmitry Torokhov };
8317dd3f0fSDmitry Torokhov
841da177e4SLinus Torvalds struct db9 {
8517dd3f0fSDmitry Torokhov struct input_dev *dev[DB9_MAX_DEVICES];
861da177e4SLinus Torvalds struct timer_list timer;
871da177e4SLinus Torvalds struct pardevice *pd;
881da177e4SLinus Torvalds int mode;
891da177e4SLinus Torvalds int used;
902260c419SSudip Mukherjee int parportno;
9172ba9f0cSIngo Molnar struct mutex mutex;
9217dd3f0fSDmitry Torokhov char phys[DB9_MAX_DEVICES][32];
931da177e4SLinus Torvalds };
941da177e4SLinus Torvalds
951da177e4SLinus Torvalds static struct db9 *db9_base[3];
961da177e4SLinus Torvalds
9717dd3f0fSDmitry Torokhov static const short db9_multi_btn[] = { BTN_TRIGGER, BTN_THUMB };
9817dd3f0fSDmitry Torokhov static const short db9_genesis_btn[] = { BTN_START, BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_MODE };
9917dd3f0fSDmitry Torokhov static const short db9_cd32_btn[] = { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL, BTN_TR, BTN_START };
1001da177e4SLinus Torvalds static const short db9_abs[] = { ABS_X, ABS_Y, ABS_RX, ABS_RY, ABS_RZ, ABS_Z, ABS_HAT0X, ABS_HAT0Y, ABS_HAT1X, ABS_HAT1Y };
10117dd3f0fSDmitry Torokhov
10217dd3f0fSDmitry Torokhov static const struct db9_mode_data db9_modes[] = {
10317dd3f0fSDmitry Torokhov { NULL, NULL, 0, 0, 0, 0, 0 },
10417dd3f0fSDmitry Torokhov { "Multisystem joystick", db9_multi_btn, 1, 1, 2, 1, 1 },
10517dd3f0fSDmitry Torokhov { "Multisystem joystick (2 fire)", db9_multi_btn, 2, 1, 2, 1, 1 },
10617dd3f0fSDmitry Torokhov { "Genesis pad", db9_genesis_btn, 4, 1, 2, 1, 1 },
10717dd3f0fSDmitry Torokhov { NULL, NULL, 0, 0, 0, 0, 0 },
10817dd3f0fSDmitry Torokhov { "Genesis 5 pad", db9_genesis_btn, 6, 1, 2, 1, 1 },
10917dd3f0fSDmitry Torokhov { "Genesis 6 pad", db9_genesis_btn, 8, 1, 2, 1, 1 },
11017dd3f0fSDmitry Torokhov { "Saturn pad", db9_cd32_btn, 9, 6, 7, 0, 1 },
11117dd3f0fSDmitry Torokhov { "Multisystem (0.8.0.2) joystick", db9_multi_btn, 1, 1, 2, 1, 1 },
11217dd3f0fSDmitry Torokhov { "Multisystem (0.8.0.2-dual) joystick", db9_multi_btn, 1, 2, 2, 1, 1 },
11317dd3f0fSDmitry Torokhov { "Amiga CD-32 pad", db9_cd32_btn, 7, 1, 2, 1, 1 },
11417dd3f0fSDmitry Torokhov { "Saturn dpp", db9_cd32_btn, 9, 6, 7, 0, 0 },
11517dd3f0fSDmitry Torokhov { "Saturn dpp dual", db9_cd32_btn, 9, 12, 7, 0, 0 },
11617dd3f0fSDmitry Torokhov };
1171da177e4SLinus Torvalds
1181da177e4SLinus Torvalds /*
1191da177e4SLinus Torvalds * Saturn controllers
1201da177e4SLinus Torvalds */
1211da177e4SLinus Torvalds #define DB9_SATURN_DELAY 300
1221da177e4SLinus Torvalds static const int db9_saturn_byte[] = { 1, 1, 1, 2, 2, 2, 2, 2, 1 };
1231da177e4SLinus Torvalds static const unsigned char db9_saturn_mask[] = { 0x04, 0x01, 0x02, 0x40, 0x20, 0x10, 0x08, 0x80, 0x08 };
1241da177e4SLinus Torvalds
1251da177e4SLinus Torvalds /*
1261da177e4SLinus Torvalds * db9_saturn_write_sub() writes 2 bit data.
1271da177e4SLinus Torvalds */
db9_saturn_write_sub(struct parport * port,int type,unsigned char data,int powered,int pwr_sub)1281da177e4SLinus Torvalds static void db9_saturn_write_sub(struct parport *port, int type, unsigned char data, int powered, int pwr_sub)
1291da177e4SLinus Torvalds {
1301da177e4SLinus Torvalds unsigned char c;
1311da177e4SLinus Torvalds
1321da177e4SLinus Torvalds switch (type) {
1331da177e4SLinus Torvalds case 1: /* DPP1 */
1341da177e4SLinus Torvalds c = 0x80 | 0x30 | (powered ? 0x08 : 0) | (pwr_sub ? 0x04 : 0) | data;
1351da177e4SLinus Torvalds parport_write_data(port, c);
1361da177e4SLinus Torvalds break;
1371da177e4SLinus Torvalds case 2: /* DPP2 */
1381da177e4SLinus Torvalds c = 0x40 | data << 4 | (powered ? 0x08 : 0) | (pwr_sub ? 0x04 : 0) | 0x03;
1391da177e4SLinus Torvalds parport_write_data(port, c);
1401da177e4SLinus Torvalds break;
1411da177e4SLinus Torvalds case 0: /* DB9 */
1421da177e4SLinus Torvalds c = ((((data & 2) ? 2 : 0) | ((data & 1) ? 4 : 0)) ^ 0x02) | !powered;
1431da177e4SLinus Torvalds parport_write_control(port, c);
1441da177e4SLinus Torvalds break;
1451da177e4SLinus Torvalds }
1461da177e4SLinus Torvalds }
1471da177e4SLinus Torvalds
1481da177e4SLinus Torvalds /*
1491da177e4SLinus Torvalds * gc_saturn_read_sub() reads 4 bit data.
1501da177e4SLinus Torvalds */
db9_saturn_read_sub(struct parport * port,int type)1511da177e4SLinus Torvalds static unsigned char db9_saturn_read_sub(struct parport *port, int type)
1521da177e4SLinus Torvalds {
1531da177e4SLinus Torvalds unsigned char data;
1541da177e4SLinus Torvalds
1551da177e4SLinus Torvalds if (type) {
1561da177e4SLinus Torvalds /* DPP */
1571da177e4SLinus Torvalds data = parport_read_status(port) ^ 0x80;
1581da177e4SLinus Torvalds return (data & 0x80 ? 1 : 0) | (data & 0x40 ? 2 : 0)
1591da177e4SLinus Torvalds | (data & 0x20 ? 4 : 0) | (data & 0x10 ? 8 : 0);
1601da177e4SLinus Torvalds } else {
1611da177e4SLinus Torvalds /* DB9 */
1621da177e4SLinus Torvalds data = parport_read_data(port) & 0x0f;
1631da177e4SLinus Torvalds return (data & 0x8 ? 1 : 0) | (data & 0x4 ? 2 : 0)
1641da177e4SLinus Torvalds | (data & 0x2 ? 4 : 0) | (data & 0x1 ? 8 : 0);
1651da177e4SLinus Torvalds }
1661da177e4SLinus Torvalds }
1671da177e4SLinus Torvalds
1681da177e4SLinus Torvalds /*
1691da177e4SLinus Torvalds * db9_saturn_read_analog() sends clock and reads 8 bit data.
1701da177e4SLinus Torvalds */
db9_saturn_read_analog(struct parport * port,int type,int powered)1711da177e4SLinus Torvalds static unsigned char db9_saturn_read_analog(struct parport *port, int type, int powered)
1721da177e4SLinus Torvalds {
1731da177e4SLinus Torvalds unsigned char data;
1741da177e4SLinus Torvalds
1751da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 0, powered, 0);
1761da177e4SLinus Torvalds udelay(DB9_SATURN_DELAY);
1771da177e4SLinus Torvalds data = db9_saturn_read_sub(port, type) << 4;
1781da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 2, powered, 0);
1791da177e4SLinus Torvalds udelay(DB9_SATURN_DELAY);
1801da177e4SLinus Torvalds data |= db9_saturn_read_sub(port, type);
1811da177e4SLinus Torvalds return data;
1821da177e4SLinus Torvalds }
1831da177e4SLinus Torvalds
1841da177e4SLinus Torvalds /*
1851da177e4SLinus Torvalds * db9_saturn_read_packet() reads whole saturn packet at connector
1861da177e4SLinus Torvalds * and returns device identifier code.
1871da177e4SLinus Torvalds */
db9_saturn_read_packet(struct parport * port,unsigned char * data,int type,int powered)1881da177e4SLinus Torvalds static unsigned char db9_saturn_read_packet(struct parport *port, unsigned char *data, int type, int powered)
1891da177e4SLinus Torvalds {
1901da177e4SLinus Torvalds int i, j;
1911da177e4SLinus Torvalds unsigned char tmp;
1921da177e4SLinus Torvalds
1931da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 3, powered, 0);
1941da177e4SLinus Torvalds data[0] = db9_saturn_read_sub(port, type);
1951da177e4SLinus Torvalds switch (data[0] & 0x0f) {
1961da177e4SLinus Torvalds case 0xf:
1971da177e4SLinus Torvalds /* 1111 no pad */
1981da177e4SLinus Torvalds return data[0] = 0xff;
1991da177e4SLinus Torvalds case 0x4: case 0x4 | 0x8:
2001da177e4SLinus Torvalds /* ?100 : digital controller */
2011da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 0, powered, 1);
2021da177e4SLinus Torvalds data[2] = db9_saturn_read_sub(port, type) << 4;
2031da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 2, powered, 1);
2041da177e4SLinus Torvalds data[1] = db9_saturn_read_sub(port, type) << 4;
2051da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 1, powered, 1);
2061da177e4SLinus Torvalds data[1] |= db9_saturn_read_sub(port, type);
2071da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 3, powered, 1);
2081da177e4SLinus Torvalds /* data[2] |= db9_saturn_read_sub(port, type); */
2091da177e4SLinus Torvalds data[2] |= data[0];
2101da177e4SLinus Torvalds return data[0] = 0x02;
2111da177e4SLinus Torvalds case 0x1:
2121da177e4SLinus Torvalds /* 0001 : analog controller or multitap */
2131da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 2, powered, 0);
2141da177e4SLinus Torvalds udelay(DB9_SATURN_DELAY);
2151da177e4SLinus Torvalds data[0] = db9_saturn_read_analog(port, type, powered);
2161da177e4SLinus Torvalds if (data[0] != 0x41) {
2171da177e4SLinus Torvalds /* read analog controller */
2181da177e4SLinus Torvalds for (i = 0; i < (data[0] & 0x0f); i++)
2191da177e4SLinus Torvalds data[i + 1] = db9_saturn_read_analog(port, type, powered);
2201da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 3, powered, 0);
2211da177e4SLinus Torvalds return data[0];
2221da177e4SLinus Torvalds } else {
2231da177e4SLinus Torvalds /* read multitap */
2241da177e4SLinus Torvalds if (db9_saturn_read_analog(port, type, powered) != 0x60)
2251da177e4SLinus Torvalds return data[0] = 0xff;
2261da177e4SLinus Torvalds for (i = 0; i < 60; i += 10) {
2271da177e4SLinus Torvalds data[i] = db9_saturn_read_analog(port, type, powered);
2281da177e4SLinus Torvalds if (data[i] != 0xff)
2291da177e4SLinus Torvalds /* read each pad */
2301da177e4SLinus Torvalds for (j = 0; j < (data[i] & 0x0f); j++)
2311da177e4SLinus Torvalds data[i + j + 1] = db9_saturn_read_analog(port, type, powered);
2321da177e4SLinus Torvalds }
2331da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 3, powered, 0);
2341da177e4SLinus Torvalds return 0x41;
2351da177e4SLinus Torvalds }
2361da177e4SLinus Torvalds case 0x0:
2371da177e4SLinus Torvalds /* 0000 : mouse */
2381da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 2, powered, 0);
2391da177e4SLinus Torvalds udelay(DB9_SATURN_DELAY);
2401da177e4SLinus Torvalds tmp = db9_saturn_read_analog(port, type, powered);
2411da177e4SLinus Torvalds if (tmp == 0xff) {
2421da177e4SLinus Torvalds for (i = 0; i < 3; i++)
2431da177e4SLinus Torvalds data[i + 1] = db9_saturn_read_analog(port, type, powered);
2441da177e4SLinus Torvalds db9_saturn_write_sub(port, type, 3, powered, 0);
2451da177e4SLinus Torvalds return data[0] = 0xe3;
2461da177e4SLinus Torvalds }
2476f49c4f5SGustavo A. R. Silva fallthrough;
2481da177e4SLinus Torvalds default:
2491da177e4SLinus Torvalds return data[0];
2501da177e4SLinus Torvalds }
2511da177e4SLinus Torvalds }
2521da177e4SLinus Torvalds
2531da177e4SLinus Torvalds /*
2541da177e4SLinus Torvalds * db9_saturn_report() analyzes packet and reports.
2551da177e4SLinus Torvalds */
db9_saturn_report(unsigned char id,unsigned char data[60],struct input_dev * devs[],int n,int max_pads)25684c61896SDmitry Torokhov static int db9_saturn_report(unsigned char id, unsigned char data[60], struct input_dev *devs[], int n, int max_pads)
2571da177e4SLinus Torvalds {
25884c61896SDmitry Torokhov struct input_dev *dev;
2591da177e4SLinus Torvalds int tmp, i, j;
2601da177e4SLinus Torvalds
2611da177e4SLinus Torvalds tmp = (id == 0x41) ? 60 : 10;
26284c61896SDmitry Torokhov for (j = 0; j < tmp && n < max_pads; j += 10, n++) {
26384c61896SDmitry Torokhov dev = devs[n];
2641da177e4SLinus Torvalds switch (data[j]) {
2651da177e4SLinus Torvalds case 0x16: /* multi controller (analog 4 axis) */
26684c61896SDmitry Torokhov input_report_abs(dev, db9_abs[5], data[j + 6]);
2676f49c4f5SGustavo A. R. Silva fallthrough;
2681da177e4SLinus Torvalds case 0x15: /* mission stick (analog 3 axis) */
26984c61896SDmitry Torokhov input_report_abs(dev, db9_abs[3], data[j + 4]);
27084c61896SDmitry Torokhov input_report_abs(dev, db9_abs[4], data[j + 5]);
2716f49c4f5SGustavo A. R. Silva fallthrough;
2721da177e4SLinus Torvalds case 0x13: /* racing controller (analog 1 axis) */
27384c61896SDmitry Torokhov input_report_abs(dev, db9_abs[2], data[j + 3]);
2746f49c4f5SGustavo A. R. Silva fallthrough;
2751da177e4SLinus Torvalds case 0x34: /* saturn keyboard (udlr ZXC ASD QE Esc) */
2761da177e4SLinus Torvalds case 0x02: /* digital pad (digital 2 axis + buttons) */
27784c61896SDmitry Torokhov input_report_abs(dev, db9_abs[0], !(data[j + 1] & 128) - !(data[j + 1] & 64));
27884c61896SDmitry Torokhov input_report_abs(dev, db9_abs[1], !(data[j + 1] & 32) - !(data[j + 1] & 16));
2791da177e4SLinus Torvalds for (i = 0; i < 9; i++)
28084c61896SDmitry Torokhov input_report_key(dev, db9_cd32_btn[i], ~data[j + db9_saturn_byte[i]] & db9_saturn_mask[i]);
2811da177e4SLinus Torvalds break;
2821da177e4SLinus Torvalds case 0x19: /* mission stick x2 (analog 6 axis + buttons) */
28384c61896SDmitry Torokhov input_report_abs(dev, db9_abs[0], !(data[j + 1] & 128) - !(data[j + 1] & 64));
28484c61896SDmitry Torokhov input_report_abs(dev, db9_abs[1], !(data[j + 1] & 32) - !(data[j + 1] & 16));
2851da177e4SLinus Torvalds for (i = 0; i < 9; i++)
28684c61896SDmitry Torokhov input_report_key(dev, db9_cd32_btn[i], ~data[j + db9_saturn_byte[i]] & db9_saturn_mask[i]);
28784c61896SDmitry Torokhov input_report_abs(dev, db9_abs[2], data[j + 3]);
28884c61896SDmitry Torokhov input_report_abs(dev, db9_abs[3], data[j + 4]);
28984c61896SDmitry Torokhov input_report_abs(dev, db9_abs[4], data[j + 5]);
2901da177e4SLinus Torvalds /*
29184c61896SDmitry Torokhov input_report_abs(dev, db9_abs[8], (data[j + 6] & 128 ? 0 : 1) - (data[j + 6] & 64 ? 0 : 1));
29284c61896SDmitry Torokhov input_report_abs(dev, db9_abs[9], (data[j + 6] & 32 ? 0 : 1) - (data[j + 6] & 16 ? 0 : 1));
2931da177e4SLinus Torvalds */
29484c61896SDmitry Torokhov input_report_abs(dev, db9_abs[6], data[j + 7]);
29584c61896SDmitry Torokhov input_report_abs(dev, db9_abs[7], data[j + 8]);
29684c61896SDmitry Torokhov input_report_abs(dev, db9_abs[5], data[j + 9]);
2971da177e4SLinus Torvalds break;
2981da177e4SLinus Torvalds case 0xd3: /* sankyo ff (analog 1 axis + stop btn) */
29984c61896SDmitry Torokhov input_report_key(dev, BTN_A, data[j + 3] & 0x80);
30084c61896SDmitry Torokhov input_report_abs(dev, db9_abs[2], data[j + 3] & 0x7f);
3011da177e4SLinus Torvalds break;
3021da177e4SLinus Torvalds case 0xe3: /* shuttle mouse (analog 2 axis + buttons. signed value) */
30384c61896SDmitry Torokhov input_report_key(dev, BTN_START, data[j + 1] & 0x08);
30484c61896SDmitry Torokhov input_report_key(dev, BTN_A, data[j + 1] & 0x04);
30584c61896SDmitry Torokhov input_report_key(dev, BTN_C, data[j + 1] & 0x02);
30684c61896SDmitry Torokhov input_report_key(dev, BTN_B, data[j + 1] & 0x01);
30784c61896SDmitry Torokhov input_report_abs(dev, db9_abs[2], data[j + 2] ^ 0x80);
30884c61896SDmitry Torokhov input_report_abs(dev, db9_abs[3], (0xff-(data[j + 3] ^ 0x80))+1); /* */
3091da177e4SLinus Torvalds break;
3101da177e4SLinus Torvalds case 0xff:
3111da177e4SLinus Torvalds default: /* no pad */
31284c61896SDmitry Torokhov input_report_abs(dev, db9_abs[0], 0);
31384c61896SDmitry Torokhov input_report_abs(dev, db9_abs[1], 0);
3141da177e4SLinus Torvalds for (i = 0; i < 9; i++)
31584c61896SDmitry Torokhov input_report_key(dev, db9_cd32_btn[i], 0);
3161da177e4SLinus Torvalds break;
3171da177e4SLinus Torvalds }
3181da177e4SLinus Torvalds }
3191da177e4SLinus Torvalds return n;
3201da177e4SLinus Torvalds }
3211da177e4SLinus Torvalds
db9_saturn(int mode,struct parport * port,struct input_dev * devs[])32284c61896SDmitry Torokhov static int db9_saturn(int mode, struct parport *port, struct input_dev *devs[])
3231da177e4SLinus Torvalds {
3241da177e4SLinus Torvalds unsigned char id, data[60];
3251da177e4SLinus Torvalds int type, n, max_pads;
3261da177e4SLinus Torvalds int tmp, i;
3271da177e4SLinus Torvalds
3281da177e4SLinus Torvalds switch (mode) {
3291da177e4SLinus Torvalds case DB9_SATURN_PAD:
3301da177e4SLinus Torvalds type = 0;
3311da177e4SLinus Torvalds n = 1;
3321da177e4SLinus Torvalds break;
3331da177e4SLinus Torvalds case DB9_SATURN_DPP:
3341da177e4SLinus Torvalds type = 1;
3351da177e4SLinus Torvalds n = 1;
3361da177e4SLinus Torvalds break;
3371da177e4SLinus Torvalds case DB9_SATURN_DPP_2:
3381da177e4SLinus Torvalds type = 1;
3391da177e4SLinus Torvalds n = 2;
3401da177e4SLinus Torvalds break;
3411da177e4SLinus Torvalds default:
3421da177e4SLinus Torvalds return -1;
3431da177e4SLinus Torvalds }
34417dd3f0fSDmitry Torokhov max_pads = min(db9_modes[mode].n_pads, DB9_MAX_DEVICES);
3451da177e4SLinus Torvalds for (tmp = 0, i = 0; i < n; i++) {
3461da177e4SLinus Torvalds id = db9_saturn_read_packet(port, data, type + i, 1);
34784c61896SDmitry Torokhov tmp = db9_saturn_report(id, data, devs, tmp, max_pads);
3481da177e4SLinus Torvalds }
3491da177e4SLinus Torvalds return 0;
3501da177e4SLinus Torvalds }
3511da177e4SLinus Torvalds
db9_timer(struct timer_list * t)352e99e88a9SKees Cook static void db9_timer(struct timer_list *t)
3531da177e4SLinus Torvalds {
354e99e88a9SKees Cook struct db9 *db9 = from_timer(db9, t, timer);
3551da177e4SLinus Torvalds struct parport *port = db9->pd->port;
35617dd3f0fSDmitry Torokhov struct input_dev *dev = db9->dev[0];
35717dd3f0fSDmitry Torokhov struct input_dev *dev2 = db9->dev[1];
3581da177e4SLinus Torvalds int data, i;
3591da177e4SLinus Torvalds
3601da177e4SLinus Torvalds switch (db9->mode) {
3611da177e4SLinus Torvalds case DB9_MULTI_0802_2:
3621da177e4SLinus Torvalds
3631da177e4SLinus Torvalds data = parport_read_data(port) >> 3;
3641da177e4SLinus Torvalds
36517dd3f0fSDmitry Torokhov input_report_abs(dev2, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
36617dd3f0fSDmitry Torokhov input_report_abs(dev2, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
36717dd3f0fSDmitry Torokhov input_report_key(dev2, BTN_TRIGGER, ~data & DB9_FIRE1);
3686f49c4f5SGustavo A. R. Silva fallthrough;
3691da177e4SLinus Torvalds
3701da177e4SLinus Torvalds case DB9_MULTI_0802:
3711da177e4SLinus Torvalds
3721da177e4SLinus Torvalds data = parport_read_status(port) >> 3;
3731da177e4SLinus Torvalds
3741da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
3751da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
3761da177e4SLinus Torvalds input_report_key(dev, BTN_TRIGGER, data & DB9_FIRE1);
3771da177e4SLinus Torvalds break;
3781da177e4SLinus Torvalds
3791da177e4SLinus Torvalds case DB9_MULTI_STICK:
3801da177e4SLinus Torvalds
3811da177e4SLinus Torvalds data = parport_read_data(port);
3821da177e4SLinus Torvalds
3831da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
3841da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
3851da177e4SLinus Torvalds input_report_key(dev, BTN_TRIGGER, ~data & DB9_FIRE1);
3861da177e4SLinus Torvalds break;
3871da177e4SLinus Torvalds
3881da177e4SLinus Torvalds case DB9_MULTI2_STICK:
3891da177e4SLinus Torvalds
3901da177e4SLinus Torvalds data = parport_read_data(port);
3911da177e4SLinus Torvalds
3921da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
3931da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
3941da177e4SLinus Torvalds input_report_key(dev, BTN_TRIGGER, ~data & DB9_FIRE1);
3951da177e4SLinus Torvalds input_report_key(dev, BTN_THUMB, ~data & DB9_FIRE2);
3961da177e4SLinus Torvalds break;
3971da177e4SLinus Torvalds
3981da177e4SLinus Torvalds case DB9_GENESIS_PAD:
3991da177e4SLinus Torvalds
4001da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT);
4011da177e4SLinus Torvalds data = parport_read_data(port);
4021da177e4SLinus Torvalds
4031da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
4041da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
4051da177e4SLinus Torvalds input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
4061da177e4SLinus Torvalds input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
4071da177e4SLinus Torvalds
4081da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4091da177e4SLinus Torvalds data = parport_read_data(port);
4101da177e4SLinus Torvalds
4111da177e4SLinus Torvalds input_report_key(dev, BTN_A, ~data & DB9_FIRE1);
4121da177e4SLinus Torvalds input_report_key(dev, BTN_START, ~data & DB9_FIRE2);
4131da177e4SLinus Torvalds break;
4141da177e4SLinus Torvalds
4151da177e4SLinus Torvalds case DB9_GENESIS5_PAD:
4161da177e4SLinus Torvalds
4171da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT);
4181da177e4SLinus Torvalds data = parport_read_data(port);
4191da177e4SLinus Torvalds
4201da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
4211da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
4221da177e4SLinus Torvalds input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
4231da177e4SLinus Torvalds input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
4241da177e4SLinus Torvalds
4251da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4261da177e4SLinus Torvalds data = parport_read_data(port);
4271da177e4SLinus Torvalds
4281da177e4SLinus Torvalds input_report_key(dev, BTN_A, ~data & DB9_FIRE1);
4291da177e4SLinus Torvalds input_report_key(dev, BTN_X, ~data & DB9_FIRE2);
4301da177e4SLinus Torvalds input_report_key(dev, BTN_Y, ~data & DB9_LEFT);
4311da177e4SLinus Torvalds input_report_key(dev, BTN_START, ~data & DB9_RIGHT);
4321da177e4SLinus Torvalds break;
4331da177e4SLinus Torvalds
4341da177e4SLinus Torvalds case DB9_GENESIS6_PAD:
4351da177e4SLinus Torvalds
4361da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT); /* 1 */
4371da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4381da177e4SLinus Torvalds data = parport_read_data(port);
4391da177e4SLinus Torvalds
4401da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
4411da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
4421da177e4SLinus Torvalds input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
4431da177e4SLinus Torvalds input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
4441da177e4SLinus Torvalds
4451da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4461da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4471da177e4SLinus Torvalds data = parport_read_data(port);
4481da177e4SLinus Torvalds
4491da177e4SLinus Torvalds input_report_key(dev, BTN_A, ~data & DB9_FIRE1);
4501da177e4SLinus Torvalds input_report_key(dev, BTN_START, ~data & DB9_FIRE2);
4511da177e4SLinus Torvalds
4521da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT); /* 2 */
4531da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4541da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4551da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4561da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT); /* 3 */
4571da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4581da177e4SLinus Torvalds data=parport_read_data(port);
4591da177e4SLinus Torvalds
4601da177e4SLinus Torvalds input_report_key(dev, BTN_X, ~data & DB9_LEFT);
4611da177e4SLinus Torvalds input_report_key(dev, BTN_Y, ~data & DB9_DOWN);
4621da177e4SLinus Torvalds input_report_key(dev, BTN_Z, ~data & DB9_UP);
4631da177e4SLinus Torvalds input_report_key(dev, BTN_MODE, ~data & DB9_RIGHT);
4641da177e4SLinus Torvalds
4651da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4661da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4671da177e4SLinus Torvalds parport_write_control(port, DB9_NOSELECT); /* 4 */
4681da177e4SLinus Torvalds udelay(DB9_GENESIS6_DELAY);
4691da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
4701da177e4SLinus Torvalds break;
4711da177e4SLinus Torvalds
4721da177e4SLinus Torvalds case DB9_SATURN_PAD:
4731da177e4SLinus Torvalds case DB9_SATURN_DPP:
4741da177e4SLinus Torvalds case DB9_SATURN_DPP_2:
4751da177e4SLinus Torvalds
47684c61896SDmitry Torokhov db9_saturn(db9->mode, port, db9->dev);
4771da177e4SLinus Torvalds break;
4781da177e4SLinus Torvalds
4791da177e4SLinus Torvalds case DB9_CD32_PAD:
4801da177e4SLinus Torvalds
4811da177e4SLinus Torvalds data = parport_read_data(port);
4821da177e4SLinus Torvalds
4831da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
4841da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data & DB9_DOWN ? 0 : 1) - (data & DB9_UP ? 0 : 1));
4851da177e4SLinus Torvalds
4861da177e4SLinus Torvalds parport_write_control(port, 0x0a);
4871da177e4SLinus Torvalds
4881da177e4SLinus Torvalds for (i = 0; i < 7; i++) {
4891da177e4SLinus Torvalds data = parport_read_data(port);
4901da177e4SLinus Torvalds parport_write_control(port, 0x02);
4911da177e4SLinus Torvalds parport_write_control(port, 0x0a);
4921da177e4SLinus Torvalds input_report_key(dev, db9_cd32_btn[i], ~data & DB9_FIRE2);
4931da177e4SLinus Torvalds }
4941da177e4SLinus Torvalds
4951da177e4SLinus Torvalds parport_write_control(port, 0x00);
4961da177e4SLinus Torvalds break;
4971da177e4SLinus Torvalds }
4981da177e4SLinus Torvalds
4991da177e4SLinus Torvalds input_sync(dev);
5001da177e4SLinus Torvalds
5011da177e4SLinus Torvalds mod_timer(&db9->timer, jiffies + DB9_REFRESH_TIME);
5021da177e4SLinus Torvalds }
5031da177e4SLinus Torvalds
db9_open(struct input_dev * dev)5041da177e4SLinus Torvalds static int db9_open(struct input_dev *dev)
5051da177e4SLinus Torvalds {
5068715c1cfSDmitry Torokhov struct db9 *db9 = input_get_drvdata(dev);
5071da177e4SLinus Torvalds struct parport *port = db9->pd->port;
5088b1a198bSDmitry Torokhov int err;
5098b1a198bSDmitry Torokhov
51072ba9f0cSIngo Molnar err = mutex_lock_interruptible(&db9->mutex);
5118b1a198bSDmitry Torokhov if (err)
5128b1a198bSDmitry Torokhov return err;
5131da177e4SLinus Torvalds
5141da177e4SLinus Torvalds if (!db9->used++) {
5151da177e4SLinus Torvalds parport_claim(db9->pd);
5161da177e4SLinus Torvalds parport_write_data(port, 0xff);
51717dd3f0fSDmitry Torokhov if (db9_modes[db9->mode].reverse) {
5181da177e4SLinus Torvalds parport_data_reverse(port);
5191da177e4SLinus Torvalds parport_write_control(port, DB9_NORMAL);
5201da177e4SLinus Torvalds }
5211da177e4SLinus Torvalds mod_timer(&db9->timer, jiffies + DB9_REFRESH_TIME);
5221da177e4SLinus Torvalds }
5231da177e4SLinus Torvalds
52472ba9f0cSIngo Molnar mutex_unlock(&db9->mutex);
5251da177e4SLinus Torvalds return 0;
5261da177e4SLinus Torvalds }
5271da177e4SLinus Torvalds
db9_close(struct input_dev * dev)5281da177e4SLinus Torvalds static void db9_close(struct input_dev *dev)
5291da177e4SLinus Torvalds {
5308715c1cfSDmitry Torokhov struct db9 *db9 = input_get_drvdata(dev);
5311da177e4SLinus Torvalds struct parport *port = db9->pd->port;
5321da177e4SLinus Torvalds
53372ba9f0cSIngo Molnar mutex_lock(&db9->mutex);
5341da177e4SLinus Torvalds if (!--db9->used) {
5358b1a198bSDmitry Torokhov del_timer_sync(&db9->timer);
5361da177e4SLinus Torvalds parport_write_control(port, 0x00);
5371da177e4SLinus Torvalds parport_data_forward(port);
5381da177e4SLinus Torvalds parport_release(db9->pd);
5391da177e4SLinus Torvalds }
54072ba9f0cSIngo Molnar mutex_unlock(&db9->mutex);
5411da177e4SLinus Torvalds }
5421da177e4SLinus Torvalds
db9_attach(struct parport * pp)5432260c419SSudip Mukherjee static void db9_attach(struct parport *pp)
5441da177e4SLinus Torvalds {
5451da177e4SLinus Torvalds struct db9 *db9;
54617dd3f0fSDmitry Torokhov const struct db9_mode_data *db9_mode;
54717dd3f0fSDmitry Torokhov struct pardevice *pd;
54817dd3f0fSDmitry Torokhov struct input_dev *input_dev;
549dd23bf10SSudip Mukherjee int i, j, port_idx;
5502260c419SSudip Mukherjee int mode;
5512260c419SSudip Mukherjee struct pardev_cb db9_parport_cb;
5522260c419SSudip Mukherjee
553dd23bf10SSudip Mukherjee for (port_idx = 0; port_idx < DB9_MAX_PORTS; port_idx++) {
554dd23bf10SSudip Mukherjee if (db9_cfg[port_idx].nargs == 0 ||
555dd23bf10SSudip Mukherjee db9_cfg[port_idx].args[DB9_ARG_PARPORT] < 0)
5562260c419SSudip Mukherjee continue;
5572260c419SSudip Mukherjee
558dd23bf10SSudip Mukherjee if (db9_cfg[port_idx].args[DB9_ARG_PARPORT] == pp->number)
5592260c419SSudip Mukherjee break;
5602260c419SSudip Mukherjee }
5612260c419SSudip Mukherjee
562dd23bf10SSudip Mukherjee if (port_idx == DB9_MAX_PORTS) {
5632260c419SSudip Mukherjee pr_debug("Not using parport%d.\n", pp->number);
5642260c419SSudip Mukherjee return;
5652260c419SSudip Mukherjee }
5662260c419SSudip Mukherjee
567dd23bf10SSudip Mukherjee mode = db9_cfg[port_idx].args[DB9_ARG_MODE];
5681da177e4SLinus Torvalds
56917dd3f0fSDmitry Torokhov if (mode < 1 || mode >= DB9_MAX_PAD || !db9_modes[mode].n_buttons) {
57017dd3f0fSDmitry Torokhov printk(KERN_ERR "db9.c: Bad device type %d\n", mode);
5712260c419SSudip Mukherjee return;
5721da177e4SLinus Torvalds }
5731da177e4SLinus Torvalds
57417dd3f0fSDmitry Torokhov db9_mode = &db9_modes[mode];
5751da177e4SLinus Torvalds
5760a3a6d69SEric Sesterhenn if (db9_mode->bidirectional && !(pp->modes & PARPORT_MODE_TRISTATE)) {
5771da177e4SLinus Torvalds printk(KERN_ERR "db9.c: specified parport is not bidirectional\n");
5782260c419SSudip Mukherjee return;
5791da177e4SLinus Torvalds }
5801da177e4SLinus Torvalds
58142beaccbSSudip Mukherjee memset(&db9_parport_cb, 0, sizeof(db9_parport_cb));
5822260c419SSudip Mukherjee db9_parport_cb.flags = PARPORT_FLAG_EXCL;
5832260c419SSudip Mukherjee
584dd23bf10SSudip Mukherjee pd = parport_register_dev_model(pp, "db9", &db9_parport_cb, port_idx);
58517dd3f0fSDmitry Torokhov if (!pd) {
58617dd3f0fSDmitry Torokhov printk(KERN_ERR "db9.c: parport busy already - lp.o loaded?\n");
5872260c419SSudip Mukherjee return;
58817dd3f0fSDmitry Torokhov }
58917dd3f0fSDmitry Torokhov
590*4654c4ccSErick Archer db9 = kzalloc(sizeof(*db9), GFP_KERNEL);
5912260c419SSudip Mukherjee if (!db9)
59217dd3f0fSDmitry Torokhov goto err_unreg_pardev;
5931da177e4SLinus Torvalds
59472ba9f0cSIngo Molnar mutex_init(&db9->mutex);
59517dd3f0fSDmitry Torokhov db9->pd = pd;
59617dd3f0fSDmitry Torokhov db9->mode = mode;
5972260c419SSudip Mukherjee db9->parportno = pp->number;
598e99e88a9SKees Cook timer_setup(&db9->timer, db9_timer, 0);
5991da177e4SLinus Torvalds
60017dd3f0fSDmitry Torokhov for (i = 0; i < (min(db9_mode->n_pads, DB9_MAX_DEVICES)); i++) {
6011da177e4SLinus Torvalds
60217dd3f0fSDmitry Torokhov db9->dev[i] = input_dev = input_allocate_device();
60317dd3f0fSDmitry Torokhov if (!input_dev) {
60417dd3f0fSDmitry Torokhov printk(KERN_ERR "db9.c: Not enough memory for input device\n");
6052e9d675eSDmitry Torokhov goto err_unreg_devs;
6061da177e4SLinus Torvalds }
6071da177e4SLinus Torvalds
60810ca4c0aSDmitry Torokhov snprintf(db9->phys[i], sizeof(db9->phys[i]),
60910ca4c0aSDmitry Torokhov "%s/input%d", db9->pd->port->name, i);
6101da177e4SLinus Torvalds
61117dd3f0fSDmitry Torokhov input_dev->name = db9_mode->name;
61217dd3f0fSDmitry Torokhov input_dev->phys = db9->phys[i];
61317dd3f0fSDmitry Torokhov input_dev->id.bustype = BUS_PARPORT;
61417dd3f0fSDmitry Torokhov input_dev->id.vendor = 0x0002;
61517dd3f0fSDmitry Torokhov input_dev->id.product = mode;
61617dd3f0fSDmitry Torokhov input_dev->id.version = 0x0100;
6178715c1cfSDmitry Torokhov
6188715c1cfSDmitry Torokhov input_set_drvdata(input_dev, db9);
6191da177e4SLinus Torvalds
62017dd3f0fSDmitry Torokhov input_dev->open = db9_open;
62117dd3f0fSDmitry Torokhov input_dev->close = db9_close;
6221da177e4SLinus Torvalds
6237b19ada2SJiri Slaby input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
62417dd3f0fSDmitry Torokhov for (j = 0; j < db9_mode->n_buttons; j++)
62517dd3f0fSDmitry Torokhov set_bit(db9_mode->buttons[j], input_dev->keybit);
62617dd3f0fSDmitry Torokhov for (j = 0; j < db9_mode->n_axis; j++) {
62717dd3f0fSDmitry Torokhov if (j < 2)
62817dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, db9_abs[j], -1, 1, 0, 0);
62917dd3f0fSDmitry Torokhov else
63017dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, db9_abs[j], 1, 255, 0, 0);
6311da177e4SLinus Torvalds }
6321da177e4SLinus Torvalds
6332260c419SSudip Mukherjee if (input_register_device(input_dev))
6342e9d675eSDmitry Torokhov goto err_free_dev;
63517dd3f0fSDmitry Torokhov }
63617dd3f0fSDmitry Torokhov
637dd23bf10SSudip Mukherjee db9_base[port_idx] = db9;
6382260c419SSudip Mukherjee return;
63917dd3f0fSDmitry Torokhov
6402e9d675eSDmitry Torokhov err_free_dev:
6412e9d675eSDmitry Torokhov input_free_device(db9->dev[i]);
6422e9d675eSDmitry Torokhov err_unreg_devs:
64317dd3f0fSDmitry Torokhov while (--i >= 0)
64417dd3f0fSDmitry Torokhov input_unregister_device(db9->dev[i]);
64517dd3f0fSDmitry Torokhov kfree(db9);
64617dd3f0fSDmitry Torokhov err_unreg_pardev:
64717dd3f0fSDmitry Torokhov parport_unregister_device(pd);
64817dd3f0fSDmitry Torokhov }
64917dd3f0fSDmitry Torokhov
db9_detach(struct parport * port)6502260c419SSudip Mukherjee static void db9_detach(struct parport *port)
65117dd3f0fSDmitry Torokhov {
65217dd3f0fSDmitry Torokhov int i;
6532260c419SSudip Mukherjee struct db9 *db9;
6542260c419SSudip Mukherjee
6552260c419SSudip Mukherjee for (i = 0; i < DB9_MAX_PORTS; i++) {
6562260c419SSudip Mukherjee if (db9_base[i] && db9_base[i]->parportno == port->number)
6572260c419SSudip Mukherjee break;
6582260c419SSudip Mukherjee }
6592260c419SSudip Mukherjee
6602260c419SSudip Mukherjee if (i == DB9_MAX_PORTS)
6612260c419SSudip Mukherjee return;
6622260c419SSudip Mukherjee
6632260c419SSudip Mukherjee db9 = db9_base[i];
664dd23bf10SSudip Mukherjee db9_base[i] = NULL;
66517dd3f0fSDmitry Torokhov
66617dd3f0fSDmitry Torokhov for (i = 0; i < min(db9_modes[db9->mode].n_pads, DB9_MAX_DEVICES); i++)
66717dd3f0fSDmitry Torokhov input_unregister_device(db9->dev[i]);
66817dd3f0fSDmitry Torokhov parport_unregister_device(db9->pd);
66917dd3f0fSDmitry Torokhov kfree(db9);
6701da177e4SLinus Torvalds }
6711da177e4SLinus Torvalds
6722260c419SSudip Mukherjee static struct parport_driver db9_parport_driver = {
6732260c419SSudip Mukherjee .name = "db9",
6742260c419SSudip Mukherjee .match_port = db9_attach,
6752260c419SSudip Mukherjee .detach = db9_detach,
6762260c419SSudip Mukherjee };
6772260c419SSudip Mukherjee
db9_init(void)6781da177e4SLinus Torvalds static int __init db9_init(void)
6791da177e4SLinus Torvalds {
68017dd3f0fSDmitry Torokhov int i;
68117dd3f0fSDmitry Torokhov int have_dev = 0;
6821da177e4SLinus Torvalds
68317dd3f0fSDmitry Torokhov for (i = 0; i < DB9_MAX_PORTS; i++) {
68478167236SDmitry Torokhov if (db9_cfg[i].nargs == 0 || db9_cfg[i].args[DB9_ARG_PARPORT] < 0)
68517dd3f0fSDmitry Torokhov continue;
6861da177e4SLinus Torvalds
68778167236SDmitry Torokhov if (db9_cfg[i].nargs < 2) {
68817dd3f0fSDmitry Torokhov printk(KERN_ERR "db9.c: Device type must be specified.\n");
6892260c419SSudip Mukherjee return -EINVAL;
69017dd3f0fSDmitry Torokhov }
69117dd3f0fSDmitry Torokhov
69217dd3f0fSDmitry Torokhov have_dev = 1;
69317dd3f0fSDmitry Torokhov }
69417dd3f0fSDmitry Torokhov
6952260c419SSudip Mukherjee if (!have_dev)
6962260c419SSudip Mukherjee return -ENODEV;
69717dd3f0fSDmitry Torokhov
6982260c419SSudip Mukherjee return parport_register_driver(&db9_parport_driver);
6991da177e4SLinus Torvalds }
7001da177e4SLinus Torvalds
db9_exit(void)7011da177e4SLinus Torvalds static void __exit db9_exit(void)
7021da177e4SLinus Torvalds {
7032260c419SSudip Mukherjee parport_unregister_driver(&db9_parport_driver);
7041da177e4SLinus Torvalds }
7051da177e4SLinus Torvalds
7061da177e4SLinus Torvalds module_init(db9_init);
7071da177e4SLinus Torvalds module_exit(db9_exit);
708