interact.c 6.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright (c) 2001 Vojtech Pavlik
  4. *
  5. * Based on the work of:
  6. * Toby Deshane
  7. */
  8. /*
  9. * InterAct digital gamepad/joystick driver for Linux
  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. #define DRIVER_DESC "InterAct digital joystick driver"
  21. MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
  22. MODULE_DESCRIPTION(DRIVER_DESC);
  23. MODULE_LICENSE("GPL");
  24. #define INTERACT_MAX_START 600 /* 400 us */
  25. #define INTERACT_MAX_STROBE 60 /* 40 us */
  26. #define INTERACT_MAX_LENGTH 32 /* 32 bits */
  27. #define INTERACT_TYPE_HHFX 0 /* HammerHead/FX */
  28. #define INTERACT_TYPE_PP8D 1 /* ProPad 8 */
  29. struct interact {
  30. struct gameport *gameport;
  31. struct input_dev *dev;
  32. int bads;
  33. int reads;
  34. unsigned char type;
  35. unsigned char length;
  36. char phys[32];
  37. };
  38. static short interact_abs_hhfx[] =
  39. { ABS_RX, ABS_RY, ABS_X, ABS_Y, ABS_HAT0X, ABS_HAT0Y, -1 };
  40. static short interact_abs_pp8d[] =
  41. { ABS_X, ABS_Y, -1 };
  42. static short interact_btn_hhfx[] =
  43. { BTN_TR, BTN_X, BTN_Y, BTN_Z, BTN_A, BTN_B, BTN_C, BTN_TL, BTN_TL2, BTN_TR2, BTN_MODE, BTN_SELECT, -1 };
  44. static short interact_btn_pp8d[] =
  45. { BTN_C, BTN_TL, BTN_TR, BTN_A, BTN_B, BTN_Y, BTN_Z, BTN_X, -1 };
  46. struct interact_type {
  47. int id;
  48. short *abs;
  49. short *btn;
  50. char *name;
  51. unsigned char length;
  52. unsigned char b8;
  53. };
  54. static struct interact_type interact_type[] = {
  55. { 0x6202, interact_abs_hhfx, interact_btn_hhfx, "InterAct HammerHead/FX", 32, 4 },
  56. { 0x53f8, interact_abs_pp8d, interact_btn_pp8d, "InterAct ProPad 8 Digital", 16, 0 },
  57. { 0 }};
  58. /*
  59. * interact_read_packet() reads and InterAct joystick data.
  60. */
  61. static int interact_read_packet(struct gameport *gameport, int length, u32 *data)
  62. {
  63. unsigned long flags;
  64. unsigned char u, v;
  65. unsigned int t, s;
  66. int i;
  67. i = 0;
  68. data[0] = data[1] = data[2] = 0;
  69. t = gameport_time(gameport, INTERACT_MAX_START);
  70. s = gameport_time(gameport, INTERACT_MAX_STROBE);
  71. local_irq_save(flags);
  72. gameport_trigger(gameport);
  73. v = gameport_read(gameport);
  74. while (t > 0 && i < length) {
  75. t--;
  76. u = v; v = gameport_read(gameport);
  77. if (v & ~u & 0x40) {
  78. data[0] = (data[0] << 1) | ((v >> 4) & 1);
  79. data[1] = (data[1] << 1) | ((v >> 5) & 1);
  80. data[2] = (data[2] << 1) | ((v >> 7) & 1);
  81. i++;
  82. t = s;
  83. }
  84. }
  85. local_irq_restore(flags);
  86. return i;
  87. }
  88. /*
  89. * interact_poll() reads and analyzes InterAct joystick data.
  90. */
  91. static void interact_poll(struct gameport *gameport)
  92. {
  93. struct interact *interact = gameport_get_drvdata(gameport);
  94. struct input_dev *dev = interact->dev;
  95. u32 data[3];
  96. int i;
  97. interact->reads++;
  98. if (interact_read_packet(interact->gameport, interact->length, data) < interact->length) {
  99. interact->bads++;
  100. } else {
  101. for (i = 0; i < 3; i++)
  102. data[i] <<= INTERACT_MAX_LENGTH - interact->length;
  103. switch (interact->type) {
  104. case INTERACT_TYPE_HHFX:
  105. for (i = 0; i < 4; i++)
  106. input_report_abs(dev, interact_abs_hhfx[i], (data[i & 1] >> ((i >> 1) << 3)) & 0xff);
  107. for (i = 0; i < 2; i++)
  108. input_report_abs(dev, ABS_HAT0Y - i,
  109. ((data[1] >> ((i << 1) + 17)) & 1) - ((data[1] >> ((i << 1) + 16)) & 1));
  110. for (i = 0; i < 8; i++)
  111. input_report_key(dev, interact_btn_hhfx[i], (data[0] >> (i + 16)) & 1);
  112. for (i = 0; i < 4; i++)
  113. input_report_key(dev, interact_btn_hhfx[i + 8], (data[1] >> (i + 20)) & 1);
  114. break;
  115. case INTERACT_TYPE_PP8D:
  116. for (i = 0; i < 2; i++)
  117. input_report_abs(dev, interact_abs_pp8d[i],
  118. ((data[0] >> ((i << 1) + 20)) & 1) - ((data[0] >> ((i << 1) + 21)) & 1));
  119. for (i = 0; i < 8; i++)
  120. input_report_key(dev, interact_btn_pp8d[i], (data[1] >> (i + 16)) & 1);
  121. break;
  122. }
  123. }
  124. input_sync(dev);
  125. }
  126. /*
  127. * interact_open() is a callback from the input open routine.
  128. */
  129. static int interact_open(struct input_dev *dev)
  130. {
  131. struct interact *interact = input_get_drvdata(dev);
  132. gameport_start_polling(interact->gameport);
  133. return 0;
  134. }
  135. /*
  136. * interact_close() is a callback from the input close routine.
  137. */
  138. static void interact_close(struct input_dev *dev)
  139. {
  140. struct interact *interact = input_get_drvdata(dev);
  141. gameport_stop_polling(interact->gameport);
  142. }
  143. /*
  144. * interact_connect() probes for InterAct joysticks.
  145. */
  146. static int interact_connect(struct gameport *gameport, struct gameport_driver *drv)
  147. {
  148. struct interact *interact;
  149. struct input_dev *input_dev;
  150. __u32 data[3];
  151. int i, t;
  152. int err;
  153. interact = kzalloc(sizeof(struct interact), GFP_KERNEL);
  154. input_dev = input_allocate_device();
  155. if (!interact || !input_dev) {
  156. err = -ENOMEM;
  157. goto fail1;
  158. }
  159. interact->gameport = gameport;
  160. interact->dev = input_dev;
  161. gameport_set_drvdata(gameport, interact);
  162. err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
  163. if (err)
  164. goto fail1;
  165. i = interact_read_packet(gameport, INTERACT_MAX_LENGTH * 2, data);
  166. if (i != 32 || (data[0] >> 24) != 0x0c || (data[1] >> 24) != 0x02) {
  167. err = -ENODEV;
  168. goto fail2;
  169. }
  170. for (i = 0; interact_type[i].length; i++)
  171. if (interact_type[i].id == (data[2] >> 16))
  172. break;
  173. if (!interact_type[i].length) {
  174. printk(KERN_WARNING "interact.c: Unknown joystick on %s. [len %d d0 %08x d1 %08x i2 %08x]\n",
  175. gameport->phys, i, data[0], data[1], data[2]);
  176. err = -ENODEV;
  177. goto fail2;
  178. }
  179. gameport_set_poll_handler(gameport, interact_poll);
  180. gameport_set_poll_interval(gameport, 20);
  181. snprintf(interact->phys, sizeof(interact->phys), "%s/input0", gameport->phys);
  182. interact->type = i;
  183. interact->length = interact_type[i].length;
  184. input_dev->name = interact_type[i].name;
  185. input_dev->phys = interact->phys;
  186. input_dev->id.bustype = BUS_GAMEPORT;
  187. input_dev->id.vendor = GAMEPORT_ID_VENDOR_INTERACT;
  188. input_dev->id.product = interact_type[i].id;
  189. input_dev->id.version = 0x0100;
  190. input_dev->dev.parent = &gameport->dev;
  191. input_set_drvdata(input_dev, interact);
  192. input_dev->open = interact_open;
  193. input_dev->close = interact_close;
  194. input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
  195. for (i = 0; (t = interact_type[interact->type].abs[i]) >= 0; i++) {
  196. if (i < interact_type[interact->type].b8)
  197. input_set_abs_params(input_dev, t, 0, 255, 0, 0);
  198. else
  199. input_set_abs_params(input_dev, t, -1, 1, 0, 0);
  200. }
  201. for (i = 0; (t = interact_type[interact->type].btn[i]) >= 0; i++)
  202. __set_bit(t, input_dev->keybit);
  203. err = input_register_device(interact->dev);
  204. if (err)
  205. goto fail2;
  206. return 0;
  207. fail2: gameport_close(gameport);
  208. fail1: gameport_set_drvdata(gameport, NULL);
  209. input_free_device(input_dev);
  210. kfree(interact);
  211. return err;
  212. }
  213. static void interact_disconnect(struct gameport *gameport)
  214. {
  215. struct interact *interact = gameport_get_drvdata(gameport);
  216. input_unregister_device(interact->dev);
  217. gameport_close(gameport);
  218. gameport_set_drvdata(gameport, NULL);
  219. kfree(interact);
  220. }
  221. static struct gameport_driver interact_drv = {
  222. .driver = {
  223. .name = "interact",
  224. },
  225. .description = DRIVER_DESC,
  226. .connect = interact_connect,
  227. .disconnect = interact_disconnect,
  228. };
  229. module_gameport_driver(interact_drv);