hid-lg.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612
  1. /*
  2. * HID driver for some logitech "special" devices
  3. *
  4. * Copyright (c) 1999 Andreas Gal
  5. * Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz>
  6. * Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc
  7. * Copyright (c) 2006-2007 Jiri Kosina
  8. * Copyright (c) 2008 Jiri Slaby
  9. * Copyright (c) 2010 Hendrik Iben
  10. */
  11. /*
  12. * This program is free software; you can redistribute it and/or modify it
  13. * under the terms of the GNU General Public License as published by the Free
  14. * Software Foundation; either version 2 of the License, or (at your option)
  15. * any later version.
  16. */
  17. #include <linux/device.h>
  18. #include <linux/hid.h>
  19. #include <linux/module.h>
  20. #include <linux/random.h>
  21. #include <linux/sched.h>
  22. #include <linux/usb.h>
  23. #include <linux/wait.h>
  24. #include "usbhid/usbhid.h"
  25. #include "hid-ids.h"
  26. #include "hid-lg.h"
  27. #define LG_RDESC 0x001
  28. #define LG_BAD_RELATIVE_KEYS 0x002
  29. #define LG_DUPLICATE_USAGES 0x004
  30. #define LG_EXPANDED_KEYMAP 0x010
  31. #define LG_IGNORE_DOUBLED_WHEEL 0x020
  32. #define LG_WIRELESS 0x040
  33. #define LG_INVERT_HWHEEL 0x080
  34. #define LG_NOGET 0x100
  35. #define LG_FF 0x200
  36. #define LG_FF2 0x400
  37. #define LG_RDESC_REL_ABS 0x800
  38. #define LG_FF3 0x1000
  39. #define LG_FF4 0x2000
  40. /* Size of the original descriptors of the Driving Force (and Pro) wheels */
  41. #define DF_RDESC_ORIG_SIZE 130
  42. #define DFP_RDESC_ORIG_SIZE 97
  43. /* Fixed report descriptors for Logitech Driving Force (and Pro)
  44. * wheel controllers
  45. *
  46. * The original descriptors hide the separate throttle and brake axes in
  47. * a custom vendor usage page, providing only a combined value as
  48. * GenericDesktop.Y.
  49. * These descriptors remove the combined Y axis and instead report
  50. * separate throttle (Y) and brake (RZ).
  51. */
  52. static __u8 df_rdesc_fixed[] = {
  53. 0x05, 0x01, /* Usage Page (Desktop), */
  54. 0x09, 0x04, /* Usage (Joystik), */
  55. 0xA1, 0x01, /* Collection (Application), */
  56. 0xA1, 0x02, /* Collection (Logical), */
  57. 0x95, 0x01, /* Report Count (1), */
  58. 0x75, 0x0A, /* Report Size (10), */
  59. 0x14, /* Logical Minimum (0), */
  60. 0x26, 0xFF, 0x03, /* Logical Maximum (1023), */
  61. 0x34, /* Physical Minimum (0), */
  62. 0x46, 0xFF, 0x03, /* Physical Maximum (1023), */
  63. 0x09, 0x30, /* Usage (X), */
  64. 0x81, 0x02, /* Input (Variable), */
  65. 0x95, 0x0C, /* Report Count (12), */
  66. 0x75, 0x01, /* Report Size (1), */
  67. 0x25, 0x01, /* Logical Maximum (1), */
  68. 0x45, 0x01, /* Physical Maximum (1), */
  69. 0x05, 0x09, /* Usage (Buttons), */
  70. 0x19, 0x01, /* Usage Minimum (1), */
  71. 0x29, 0x0c, /* Usage Maximum (12), */
  72. 0x81, 0x02, /* Input (Variable), */
  73. 0x95, 0x02, /* Report Count (2), */
  74. 0x06, 0x00, 0xFF, /* Usage Page (Vendor: 65280), */
  75. 0x09, 0x01, /* Usage (?: 1), */
  76. 0x81, 0x02, /* Input (Variable), */
  77. 0x05, 0x01, /* Usage Page (Desktop), */
  78. 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
  79. 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
  80. 0x95, 0x01, /* Report Count (1), */
  81. 0x75, 0x08, /* Report Size (8), */
  82. 0x81, 0x02, /* Input (Variable), */
  83. 0x25, 0x07, /* Logical Maximum (7), */
  84. 0x46, 0x3B, 0x01, /* Physical Maximum (315), */
  85. 0x75, 0x04, /* Report Size (4), */
  86. 0x65, 0x14, /* Unit (Degrees), */
  87. 0x09, 0x39, /* Usage (Hat Switch), */
  88. 0x81, 0x42, /* Input (Variable, Null State), */
  89. 0x75, 0x01, /* Report Size (1), */
  90. 0x95, 0x04, /* Report Count (4), */
  91. 0x65, 0x00, /* Unit (none), */
  92. 0x06, 0x00, 0xFF, /* Usage Page (Vendor: 65280), */
  93. 0x09, 0x01, /* Usage (?: 1), */
  94. 0x25, 0x01, /* Logical Maximum (1), */
  95. 0x45, 0x01, /* Physical Maximum (1), */
  96. 0x81, 0x02, /* Input (Variable), */
  97. 0x05, 0x01, /* Usage Page (Desktop), */
  98. 0x95, 0x01, /* Report Count (1), */
  99. 0x75, 0x08, /* Report Size (8), */
  100. 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
  101. 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
  102. 0x09, 0x31, /* Usage (Y), */
  103. 0x81, 0x02, /* Input (Variable), */
  104. 0x09, 0x35, /* Usage (Rz), */
  105. 0x81, 0x02, /* Input (Variable), */
  106. 0xC0, /* End Collection, */
  107. 0xA1, 0x02, /* Collection (Logical), */
  108. 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
  109. 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
  110. 0x95, 0x07, /* Report Count (7), */
  111. 0x75, 0x08, /* Report Size (8), */
  112. 0x09, 0x03, /* Usage (?: 3), */
  113. 0x91, 0x02, /* Output (Variable), */
  114. 0xC0, /* End Collection, */
  115. 0xC0 /* End Collection */
  116. };
  117. static __u8 dfp_rdesc_fixed[] = {
  118. 0x05, 0x01, /* Usage Page (Desktop), */
  119. 0x09, 0x04, /* Usage (Joystik), */
  120. 0xA1, 0x01, /* Collection (Application), */
  121. 0xA1, 0x02, /* Collection (Logical), */
  122. 0x95, 0x01, /* Report Count (1), */
  123. 0x75, 0x0E, /* Report Size (14), */
  124. 0x14, /* Logical Minimum (0), */
  125. 0x26, 0xFF, 0x3F, /* Logical Maximum (16383), */
  126. 0x34, /* Physical Minimum (0), */
  127. 0x46, 0xFF, 0x3F, /* Physical Maximum (16383), */
  128. 0x09, 0x30, /* Usage (X), */
  129. 0x81, 0x02, /* Input (Variable), */
  130. 0x95, 0x0E, /* Report Count (14), */
  131. 0x75, 0x01, /* Report Size (1), */
  132. 0x25, 0x01, /* Logical Maximum (1), */
  133. 0x45, 0x01, /* Physical Maximum (1), */
  134. 0x05, 0x09, /* Usage Page (Button), */
  135. 0x19, 0x01, /* Usage Minimum (01h), */
  136. 0x29, 0x0E, /* Usage Maximum (0Eh), */
  137. 0x81, 0x02, /* Input (Variable), */
  138. 0x05, 0x01, /* Usage Page (Desktop), */
  139. 0x95, 0x01, /* Report Count (1), */
  140. 0x75, 0x04, /* Report Size (4), */
  141. 0x25, 0x07, /* Logical Maximum (7), */
  142. 0x46, 0x3B, 0x01, /* Physical Maximum (315), */
  143. 0x65, 0x14, /* Unit (Degrees), */
  144. 0x09, 0x39, /* Usage (Hat Switch), */
  145. 0x81, 0x42, /* Input (Variable, Nullstate), */
  146. 0x65, 0x00, /* Unit, */
  147. 0x26, 0xFF, 0x00, /* Logical Maximum (255), */
  148. 0x46, 0xFF, 0x00, /* Physical Maximum (255), */
  149. 0x75, 0x08, /* Report Size (8), */
  150. 0x81, 0x01, /* Input (Constant), */
  151. 0x09, 0x31, /* Usage (Y), */
  152. 0x81, 0x02, /* Input (Variable), */
  153. 0x09, 0x35, /* Usage (Rz), */
  154. 0x81, 0x02, /* Input (Variable), */
  155. 0x81, 0x01, /* Input (Constant), */
  156. 0xC0, /* End Collection, */
  157. 0xA1, 0x02, /* Collection (Logical), */
  158. 0x09, 0x02, /* Usage (02h), */
  159. 0x95, 0x07, /* Report Count (7), */
  160. 0x91, 0x02, /* Output (Variable), */
  161. 0xC0, /* End Collection, */
  162. 0xC0 /* End Collection */
  163. };
  164. /*
  165. * Certain Logitech keyboards send in report #3 keys which are far
  166. * above the logical maximum described in descriptor. This extends
  167. * the original value of 0x28c of logical maximum to 0x104d
  168. */
  169. static __u8 *lg_report_fixup(struct hid_device *hdev, __u8 *rdesc,
  170. unsigned int *rsize)
  171. {
  172. struct lg_drv_data *drv_data = hid_get_drvdata(hdev);
  173. struct usb_device_descriptor *udesc;
  174. __u16 bcdDevice, rev_maj, rev_min;
  175. if ((drv_data->quirks & LG_RDESC) && *rsize >= 90 && rdesc[83] == 0x26 &&
  176. rdesc[84] == 0x8c && rdesc[85] == 0x02) {
  177. hid_info(hdev,
  178. "fixing up Logitech keyboard report descriptor\n");
  179. rdesc[84] = rdesc[89] = 0x4d;
  180. rdesc[85] = rdesc[90] = 0x10;
  181. }
  182. if ((drv_data->quirks & LG_RDESC_REL_ABS) && *rsize >= 50 &&
  183. rdesc[32] == 0x81 && rdesc[33] == 0x06 &&
  184. rdesc[49] == 0x81 && rdesc[50] == 0x06) {
  185. hid_info(hdev,
  186. "fixing up rel/abs in Logitech report descriptor\n");
  187. rdesc[33] = rdesc[50] = 0x02;
  188. }
  189. if ((drv_data->quirks & LG_FF4) && *rsize >= 101 &&
  190. rdesc[41] == 0x95 && rdesc[42] == 0x0B &&
  191. rdesc[47] == 0x05 && rdesc[48] == 0x09) {
  192. hid_info(hdev, "fixing up Logitech Speed Force Wireless button descriptor\n");
  193. rdesc[41] = 0x05;
  194. rdesc[42] = 0x09;
  195. rdesc[47] = 0x95;
  196. rdesc[48] = 0x0B;
  197. }
  198. switch (hdev->product) {
  199. /* Several wheels report as this id when operating in emulation mode. */
  200. case USB_DEVICE_ID_LOGITECH_WHEEL:
  201. udesc = &(hid_to_usb_dev(hdev)->descriptor);
  202. if (!udesc) {
  203. hid_err(hdev, "NULL USB device descriptor\n");
  204. break;
  205. }
  206. bcdDevice = le16_to_cpu(udesc->bcdDevice);
  207. rev_maj = bcdDevice >> 8;
  208. rev_min = bcdDevice & 0xff;
  209. /* Update the report descriptor for only the Driving Force wheel */
  210. if (rev_maj == 1 && rev_min == 2 &&
  211. *rsize == DF_RDESC_ORIG_SIZE) {
  212. hid_info(hdev,
  213. "fixing up Logitech Driving Force report descriptor\n");
  214. rdesc = df_rdesc_fixed;
  215. *rsize = sizeof(df_rdesc_fixed);
  216. }
  217. break;
  218. case USB_DEVICE_ID_LOGITECH_DFP_WHEEL:
  219. if (*rsize == DFP_RDESC_ORIG_SIZE) {
  220. hid_info(hdev,
  221. "fixing up Logitech Driving Force Pro report descriptor\n");
  222. rdesc = dfp_rdesc_fixed;
  223. *rsize = sizeof(dfp_rdesc_fixed);
  224. }
  225. break;
  226. }
  227. return rdesc;
  228. }
  229. #define lg_map_key_clear(c) hid_map_usage_clear(hi, usage, bit, max, \
  230. EV_KEY, (c))
  231. static int lg_ultrax_remote_mapping(struct hid_input *hi,
  232. struct hid_usage *usage, unsigned long **bit, int *max)
  233. {
  234. if ((usage->hid & HID_USAGE_PAGE) != HID_UP_LOGIVENDOR)
  235. return 0;
  236. set_bit(EV_REP, hi->input->evbit);
  237. switch (usage->hid & HID_USAGE) {
  238. /* Reported on Logitech Ultra X Media Remote */
  239. case 0x004: lg_map_key_clear(KEY_AGAIN); break;
  240. case 0x00d: lg_map_key_clear(KEY_HOME); break;
  241. case 0x024: lg_map_key_clear(KEY_SHUFFLE); break;
  242. case 0x025: lg_map_key_clear(KEY_TV); break;
  243. case 0x026: lg_map_key_clear(KEY_MENU); break;
  244. case 0x031: lg_map_key_clear(KEY_AUDIO); break;
  245. case 0x032: lg_map_key_clear(KEY_TEXT); break;
  246. case 0x033: lg_map_key_clear(KEY_LAST); break;
  247. case 0x047: lg_map_key_clear(KEY_MP3); break;
  248. case 0x048: lg_map_key_clear(KEY_DVD); break;
  249. case 0x049: lg_map_key_clear(KEY_MEDIA); break;
  250. case 0x04a: lg_map_key_clear(KEY_VIDEO); break;
  251. case 0x04b: lg_map_key_clear(KEY_ANGLE); break;
  252. case 0x04c: lg_map_key_clear(KEY_LANGUAGE); break;
  253. case 0x04d: lg_map_key_clear(KEY_SUBTITLE); break;
  254. case 0x051: lg_map_key_clear(KEY_RED); break;
  255. case 0x052: lg_map_key_clear(KEY_CLOSE); break;
  256. default:
  257. return 0;
  258. }
  259. return 1;
  260. }
  261. static int lg_dinovo_mapping(struct hid_input *hi, struct hid_usage *usage,
  262. unsigned long **bit, int *max)
  263. {
  264. if ((usage->hid & HID_USAGE_PAGE) != HID_UP_LOGIVENDOR)
  265. return 0;
  266. switch (usage->hid & HID_USAGE) {
  267. case 0x00d: lg_map_key_clear(KEY_MEDIA); break;
  268. default:
  269. return 0;
  270. }
  271. return 1;
  272. }
  273. static int lg_wireless_mapping(struct hid_input *hi, struct hid_usage *usage,
  274. unsigned long **bit, int *max)
  275. {
  276. if ((usage->hid & HID_USAGE_PAGE) != HID_UP_CONSUMER)
  277. return 0;
  278. switch (usage->hid & HID_USAGE) {
  279. case 0x1001: lg_map_key_clear(KEY_MESSENGER); break;
  280. case 0x1003: lg_map_key_clear(KEY_SOUND); break;
  281. case 0x1004: lg_map_key_clear(KEY_VIDEO); break;
  282. case 0x1005: lg_map_key_clear(KEY_AUDIO); break;
  283. case 0x100a: lg_map_key_clear(KEY_DOCUMENTS); break;
  284. /* The following two entries are Playlist 1 and 2 on the MX3200 */
  285. case 0x100f: lg_map_key_clear(KEY_FN_1); break;
  286. case 0x1010: lg_map_key_clear(KEY_FN_2); break;
  287. case 0x1011: lg_map_key_clear(KEY_PREVIOUSSONG); break;
  288. case 0x1012: lg_map_key_clear(KEY_NEXTSONG); break;
  289. case 0x1013: lg_map_key_clear(KEY_CAMERA); break;
  290. case 0x1014: lg_map_key_clear(KEY_MESSENGER); break;
  291. case 0x1015: lg_map_key_clear(KEY_RECORD); break;
  292. case 0x1016: lg_map_key_clear(KEY_PLAYER); break;
  293. case 0x1017: lg_map_key_clear(KEY_EJECTCD); break;
  294. case 0x1018: lg_map_key_clear(KEY_MEDIA); break;
  295. case 0x1019: lg_map_key_clear(KEY_PROG1); break;
  296. case 0x101a: lg_map_key_clear(KEY_PROG2); break;
  297. case 0x101b: lg_map_key_clear(KEY_PROG3); break;
  298. case 0x101c: lg_map_key_clear(KEY_CYCLEWINDOWS); break;
  299. case 0x101f: lg_map_key_clear(KEY_ZOOMIN); break;
  300. case 0x1020: lg_map_key_clear(KEY_ZOOMOUT); break;
  301. case 0x1021: lg_map_key_clear(KEY_ZOOMRESET); break;
  302. case 0x1023: lg_map_key_clear(KEY_CLOSE); break;
  303. case 0x1027: lg_map_key_clear(KEY_MENU); break;
  304. /* this one is marked as 'Rotate' */
  305. case 0x1028: lg_map_key_clear(KEY_ANGLE); break;
  306. case 0x1029: lg_map_key_clear(KEY_SHUFFLE); break;
  307. case 0x102a: lg_map_key_clear(KEY_BACK); break;
  308. case 0x102b: lg_map_key_clear(KEY_CYCLEWINDOWS); break;
  309. case 0x102d: lg_map_key_clear(KEY_WWW); break;
  310. /* The following two are 'Start/answer call' and 'End/reject call'
  311. on the MX3200 */
  312. case 0x1031: lg_map_key_clear(KEY_OK); break;
  313. case 0x1032: lg_map_key_clear(KEY_CANCEL); break;
  314. case 0x1041: lg_map_key_clear(KEY_BATTERY); break;
  315. case 0x1042: lg_map_key_clear(KEY_WORDPROCESSOR); break;
  316. case 0x1043: lg_map_key_clear(KEY_SPREADSHEET); break;
  317. case 0x1044: lg_map_key_clear(KEY_PRESENTATION); break;
  318. case 0x1045: lg_map_key_clear(KEY_UNDO); break;
  319. case 0x1046: lg_map_key_clear(KEY_REDO); break;
  320. case 0x1047: lg_map_key_clear(KEY_PRINT); break;
  321. case 0x1048: lg_map_key_clear(KEY_SAVE); break;
  322. case 0x1049: lg_map_key_clear(KEY_PROG1); break;
  323. case 0x104a: lg_map_key_clear(KEY_PROG2); break;
  324. case 0x104b: lg_map_key_clear(KEY_PROG3); break;
  325. case 0x104c: lg_map_key_clear(KEY_PROG4); break;
  326. default:
  327. return 0;
  328. }
  329. return 1;
  330. }
  331. static int lg_input_mapping(struct hid_device *hdev, struct hid_input *hi,
  332. struct hid_field *field, struct hid_usage *usage,
  333. unsigned long **bit, int *max)
  334. {
  335. /* extended mapping for certain Logitech hardware (Logitech cordless
  336. desktop LX500) */
  337. static const u8 e_keymap[] = {
  338. 0,216, 0,213,175,156, 0, 0, 0, 0,
  339. 144, 0, 0, 0, 0, 0, 0, 0, 0,212,
  340. 174,167,152,161,112, 0, 0, 0,154, 0,
  341. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  342. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  343. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  344. 0, 0, 0, 0, 0,183,184,185,186,187,
  345. 188,189,190,191,192,193,194, 0, 0, 0
  346. };
  347. struct lg_drv_data *drv_data = hid_get_drvdata(hdev);
  348. unsigned int hid = usage->hid;
  349. if (hdev->product == USB_DEVICE_ID_LOGITECH_RECEIVER &&
  350. lg_ultrax_remote_mapping(hi, usage, bit, max))
  351. return 1;
  352. if (hdev->product == USB_DEVICE_ID_DINOVO_MINI &&
  353. lg_dinovo_mapping(hi, usage, bit, max))
  354. return 1;
  355. if ((drv_data->quirks & LG_WIRELESS) && lg_wireless_mapping(hi, usage, bit, max))
  356. return 1;
  357. if ((hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
  358. return 0;
  359. hid &= HID_USAGE;
  360. /* Special handling for Logitech Cordless Desktop */
  361. if (field->application == HID_GD_MOUSE) {
  362. if ((drv_data->quirks & LG_IGNORE_DOUBLED_WHEEL) &&
  363. (hid == 7 || hid == 8))
  364. return -1;
  365. } else {
  366. if ((drv_data->quirks & LG_EXPANDED_KEYMAP) &&
  367. hid < ARRAY_SIZE(e_keymap) &&
  368. e_keymap[hid] != 0) {
  369. hid_map_usage(hi, usage, bit, max, EV_KEY,
  370. e_keymap[hid]);
  371. return 1;
  372. }
  373. }
  374. return 0;
  375. }
  376. static int lg_input_mapped(struct hid_device *hdev, struct hid_input *hi,
  377. struct hid_field *field, struct hid_usage *usage,
  378. unsigned long **bit, int *max)
  379. {
  380. struct lg_drv_data *drv_data = hid_get_drvdata(hdev);
  381. if ((drv_data->quirks & LG_BAD_RELATIVE_KEYS) && usage->type == EV_KEY &&
  382. (field->flags & HID_MAIN_ITEM_RELATIVE))
  383. field->flags &= ~HID_MAIN_ITEM_RELATIVE;
  384. if ((drv_data->quirks & LG_DUPLICATE_USAGES) && (usage->type == EV_KEY ||
  385. usage->type == EV_REL || usage->type == EV_ABS))
  386. clear_bit(usage->code, *bit);
  387. return 0;
  388. }
  389. static int lg_event(struct hid_device *hdev, struct hid_field *field,
  390. struct hid_usage *usage, __s32 value)
  391. {
  392. struct lg_drv_data *drv_data = hid_get_drvdata(hdev);
  393. if ((drv_data->quirks & LG_INVERT_HWHEEL) && usage->code == REL_HWHEEL) {
  394. input_event(field->hidinput->input, usage->type, usage->code,
  395. -value);
  396. return 1;
  397. }
  398. if (drv_data->quirks & LG_FF4) {
  399. return lg4ff_adjust_input_event(hdev, field, usage, value, drv_data);
  400. }
  401. return 0;
  402. }
  403. static int lg_probe(struct hid_device *hdev, const struct hid_device_id *id)
  404. {
  405. unsigned int connect_mask = HID_CONNECT_DEFAULT;
  406. struct lg_drv_data *drv_data;
  407. int ret;
  408. drv_data = kzalloc(sizeof(struct lg_drv_data), GFP_KERNEL);
  409. if (!drv_data) {
  410. hid_err(hdev, "Insufficient memory, cannot allocate driver data\n");
  411. return -ENOMEM;
  412. }
  413. drv_data->quirks = id->driver_data;
  414. hid_set_drvdata(hdev, (void *)drv_data);
  415. if (drv_data->quirks & LG_NOGET)
  416. hdev->quirks |= HID_QUIRK_NOGET;
  417. ret = hid_parse(hdev);
  418. if (ret) {
  419. hid_err(hdev, "parse failed\n");
  420. goto err_free;
  421. }
  422. if (drv_data->quirks & (LG_FF | LG_FF2 | LG_FF3 | LG_FF4))
  423. connect_mask &= ~HID_CONNECT_FF;
  424. ret = hid_hw_start(hdev, connect_mask);
  425. if (ret) {
  426. hid_err(hdev, "hw start failed\n");
  427. goto err_free;
  428. }
  429. /* Setup wireless link with Logitech Wii wheel */
  430. if (hdev->product == USB_DEVICE_ID_LOGITECH_WII_WHEEL) {
  431. unsigned char buf[] = { 0x00, 0xAF, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
  432. ret = hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
  433. if (ret >= 0) {
  434. /* insert a little delay of 10 jiffies ~ 40ms */
  435. wait_queue_head_t wait;
  436. init_waitqueue_head (&wait);
  437. wait_event_interruptible_timeout(wait, 0, 10);
  438. /* Select random Address */
  439. buf[1] = 0xB2;
  440. get_random_bytes(&buf[2], 2);
  441. ret = hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
  442. }
  443. }
  444. if (drv_data->quirks & LG_FF)
  445. lgff_init(hdev);
  446. if (drv_data->quirks & LG_FF2)
  447. lg2ff_init(hdev);
  448. if (drv_data->quirks & LG_FF3)
  449. lg3ff_init(hdev);
  450. if (drv_data->quirks & LG_FF4)
  451. lg4ff_init(hdev);
  452. return 0;
  453. err_free:
  454. kfree(drv_data);
  455. return ret;
  456. }
  457. static void lg_remove(struct hid_device *hdev)
  458. {
  459. struct lg_drv_data *drv_data = hid_get_drvdata(hdev);
  460. if (drv_data->quirks & LG_FF4)
  461. lg4ff_deinit(hdev);
  462. hid_hw_stop(hdev);
  463. kfree(drv_data);
  464. }
  465. static const struct hid_device_id lg_devices[] = {
  466. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_MX3000_RECEIVER),
  467. .driver_data = LG_RDESC | LG_WIRELESS },
  468. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER),
  469. .driver_data = LG_RDESC | LG_WIRELESS },
  470. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER_2),
  471. .driver_data = LG_RDESC | LG_WIRELESS },
  472. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RECEIVER),
  473. .driver_data = LG_BAD_RELATIVE_KEYS },
  474. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_DESKTOP),
  475. .driver_data = LG_DUPLICATE_USAGES },
  476. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_EDGE),
  477. .driver_data = LG_DUPLICATE_USAGES },
  478. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_MINI),
  479. .driver_data = LG_DUPLICATE_USAGES },
  480. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_ELITE_KBD),
  481. .driver_data = LG_IGNORE_DOUBLED_WHEEL | LG_EXPANDED_KEYMAP },
  482. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_CORDLESS_DESKTOP_LX500),
  483. .driver_data = LG_IGNORE_DOUBLED_WHEEL | LG_EXPANDED_KEYMAP },
  484. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_EXTREME_3D),
  485. .driver_data = LG_NOGET },
  486. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WHEEL),
  487. .driver_data = LG_NOGET | LG_FF4 },
  488. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD_CORD),
  489. .driver_data = LG_FF2 },
  490. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD),
  491. .driver_data = LG_FF },
  492. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD2_2),
  493. .driver_data = LG_FF },
  494. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WINGMAN_F3D),
  495. .driver_data = LG_FF },
  496. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_FORCE3D_PRO),
  497. .driver_data = LG_FF },
  498. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_MOMO_WHEEL),
  499. .driver_data = LG_FF4 },
  500. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2),
  501. .driver_data = LG_FF4 },
  502. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G25_WHEEL),
  503. .driver_data = LG_FF4 },
  504. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_DFGT_WHEEL),
  505. .driver_data = LG_FF4 },
  506. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G27_WHEEL),
  507. .driver_data = LG_FF4 },
  508. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_DFP_WHEEL),
  509. .driver_data = LG_NOGET | LG_FF4 },
  510. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WII_WHEEL),
  511. .driver_data = LG_FF4 },
  512. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WINGMAN_FFG),
  513. .driver_data = LG_FF },
  514. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD2),
  515. .driver_data = LG_FF2 },
  516. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_FLIGHT_SYSTEM_G940),
  517. .driver_data = LG_FF3 },
  518. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACENAVIGATOR),
  519. .driver_data = LG_RDESC_REL_ABS },
  520. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACETRAVELLER),
  521. .driver_data = LG_RDESC_REL_ABS },
  522. { }
  523. };
  524. MODULE_DEVICE_TABLE(hid, lg_devices);
  525. static struct hid_driver lg_driver = {
  526. .name = "logitech",
  527. .id_table = lg_devices,
  528. .report_fixup = lg_report_fixup,
  529. .input_mapping = lg_input_mapping,
  530. .input_mapped = lg_input_mapped,
  531. .event = lg_event,
  532. .probe = lg_probe,
  533. .remove = lg_remove,
  534. };
  535. static int __init lg_init(void)
  536. {
  537. return hid_register_driver(&lg_driver);
  538. }
  539. static void __exit lg_exit(void)
  540. {
  541. hid_unregister_driver(&lg_driver);
  542. }
  543. module_init(lg_init);
  544. module_exit(lg_exit);
  545. MODULE_LICENSE("GPL");