1e8fc9828SThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 21da177e4SLinus Torvalds /* 31da177e4SLinus Torvalds * Copyright (c) 1999-2001 Vojtech Pavlik 41da177e4SLinus Torvalds */ 51da177e4SLinus Torvalds 61da177e4SLinus Torvalds /* 71da177e4SLinus Torvalds * Logitech WingMan Warrior joystick driver for Linux 81da177e4SLinus Torvalds */ 91da177e4SLinus Torvalds 101da177e4SLinus Torvalds /* 111da177e4SLinus Torvalds */ 121da177e4SLinus Torvalds 131da177e4SLinus Torvalds #include <linux/kernel.h> 141da177e4SLinus Torvalds #include <linux/module.h> 151da177e4SLinus Torvalds #include <linux/slab.h> 161da177e4SLinus Torvalds #include <linux/input.h> 171da177e4SLinus Torvalds #include <linux/serio.h> 181da177e4SLinus Torvalds 191da177e4SLinus Torvalds #define DRIVER_DESC "Logitech WingMan Warrior joystick driver" 201da177e4SLinus Torvalds 211da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 221da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC); 231da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 241da177e4SLinus Torvalds 251da177e4SLinus Torvalds /* 261da177e4SLinus Torvalds * Constants. 271da177e4SLinus Torvalds */ 281da177e4SLinus Torvalds 291da177e4SLinus Torvalds #define WARRIOR_MAX_LENGTH 16 301da177e4SLinus Torvalds static char warrior_lengths[] = { 0, 4, 12, 3, 4, 4, 0, 0 }; 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds /* 331da177e4SLinus Torvalds * Per-Warrior data. 341da177e4SLinus Torvalds */ 351da177e4SLinus Torvalds 361da177e4SLinus Torvalds struct warrior { 3717dd3f0fSDmitry Torokhov struct input_dev *dev; 381da177e4SLinus Torvalds int idx, len; 391da177e4SLinus Torvalds unsigned char data[WARRIOR_MAX_LENGTH]; 401da177e4SLinus Torvalds char phys[32]; 411da177e4SLinus Torvalds }; 421da177e4SLinus Torvalds 431da177e4SLinus Torvalds /* 441da177e4SLinus Torvalds * warrior_process_packet() decodes packets the driver receives from the 451da177e4SLinus Torvalds * Warrior. It updates the data accordingly. 461da177e4SLinus Torvalds */ 471da177e4SLinus Torvalds 487d12e780SDavid Howells static void warrior_process_packet(struct warrior *warrior) 491da177e4SLinus Torvalds { 5017dd3f0fSDmitry Torokhov struct input_dev *dev = warrior->dev; 511da177e4SLinus Torvalds unsigned char *data = warrior->data; 521da177e4SLinus Torvalds 531da177e4SLinus Torvalds if (!warrior->idx) return; 541da177e4SLinus Torvalds 551da177e4SLinus Torvalds switch ((data[0] >> 4) & 7) { 561da177e4SLinus Torvalds case 1: /* Button data */ 571da177e4SLinus Torvalds input_report_key(dev, BTN_TRIGGER, data[3] & 1); 581da177e4SLinus Torvalds input_report_key(dev, BTN_THUMB, (data[3] >> 1) & 1); 591da177e4SLinus Torvalds input_report_key(dev, BTN_TOP, (data[3] >> 2) & 1); 601da177e4SLinus Torvalds input_report_key(dev, BTN_TOP2, (data[3] >> 3) & 1); 611da177e4SLinus Torvalds break; 621da177e4SLinus Torvalds case 3: /* XY-axis info->data */ 631da177e4SLinus Torvalds input_report_abs(dev, ABS_X, ((data[0] & 8) << 5) - (data[2] | ((data[0] & 4) << 5))); 641da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, (data[1] | ((data[0] & 1) << 7)) - ((data[0] & 2) << 7)); 651da177e4SLinus Torvalds break; 661da177e4SLinus Torvalds case 5: /* Throttle, spinner, hat info->data */ 671da177e4SLinus Torvalds input_report_abs(dev, ABS_THROTTLE, (data[1] | ((data[0] & 1) << 7)) - ((data[0] & 2) << 7)); 681da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0X, (data[3] & 2 ? 1 : 0) - (data[3] & 1 ? 1 : 0)); 691da177e4SLinus Torvalds input_report_abs(dev, ABS_HAT0Y, (data[3] & 8 ? 1 : 0) - (data[3] & 4 ? 1 : 0)); 701da177e4SLinus Torvalds input_report_rel(dev, REL_DIAL, (data[2] | ((data[0] & 4) << 5)) - ((data[0] & 8) << 5)); 711da177e4SLinus Torvalds break; 721da177e4SLinus Torvalds } 731da177e4SLinus Torvalds input_sync(dev); 741da177e4SLinus Torvalds } 751da177e4SLinus Torvalds 761da177e4SLinus Torvalds /* 771da177e4SLinus Torvalds * warrior_interrupt() is called by the low level driver when characters 781da177e4SLinus Torvalds * are ready for us. We then buffer them for further processing, or call the 791da177e4SLinus Torvalds * packet processing routine. 801da177e4SLinus Torvalds */ 811da177e4SLinus Torvalds 821da177e4SLinus Torvalds static irqreturn_t warrior_interrupt(struct serio *serio, 837d12e780SDavid Howells unsigned char data, unsigned int flags) 841da177e4SLinus Torvalds { 851da177e4SLinus Torvalds struct warrior *warrior = serio_get_drvdata(serio); 861da177e4SLinus Torvalds 871da177e4SLinus Torvalds if (data & 0x80) { 887d12e780SDavid Howells if (warrior->idx) warrior_process_packet(warrior); 891da177e4SLinus Torvalds warrior->idx = 0; 901da177e4SLinus Torvalds warrior->len = warrior_lengths[(data >> 4) & 7]; 911da177e4SLinus Torvalds } 921da177e4SLinus Torvalds 931da177e4SLinus Torvalds if (warrior->idx < warrior->len) 941da177e4SLinus Torvalds warrior->data[warrior->idx++] = data; 951da177e4SLinus Torvalds 961da177e4SLinus Torvalds if (warrior->idx == warrior->len) { 977d12e780SDavid Howells if (warrior->idx) warrior_process_packet(warrior); 981da177e4SLinus Torvalds warrior->idx = 0; 991da177e4SLinus Torvalds warrior->len = 0; 1001da177e4SLinus Torvalds } 1011da177e4SLinus Torvalds return IRQ_HANDLED; 1021da177e4SLinus Torvalds } 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds /* 1051da177e4SLinus Torvalds * warrior_disconnect() is the opposite of warrior_connect() 1061da177e4SLinus Torvalds */ 1071da177e4SLinus Torvalds 1081da177e4SLinus Torvalds static void warrior_disconnect(struct serio *serio) 1091da177e4SLinus Torvalds { 1101da177e4SLinus Torvalds struct warrior *warrior = serio_get_drvdata(serio); 1111da177e4SLinus Torvalds 1121da177e4SLinus Torvalds serio_close(serio); 1131da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 11417dd3f0fSDmitry Torokhov input_unregister_device(warrior->dev); 1151da177e4SLinus Torvalds kfree(warrior); 1161da177e4SLinus Torvalds } 1171da177e4SLinus Torvalds 1181da177e4SLinus Torvalds /* 1191da177e4SLinus Torvalds * warrior_connect() is the routine that is called when someone adds a 1201da177e4SLinus Torvalds * new serio device. It looks for the Warrior, and if found, registers 1211da177e4SLinus Torvalds * it as an input device. 1221da177e4SLinus Torvalds */ 1231da177e4SLinus Torvalds 1241da177e4SLinus Torvalds static int warrior_connect(struct serio *serio, struct serio_driver *drv) 1251da177e4SLinus Torvalds { 1261da177e4SLinus Torvalds struct warrior *warrior; 12717dd3f0fSDmitry Torokhov struct input_dev *input_dev; 12817dd3f0fSDmitry Torokhov int err = -ENOMEM; 1291da177e4SLinus Torvalds 13017dd3f0fSDmitry Torokhov warrior = kzalloc(sizeof(struct warrior), GFP_KERNEL); 13117dd3f0fSDmitry Torokhov input_dev = input_allocate_device(); 13217dd3f0fSDmitry Torokhov if (!warrior || !input_dev) 133127278ceSDmitry Torokhov goto fail1; 1341da177e4SLinus Torvalds 13517dd3f0fSDmitry Torokhov warrior->dev = input_dev; 13610ca4c0aSDmitry Torokhov snprintf(warrior->phys, sizeof(warrior->phys), "%s/input0", serio->phys); 1371da177e4SLinus Torvalds 13817dd3f0fSDmitry Torokhov input_dev->name = "Logitech WingMan Warrior"; 13917dd3f0fSDmitry Torokhov input_dev->phys = warrior->phys; 14017dd3f0fSDmitry Torokhov input_dev->id.bustype = BUS_RS232; 14117dd3f0fSDmitry Torokhov input_dev->id.vendor = SERIO_WARRIOR; 14217dd3f0fSDmitry Torokhov input_dev->id.product = 0x0001; 14317dd3f0fSDmitry Torokhov input_dev->id.version = 0x0100; 144935e658eSDmitry Torokhov input_dev->dev.parent = &serio->dev; 1451da177e4SLinus Torvalds 1467b19ada2SJiri Slaby input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_REL) | 1477b19ada2SJiri Slaby BIT_MASK(EV_ABS); 1487b19ada2SJiri Slaby input_dev->keybit[BIT_WORD(BTN_TRIGGER)] = BIT_MASK(BTN_TRIGGER) | 1497b19ada2SJiri Slaby BIT_MASK(BTN_THUMB) | BIT_MASK(BTN_TOP) | BIT_MASK(BTN_TOP2); 1507b19ada2SJiri Slaby input_dev->relbit[0] = BIT_MASK(REL_DIAL); 15117dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_X, -64, 64, 0, 8); 15217dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_Y, -64, 64, 0, 8); 15317dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_THROTTLE, -112, 112, 0, 0); 15417dd3f0fSDmitry Torokhov input_set_abs_params(input_dev, ABS_HAT0X, -1, 1, 0, 0); 155ae5536d6SDmitry Torokhov input_set_abs_params(input_dev, ABS_HAT0Y, -1, 1, 0, 0); 1561da177e4SLinus Torvalds 1571da177e4SLinus Torvalds serio_set_drvdata(serio, warrior); 1581da177e4SLinus Torvalds 1591da177e4SLinus Torvalds err = serio_open(serio, drv); 16017dd3f0fSDmitry Torokhov if (err) 161127278ceSDmitry Torokhov goto fail2; 16217dd3f0fSDmitry Torokhov 163127278ceSDmitry Torokhov err = input_register_device(warrior->dev); 164127278ceSDmitry Torokhov if (err) 165127278ceSDmitry Torokhov goto fail3; 166127278ceSDmitry Torokhov 16717dd3f0fSDmitry Torokhov return 0; 16817dd3f0fSDmitry Torokhov 169127278ceSDmitry Torokhov fail3: serio_close(serio); 170127278ceSDmitry Torokhov fail2: serio_set_drvdata(serio, NULL); 171127278ceSDmitry Torokhov fail1: input_free_device(input_dev); 1721da177e4SLinus Torvalds kfree(warrior); 1731da177e4SLinus Torvalds return err; 1741da177e4SLinus Torvalds } 1751da177e4SLinus Torvalds 1761da177e4SLinus Torvalds /* 1771da177e4SLinus Torvalds * The serio driver structure. 1781da177e4SLinus Torvalds */ 1791da177e4SLinus Torvalds 180bee186deSArvind Yadav static const struct serio_device_id warrior_serio_ids[] = { 1811da177e4SLinus Torvalds { 1821da177e4SLinus Torvalds .type = SERIO_RS232, 1831da177e4SLinus Torvalds .proto = SERIO_WARRIOR, 1841da177e4SLinus Torvalds .id = SERIO_ANY, 1851da177e4SLinus Torvalds .extra = SERIO_ANY, 1861da177e4SLinus Torvalds }, 1871da177e4SLinus Torvalds { 0 } 1881da177e4SLinus Torvalds }; 1891da177e4SLinus Torvalds 1901da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, warrior_serio_ids); 1911da177e4SLinus Torvalds 1921da177e4SLinus Torvalds static struct serio_driver warrior_drv = { 1931da177e4SLinus Torvalds .driver = { 1941da177e4SLinus Torvalds .name = "warrior", 1951da177e4SLinus Torvalds }, 1961da177e4SLinus Torvalds .description = DRIVER_DESC, 1971da177e4SLinus Torvalds .id_table = warrior_serio_ids, 1981da177e4SLinus Torvalds .interrupt = warrior_interrupt, 1991da177e4SLinus Torvalds .connect = warrior_connect, 2001da177e4SLinus Torvalds .disconnect = warrior_disconnect, 2011da177e4SLinus Torvalds }; 2021da177e4SLinus Torvalds 20365ac9f7aSAxel Lin module_serio_driver(warrior_drv); 204