root/drivers/input/joystick/guillemot.c

/* [<][>][^][v][top][bottom][index][help] */

DEFINITIONS

This source file includes following definitions.
  1. guillemot_read_packet
  2. guillemot_poll
  3. guillemot_open
  4. guillemot_close
  5. guillemot_connect
  6. guillemot_disconnect

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  *  Copyright (c) 2001 Vojtech Pavlik
   4  */
   5 
   6 /*
   7  * Guillemot Digital Interface Protocol driver for Linux
   8  */
   9 
  10 /*
  11  */
  12 
  13 #include <linux/kernel.h>
  14 #include <linux/slab.h>
  15 #include <linux/module.h>
  16 #include <linux/delay.h>
  17 #include <linux/gameport.h>
  18 #include <linux/input.h>
  19 #include <linux/jiffies.h>
  20 
  21 #define DRIVER_DESC     "Guillemot Digital joystick driver"
  22 
  23 MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
  24 MODULE_DESCRIPTION(DRIVER_DESC);
  25 MODULE_LICENSE("GPL");
  26 
  27 #define GUILLEMOT_MAX_START     600     /* 600 us */
  28 #define GUILLEMOT_MAX_STROBE    60      /* 60 us */
  29 #define GUILLEMOT_MAX_LENGTH    17      /* 17 bytes */
  30 
  31 static short guillemot_abs_pad[] =
  32         { ABS_X, ABS_Y, ABS_THROTTLE, ABS_RUDDER, -1 };
  33 
  34 static short guillemot_btn_pad[] =
  35         { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL, BTN_TR, BTN_MODE, BTN_SELECT, -1 };
  36 
  37 static struct {
  38         int x;
  39         int y;
  40 } guillemot_hat_to_axis[16] = {{ 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}};
  41 
  42 struct guillemot_type {
  43         unsigned char id;
  44         short *abs;
  45         short *btn;
  46         int hat;
  47         char *name;
  48 };
  49 
  50 struct guillemot {
  51         struct gameport *gameport;
  52         struct input_dev *dev;
  53         int bads;
  54         int reads;
  55         struct guillemot_type *type;
  56         unsigned char length;
  57         char phys[32];
  58 };
  59 
  60 static struct guillemot_type guillemot_type[] = {
  61         { 0x00, guillemot_abs_pad, guillemot_btn_pad, 1, "Guillemot Pad" },
  62         { 0 }};
  63 
  64 /*
  65  * guillemot_read_packet() reads Guillemot joystick data.
  66  */
  67 
  68 static int guillemot_read_packet(struct gameport *gameport, u8 *data)
  69 {
  70         unsigned long flags;
  71         unsigned char u, v;
  72         unsigned int t, s;
  73         int i;
  74 
  75         for (i = 0; i < GUILLEMOT_MAX_LENGTH; i++)
  76                 data[i] = 0;
  77 
  78         i = 0;
  79         t = gameport_time(gameport, GUILLEMOT_MAX_START);
  80         s = gameport_time(gameport, GUILLEMOT_MAX_STROBE);
  81 
  82         local_irq_save(flags);
  83         gameport_trigger(gameport);
  84         v = gameport_read(gameport);
  85 
  86         while (t > 0 && i < GUILLEMOT_MAX_LENGTH * 8) {
  87                 t--;
  88                 u = v; v = gameport_read(gameport);
  89                 if (v & ~u & 0x10) {
  90                         data[i >> 3] |= ((v >> 5) & 1) << (i & 7);
  91                         i++;
  92                         t = s;
  93                 }
  94         }
  95 
  96         local_irq_restore(flags);
  97 
  98         return i;
  99 }
 100 
 101 /*
 102  * guillemot_poll() reads and analyzes Guillemot joystick data.
 103  */
 104 
 105 static void guillemot_poll(struct gameport *gameport)
 106 {
 107         struct guillemot *guillemot = gameport_get_drvdata(gameport);
 108         struct input_dev *dev = guillemot->dev;
 109         u8 data[GUILLEMOT_MAX_LENGTH];
 110         int i;
 111 
 112         guillemot->reads++;
 113 
 114         if (guillemot_read_packet(guillemot->gameport, data) != GUILLEMOT_MAX_LENGTH * 8 ||
 115                 data[0] != 0x55 || data[16] != 0xaa) {
 116                 guillemot->bads++;
 117         } else {
 118 
 119                 for (i = 0; i < 6 && guillemot->type->abs[i] >= 0; i++)
 120                         input_report_abs(dev, guillemot->type->abs[i], data[i + 5]);
 121 
 122                 if (guillemot->type->hat) {
 123                         input_report_abs(dev, ABS_HAT0X, guillemot_hat_to_axis[data[4] >> 4].x);
 124                         input_report_abs(dev, ABS_HAT0Y, guillemot_hat_to_axis[data[4] >> 4].y);
 125                 }
 126 
 127                 for (i = 0; i < 16 && guillemot->type->btn[i] >= 0; i++)
 128                         input_report_key(dev, guillemot->type->btn[i], (data[2 + (i >> 3)] >> (i & 7)) & 1);
 129         }
 130 
 131         input_sync(dev);
 132 }
 133 
 134 /*
 135  * guillemot_open() is a callback from the input open routine.
 136  */
 137 
 138 static int guillemot_open(struct input_dev *dev)
 139 {
 140         struct guillemot *guillemot = input_get_drvdata(dev);
 141 
 142         gameport_start_polling(guillemot->gameport);
 143         return 0;
 144 }
 145 
 146 /*
 147  * guillemot_close() is a callback from the input close routine.
 148  */
 149 
 150 static void guillemot_close(struct input_dev *dev)
 151 {
 152         struct guillemot *guillemot = input_get_drvdata(dev);
 153 
 154         gameport_stop_polling(guillemot->gameport);
 155 }
 156 
 157 /*
 158  * guillemot_connect() probes for Guillemot joysticks.
 159  */
 160 
 161 static int guillemot_connect(struct gameport *gameport, struct gameport_driver *drv)
 162 {
 163         struct guillemot *guillemot;
 164         struct input_dev *input_dev;
 165         u8 data[GUILLEMOT_MAX_LENGTH];
 166         int i, t;
 167         int err;
 168 
 169         guillemot = kzalloc(sizeof(struct guillemot), GFP_KERNEL);
 170         input_dev = input_allocate_device();
 171         if (!guillemot || !input_dev) {
 172                 err = -ENOMEM;
 173                 goto fail1;
 174         }
 175 
 176         guillemot->gameport = gameport;
 177         guillemot->dev = input_dev;
 178 
 179         gameport_set_drvdata(gameport, guillemot);
 180 
 181         err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
 182         if (err)
 183                 goto fail1;
 184 
 185         i = guillemot_read_packet(gameport, data);
 186 
 187         if (i != GUILLEMOT_MAX_LENGTH * 8 || data[0] != 0x55 || data[16] != 0xaa) {
 188                 err = -ENODEV;
 189                 goto fail2;
 190         }
 191 
 192         for (i = 0; guillemot_type[i].name; i++)
 193                 if (guillemot_type[i].id == data[11])
 194                         break;
 195 
 196         if (!guillemot_type[i].name) {
 197                 printk(KERN_WARNING "guillemot.c: Unknown joystick on %s. [ %02x%02x:%04x, ver %d.%02d ]\n",
 198                         gameport->phys, data[12], data[13], data[11], data[14], data[15]);
 199                 err = -ENODEV;
 200                 goto fail2;
 201         }
 202 
 203         gameport_set_poll_handler(gameport, guillemot_poll);
 204         gameport_set_poll_interval(gameport, 20);
 205 
 206         snprintf(guillemot->phys, sizeof(guillemot->phys), "%s/input0", gameport->phys);
 207         guillemot->type = guillemot_type + i;
 208 
 209         input_dev->name = guillemot_type[i].name;
 210         input_dev->phys = guillemot->phys;
 211         input_dev->id.bustype = BUS_GAMEPORT;
 212         input_dev->id.vendor = GAMEPORT_ID_VENDOR_GUILLEMOT;
 213         input_dev->id.product = guillemot_type[i].id;
 214         input_dev->id.version = (int)data[14] << 8 | data[15];
 215         input_dev->dev.parent = &gameport->dev;
 216 
 217         input_set_drvdata(input_dev, guillemot);
 218 
 219         input_dev->open = guillemot_open;
 220         input_dev->close = guillemot_close;
 221 
 222         input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
 223 
 224         for (i = 0; (t = guillemot->type->abs[i]) >= 0; i++)
 225                 input_set_abs_params(input_dev, t, 0, 255, 0, 0);
 226 
 227         if (guillemot->type->hat) {
 228                 input_set_abs_params(input_dev, ABS_HAT0X, -1, 1, 0, 0);
 229                 input_set_abs_params(input_dev, ABS_HAT0Y, -1, 1, 0, 0);
 230         }
 231 
 232         for (i = 0; (t = guillemot->type->btn[i]) >= 0; i++)
 233                 set_bit(t, input_dev->keybit);
 234 
 235         err = input_register_device(guillemot->dev);
 236         if (err)
 237                 goto fail2;
 238 
 239         return 0;
 240 
 241 fail2:  gameport_close(gameport);
 242 fail1:  gameport_set_drvdata(gameport, NULL);
 243         input_free_device(input_dev);
 244         kfree(guillemot);
 245         return err;
 246 }
 247 
 248 static void guillemot_disconnect(struct gameport *gameport)
 249 {
 250         struct guillemot *guillemot = gameport_get_drvdata(gameport);
 251 
 252         printk(KERN_INFO "guillemot.c: Failed %d reads out of %d on %s\n", guillemot->reads, guillemot->bads, guillemot->phys);
 253         input_unregister_device(guillemot->dev);
 254         gameport_close(gameport);
 255         kfree(guillemot);
 256 }
 257 
 258 static struct gameport_driver guillemot_drv = {
 259         .driver         = {
 260                 .name   = "guillemot",
 261         },
 262         .description    = DRIVER_DESC,
 263         .connect        = guillemot_connect,
 264         .disconnect     = guillemot_disconnect,
 265 };
 266 
 267 module_gameport_driver(guillemot_drv);

/* [<][>][^][v][top][bottom][index][help] */