tmdc.c 10.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. * Copyright (c) 1998-2001 Vojtech Pavlik
  4. *
  5. * Based on the work of:
  6. * Trystan Larey-Williams
  7. */
  8. /*
  9. * ThrustMaster DirectConnect (BSP) joystick family driver for Linux
  10. */
  11. /*
  12. */
  13. #include <linux/delay.h>
  14. #include <linux/kernel.h>
  15. #include <linux/slab.h>
  16. #include <linux/module.h>
  17. #include <linux/gameport.h>
  18. #include <linux/input.h>
  19. #include <linux/jiffies.h>
  20. #define DRIVER_DESC "ThrustMaster DirectConnect joystick driver"
  21. MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
  22. MODULE_DESCRIPTION(DRIVER_DESC);
  23. MODULE_LICENSE("GPL");
  24. #define TMDC_MAX_START 600 /* 600 us */
  25. #define TMDC_MAX_STROBE 60 /* 60 us */
  26. #define TMDC_MAX_LENGTH 13
  27. #define TMDC_MODE_M3DI 1
  28. #define TMDC_MODE_3DRP 3
  29. #define TMDC_MODE_AT 4
  30. #define TMDC_MODE_FM 8
  31. #define TMDC_MODE_FGP 163
  32. #define TMDC_BYTE_ID 10
  33. #define TMDC_BYTE_REV 11
  34. #define TMDC_BYTE_DEF 12
  35. #define TMDC_ABS 7
  36. #define TMDC_ABS_HAT 4
  37. #define TMDC_BTN 16
  38. static const unsigned char tmdc_byte_a[16] = { 0, 1, 3, 4, 6, 7 };
  39. static const unsigned char tmdc_byte_d[16] = { 2, 5, 8, 9 };
  40. static const signed char tmdc_abs[TMDC_ABS] =
  41. { ABS_X, ABS_Y, ABS_RUDDER, ABS_THROTTLE, ABS_RX, ABS_RY, ABS_RZ };
  42. static const signed char tmdc_abs_hat[TMDC_ABS_HAT] =
  43. { ABS_HAT0X, ABS_HAT0Y, ABS_HAT1X, ABS_HAT1Y };
  44. static const signed char tmdc_abs_at[TMDC_ABS] =
  45. { ABS_X, ABS_Y, ABS_RUDDER, -1, ABS_THROTTLE };
  46. static const signed char tmdc_abs_fm[TMDC_ABS] =
  47. { ABS_RX, ABS_RY, ABS_X, ABS_Y };
  48. static const short tmdc_btn_pad[TMDC_BTN] =
  49. { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_START, BTN_SELECT, BTN_TL, BTN_TR };
  50. static const short tmdc_btn_joy[TMDC_BTN] =
  51. { BTN_TRIGGER, BTN_THUMB, BTN_TOP, BTN_TOP2, BTN_BASE, BTN_BASE2, BTN_THUMB2, BTN_PINKIE,
  52. BTN_BASE3, BTN_BASE4, BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z };
  53. static const short tmdc_btn_fm[TMDC_BTN] =
  54. { BTN_TRIGGER, BTN_C, BTN_B, BTN_A, BTN_THUMB, BTN_X, BTN_Y, BTN_Z, BTN_TOP, BTN_TOP2 };
  55. static const short tmdc_btn_at[TMDC_BTN] =
  56. { BTN_TRIGGER, BTN_THUMB2, BTN_PINKIE, BTN_THUMB, BTN_BASE6, BTN_BASE5, BTN_BASE4,
  57. BTN_BASE3, BTN_BASE2, BTN_BASE };
  58. static const struct {
  59. int x;
  60. int y;
  61. } tmdc_hat_to_axis[] = {{ 0, 0}, { 1, 0}, { 0,-1}, {-1, 0}, { 0, 1}};
  62. static const struct tmdc_model {
  63. unsigned char id;
  64. const char *name;
  65. char abs;
  66. char hats;
  67. char btnc[4];
  68. char btno[4];
  69. const signed char *axes;
  70. const short *buttons;
  71. } tmdc_models[] = {
  72. { 1, "ThrustMaster Millenium 3D Inceptor", 6, 2, { 4, 2 }, { 4, 6 }, tmdc_abs, tmdc_btn_joy },
  73. { 3, "ThrustMaster Rage 3D Gamepad", 2, 0, { 8, 2 }, { 0, 0 }, tmdc_abs, tmdc_btn_pad },
  74. { 4, "ThrustMaster Attack Throttle", 5, 2, { 4, 6 }, { 4, 2 }, tmdc_abs_at, tmdc_btn_at },
  75. { 8, "ThrustMaster FragMaster", 4, 0, { 8, 2 }, { 0, 0 }, tmdc_abs_fm, tmdc_btn_fm },
  76. { 163, "Thrustmaster Fusion GamePad", 2, 0, { 8, 2 }, { 0, 0 }, tmdc_abs, tmdc_btn_pad },
  77. { 0, "Unknown %d-axis, %d-button TM device %d", 0, 0, { 0, 0 }, { 0, 0 }, tmdc_abs, tmdc_btn_joy }
  78. };
  79. struct tmdc_port {
  80. struct input_dev *dev;
  81. char name[64];
  82. char phys[32];
  83. int mode;
  84. const signed char *abs;
  85. const short *btn;
  86. unsigned char absc;
  87. unsigned char btnc[4];
  88. unsigned char btno[4];
  89. };
  90. struct tmdc {
  91. struct gameport *gameport;
  92. struct tmdc_port *port[2];
  93. #if 0
  94. struct input_dev *dev[2];
  95. char name[2][64];
  96. char phys[2][32];
  97. int mode[2];
  98. signed char *abs[2];
  99. short *btn[2];
  100. unsigned char absc[2];
  101. unsigned char btnc[2][4];
  102. unsigned char btno[2][4];
  103. #endif
  104. int reads;
  105. int bads;
  106. unsigned char exists;
  107. };
  108. /*
  109. * tmdc_read_packet() reads a ThrustMaster packet.
  110. */
  111. static int tmdc_read_packet(struct gameport *gameport, unsigned char data[2][TMDC_MAX_LENGTH])
  112. {
  113. unsigned char u, v, w, x;
  114. unsigned long flags;
  115. int i[2], j[2], t[2], p, k;
  116. p = gameport_time(gameport, TMDC_MAX_STROBE);
  117. for (k = 0; k < 2; k++) {
  118. t[k] = gameport_time(gameport, TMDC_MAX_START);
  119. i[k] = j[k] = 0;
  120. }
  121. local_irq_save(flags);
  122. gameport_trigger(gameport);
  123. w = gameport_read(gameport) >> 4;
  124. do {
  125. x = w;
  126. w = gameport_read(gameport) >> 4;
  127. for (k = 0, v = w, u = x; k < 2; k++, v >>= 2, u >>= 2) {
  128. if (~v & u & 2) {
  129. if (t[k] <= 0 || i[k] >= TMDC_MAX_LENGTH) continue;
  130. t[k] = p;
  131. if (j[k] == 0) { /* Start bit */
  132. if (~v & 1) t[k] = 0;
  133. data[k][i[k]] = 0; j[k]++; continue;
  134. }
  135. if (j[k] == 9) { /* Stop bit */
  136. if (v & 1) t[k] = 0;
  137. j[k] = 0; i[k]++; continue;
  138. }
  139. data[k][i[k]] |= (~v & 1) << (j[k]++ - 1); /* Data bit */
  140. }
  141. t[k]--;
  142. }
  143. } while (t[0] > 0 || t[1] > 0);
  144. local_irq_restore(flags);
  145. return (i[0] == TMDC_MAX_LENGTH) | ((i[1] == TMDC_MAX_LENGTH) << 1);
  146. }
  147. static int tmdc_parse_packet(struct tmdc_port *port, unsigned char *data)
  148. {
  149. int i, k, l;
  150. if (data[TMDC_BYTE_ID] != port->mode)
  151. return -1;
  152. for (i = 0; i < port->absc; i++) {
  153. if (port->abs[i] < 0)
  154. return 0;
  155. input_report_abs(port->dev, port->abs[i], data[tmdc_byte_a[i]]);
  156. }
  157. switch (port->mode) {
  158. case TMDC_MODE_M3DI:
  159. i = tmdc_byte_d[0];
  160. input_report_abs(port->dev, ABS_HAT0X, ((data[i] >> 3) & 1) - ((data[i] >> 1) & 1));
  161. input_report_abs(port->dev, ABS_HAT0Y, ((data[i] >> 2) & 1) - ( data[i] & 1));
  162. break;
  163. case TMDC_MODE_AT:
  164. i = tmdc_byte_a[3];
  165. input_report_abs(port->dev, ABS_HAT0X, tmdc_hat_to_axis[(data[i] - 141) / 25].x);
  166. input_report_abs(port->dev, ABS_HAT0Y, tmdc_hat_to_axis[(data[i] - 141) / 25].y);
  167. break;
  168. }
  169. for (k = l = 0; k < 4; k++) {
  170. for (i = 0; i < port->btnc[k]; i++)
  171. input_report_key(port->dev, port->btn[i + l],
  172. ((data[tmdc_byte_d[k]] >> (i + port->btno[k])) & 1));
  173. l += port->btnc[k];
  174. }
  175. input_sync(port->dev);
  176. return 0;
  177. }
  178. /*
  179. * tmdc_poll() reads and analyzes ThrustMaster joystick data.
  180. */
  181. static void tmdc_poll(struct gameport *gameport)
  182. {
  183. unsigned char data[2][TMDC_MAX_LENGTH];
  184. struct tmdc *tmdc = gameport_get_drvdata(gameport);
  185. unsigned char r, bad = 0;
  186. int i;
  187. tmdc->reads++;
  188. if ((r = tmdc_read_packet(tmdc->gameport, data)) != tmdc->exists)
  189. bad = 1;
  190. else {
  191. for (i = 0; i < 2; i++) {
  192. if (r & (1 << i) & tmdc->exists) {
  193. if (tmdc_parse_packet(tmdc->port[i], data[i]))
  194. bad = 1;
  195. }
  196. }
  197. }
  198. tmdc->bads += bad;
  199. }
  200. static int tmdc_open(struct input_dev *dev)
  201. {
  202. struct tmdc *tmdc = input_get_drvdata(dev);
  203. gameport_start_polling(tmdc->gameport);
  204. return 0;
  205. }
  206. static void tmdc_close(struct input_dev *dev)
  207. {
  208. struct tmdc *tmdc = input_get_drvdata(dev);
  209. gameport_stop_polling(tmdc->gameport);
  210. }
  211. static int tmdc_setup_port(struct tmdc *tmdc, int idx, unsigned char *data)
  212. {
  213. const struct tmdc_model *model;
  214. struct tmdc_port *port;
  215. struct input_dev *input_dev;
  216. int i, j, b = 0;
  217. int err;
  218. tmdc->port[idx] = port = kzalloc(sizeof (struct tmdc_port), GFP_KERNEL);
  219. input_dev = input_allocate_device();
  220. if (!port || !input_dev) {
  221. err = -ENOMEM;
  222. goto fail;
  223. }
  224. port->mode = data[TMDC_BYTE_ID];
  225. for (model = tmdc_models; model->id && model->id != port->mode; model++)
  226. /* empty */;
  227. port->abs = model->axes;
  228. port->btn = model->buttons;
  229. if (!model->id) {
  230. port->absc = data[TMDC_BYTE_DEF] >> 4;
  231. for (i = 0; i < 4; i++)
  232. port->btnc[i] = i < (data[TMDC_BYTE_DEF] & 0xf) ? 8 : 0;
  233. } else {
  234. port->absc = model->abs;
  235. for (i = 0; i < 4; i++)
  236. port->btnc[i] = model->btnc[i];
  237. }
  238. for (i = 0; i < 4; i++)
  239. port->btno[i] = model->btno[i];
  240. snprintf(port->name, sizeof(port->name), model->name,
  241. port->absc, (data[TMDC_BYTE_DEF] & 0xf) << 3, port->mode);
  242. snprintf(port->phys, sizeof(port->phys), "%s/input%d", tmdc->gameport->phys, i);
  243. port->dev = input_dev;
  244. input_dev->name = port->name;
  245. input_dev->phys = port->phys;
  246. input_dev->id.bustype = BUS_GAMEPORT;
  247. input_dev->id.vendor = GAMEPORT_ID_VENDOR_THRUSTMASTER;
  248. input_dev->id.product = model->id;
  249. input_dev->id.version = 0x0100;
  250. input_dev->dev.parent = &tmdc->gameport->dev;
  251. input_set_drvdata(input_dev, tmdc);
  252. input_dev->open = tmdc_open;
  253. input_dev->close = tmdc_close;
  254. input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_ABS);
  255. for (i = 0; i < port->absc && i < TMDC_ABS; i++)
  256. if (port->abs[i] >= 0)
  257. input_set_abs_params(input_dev, port->abs[i], 8, 248, 2, 4);
  258. for (i = 0; i < model->hats && i < TMDC_ABS_HAT; i++)
  259. input_set_abs_params(input_dev, tmdc_abs_hat[i], -1, 1, 0, 0);
  260. for (i = 0; i < 4; i++) {
  261. for (j = 0; j < port->btnc[i] && j < TMDC_BTN; j++)
  262. set_bit(port->btn[j + b], input_dev->keybit);
  263. b += port->btnc[i];
  264. }
  265. err = input_register_device(port->dev);
  266. if (err)
  267. goto fail;
  268. return 0;
  269. fail: input_free_device(input_dev);
  270. kfree(port);
  271. return err;
  272. }
  273. /*
  274. * tmdc_probe() probes for ThrustMaster type joysticks.
  275. */
  276. static int tmdc_connect(struct gameport *gameport, struct gameport_driver *drv)
  277. {
  278. unsigned char data[2][TMDC_MAX_LENGTH];
  279. struct tmdc *tmdc;
  280. int i;
  281. int err;
  282. if (!(tmdc = kzalloc(sizeof(struct tmdc), GFP_KERNEL)))
  283. return -ENOMEM;
  284. tmdc->gameport = gameport;
  285. gameport_set_drvdata(gameport, tmdc);
  286. err = gameport_open(gameport, drv, GAMEPORT_MODE_RAW);
  287. if (err)
  288. goto fail1;
  289. if (!(tmdc->exists = tmdc_read_packet(gameport, data))) {
  290. err = -ENODEV;
  291. goto fail2;
  292. }
  293. gameport_set_poll_handler(gameport, tmdc_poll);
  294. gameport_set_poll_interval(gameport, 20);
  295. for (i = 0; i < 2; i++) {
  296. if (tmdc->exists & (1 << i)) {
  297. err = tmdc_setup_port(tmdc, i, data[i]);
  298. if (err)
  299. goto fail3;
  300. }
  301. }
  302. return 0;
  303. fail3: while (--i >= 0) {
  304. if (tmdc->port[i]) {
  305. input_unregister_device(tmdc->port[i]->dev);
  306. kfree(tmdc->port[i]);
  307. }
  308. }
  309. fail2: gameport_close(gameport);
  310. fail1: gameport_set_drvdata(gameport, NULL);
  311. kfree(tmdc);
  312. return err;
  313. }
  314. static void tmdc_disconnect(struct gameport *gameport)
  315. {
  316. struct tmdc *tmdc = gameport_get_drvdata(gameport);
  317. int i;
  318. for (i = 0; i < 2; i++) {
  319. if (tmdc->port[i]) {
  320. input_unregister_device(tmdc->port[i]->dev);
  321. kfree(tmdc->port[i]);
  322. }
  323. }
  324. gameport_close(gameport);
  325. gameport_set_drvdata(gameport, NULL);
  326. kfree(tmdc);
  327. }
  328. static struct gameport_driver tmdc_drv = {
  329. .driver = {
  330. .name = "tmdc",
  331. .owner = THIS_MODULE,
  332. },
  333. .description = DRIVER_DESC,
  334. .connect = tmdc_connect,
  335. .disconnect = tmdc_disconnect,
  336. };
  337. module_gameport_driver(tmdc_drv);