1*1da177e4SLinus Torvalds /* 2*1da177e4SLinus Torvalds * $Id: stinger.c,v 1.10 2002/01/22 20:29:31 vojtech Exp $ 3*1da177e4SLinus Torvalds * 4*1da177e4SLinus Torvalds * Copyright (c) 2000-2001 Vojtech Pavlik 5*1da177e4SLinus Torvalds * Copyright (c) 2000 Mark Fletcher 6*1da177e4SLinus Torvalds */ 7*1da177e4SLinus Torvalds 8*1da177e4SLinus Torvalds /* 9*1da177e4SLinus Torvalds * Gravis Stinger gamepad driver for Linux 10*1da177e4SLinus Torvalds */ 11*1da177e4SLinus Torvalds 12*1da177e4SLinus Torvalds /* 13*1da177e4SLinus Torvalds * This program is free warftware; you can redistribute it and/or modify 14*1da177e4SLinus Torvalds * it under the terms of the GNU General Public License as published by 15*1da177e4SLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 16*1da177e4SLinus Torvalds * (at your option) any later version. 17*1da177e4SLinus Torvalds * 18*1da177e4SLinus Torvalds * This program is distributed in the hope that it will be useful, 19*1da177e4SLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 20*1da177e4SLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 21*1da177e4SLinus Torvalds * GNU General Public License for more details. 22*1da177e4SLinus Torvalds * 23*1da177e4SLinus Torvalds * You should have received a copy of the GNU General Public License 24*1da177e4SLinus Torvalds * along with this program; if not, write to the Free Software 25*1da177e4SLinus Torvalds * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 26*1da177e4SLinus Torvalds * 27*1da177e4SLinus Torvalds * Should you need to contact me, the author, you can do so either by 28*1da177e4SLinus Torvalds * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: 29*1da177e4SLinus Torvalds * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic 30*1da177e4SLinus Torvalds */ 31*1da177e4SLinus Torvalds 32*1da177e4SLinus Torvalds #include <linux/kernel.h> 33*1da177e4SLinus Torvalds #include <linux/module.h> 34*1da177e4SLinus Torvalds #include <linux/slab.h> 35*1da177e4SLinus Torvalds #include <linux/input.h> 36*1da177e4SLinus Torvalds #include <linux/serio.h> 37*1da177e4SLinus Torvalds #include <linux/init.h> 38*1da177e4SLinus Torvalds 39*1da177e4SLinus Torvalds #define DRIVER_DESC "Gravis Stinger gamepad driver" 40*1da177e4SLinus Torvalds 41*1da177e4SLinus Torvalds MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 42*1da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC); 43*1da177e4SLinus Torvalds MODULE_LICENSE("GPL"); 44*1da177e4SLinus Torvalds 45*1da177e4SLinus Torvalds /* 46*1da177e4SLinus Torvalds * Constants. 47*1da177e4SLinus Torvalds */ 48*1da177e4SLinus Torvalds 49*1da177e4SLinus Torvalds #define STINGER_MAX_LENGTH 8 50*1da177e4SLinus Torvalds 51*1da177e4SLinus Torvalds static char *stinger_name = "Gravis Stinger"; 52*1da177e4SLinus Torvalds 53*1da177e4SLinus Torvalds /* 54*1da177e4SLinus Torvalds * Per-Stinger data. 55*1da177e4SLinus Torvalds */ 56*1da177e4SLinus Torvalds 57*1da177e4SLinus Torvalds struct stinger { 58*1da177e4SLinus Torvalds struct input_dev dev; 59*1da177e4SLinus Torvalds int idx; 60*1da177e4SLinus Torvalds unsigned char data[STINGER_MAX_LENGTH]; 61*1da177e4SLinus Torvalds char phys[32]; 62*1da177e4SLinus Torvalds }; 63*1da177e4SLinus Torvalds 64*1da177e4SLinus Torvalds /* 65*1da177e4SLinus Torvalds * stinger_process_packet() decodes packets the driver receives from the 66*1da177e4SLinus Torvalds * Stinger. It updates the data accordingly. 67*1da177e4SLinus Torvalds */ 68*1da177e4SLinus Torvalds 69*1da177e4SLinus Torvalds static void stinger_process_packet(struct stinger *stinger, struct pt_regs *regs) 70*1da177e4SLinus Torvalds { 71*1da177e4SLinus Torvalds struct input_dev *dev = &stinger->dev; 72*1da177e4SLinus Torvalds unsigned char *data = stinger->data; 73*1da177e4SLinus Torvalds 74*1da177e4SLinus Torvalds if (!stinger->idx) return; 75*1da177e4SLinus Torvalds 76*1da177e4SLinus Torvalds input_regs(dev, regs); 77*1da177e4SLinus Torvalds 78*1da177e4SLinus Torvalds input_report_key(dev, BTN_A, ((data[0] & 0x20) >> 5)); 79*1da177e4SLinus Torvalds input_report_key(dev, BTN_B, ((data[0] & 0x10) >> 4)); 80*1da177e4SLinus Torvalds input_report_key(dev, BTN_C, ((data[0] & 0x08) >> 3)); 81*1da177e4SLinus Torvalds input_report_key(dev, BTN_X, ((data[0] & 0x04) >> 2)); 82*1da177e4SLinus Torvalds input_report_key(dev, BTN_Y, ((data[3] & 0x20) >> 5)); 83*1da177e4SLinus Torvalds input_report_key(dev, BTN_Z, ((data[3] & 0x10) >> 4)); 84*1da177e4SLinus Torvalds input_report_key(dev, BTN_TL, ((data[3] & 0x08) >> 3)); 85*1da177e4SLinus Torvalds input_report_key(dev, BTN_TR, ((data[3] & 0x04) >> 2)); 86*1da177e4SLinus Torvalds input_report_key(dev, BTN_SELECT, ((data[3] & 0x02) >> 1)); 87*1da177e4SLinus Torvalds input_report_key(dev, BTN_START, (data[3] & 0x01)); 88*1da177e4SLinus Torvalds 89*1da177e4SLinus Torvalds input_report_abs(dev, ABS_X, (data[1] & 0x3F) - ((data[0] & 0x01) << 6)); 90*1da177e4SLinus Torvalds input_report_abs(dev, ABS_Y, ((data[0] & 0x02) << 5) - (data[2] & 0x3F)); 91*1da177e4SLinus Torvalds 92*1da177e4SLinus Torvalds input_sync(dev); 93*1da177e4SLinus Torvalds 94*1da177e4SLinus Torvalds return; 95*1da177e4SLinus Torvalds } 96*1da177e4SLinus Torvalds 97*1da177e4SLinus Torvalds /* 98*1da177e4SLinus Torvalds * stinger_interrupt() is called by the low level driver when characters 99*1da177e4SLinus Torvalds * are ready for us. We then buffer them for further processing, or call the 100*1da177e4SLinus Torvalds * packet processing routine. 101*1da177e4SLinus Torvalds */ 102*1da177e4SLinus Torvalds 103*1da177e4SLinus Torvalds static irqreturn_t stinger_interrupt(struct serio *serio, 104*1da177e4SLinus Torvalds unsigned char data, unsigned int flags, struct pt_regs *regs) 105*1da177e4SLinus Torvalds { 106*1da177e4SLinus Torvalds struct stinger *stinger = serio_get_drvdata(serio); 107*1da177e4SLinus Torvalds 108*1da177e4SLinus Torvalds /* All Stinger packets are 4 bytes */ 109*1da177e4SLinus Torvalds 110*1da177e4SLinus Torvalds if (stinger->idx < STINGER_MAX_LENGTH) 111*1da177e4SLinus Torvalds stinger->data[stinger->idx++] = data; 112*1da177e4SLinus Torvalds 113*1da177e4SLinus Torvalds if (stinger->idx == 4) { 114*1da177e4SLinus Torvalds stinger_process_packet(stinger, regs); 115*1da177e4SLinus Torvalds stinger->idx = 0; 116*1da177e4SLinus Torvalds } 117*1da177e4SLinus Torvalds 118*1da177e4SLinus Torvalds return IRQ_HANDLED; 119*1da177e4SLinus Torvalds } 120*1da177e4SLinus Torvalds 121*1da177e4SLinus Torvalds /* 122*1da177e4SLinus Torvalds * stinger_disconnect() is the opposite of stinger_connect() 123*1da177e4SLinus Torvalds */ 124*1da177e4SLinus Torvalds 125*1da177e4SLinus Torvalds static void stinger_disconnect(struct serio *serio) 126*1da177e4SLinus Torvalds { 127*1da177e4SLinus Torvalds struct stinger *stinger = serio_get_drvdata(serio); 128*1da177e4SLinus Torvalds 129*1da177e4SLinus Torvalds input_unregister_device(&stinger->dev); 130*1da177e4SLinus Torvalds serio_close(serio); 131*1da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 132*1da177e4SLinus Torvalds kfree(stinger); 133*1da177e4SLinus Torvalds } 134*1da177e4SLinus Torvalds 135*1da177e4SLinus Torvalds /* 136*1da177e4SLinus Torvalds * stinger_connect() is the routine that is called when someone adds a 137*1da177e4SLinus Torvalds * new serio device that supports Stinger protocol and registers it as 138*1da177e4SLinus Torvalds * an input device. 139*1da177e4SLinus Torvalds */ 140*1da177e4SLinus Torvalds 141*1da177e4SLinus Torvalds static int stinger_connect(struct serio *serio, struct serio_driver *drv) 142*1da177e4SLinus Torvalds { 143*1da177e4SLinus Torvalds struct stinger *stinger; 144*1da177e4SLinus Torvalds int i; 145*1da177e4SLinus Torvalds int err; 146*1da177e4SLinus Torvalds 147*1da177e4SLinus Torvalds if (!(stinger = kmalloc(sizeof(struct stinger), GFP_KERNEL))) 148*1da177e4SLinus Torvalds return -ENOMEM; 149*1da177e4SLinus Torvalds 150*1da177e4SLinus Torvalds memset(stinger, 0, sizeof(struct stinger)); 151*1da177e4SLinus Torvalds 152*1da177e4SLinus Torvalds stinger->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); 153*1da177e4SLinus Torvalds stinger->dev.keybit[LONG(BTN_A)] = BIT(BTN_A) | BIT(BTN_B) | BIT(BTN_C) | BIT(BTN_X) | \ 154*1da177e4SLinus Torvalds BIT(BTN_Y) | BIT(BTN_Z) | BIT(BTN_TL) | BIT(BTN_TR) | \ 155*1da177e4SLinus Torvalds BIT(BTN_START) | BIT(BTN_SELECT); 156*1da177e4SLinus Torvalds stinger->dev.absbit[0] = BIT(ABS_X) | BIT(ABS_Y); 157*1da177e4SLinus Torvalds 158*1da177e4SLinus Torvalds sprintf(stinger->phys, "%s/serio0", serio->phys); 159*1da177e4SLinus Torvalds 160*1da177e4SLinus Torvalds init_input_dev(&stinger->dev); 161*1da177e4SLinus Torvalds stinger->dev.name = stinger_name; 162*1da177e4SLinus Torvalds stinger->dev.phys = stinger->phys; 163*1da177e4SLinus Torvalds stinger->dev.id.bustype = BUS_RS232; 164*1da177e4SLinus Torvalds stinger->dev.id.vendor = SERIO_STINGER; 165*1da177e4SLinus Torvalds stinger->dev.id.product = 0x0001; 166*1da177e4SLinus Torvalds stinger->dev.id.version = 0x0100; 167*1da177e4SLinus Torvalds stinger->dev.dev = &serio->dev; 168*1da177e4SLinus Torvalds 169*1da177e4SLinus Torvalds for (i = 0; i < 2; i++) { 170*1da177e4SLinus Torvalds stinger->dev.absmax[ABS_X+i] = 64; 171*1da177e4SLinus Torvalds stinger->dev.absmin[ABS_X+i] = -64; 172*1da177e4SLinus Torvalds stinger->dev.absflat[ABS_X+i] = 4; 173*1da177e4SLinus Torvalds } 174*1da177e4SLinus Torvalds 175*1da177e4SLinus Torvalds stinger->dev.private = stinger; 176*1da177e4SLinus Torvalds 177*1da177e4SLinus Torvalds serio_set_drvdata(serio, stinger); 178*1da177e4SLinus Torvalds 179*1da177e4SLinus Torvalds err = serio_open(serio, drv); 180*1da177e4SLinus Torvalds if (err) { 181*1da177e4SLinus Torvalds serio_set_drvdata(serio, NULL); 182*1da177e4SLinus Torvalds kfree(stinger); 183*1da177e4SLinus Torvalds return err; 184*1da177e4SLinus Torvalds } 185*1da177e4SLinus Torvalds 186*1da177e4SLinus Torvalds input_register_device(&stinger->dev); 187*1da177e4SLinus Torvalds 188*1da177e4SLinus Torvalds printk(KERN_INFO "input: %s on %s\n", stinger_name, serio->phys); 189*1da177e4SLinus Torvalds 190*1da177e4SLinus Torvalds return 0; 191*1da177e4SLinus Torvalds } 192*1da177e4SLinus Torvalds 193*1da177e4SLinus Torvalds /* 194*1da177e4SLinus Torvalds * The serio driver structure. 195*1da177e4SLinus Torvalds */ 196*1da177e4SLinus Torvalds 197*1da177e4SLinus Torvalds static struct serio_device_id stinger_serio_ids[] = { 198*1da177e4SLinus Torvalds { 199*1da177e4SLinus Torvalds .type = SERIO_RS232, 200*1da177e4SLinus Torvalds .proto = SERIO_STINGER, 201*1da177e4SLinus Torvalds .id = SERIO_ANY, 202*1da177e4SLinus Torvalds .extra = SERIO_ANY, 203*1da177e4SLinus Torvalds }, 204*1da177e4SLinus Torvalds { 0 } 205*1da177e4SLinus Torvalds }; 206*1da177e4SLinus Torvalds 207*1da177e4SLinus Torvalds MODULE_DEVICE_TABLE(serio, stinger_serio_ids); 208*1da177e4SLinus Torvalds 209*1da177e4SLinus Torvalds static struct serio_driver stinger_drv = { 210*1da177e4SLinus Torvalds .driver = { 211*1da177e4SLinus Torvalds .name = "stinger", 212*1da177e4SLinus Torvalds }, 213*1da177e4SLinus Torvalds .description = DRIVER_DESC, 214*1da177e4SLinus Torvalds .id_table = stinger_serio_ids, 215*1da177e4SLinus Torvalds .interrupt = stinger_interrupt, 216*1da177e4SLinus Torvalds .connect = stinger_connect, 217*1da177e4SLinus Torvalds .disconnect = stinger_disconnect, 218*1da177e4SLinus Torvalds }; 219*1da177e4SLinus Torvalds 220*1da177e4SLinus Torvalds /* 221*1da177e4SLinus Torvalds * The functions for inserting/removing us as a module. 222*1da177e4SLinus Torvalds */ 223*1da177e4SLinus Torvalds 224*1da177e4SLinus Torvalds static int __init stinger_init(void) 225*1da177e4SLinus Torvalds { 226*1da177e4SLinus Torvalds serio_register_driver(&stinger_drv); 227*1da177e4SLinus Torvalds return 0; 228*1da177e4SLinus Torvalds } 229*1da177e4SLinus Torvalds 230*1da177e4SLinus Torvalds static void __exit stinger_exit(void) 231*1da177e4SLinus Torvalds { 232*1da177e4SLinus Torvalds serio_unregister_driver(&stinger_drv); 233*1da177e4SLinus Torvalds } 234*1da177e4SLinus Torvalds 235*1da177e4SLinus Torvalds module_init(stinger_init); 236*1da177e4SLinus Torvalds module_exit(stinger_exit); 237