11da177e4SLinus Torvalds /* 21da177e4SLinus Torvalds * $Id: warrior.c,v 1.14 2002/01/22 20:32:10 vojtech Exp $ 31da177e4SLinus Torvalds * 41da177e4SLinus Torvalds * Copyright (c) 1999-2001 Vojtech Pavlik 51da177e4SLinus Torvalds */ 61da177e4SLinus Torvalds 71da177e4SLinus Torvalds /* 81da177e4SLinus Torvalds * Logitech WingMan Warrior joystick driver for Linux 91da177e4SLinus Torvalds */ 101da177e4SLinus Torvalds 111da177e4SLinus Torvalds /* 121da177e4SLinus Torvalds * This program is free warftware; you can redistribute it and/or modify 131da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 141da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 151da177e4SLinus Torvalds * (at your option) any later version. 161da177e4SLinus Torvalds * 171da177e4SLinus Torvalds * This program is distributed in the hope that it will be useful, 181da177e4SLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 191da177e4SLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 201da177e4SLinus Torvalds * GNU General Public License for more details. 211da177e4SLinus Torvalds * 221da177e4SLinus Torvalds * You should have received a copy of the GNU General Public License 231da177e4SLinus Torvalds * along with this program; if not, write to the Free Software 241da177e4SLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 251da177e4SLinus Torvalds * 261da177e4SLinus Torvalds * Should you need to contact me, the author, you can do so either by 271da177e4SLinus Torvalds * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: 281da177e4SLinus Torvalds * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic 291da177e4SLinus Torvalds */ 301da177e4SLinus Torvalds 311da177e4SLinus Torvalds #include <linux/kernel.h> 321da177e4SLinus Torvalds #include <linux/module.h> 331da177e4SLinus Torvalds #include <linux/slab.h> 341da177e4SLinus Torvalds #include <linux/input.h> 351da177e4SLinus Torvalds #include <linux/serio.h> 361da177e4SLinus Torvalds #include <linux/init.h> 371da177e4SLinus Torvalds 381da177e4SLinus Torvalds #define DRIVER_DESC "Logitech WingMan Warrior joystick driver" 391da177e4SLinus Torvalds 401da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 411da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC); 421da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 431da177e4SLinus Torvalds 441da177e4SLinus Torvalds /* 451da177e4SLinus Torvalds * Constants. 461da177e4SLinus Torvalds */ 471da177e4SLinus Torvalds 481da177e4SLinus Torvalds #define WARRIOR_MAX_LENGTH 16 491da177e4SLinus Torvalds static char warrior_lengths[] = { 0, 4, 12, 3, 4, 4, 0, 0 }; 501da177e4SLinus Torvalds static char *warrior_name = "Logitech WingMan Warrior"; 511da177e4SLinus Torvalds 521da177e4SLinus Torvalds /* 531da177e4SLinus Torvalds * Per-Warrior data. 541da177e4SLinus Torvalds */ 551da177e4SLinus Torvalds 561da177e4SLinus Torvalds struct warrior { 571da177e4SLinus Torvalds struct input_dev dev; 581da177e4SLinus Torvalds int idx, len; 591da177e4SLinus Torvalds unsigned char data[WARRIOR_MAX_LENGTH]; 601da177e4SLinus Torvalds char phys[32]; 611da177e4SLinus Torvalds }; 621da177e4SLinus Torvalds 631da177e4SLinus Torvalds /* 641da177e4SLinus Torvalds * warrior_process_packet() decodes packets the driver receives from the 651da177e4SLinus Torvalds * Warrior. It updates the data accordingly. 661da177e4SLinus Torvalds */ 671da177e4SLinus Torvalds 681da177e4SLinus Torvalds static void warrior_process_packet(struct warrior *warrior, struct pt_regs *regs) 691da177e4SLinus Torvalds { 701da177e4SLinus Torvalds struct input_dev *dev = &warrior->dev; 711da177e4SLinus Torvalds unsigned char *data = warrior->data; 721da177e4SLinus Torvalds 731da177e4SLinus Torvalds if (!warrior->idx) return; 741da177e4SLinus Torvalds 751da177e4SLinus Torvalds input_regs(dev, regs); 761da177e4SLinus Torvalds 771da177e4SLinus Torvalds switch ((data[0] >> 4) & 7) { 781da177e4SLinus Torvalds case 1: /* Button data */ 791da177e4SLinus Torvalds input_report_key(dev, BTN_TRIGGER, data[3] & 1); 801da177e4SLinus Torvalds input_report_key(dev, BTN_THUMB, (data[3] >> 1) & 1); 811da177e4SLinus Torvalds input_report_key(dev, BTN_TOP, (data[3] >> 2) & 1); 821da177e4SLinus Torvalds input_report_key(dev, BTN_TOP2, (data[3] >> 3) & 1); 831da177e4SLinus Torvalds break; 841da177e4SLinus Torvalds case 3: /* XY-axis info->data */ 851da177e4SLinus Torvalds input_report_abs(dev, ABS_X, ((data[0] & 8) << 5) - (data[2] | ((data[0] & 4) << 5))); 861da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data[1] | ((data[0] & 1) << 7)) - ((data[0] & 2) << 7)); 871da177e4SLinus Torvalds break; 881da177e4SLinus Torvalds case 5: /* Throttle, spinner, hat info->data */ 891da177e4SLinus Torvalds input_report_abs(dev, ABS_THROTTLE, (data[1] | ((data[0] & 1) << 7)) - ((data[0] & 2) << 7)); 901da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0X, (data[3] & 2 ? 1 : 0) - (data[3] & 1 ? 1 : 0)); 911da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0Y, (data[3] & 8 ? 1 : 0) - (data[3] & 4 ? 1 : 0)); 921da177e4SLinus Torvalds input_report_rel(dev, REL_DIAL, (data[2] | ((data[0] & 4) << 5)) - ((data[0] & 8) << 5)); 931da177e4SLinus Torvalds break; 941da177e4SLinus Torvalds } 951da177e4SLinus Torvalds input_sync(dev); 961da177e4SLinus Torvalds } 971da177e4SLinus Torvalds 981da177e4SLinus Torvalds /* 991da177e4SLinus Torvalds * warrior_interrupt() is called by the low level driver when characters 1001da177e4SLinus Torvalds * are ready for us. We then buffer them for further processing, or call the 1011da177e4SLinus Torvalds * packet processing routine. 1021da177e4SLinus Torvalds */ 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds static irqreturn_t warrior_interrupt(struct serio *serio, 1051da177e4SLinus Torvalds unsigned char data, unsigned int flags, struct pt_regs *regs) 1061da177e4SLinus Torvalds { 1071da177e4SLinus Torvalds struct warrior *warrior = serio_get_drvdata(serio); 1081da177e4SLinus Torvalds 1091da177e4SLinus Torvalds if (data & 0x80) { 1101da177e4SLinus Torvalds if (warrior->idx) warrior_process_packet(warrior, regs); 1111da177e4SLinus Torvalds warrior->idx = 0; 1121da177e4SLinus Torvalds warrior->len = warrior_lengths[(data >> 4) & 7]; 1131da177e4SLinus Torvalds } 1141da177e4SLinus Torvalds 1151da177e4SLinus Torvalds if (warrior->idx < warrior->len) 1161da177e4SLinus Torvalds warrior->data[warrior->idx++] = data; 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds if (warrior->idx == warrior->len) { 1191da177e4SLinus Torvalds if (warrior->idx) warrior_process_packet(warrior, regs); 1201da177e4SLinus Torvalds warrior->idx = 0; 1211da177e4SLinus Torvalds warrior->len = 0; 1221da177e4SLinus Torvalds } 1231da177e4SLinus Torvalds return IRQ_HANDLED; 1241da177e4SLinus Torvalds } 1251da177e4SLinus Torvalds 1261da177e4SLinus Torvalds /* 1271da177e4SLinus Torvalds * warrior_disconnect() is the opposite of warrior_connect() 1281da177e4SLinus Torvalds */ 1291da177e4SLinus Torvalds 1301da177e4SLinus Torvalds static void warrior_disconnect(struct serio *serio) 1311da177e4SLinus Torvalds { 1321da177e4SLinus Torvalds struct warrior *warrior = serio_get_drvdata(serio); 1331da177e4SLinus Torvalds 1341da177e4SLinus Torvalds input_unregister_device(&warrior->dev); 1351da177e4SLinus Torvalds serio_close(serio); 1361da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 1371da177e4SLinus Torvalds kfree(warrior); 1381da177e4SLinus Torvalds } 1391da177e4SLinus Torvalds 1401da177e4SLinus Torvalds /* 1411da177e4SLinus Torvalds * warrior_connect() is the routine that is called when someone adds a 1421da177e4SLinus Torvalds * new serio device. It looks for the Warrior, and if found, registers 1431da177e4SLinus Torvalds * it as an input device. 1441da177e4SLinus Torvalds */ 1451da177e4SLinus Torvalds 1461da177e4SLinus Torvalds static int warrior_connect(struct serio *serio, struct serio_driver *drv) 1471da177e4SLinus Torvalds { 1481da177e4SLinus Torvalds struct warrior *warrior; 1491da177e4SLinus Torvalds int i; 1501da177e4SLinus Torvalds int err; 1511da177e4SLinus Torvalds 1521da177e4SLinus Torvalds if (!(warrior = kmalloc(sizeof(struct warrior), GFP_KERNEL))) 1531da177e4SLinus Torvalds return -ENOMEM; 1541da177e4SLinus Torvalds 1551da177e4SLinus Torvalds memset(warrior, 0, sizeof(struct warrior)); 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds warrior->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_REL) | BIT(EV_ABS); 1581da177e4SLinus Torvalds warrior->dev.keybit[LONG(BTN_TRIGGER)] = BIT(BTN_TRIGGER) | BIT(BTN_THUMB) | BIT(BTN_TOP) | BIT(BTN_TOP2); 1591da177e4SLinus Torvalds warrior->dev.relbit[0] = BIT(REL_DIAL); 1601da177e4SLinus Torvalds warrior->dev.absbit[0] = BIT(ABS_X) | BIT(ABS_Y) | BIT(ABS_THROTTLE) | BIT(ABS_HAT0X) | BIT(ABS_HAT0Y); 1611da177e4SLinus Torvalds 1621da177e4SLinus Torvalds sprintf(warrior->phys, "%s/input0", serio->phys); 1631da177e4SLinus Torvalds 1641da177e4SLinus Torvalds init_input_dev(&warrior->dev); 1651da177e4SLinus Torvalds warrior->dev.name = warrior_name; 1661da177e4SLinus Torvalds warrior->dev.phys = warrior->phys; 1671da177e4SLinus Torvalds warrior->dev.id.bustype = BUS_RS232; 1681da177e4SLinus Torvalds warrior->dev.id.vendor = SERIO_WARRIOR; 1691da177e4SLinus Torvalds warrior->dev.id.product = 0x0001; 1701da177e4SLinus Torvalds warrior->dev.id.version = 0x0100; 1711da177e4SLinus Torvalds warrior->dev.dev = &serio->dev; 1721da177e4SLinus Torvalds 1731da177e4SLinus Torvalds for (i = 0; i < 2; i++) { 1741da177e4SLinus Torvalds warrior->dev.absmax[ABS_X+i] = -64; 1751da177e4SLinus Torvalds warrior->dev.absmin[ABS_X+i] = 64; 1761da177e4SLinus Torvalds warrior->dev.absflat[ABS_X+i] = 8; 1771da177e4SLinus Torvalds } 1781da177e4SLinus Torvalds 1791da177e4SLinus Torvalds warrior->dev.absmax[ABS_THROTTLE] = -112; 1801da177e4SLinus Torvalds warrior->dev.absmin[ABS_THROTTLE] = 112; 1811da177e4SLinus Torvalds 1821da177e4SLinus Torvalds for (i = 0; i < 2; i++) { 1831da177e4SLinus Torvalds warrior->dev.absmax[ABS_HAT0X+i] = -1; 1841da177e4SLinus Torvalds warrior->dev.absmin[ABS_HAT0X+i] = 1; 1851da177e4SLinus Torvalds } 1861da177e4SLinus Torvalds 1871da177e4SLinus Torvalds warrior->dev.private = warrior; 1881da177e4SLinus Torvalds 1891da177e4SLinus Torvalds serio_set_drvdata(serio, warrior); 1901da177e4SLinus Torvalds 1911da177e4SLinus Torvalds err = serio_open(serio, drv); 1921da177e4SLinus Torvalds if (err) { 1931da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 1941da177e4SLinus Torvalds kfree(warrior); 1951da177e4SLinus Torvalds return err; 1961da177e4SLinus Torvalds } 1971da177e4SLinus Torvalds 1981da177e4SLinus Torvalds input_register_device(&warrior->dev); 1991da177e4SLinus Torvalds 2001da177e4SLinus Torvalds printk(KERN_INFO "input: Logitech WingMan Warrior on %s\n", serio->phys); 2011da177e4SLinus Torvalds 2021da177e4SLinus Torvalds return 0; 2031da177e4SLinus Torvalds } 2041da177e4SLinus Torvalds 2051da177e4SLinus Torvalds /* 2061da177e4SLinus Torvalds * The serio driver structure. 2071da177e4SLinus Torvalds */ 2081da177e4SLinus Torvalds 2091da177e4SLinus Torvalds static struct serio_device_id warrior_serio_ids[] = { 2101da177e4SLinus Torvalds { 2111da177e4SLinus Torvalds .type = SERIO_RS232, 2121da177e4SLinus Torvalds .proto = SERIO_WARRIOR, 2131da177e4SLinus Torvalds .id = SERIO_ANY, 2141da177e4SLinus Torvalds .extra = SERIO_ANY, 2151da177e4SLinus Torvalds }, 2161da177e4SLinus Torvalds { 0 } 2171da177e4SLinus Torvalds }; 2181da177e4SLinus Torvalds 2191da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, warrior_serio_ids); 2201da177e4SLinus Torvalds 2211da177e4SLinus Torvalds static struct serio_driver warrior_drv = { 2221da177e4SLinus Torvalds .driver = { 2231da177e4SLinus Torvalds .name = "warrior", 2241da177e4SLinus Torvalds }, 2251da177e4SLinus Torvalds .description = DRIVER_DESC, 2261da177e4SLinus Torvalds .id_table = warrior_serio_ids, 2271da177e4SLinus Torvalds .interrupt = warrior_interrupt, 2281da177e4SLinus Torvalds .connect = warrior_connect, 2291da177e4SLinus Torvalds .disconnect = warrior_disconnect, 2301da177e4SLinus Torvalds }; 2311da177e4SLinus Torvalds 2321da177e4SLinus Torvalds /* 2331da177e4SLinus Torvalds * The functions for inserting/removing us as a module. 2341da177e4SLinus Torvalds */ 2351da177e4SLinus Torvalds 2361da177e4SLinus Torvalds static int __init warrior_init(void) 2371da177e4SLinus Torvalds { 2381da177e4SLinus Torvalds serio_register_driver(&warrior_drv); 2391da177e4SLinus Torvalds return 0; 2401da177e4SLinus Torvalds } 2411da177e4SLinus Torvalds 2421da177e4SLinus Torvalds static void __exit warrior_exit(void) 2431da177e4SLinus Torvalds { 2441da177e4SLinus Torvalds serio_unregister_driver(&warrior_drv); 2451da177e4SLinus Torvalds } 2461da177e4SLinus Torvalds 2471da177e4SLinus Torvalds module_init(warrior_init); 2481da177e4SLinus Torvalds module_exit(warrior_exit); 249