1 /* 2 * $Id: guillemot.c,v 1.10 2002/01/22 20:28:12 vojtech Exp $ 3 * 4 * Copyright (c) 2001 Vojtech Pavlik 5 */ 6 7 /* 8 * Guillemot Digital Interface Protocol driver for Linux 9 */ 10 11 /* 12 * This program is free software; you can redistribute it and/or modify 13 * it under the terms of the GNU General Public License as published by 14 * the Free Software Foundation; either version 2 of the License, or 15 * (at your option) any later version. 16 * 17 * This program is distributed in the hope that it will be useful, 18 * but WITHOUT ANY WARRANTY; without even the implied warranty of 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 20 * GNU General Public License for more details. 21 * 22 * You should have received a copy of the GNU General Public License 23 * along with this program; if not, write to the Free Software 24 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 25 * 26 * Should you need to contact me, the author, you can do so either by 27 * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: 28 * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic 29 */ 30 31 #include <linux/kernel.h> 32 #include <linux/slab.h> 33 #include <linux/module.h> 34 #include <linux/delay.h> 35 #include <linux/init.h> 36 #include <linux/gameport.h> 37 #include <linux/input.h> 38 39 #define DRIVER_DESC "Guillemot Digital joystick driver" 40 41 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>"); 42 MODULE_DESCRIPTION(DRIVER_DESC); 43 MODULE_LICENSE("GPL"); 44 45 #define GUILLEMOT_MAX_START 600 /* 600 us */ 46 #define GUILLEMOT_MAX_STROBE 60 /* 60 us */ 47 #define GUILLEMOT_MAX_LENGTH 17 /* 17 bytes */ 48 49 static short guillemot_abs_pad[] = 50 { ABS_X, ABS_Y, ABS_THROTTLE, ABS_RUDDER, -1 }; 51 52 static short guillemot_btn_pad[] = 53 { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL, BTN_TR, BTN_MODE, BTN_SELECT, -1 }; 54 55 static struct { 56 int x; 57 int y; 58 } guillemot_hat_to_axis[16] = {{ 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}}; 59 60 struct guillemot_type { 61 unsigned char id; 62 short *abs; 63 short *btn; 64 int hat; 65 char *name; 66 }; 67 68 struct guillemot { 69 struct gameport *gameport; 70 struct input_dev dev; 71 int bads; 72 int reads; 73 struct guillemot_type *type; 74 unsigned char length; 75 char phys[32]; 76 }; 77 78 static struct guillemot_type guillemot_type[] = { 79 { 0x00, guillemot_abs_pad, guillemot_btn_pad, 1, "Guillemot Pad" }, 80 { 0 }}; 81 82 /* 83 * guillemot_read_packet() reads Guillemot joystick data. 84 */ 85 86 static int guillemot_read_packet(struct gameport *gameport, u8 *data) 87 { 88 unsigned long flags; 89 unsigned char u, v; 90 unsigned int t, s; 91 int i; 92 93 for (i = 0; i < GUILLEMOT_MAX_LENGTH; i++) 94 data[i] = 0; 95 96 i = 0; 97 t = gameport_time(gameport, GUILLEMOT_MAX_START); 98 s = gameport_time(gameport, GUILLEMOT_MAX_STROBE); 99 100 local_irq_save(flags); 101 gameport_trigger(gameport); 102 v = gameport_read(gameport); 103 104 while (t > 0 && i < GUILLEMOT_MAX_LENGTH * 8) { 105 t--; 106 u = v; v = gameport_read(gameport); 107 if (v & ~u & 0x10) { 108 data[i >> 3] |= ((v >> 5) & 1) << (i & 7); 109 i++; 110 t = s; 111 } 112 } 113 114 local_irq_restore(flags); 115 116 return i; 117 } 118 119 /* 120 * guillemot_poll() reads and analyzes Guillemot joystick data. 121 */ 122 123 static void guillemot_poll(struct gameport *gameport) 124 { 125 struct guillemot *guillemot = gameport_get_drvdata(gameport); 126 struct input_dev *dev = &guillemot->dev; 127 u8 data[GUILLEMOT_MAX_LENGTH]; 128 int i; 129 130 guillemot->reads++; 131 132 if (guillemot_read_packet(guillemot->gameport, data) != GUILLEMOT_MAX_LENGTH * 8 || 133 data[0] != 0x55 || data[16] != 0xaa) { 134 guillemot->bads++; 135 } else { 136 137 for (i = 0; i < 6 && guillemot->type->abs[i] >= 0; i++) 138 input_report_abs(dev, guillemot->type->abs[i], data[i + 5]); 139 140 if (guillemot->type->hat) { 141 input_report_abs(dev, ABS_HAT0X, guillemot_hat_to_axis[data[4] >> 4].x); 142 input_report_abs(dev, ABS_HAT0Y, guillemot_hat_to_axis[data[4] >> 4].y); 143 } 144 145 for (i = 0; i < 16 && guillemot->type->btn[i] >= 0; i++) 146 input_report_key(dev, guillemot->type->btn[i], (data[2 + (i >> 3)] >> (i & 7)) & 1); 147 } 148 149 input_sync(dev); 150 } 151 152 /* 153 * guillemot_open() is a callback from the input open routine. 154 */ 155 156 static int guillemot_open(struct input_dev *dev) 157 { 158 struct guillemot *guillemot = dev->private; 159 160 gameport_start_polling(guillemot->gameport); 161 return 0; 162 } 163 164 /* 165 * guillemot_close() is a callback from the input close routine. 166 */ 167 168 static void guillemot_close(struct input_dev *dev) 169 { 170 struct guillemot *guillemot = dev->private; 171 172 gameport_stop_polling(guillemot->gameport); 173 } 174 175 /* 176 * guillemot_connect() probes for Guillemot joysticks. 177 */ 178 179 static int guillemot_connect(struct gameport *gameport, struct gameport_driver *drv) 180 { 181 struct guillemot *guillemot; 182 u8 data[GUILLEMOT_MAX_LENGTH]; 183 int i, t; 184 int err; 185 186 if (!(guillemot = kcalloc(1, sizeof(struct guillemot), GFP_KERNEL))) 187 return -ENOMEM; 188 189 guillemot->gameport = gameport; 190 191 gameport_set_drvdata(gameport, guillemot); 192 193 err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW); 194 if (err) 195 goto fail1; 196 197 i = guillemot_read_packet(gameport, data); 198 199 if (i != GUILLEMOT_MAX_LENGTH * 8 || data[0] != 0x55 || data[16] != 0xaa) { 200 err = -ENODEV; 201 goto fail2; 202 } 203 204 for (i = 0; guillemot_type[i].name; i++) 205 if (guillemot_type[i].id == data[11]) 206 break; 207 208 if (!guillemot_type[i].name) { 209 printk(KERN_WARNING "guillemot.c: Unknown joystick on %s. [ %02x%02x:%04x, ver %d.%02d ]\n", 210 gameport->phys, data[12], data[13], data[11], data[14], data[15]); 211 err = -ENODEV; 212 goto fail2; 213 } 214 215 gameport_set_poll_handler(gameport, guillemot_poll); 216 gameport_set_poll_interval(gameport, 20); 217 218 sprintf(guillemot->phys, "%s/input0", gameport->phys); 219 220 guillemot->type = guillemot_type + i; 221 222 guillemot->dev.private = guillemot; 223 guillemot->dev.open = guillemot_open; 224 guillemot->dev.close = guillemot_close; 225 226 guillemot->dev.name = guillemot_type[i].name; 227 guillemot->dev.phys = guillemot->phys; 228 guillemot->dev.id.bustype = BUS_GAMEPORT; 229 guillemot->dev.id.vendor = GAMEPORT_ID_VENDOR_GUILLEMOT; 230 guillemot->dev.id.product = guillemot_type[i].id; 231 guillemot->dev.id.version = (int)data[14] << 8 | data[15]; 232 233 guillemot->dev.evbit[0] = BIT(EV_KEY) | BIT(EV_ABS); 234 235 for (i = 0; (t = guillemot->type->abs[i]) >= 0; i++) 236 input_set_abs_params(&guillemot->dev, t, 0, 255, 0, 0); 237 238 if (guillemot->type->hat) { 239 input_set_abs_params(&guillemot->dev, ABS_HAT0X, -1, 1, 0, 0); 240 input_set_abs_params(&guillemot->dev, ABS_HAT0Y, -1, 1, 0, 0); 241 } 242 243 for (i = 0; (t = guillemot->type->btn[i]) >= 0; i++) 244 set_bit(t, guillemot->dev.keybit); 245 246 input_register_device(&guillemot->dev); 247 printk(KERN_INFO "input: %s ver %d.%02d on %s\n", 248 guillemot->type->name, data[14], data[15], gameport->phys); 249 250 return 0; 251 252 fail2: gameport_close(gameport); 253 fail1: gameport_set_drvdata(gameport, NULL); 254 kfree(guillemot); 255 return err; 256 } 257 258 static void guillemot_disconnect(struct gameport *gameport) 259 { 260 struct guillemot *guillemot = gameport_get_drvdata(gameport); 261 262 printk(KERN_INFO "guillemot.c: Failed %d reads out of %d on %s\n", guillemot->reads, guillemot->bads, guillemot->phys); 263 input_unregister_device(&guillemot->dev); 264 gameport_close(gameport); 265 kfree(guillemot); 266 } 267 268 static struct gameport_driver guillemot_drv = { 269 .driver = { 270 .name = "guillemot", 271 }, 272 .description = DRIVER_DESC, 273 .connect = guillemot_connect, 274 .disconnect = guillemot_disconnect, 275 }; 276 277 static int __init guillemot_init(void) 278 { 279 gameport_register_driver(&guillemot_drv); 280 return 0; 281 } 282 283 static void __exit guillemot_exit(void) 284 { 285 gameport_unregister_driver(&guillemot_drv); 286 } 287 288 module_init(guillemot_init); 289 module_exit(guillemot_exit); 290