1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/device.h>
21#include <linux/hid.h>
22#include <linux/module.h>
23#include <linux/random.h>
24#include <linux/sched.h>
25#include <linux/wait.h>
26
27#include "hid-ids.h"
28#include "hid-lg.h"
29
30#define LG_RDESC 0x001
31#define LG_BAD_RELATIVE_KEYS 0x002
32#define LG_DUPLICATE_USAGES 0x004
33#define LG_EXPANDED_KEYMAP 0x010
34#define LG_IGNORE_DOUBLED_WHEEL 0x020
35#define LG_WIRELESS 0x040
36#define LG_INVERT_HWHEEL 0x080
37#define LG_NOGET 0x100
38#define LG_FF 0x200
39#define LG_FF2 0x400
40#define LG_RDESC_REL_ABS 0x800
41#define LG_FF3 0x1000
42#define LG_FF4 0x2000
43
44
45#define DFP_RDESC_ORIG_SIZE 97
46
47
48
49
50
51
52
53
54
55static __u8 dfp_rdesc_fixed[] = {
560x05, 0x01,
570x09, 0x04,
580xA1, 0x01,
590xA1, 0x02,
600x95, 0x01,
610x75, 0x0E,
620x14,
630x26, 0xFF, 0x3F,
640x34,
650x46, 0xFF, 0x3F,
660x09, 0x30,
670x81, 0x02,
680x95, 0x0E,
690x75, 0x01,
700x25, 0x01,
710x45, 0x01,
720x05, 0x09,
730x19, 0x01,
740x29, 0x0E,
750x81, 0x02,
760x05, 0x01,
770x95, 0x01,
780x75, 0x04,
790x25, 0x07,
800x46, 0x3B, 0x01,
810x65, 0x14,
820x09, 0x39,
830x81, 0x42,
840x65, 0x00,
850x26, 0xFF, 0x00,
860x46, 0xFF, 0x00,
870x75, 0x08,
880x81, 0x01,
890x09, 0x31,
900x81, 0x02,
910x09, 0x35,
920x81, 0x02,
930x81, 0x01,
940xC0,
950xA1, 0x02,
960x09, 0x02,
970x95, 0x07,
980x91, 0x02,
990xC0,
1000xC0
101};
102
103
104
105
106
107
108
109static __u8 *lg_report_fixup(struct hid_device *hdev, __u8 *rdesc,
110 unsigned int *rsize)
111{
112 unsigned long quirks = (unsigned long)hid_get_drvdata(hdev);
113
114 if ((quirks & LG_RDESC) && *rsize >= 90 && rdesc[83] == 0x26 &&
115 rdesc[84] == 0x8c && rdesc[85] == 0x02) {
116 hid_info(hdev,
117 "fixing up Logitech keyboard report descriptor\n");
118 rdesc[84] = rdesc[89] = 0x4d;
119 rdesc[85] = rdesc[90] = 0x10;
120 }
121 if ((quirks & LG_RDESC_REL_ABS) && *rsize >= 50 &&
122 rdesc[32] == 0x81 && rdesc[33] == 0x06 &&
123 rdesc[49] == 0x81 && rdesc[50] == 0x06) {
124 hid_info(hdev,
125 "fixing up rel/abs in Logitech report descriptor\n");
126 rdesc[33] = rdesc[50] = 0x02;
127 }
128 if ((quirks & LG_FF4) && *rsize >= 101 &&
129 rdesc[41] == 0x95 && rdesc[42] == 0x0B &&
130 rdesc[47] == 0x05 && rdesc[48] == 0x09) {
131 hid_info(hdev, "fixing up Logitech Speed Force Wireless button descriptor\n");
132 rdesc[41] = 0x05;
133 rdesc[42] = 0x09;
134 rdesc[47] = 0x95;
135 rdesc[48] = 0x0B;
136 }
137
138 switch (hdev->product) {
139 case USB_DEVICE_ID_LOGITECH_DFP_WHEEL:
140 if (*rsize == DFP_RDESC_ORIG_SIZE) {
141 hid_info(hdev,
142 "fixing up Logitech Driving Force Pro report descriptor\n");
143 rdesc = dfp_rdesc_fixed;
144 *rsize = sizeof(dfp_rdesc_fixed);
145 }
146 break;
147 }
148
149 return rdesc;
150}
151
152#define lg_map_key_clear(c) hid_map_usage_clear(hi, usage, bit, max, \
153 EV_KEY, (c))
154
155static int lg_ultrax_remote_mapping(struct hid_input *hi,
156 struct hid_usage *usage, unsigned long **bit, int *max)
157{
158 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_LOGIVENDOR)
159 return 0;
160
161 set_bit(EV_REP, hi->input->evbit);
162 switch (usage->hid & HID_USAGE) {
163
164 case 0x004: lg_map_key_clear(KEY_AGAIN); break;
165 case 0x00d: lg_map_key_clear(KEY_HOME); break;
166 case 0x024: lg_map_key_clear(KEY_SHUFFLE); break;
167 case 0x025: lg_map_key_clear(KEY_TV); break;
168 case 0x026: lg_map_key_clear(KEY_MENU); break;
169 case 0x031: lg_map_key_clear(KEY_AUDIO); break;
170 case 0x032: lg_map_key_clear(KEY_TEXT); break;
171 case 0x033: lg_map_key_clear(KEY_LAST); break;
172 case 0x047: lg_map_key_clear(KEY_MP3); break;
173 case 0x048: lg_map_key_clear(KEY_DVD); break;
174 case 0x049: lg_map_key_clear(KEY_MEDIA); break;
175 case 0x04a: lg_map_key_clear(KEY_VIDEO); break;
176 case 0x04b: lg_map_key_clear(KEY_ANGLE); break;
177 case 0x04c: lg_map_key_clear(KEY_LANGUAGE); break;
178 case 0x04d: lg_map_key_clear(KEY_SUBTITLE); break;
179 case 0x051: lg_map_key_clear(KEY_RED); break;
180 case 0x052: lg_map_key_clear(KEY_CLOSE); break;
181
182 default:
183 return 0;
184 }
185 return 1;
186}
187
188static int lg_dinovo_mapping(struct hid_input *hi, struct hid_usage *usage,
189 unsigned long **bit, int *max)
190{
191 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_LOGIVENDOR)
192 return 0;
193
194 switch (usage->hid & HID_USAGE) {
195
196 case 0x00d: lg_map_key_clear(KEY_MEDIA); break;
197 default:
198 return 0;
199
200 }
201 return 1;
202}
203
204static int lg_wireless_mapping(struct hid_input *hi, struct hid_usage *usage,
205 unsigned long **bit, int *max)
206{
207 if ((usage->hid & HID_USAGE_PAGE) != HID_UP_CONSUMER)
208 return 0;
209
210 switch (usage->hid & HID_USAGE) {
211 case 0x1001: lg_map_key_clear(KEY_MESSENGER); break;
212 case 0x1003: lg_map_key_clear(KEY_SOUND); break;
213 case 0x1004: lg_map_key_clear(KEY_VIDEO); break;
214 case 0x1005: lg_map_key_clear(KEY_AUDIO); break;
215 case 0x100a: lg_map_key_clear(KEY_DOCUMENTS); break;
216
217 case 0x100f: lg_map_key_clear(KEY_FN_1); break;
218 case 0x1010: lg_map_key_clear(KEY_FN_2); break;
219 case 0x1011: lg_map_key_clear(KEY_PREVIOUSSONG); break;
220 case 0x1012: lg_map_key_clear(KEY_NEXTSONG); break;
221 case 0x1013: lg_map_key_clear(KEY_CAMERA); break;
222 case 0x1014: lg_map_key_clear(KEY_MESSENGER); break;
223 case 0x1015: lg_map_key_clear(KEY_RECORD); break;
224 case 0x1016: lg_map_key_clear(KEY_PLAYER); break;
225 case 0x1017: lg_map_key_clear(KEY_EJECTCD); break;
226 case 0x1018: lg_map_key_clear(KEY_MEDIA); break;
227 case 0x1019: lg_map_key_clear(KEY_PROG1); break;
228 case 0x101a: lg_map_key_clear(KEY_PROG2); break;
229 case 0x101b: lg_map_key_clear(KEY_PROG3); break;
230 case 0x101c: lg_map_key_clear(KEY_CYCLEWINDOWS); break;
231 case 0x101f: lg_map_key_clear(KEY_ZOOMIN); break;
232 case 0x1020: lg_map_key_clear(KEY_ZOOMOUT); break;
233 case 0x1021: lg_map_key_clear(KEY_ZOOMRESET); break;
234 case 0x1023: lg_map_key_clear(KEY_CLOSE); break;
235 case 0x1027: lg_map_key_clear(KEY_MENU); break;
236
237 case 0x1028: lg_map_key_clear(KEY_ANGLE); break;
238 case 0x1029: lg_map_key_clear(KEY_SHUFFLE); break;
239 case 0x102a: lg_map_key_clear(KEY_BACK); break;
240 case 0x102b: lg_map_key_clear(KEY_CYCLEWINDOWS); break;
241 case 0x102d: lg_map_key_clear(KEY_WWW); break;
242
243
244 case 0x1031: lg_map_key_clear(KEY_OK); break;
245 case 0x1032: lg_map_key_clear(KEY_CANCEL); break;
246 case 0x1041: lg_map_key_clear(KEY_BATTERY); break;
247 case 0x1042: lg_map_key_clear(KEY_WORDPROCESSOR); break;
248 case 0x1043: lg_map_key_clear(KEY_SPREADSHEET); break;
249 case 0x1044: lg_map_key_clear(KEY_PRESENTATION); break;
250 case 0x1045: lg_map_key_clear(KEY_UNDO); break;
251 case 0x1046: lg_map_key_clear(KEY_REDO); break;
252 case 0x1047: lg_map_key_clear(KEY_PRINT); break;
253 case 0x1048: lg_map_key_clear(KEY_SAVE); break;
254 case 0x1049: lg_map_key_clear(KEY_PROG1); break;
255 case 0x104a: lg_map_key_clear(KEY_PROG2); break;
256 case 0x104b: lg_map_key_clear(KEY_PROG3); break;
257 case 0x104c: lg_map_key_clear(KEY_PROG4); break;
258
259 default:
260 return 0;
261 }
262 return 1;
263}
264
265static int lg_input_mapping(struct hid_device *hdev, struct hid_input *hi,
266 struct hid_field *field, struct hid_usage *usage,
267 unsigned long **bit, int *max)
268{
269
270
271 static const u8 e_keymap[] = {
272 0,216, 0,213,175,156, 0, 0, 0, 0,
273 144, 0, 0, 0, 0, 0, 0, 0, 0,212,
274 174,167,152,161,112, 0, 0, 0,154, 0,
275 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
276 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
277 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
278 0, 0, 0, 0, 0,183,184,185,186,187,
279 188,189,190,191,192,193,194, 0, 0, 0
280 };
281 unsigned long quirks = (unsigned long)hid_get_drvdata(hdev);
282 unsigned int hid = usage->hid;
283
284 if (hdev->product == USB_DEVICE_ID_LOGITECH_RECEIVER &&
285 lg_ultrax_remote_mapping(hi, usage, bit, max))
286 return 1;
287
288 if (hdev->product == USB_DEVICE_ID_DINOVO_MINI &&
289 lg_dinovo_mapping(hi, usage, bit, max))
290 return 1;
291
292 if ((quirks & LG_WIRELESS) && lg_wireless_mapping(hi, usage, bit, max))
293 return 1;
294
295 if ((hid & HID_USAGE_PAGE) != HID_UP_BUTTON)
296 return 0;
297
298 hid &= HID_USAGE;
299
300
301 if (field->application == HID_GD_MOUSE) {
302 if ((quirks & LG_IGNORE_DOUBLED_WHEEL) &&
303 (hid == 7 || hid == 8))
304 return -1;
305 } else {
306 if ((quirks & LG_EXPANDED_KEYMAP) &&
307 hid < ARRAY_SIZE(e_keymap) &&
308 e_keymap[hid] != 0) {
309 hid_map_usage(hi, usage, bit, max, EV_KEY,
310 e_keymap[hid]);
311 return 1;
312 }
313 }
314
315 return 0;
316}
317
318static int lg_input_mapped(struct hid_device *hdev, struct hid_input *hi,
319 struct hid_field *field, struct hid_usage *usage,
320 unsigned long **bit, int *max)
321{
322 unsigned long quirks = (unsigned long)hid_get_drvdata(hdev);
323
324 if ((quirks & LG_BAD_RELATIVE_KEYS) && usage->type == EV_KEY &&
325 (field->flags & HID_MAIN_ITEM_RELATIVE))
326 field->flags &= ~HID_MAIN_ITEM_RELATIVE;
327
328 if ((quirks & LG_DUPLICATE_USAGES) && (usage->type == EV_KEY ||
329 usage->type == EV_REL || usage->type == EV_ABS))
330 clear_bit(usage->code, *bit);
331
332 return 0;
333}
334
335static int lg_event(struct hid_device *hdev, struct hid_field *field,
336 struct hid_usage *usage, __s32 value)
337{
338 unsigned long quirks = (unsigned long)hid_get_drvdata(hdev);
339
340 if ((quirks & LG_INVERT_HWHEEL) && usage->code == REL_HWHEEL) {
341 input_event(field->hidinput->input, usage->type, usage->code,
342 -value);
343 return 1;
344 }
345
346 return 0;
347}
348
349static int lg_probe(struct hid_device *hdev, const struct hid_device_id *id)
350{
351 unsigned long quirks = id->driver_data;
352 unsigned int connect_mask = HID_CONNECT_DEFAULT;
353 int ret;
354
355 hid_set_drvdata(hdev, (void *)quirks);
356
357 if (quirks & LG_NOGET)
358 hdev->quirks |= HID_QUIRK_NOGET;
359
360 ret = hid_parse(hdev);
361 if (ret) {
362 hid_err(hdev, "parse failed\n");
363 goto err_free;
364 }
365
366 if (quirks & (LG_FF | LG_FF2 | LG_FF3))
367 connect_mask &= ~HID_CONNECT_FF;
368
369 ret = hid_hw_start(hdev, connect_mask);
370 if (ret) {
371 hid_err(hdev, "hw start failed\n");
372 goto err_free;
373 }
374
375 if (quirks & LG_FF4) {
376 unsigned char buf[] = { 0x00, 0xAF, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
377
378 ret = hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
379
380 if (ret >= 0) {
381
382 wait_queue_head_t wait;
383 init_waitqueue_head (&wait);
384 wait_event_interruptible_timeout(wait, 0, 10);
385
386
387 buf[1] = 0xB2;
388 get_random_bytes(&buf[2], 2);
389
390 ret = hdev->hid_output_raw_report(hdev, buf, sizeof(buf), HID_FEATURE_REPORT);
391 }
392 }
393
394 if (quirks & LG_FF)
395 lgff_init(hdev);
396 if (quirks & LG_FF2)
397 lg2ff_init(hdev);
398 if (quirks & LG_FF3)
399 lg3ff_init(hdev);
400 if (quirks & LG_FF4)
401 lg4ff_init(hdev);
402
403 return 0;
404err_free:
405 return ret;
406}
407
408static const struct hid_device_id lg_devices[] = {
409 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_MX3000_RECEIVER),
410 .driver_data = LG_RDESC | LG_WIRELESS },
411 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER),
412 .driver_data = LG_RDESC | LG_WIRELESS },
413 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER_2),
414 .driver_data = LG_RDESC | LG_WIRELESS },
415
416 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RECEIVER),
417 .driver_data = LG_BAD_RELATIVE_KEYS },
418
419 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_DESKTOP),
420 .driver_data = LG_DUPLICATE_USAGES },
421 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_EDGE),
422 .driver_data = LG_DUPLICATE_USAGES },
423 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_MINI),
424 .driver_data = LG_DUPLICATE_USAGES },
425
426 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_ELITE_KBD),
427 .driver_data = LG_IGNORE_DOUBLED_WHEEL | LG_EXPANDED_KEYMAP },
428 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_CORDLESS_DESKTOP_LX500),
429 .driver_data = LG_IGNORE_DOUBLED_WHEEL | LG_EXPANDED_KEYMAP },
430
431 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_EXTREME_3D),
432 .driver_data = LG_NOGET },
433 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WHEEL),
434 .driver_data = LG_NOGET | LG_FF },
435
436 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD_CORD),
437 .driver_data = LG_FF2 },
438 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD),
439 .driver_data = LG_FF },
440 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD2_2),
441 .driver_data = LG_FF },
442 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WINGMAN_F3D),
443 .driver_data = LG_FF },
444 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_FORCE3D_PRO),
445 .driver_data = LG_FF },
446 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_MOMO_WHEEL),
447 .driver_data = LG_FF },
448 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2),
449 .driver_data = LG_FF },
450 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G25_WHEEL),
451 .driver_data = LG_FF },
452 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_G27_WHEEL),
453 .driver_data = LG_FF },
454 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_DFP_WHEEL),
455 .driver_data = LG_NOGET | LG_FF },
456 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WII_WHEEL),
457 .driver_data = LG_FF4 },
458 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WINGMAN_FFG ),
459 .driver_data = LG_FF },
460 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RUMBLEPAD2),
461 .driver_data = LG_FF2 },
462 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_FLIGHT_SYSTEM_G940),
463 .driver_data = LG_FF3 },
464 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACENAVIGATOR),
465 .driver_data = LG_RDESC_REL_ABS },
466 { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_SPACETRAVELLER),
467 .driver_data = LG_RDESC_REL_ABS },
468 { }
469};
470
471MODULE_DEVICE_TABLE(hid, lg_devices);
472
473static struct hid_driver lg_driver = {
474 .name = "logitech",
475 .id_table = lg_devices,
476 .report_fixup = lg_report_fixup,
477 .input_mapping = lg_input_mapping,
478 .input_mapped = lg_input_mapped,
479 .event = lg_event,
480 .probe = lg_probe,
481};
482
483static int __init lg_init(void)
484{
485 return hid_register_driver(&lg_driver);
486}
487
488static void __exit lg_exit(void)
489{
490 hid_unregister_driver(&lg_driver);
491}
492
493module_init(lg_init);
494module_exit(lg_exit);
495MODULE_LICENSE("GPL");
496
