11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * Copyright (c) 2000-2001 Vojtech Pavlik 31da177e4SLinus Torvalds * Copyright (c) 2000 Mark Fletcher 41da177e4SLinus Torvalds */ 51da177e4SLinus Torvalds 61da177e4SLinus Torvalds /* 71da177e4SLinus Torvalds * Gravis Stinger gamepad driver for Linux 81da177e4SLinus Torvalds */ 91da177e4SLinus Torvalds 101da177e4SLinus Torvalds /* 111da177e4SLinus Torvalds * This program is free warftware; you can redistribute it and/or modify 121da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 131da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 141da177e4SLinus Torvalds * (at your option) any later version. 151da177e4SLinus Torvalds * 161da177e4SLinus Torvalds * This program is distributed in the hope that it will be useful, 171da177e4SLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 181da177e4SLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 191da177e4SLinus Torvalds * GNU General Public License for more details. 201da177e4SLinus Torvalds * 211da177e4SLinus Torvalds * You should have received a copy of the GNU General Public License 221da177e4SLinus Torvalds * along with this program; if not, write to the Free Software 231da177e4SLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 241da177e4SLinus Torvalds * 251da177e4SLinus Torvalds * Should you need to contact me, the author, you can do so either by 261da177e4SLinus Torvalds * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: 271da177e4SLinus Torvalds * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic 281da177e4SLinus Torvalds */ 291da177e4SLinus Torvalds 301da177e4SLinus Torvalds #include <linux/kernel.h> 311da177e4SLinus Torvalds #include <linux/module.h> 321da177e4SLinus Torvalds #include <linux/slab.h> 331da177e4SLinus Torvalds #include <linux/input.h> 341da177e4SLinus Torvalds #include <linux/serio.h> 351da177e4SLinus Torvalds #include <linux/init.h> 361da177e4SLinus Torvalds 371da177e4SLinus Torvalds #define DRIVER_DESC "Gravis Stinger gamepad driver" 381da177e4SLinus Torvalds 391da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 401da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC); 411da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 421da177e4SLinus Torvalds 431da177e4SLinus Torvalds /* 441da177e4SLinus Torvalds * Constants. 451da177e4SLinus Torvalds */ 461da177e4SLinus Torvalds 471da177e4SLinus Torvalds #define STINGER_MAX_LENGTH 8 481da177e4SLinus Torvalds 491da177e4SLinus Torvalds /* 501da177e4SLinus Torvalds * Per-Stinger data. 511da177e4SLinus Torvalds */ 521da177e4SLinus Torvalds 531da177e4SLinus Torvalds struct stinger { 5417dd3f0fSDmitry Torokhov struct input_dev *dev; 551da177e4SLinus Torvalds int idx; 561da177e4SLinus Torvalds unsigned char data[STINGER_MAX_LENGTH]; 571da177e4SLinus Torvalds char phys[32]; 581da177e4SLinus Torvalds }; 591da177e4SLinus Torvalds 601da177e4SLinus Torvalds /* 611da177e4SLinus Torvalds * stinger_process_packet() decodes packets the driver receives from the 621da177e4SLinus Torvalds * Stinger. It updates the data accordingly. 631da177e4SLinus Torvalds */ 641da177e4SLinus Torvalds 657d12e780SDavid Howells static void stinger_process_packet(struct stinger *stinger) 661da177e4SLinus Torvalds { 6717dd3f0fSDmitry Torokhov struct input_dev *dev = stinger->dev; 681da177e4SLinus Torvalds unsigned char *data = stinger->data; 691da177e4SLinus Torvalds 701da177e4SLinus Torvalds if (!stinger->idx) return; 711da177e4SLinus Torvalds 721da177e4SLinus Torvalds input_report_key(dev, BTN_A, ((data[0] & 0x20) >> 5)); 731da177e4SLinus Torvalds input_report_key(dev, BTN_B, ((data[0] & 0x10) >> 4)); 741da177e4SLinus Torvalds input_report_key(dev, BTN_C, ((data[0] & 0x08) >> 3)); 751da177e4SLinus Torvalds input_report_key(dev, BTN_X, ((data[0] & 0x04) >> 2)); 761da177e4SLinus Torvalds input_report_key(dev, BTN_Y, ((data[3] & 0x20) >> 5)); 771da177e4SLinus Torvalds input_report_key(dev, BTN_Z, ((data[3] & 0x10) >> 4)); 781da177e4SLinus Torvalds input_report_key(dev, BTN_TL, ((data[3] & 0x08) >> 3)); 791da177e4SLinus Torvalds input_report_key(dev, BTN_TR, ((data[3] & 0x04) >> 2)); 801da177e4SLinus Torvalds input_report_key(dev, BTN_SELECT, ((data[3] & 0x02) >> 1)); 811da177e4SLinus Torvalds input_report_key(dev, BTN_START, (data[3] & 0x01)); 821da177e4SLinus Torvalds 831da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data[1] & 0x3F) - ((data[0] & 0x01) << 6)); 841da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, ((data[0] & 0x02) << 5) - (data[2] & 0x3F)); 851da177e4SLinus Torvalds 861da177e4SLinus Torvalds input_sync(dev); 871da177e4SLinus Torvalds 881da177e4SLinus Torvalds return; 891da177e4SLinus Torvalds } 901da177e4SLinus Torvalds 911da177e4SLinus Torvalds /* 921da177e4SLinus Torvalds * stinger_interrupt() is called by the low level driver when characters 931da177e4SLinus Torvalds * are ready for us. We then buffer them for further processing, or call the 941da177e4SLinus Torvalds * packet processing routine. 951da177e4SLinus Torvalds */ 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds static irqreturn_t stinger_interrupt(struct serio *serio, 987d12e780SDavid Howells unsigned char data, unsigned int flags) 991da177e4SLinus Torvalds { 1001da177e4SLinus Torvalds struct stinger *stinger = serio_get_drvdata(serio); 1011da177e4SLinus Torvalds 1021da177e4SLinus Torvalds /* All Stinger packets are 4 bytes */ 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds if (stinger->idx < STINGER_MAX_LENGTH) 1051da177e4SLinus Torvalds stinger->data[stinger->idx++] = data; 1061da177e4SLinus Torvalds 1071da177e4SLinus Torvalds if (stinger->idx == 4) { 1087d12e780SDavid Howells stinger_process_packet(stinger); 1091da177e4SLinus Torvalds stinger->idx = 0; 1101da177e4SLinus Torvalds } 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds return IRQ_HANDLED; 1131da177e4SLinus Torvalds } 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds /* 1161da177e4SLinus Torvalds * stinger_disconnect() is the opposite of stinger_connect() 1171da177e4SLinus Torvalds */ 1181da177e4SLinus Torvalds 1191da177e4SLinus Torvalds static void stinger_disconnect(struct serio *serio) 1201da177e4SLinus Torvalds { 1211da177e4SLinus Torvalds struct stinger *stinger = serio_get_drvdata(serio); 1221da177e4SLinus Torvalds 1231da177e4SLinus Torvalds serio_close(serio); 1241da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 12517dd3f0fSDmitry Torokhov input_unregister_device(stinger->dev); 1261da177e4SLinus Torvalds kfree(stinger); 1271da177e4SLinus Torvalds } 1281da177e4SLinus Torvalds 1291da177e4SLinus Torvalds /* 1301da177e4SLinus Torvalds * stinger_connect() is the routine that is called when someone adds a 1311da177e4SLinus Torvalds * new serio device that supports Stinger protocol and registers it as 1321da177e4SLinus Torvalds * an input device. 1331da177e4SLinus Torvalds */ 1341da177e4SLinus Torvalds 1351da177e4SLinus Torvalds static int stinger_connect(struct serio *serio, struct serio_driver *drv) 1361da177e4SLinus Torvalds { 1371da177e4SLinus Torvalds struct stinger *stinger; 13817dd3f0fSDmitry Torokhov struct input_dev *input_dev; 13917dd3f0fSDmitry Torokhov int err = -ENOMEM; 1401da177e4SLinus Torvalds 14117dd3f0fSDmitry Torokhov stinger = kmalloc(sizeof(struct stinger), GFP_KERNEL); 14217dd3f0fSDmitry Torokhov input_dev = input_allocate_device(); 14317dd3f0fSDmitry Torokhov if (!stinger || !input_dev) 144127278ceSDmitry Torokhov goto fail1; 1451da177e4SLinus Torvalds 14617dd3f0fSDmitry Torokhov stinger->dev = input_dev; 14710ca4c0aSDmitry Torokhov snprintf(stinger->phys, sizeof(stinger->phys), "%s/serio0", serio->phys); 1481da177e4SLinus Torvalds 14917dd3f0fSDmitry Torokhov input_dev->name = "Gravis Stinger"; 15017dd3f0fSDmitry Torokhov input_dev->phys = stinger->phys; 15117dd3f0fSDmitry Torokhov input_dev->id.bustype = BUS_RS232; 15217dd3f0fSDmitry Torokhov input_dev->id.vendor = SERIO_STINGER; 15317dd3f0fSDmitry Torokhov input_dev->id.product = 0x0001; 15417dd3f0fSDmitry Torokhov input_dev->id.version = 0x0100; 155935e658eSDmitry Torokhov input_dev->dev.parent = &serio->dev; 1561da177e4SLinus Torvalds 1577b19ada2SJiri Slaby input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS); 1587b19ada2SJiri Slaby input_dev->keybit[BIT_WORD(BTN_A)] = BIT_MASK(BTN_A) | BIT_MASK(BTN_B) | 1597b19ada2SJiri Slaby BIT_MASK(BTN_C) | BIT_MASK(BTN_X) | BIT_MASK(BTN_Y) | 1607b19ada2SJiri Slaby BIT_MASK(BTN_Z) | BIT_MASK(BTN_TL) | BIT_MASK(BTN_TR) | 1617b19ada2SJiri Slaby BIT_MASK(BTN_START) | BIT_MASK(BTN_SELECT); 16217dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_X, -64, 64, 0, 4); 16317dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_Y, -64, 64, 0, 4); 1641da177e4SLinus Torvalds 1651da177e4SLinus Torvalds serio_set_drvdata(serio, stinger); 1661da177e4SLinus Torvalds 1671da177e4SLinus Torvalds err = serio_open(serio, drv); 16817dd3f0fSDmitry Torokhov if (err) 169127278ceSDmitry Torokhov goto fail2; 17017dd3f0fSDmitry Torokhov 171127278ceSDmitry Torokhov err = input_register_device(stinger->dev); 172127278ceSDmitry Torokhov if (err) 173127278ceSDmitry Torokhov goto fail3; 174127278ceSDmitry Torokhov 17517dd3f0fSDmitry Torokhov return 0; 17617dd3f0fSDmitry Torokhov 177127278ceSDmitry Torokhov fail3: serio_close(serio); 178127278ceSDmitry Torokhov fail2: serio_set_drvdata(serio, NULL); 179127278ceSDmitry Torokhov fail1: input_free_device(input_dev); 1801da177e4SLinus Torvalds kfree(stinger); 1811da177e4SLinus Torvalds return err; 1821da177e4SLinus Torvalds } 1831da177e4SLinus Torvalds 1841da177e4SLinus Torvalds /* 1851da177e4SLinus Torvalds * The serio driver structure. 1861da177e4SLinus Torvalds */ 1871da177e4SLinus Torvalds 1881da177e4SLinus Torvalds static struct serio_device_id stinger_serio_ids[] = { 1891da177e4SLinus Torvalds { 1901da177e4SLinus Torvalds .type = SERIO_RS232, 1911da177e4SLinus Torvalds .proto = SERIO_STINGER, 1921da177e4SLinus Torvalds .id = SERIO_ANY, 1931da177e4SLinus Torvalds .extra = SERIO_ANY, 1941da177e4SLinus Torvalds }, 1951da177e4SLinus Torvalds { 0 } 1961da177e4SLinus Torvalds }; 1971da177e4SLinus Torvalds 1981da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, stinger_serio_ids); 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds static struct serio_driver stinger_drv = { 2011da177e4SLinus Torvalds .driver = { 2021da177e4SLinus Torvalds .name = "stinger", 2031da177e4SLinus Torvalds }, 2041da177e4SLinus Torvalds .description = DRIVER_DESC, 2051da177e4SLinus Torvalds .id_table = stinger_serio_ids, 2061da177e4SLinus Torvalds .interrupt = stinger_interrupt, 2071da177e4SLinus Torvalds .connect = stinger_connect, 2081da177e4SLinus Torvalds .disconnect = stinger_disconnect, 2091da177e4SLinus Torvalds }; 2101da177e4SLinus Torvalds 211*65ac9f7aSAxel Lin module_serio_driver(stinger_drv); 212