diff options
author | Jiri Kosina <jkosina@suse.cz> | 2006-12-08 12:40:44 -0500 |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@suse.de> | 2006-12-08 13:43:01 -0500 |
commit | dde5845a529ff753364a6d1aea61180946270bfa (patch) | |
tree | e0160fe45c047024b281a2805196a8c64242b59e /drivers/hid | |
parent | 64bb67b1702958759f650adb64ab33496641e526 (diff) |
[PATCH] Generic HID layer - code split
The "big main" split of USB HID code into generic HID code and
USB-transport specific HID handling.
Signed-off-by: Jiri Kosina <jkosina@suse.cz>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
Cc: Dmitry Torokhov <dmitry.torokhov@gmail.com>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
Diffstat (limited to 'drivers/hid')
-rw-r--r-- | drivers/hid/hid-core.c | 940 | ||||
-rw-r--r-- | drivers/hid/hid-input.c | 840 |
2 files changed, 1780 insertions, 0 deletions
diff --git a/drivers/hid/hid-core.c b/drivers/hid/hid-core.c new file mode 100644 index 000000000000..689ae16adf33 --- /dev/null +++ b/drivers/hid/hid-core.c | |||
@@ -0,0 +1,940 @@ | |||
1 | /* | ||
2 | * USB HID support for Linux | ||
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 Jiri Kosina | ||
8 | */ | ||
9 | |||
10 | /* | ||
11 | * This program is free software; you can redistribute it and/or modify it | ||
12 | * under the terms of the GNU General Public License as published by the Free | ||
13 | * Software Foundation; either version 2 of the License, or (at your option) | ||
14 | * any later version. | ||
15 | */ | ||
16 | |||
17 | #include <linux/module.h> | ||
18 | #include <linux/slab.h> | ||
19 | #include <linux/init.h> | ||
20 | #include <linux/kernel.h> | ||
21 | #include <linux/sched.h> | ||
22 | #include <linux/list.h> | ||
23 | #include <linux/mm.h> | ||
24 | #include <linux/smp_lock.h> | ||
25 | #include <linux/spinlock.h> | ||
26 | #include <asm/unaligned.h> | ||
27 | #include <asm/byteorder.h> | ||
28 | #include <linux/input.h> | ||
29 | #include <linux/wait.h> | ||
30 | |||
31 | #undef DEBUG | ||
32 | #undef DEBUG_DATA | ||
33 | |||
34 | #include <linux/usb.h> | ||
35 | |||
36 | #include <linux/hid.h> | ||
37 | #include <linux/hiddev.h> | ||
38 | |||
39 | /* | ||
40 | * Version Information | ||
41 | */ | ||
42 | |||
43 | #define DRIVER_VERSION "v2.6" | ||
44 | #define DRIVER_AUTHOR "Andreas Gal, Vojtech Pavlik" | ||
45 | #define DRIVER_DESC "USB HID core driver" | ||
46 | #define DRIVER_LICENSE "GPL" | ||
47 | |||
48 | /* | ||
49 | * Module parameters. | ||
50 | */ | ||
51 | |||
52 | static unsigned int hid_mousepoll_interval; | ||
53 | module_param_named(mousepoll, hid_mousepoll_interval, uint, 0644); | ||
54 | MODULE_PARM_DESC(mousepoll, "Polling interval of mice"); | ||
55 | |||
56 | /* | ||
57 | * Register a new report for a device. | ||
58 | */ | ||
59 | |||
60 | static struct hid_report *hid_register_report(struct hid_device *device, unsigned type, unsigned id) | ||
61 | { | ||
62 | struct hid_report_enum *report_enum = device->report_enum + type; | ||
63 | struct hid_report *report; | ||
64 | |||
65 | if (report_enum->report_id_hash[id]) | ||
66 | return report_enum->report_id_hash[id]; | ||
67 | |||
68 | if (!(report = kzalloc(sizeof(struct hid_report), GFP_KERNEL))) | ||
69 | return NULL; | ||
70 | |||
71 | if (id != 0) | ||
72 | report_enum->numbered = 1; | ||
73 | |||
74 | report->id = id; | ||
75 | report->type = type; | ||
76 | report->size = 0; | ||
77 | report->device = device; | ||
78 | report_enum->report_id_hash[id] = report; | ||
79 | |||
80 | list_add_tail(&report->list, &report_enum->report_list); | ||
81 | |||
82 | return report; | ||
83 | } | ||
84 | |||
85 | /* | ||
86 | * Register a new field for this report. | ||
87 | */ | ||
88 | |||
89 | static struct hid_field *hid_register_field(struct hid_report *report, unsigned usages, unsigned values) | ||
90 | { | ||
91 | struct hid_field *field; | ||
92 | |||
93 | if (report->maxfield == HID_MAX_FIELDS) { | ||
94 | dbg("too many fields in report"); | ||
95 | return NULL; | ||
96 | } | ||
97 | |||
98 | if (!(field = kzalloc(sizeof(struct hid_field) + usages * sizeof(struct hid_usage) | ||
99 | + values * sizeof(unsigned), GFP_KERNEL))) return NULL; | ||
100 | |||
101 | field->index = report->maxfield++; | ||
102 | report->field[field->index] = field; | ||
103 | field->usage = (struct hid_usage *)(field + 1); | ||
104 | field->value = (unsigned *)(field->usage + usages); | ||
105 | field->report = report; | ||
106 | |||
107 | return field; | ||
108 | } | ||
109 | |||
110 | /* | ||
111 | * Open a collection. The type/usage is pushed on the stack. | ||
112 | */ | ||
113 | |||
114 | static int open_collection(struct hid_parser *parser, unsigned type) | ||
115 | { | ||
116 | struct hid_collection *collection; | ||
117 | unsigned usage; | ||
118 | |||
119 | usage = parser->local.usage[0]; | ||
120 | |||
121 | if (parser->collection_stack_ptr == HID_COLLECTION_STACK_SIZE) { | ||
122 | dbg("collection stack overflow"); | ||
123 | return -1; | ||
124 | } | ||
125 | |||
126 | if (parser->device->maxcollection == parser->device->collection_size) { | ||
127 | collection = kmalloc(sizeof(struct hid_collection) * | ||
128 | parser->device->collection_size * 2, GFP_KERNEL); | ||
129 | if (collection == NULL) { | ||
130 | dbg("failed to reallocate collection array"); | ||
131 | return -1; | ||
132 | } | ||
133 | memcpy(collection, parser->device->collection, | ||
134 | sizeof(struct hid_collection) * | ||
135 | parser->device->collection_size); | ||
136 | memset(collection + parser->device->collection_size, 0, | ||
137 | sizeof(struct hid_collection) * | ||
138 | parser->device->collection_size); | ||
139 | kfree(parser->device->collection); | ||
140 | parser->device->collection = collection; | ||
141 | parser->device->collection_size *= 2; | ||
142 | } | ||
143 | |||
144 | parser->collection_stack[parser->collection_stack_ptr++] = | ||
145 | parser->device->maxcollection; | ||
146 | |||
147 | collection = parser->device->collection + | ||
148 | parser->device->maxcollection++; | ||
149 | collection->type = type; | ||
150 | collection->usage = usage; | ||
151 | collection->level = parser->collection_stack_ptr - 1; | ||
152 | |||
153 | if (type == HID_COLLECTION_APPLICATION) | ||
154 | parser->device->maxapplication++; | ||
155 | |||
156 | return 0; | ||
157 | } | ||
158 | |||
159 | /* | ||
160 | * Close a collection. | ||
161 | */ | ||
162 | |||
163 | static int close_collection(struct hid_parser *parser) | ||
164 | { | ||
165 | if (!parser->collection_stack_ptr) { | ||
166 | dbg("collection stack underflow"); | ||
167 | return -1; | ||
168 | } | ||
169 | parser->collection_stack_ptr--; | ||
170 | return 0; | ||
171 | } | ||
172 | |||
173 | /* | ||
174 | * Climb up the stack, search for the specified collection type | ||
175 | * and return the usage. | ||
176 | */ | ||
177 | |||
178 | static unsigned hid_lookup_collection(struct hid_parser *parser, unsigned type) | ||
179 | { | ||
180 | int n; | ||
181 | for (n = parser->collection_stack_ptr - 1; n >= 0; n--) | ||
182 | if (parser->device->collection[parser->collection_stack[n]].type == type) | ||
183 | return parser->device->collection[parser->collection_stack[n]].usage; | ||
184 | return 0; /* we know nothing about this usage type */ | ||
185 | } | ||
186 | |||
187 | /* | ||
188 | * Add a usage to the temporary parser table. | ||
189 | */ | ||
190 | |||
191 | static int hid_add_usage(struct hid_parser *parser, unsigned usage) | ||
192 | { | ||
193 | if (parser->local.usage_index >= HID_MAX_USAGES) { | ||
194 | dbg("usage index exceeded"); | ||
195 | return -1; | ||
196 | } | ||
197 | parser->local.usage[parser->local.usage_index] = usage; | ||
198 | parser->local.collection_index[parser->local.usage_index] = | ||
199 | parser->collection_stack_ptr ? | ||
200 | parser->collection_stack[parser->collection_stack_ptr - 1] : 0; | ||
201 | parser->local.usage_index++; | ||
202 | return 0; | ||
203 | } | ||
204 | |||
205 | /* | ||
206 | * Register a new field for this report. | ||
207 | */ | ||
208 | |||
209 | static int hid_add_field(struct hid_parser *parser, unsigned report_type, unsigned flags) | ||
210 | { | ||
211 | struct hid_report *report; | ||
212 | struct hid_field *field; | ||
213 | int usages; | ||
214 | unsigned offset; | ||
215 | int i; | ||
216 | |||
217 | if (!(report = hid_register_report(parser->device, report_type, parser->global.report_id))) { | ||
218 | dbg("hid_register_report failed"); | ||
219 | return -1; | ||
220 | } | ||
221 | |||
222 | if (parser->global.logical_maximum < parser->global.logical_minimum) { | ||
223 | dbg("logical range invalid %d %d", parser->global.logical_minimum, parser->global.logical_maximum); | ||
224 | return -1; | ||
225 | } | ||
226 | |||
227 | offset = report->size; | ||
228 | report->size += parser->global.report_size * parser->global.report_count; | ||
229 | |||
230 | if (!parser->local.usage_index) /* Ignore padding fields */ | ||
231 | return 0; | ||
232 | |||
233 | usages = max_t(int, parser->local.usage_index, parser->global.report_count); | ||
234 | |||
235 | if ((field = hid_register_field(report, usages, parser->global.report_count)) == NULL) | ||
236 | return 0; | ||
237 | |||
238 | field->physical = hid_lookup_collection(parser, HID_COLLECTION_PHYSICAL); | ||
239 | field->logical = hid_lookup_collection(parser, HID_COLLECTION_LOGICAL); | ||
240 | field->application = hid_lookup_collection(parser, HID_COLLECTION_APPLICATION); | ||
241 | |||
242 | for (i = 0; i < usages; i++) { | ||
243 | int j = i; | ||
244 | /* Duplicate the last usage we parsed if we have excess values */ | ||
245 | if (i >= parser->local.usage_index) | ||
246 | j = parser->local.usage_index - 1; | ||
247 | field->usage[i].hid = parser->local.usage[j]; | ||
248 | field->usage[i].collection_index = | ||
249 | parser->local.collection_index[j]; | ||
250 | } | ||
251 | |||
252 | field->maxusage = usages; | ||
253 | field->flags = flags; | ||
254 | field->report_offset = offset; | ||
255 | field->report_type = report_type; | ||
256 | field->report_size = parser->global.report_size; | ||
257 | field->report_count = parser->global.report_count; | ||
258 | field->logical_minimum = parser->global.logical_minimum; | ||
259 | field->logical_maximum = parser->global.logical_maximum; | ||
260 | field->physical_minimum = parser->global.physical_minimum; | ||
261 | field->physical_maximum = parser->global.physical_maximum; | ||
262 | field->unit_exponent = parser->global.unit_exponent; | ||
263 | field->unit = parser->global.unit; | ||
264 | |||
265 | return 0; | ||
266 | } | ||
267 | |||
268 | /* | ||
269 | * Read data value from item. | ||
270 | */ | ||
271 | |||
272 | static u32 item_udata(struct hid_item *item) | ||
273 | { | ||
274 | switch (item->size) { | ||
275 | case 1: return item->data.u8; | ||
276 | case 2: return item->data.u16; | ||
277 | case 4: return item->data.u32; | ||
278 | } | ||
279 | return 0; | ||
280 | } | ||
281 | |||
282 | static s32 item_sdata(struct hid_item *item) | ||
283 | { | ||
284 | switch (item->size) { | ||
285 | case 1: return item->data.s8; | ||
286 | case 2: return item->data.s16; | ||
287 | case 4: return item->data.s32; | ||
288 | } | ||
289 | return 0; | ||
290 | } | ||
291 | |||
292 | /* | ||
293 | * Process a global item. | ||
294 | */ | ||
295 | |||
296 | static int hid_parser_global(struct hid_parser *parser, struct hid_item *item) | ||
297 | { | ||
298 | switch (item->tag) { | ||
299 | |||
300 | case HID_GLOBAL_ITEM_TAG_PUSH: | ||
301 | |||
302 | if (parser->global_stack_ptr == HID_GLOBAL_STACK_SIZE) { | ||
303 | dbg("global enviroment stack overflow"); | ||
304 | return -1; | ||
305 | } | ||
306 | |||
307 | memcpy(parser->global_stack + parser->global_stack_ptr++, | ||
308 | &parser->global, sizeof(struct hid_global)); | ||
309 | return 0; | ||
310 | |||
311 | case HID_GLOBAL_ITEM_TAG_POP: | ||
312 | |||
313 | if (!parser->global_stack_ptr) { | ||
314 | dbg("global enviroment stack underflow"); | ||
315 | return -1; | ||
316 | } | ||
317 | |||
318 | memcpy(&parser->global, parser->global_stack + --parser->global_stack_ptr, | ||
319 | sizeof(struct hid_global)); | ||
320 | return 0; | ||
321 | |||
322 | case HID_GLOBAL_ITEM_TAG_USAGE_PAGE: | ||
323 | parser->global.usage_page = item_udata(item); | ||
324 | return 0; | ||
325 | |||
326 | case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM: | ||
327 | parser->global.logical_minimum = item_sdata(item); | ||
328 | return 0; | ||
329 | |||
330 | case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM: | ||
331 | if (parser->global.logical_minimum < 0) | ||
332 | parser->global.logical_maximum = item_sdata(item); | ||
333 | else | ||
334 | parser->global.logical_maximum = item_udata(item); | ||
335 | return 0; | ||
336 | |||
337 | case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM: | ||
338 | parser->global.physical_minimum = item_sdata(item); | ||
339 | return 0; | ||
340 | |||
341 | case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM: | ||
342 | if (parser->global.physical_minimum < 0) | ||
343 | parser->global.physical_maximum = item_sdata(item); | ||
344 | else | ||
345 | parser->global.physical_maximum = item_udata(item); | ||
346 | return 0; | ||
347 | |||
348 | case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT: | ||
349 | parser->global.unit_exponent = item_sdata(item); | ||
350 | return 0; | ||
351 | |||
352 | case HID_GLOBAL_ITEM_TAG_UNIT: | ||
353 | parser->global.unit = item_udata(item); | ||
354 | return 0; | ||
355 | |||
356 | case HID_GLOBAL_ITEM_TAG_REPORT_SIZE: | ||
357 | if ((parser->global.report_size = item_udata(item)) > 32) { | ||
358 | dbg("invalid report_size %d", parser->global.report_size); | ||
359 | return -1; | ||
360 | } | ||
361 | return 0; | ||
362 | |||
363 | case HID_GLOBAL_ITEM_TAG_REPORT_COUNT: | ||
364 | if ((parser->global.report_count = item_udata(item)) > HID_MAX_USAGES) { | ||
365 | dbg("invalid report_count %d", parser->global.report_count); | ||
366 | return -1; | ||
367 | } | ||
368 | return 0; | ||
369 | |||
370 | case HID_GLOBAL_ITEM_TAG_REPORT_ID: | ||
371 | if ((parser->global.report_id = item_udata(item)) == 0) { | ||
372 | dbg("report_id 0 is invalid"); | ||
373 | return -1; | ||
374 | } | ||
375 | return 0; | ||
376 | |||
377 | default: | ||
378 | dbg("unknown global tag 0x%x", item->tag); | ||
379 | return -1; | ||
380 | } | ||
381 | } | ||
382 | |||
383 | /* | ||
384 | * Process a local item. | ||
385 | */ | ||
386 | |||
387 | static int hid_parser_local(struct hid_parser *parser, struct hid_item *item) | ||
388 | { | ||
389 | __u32 data; | ||
390 | unsigned n; | ||
391 | |||
392 | if (item->size == 0) { | ||
393 | dbg("item data expected for local item"); | ||
394 | return -1; | ||
395 | } | ||
396 | |||
397 | data = item_udata(item); | ||
398 | |||
399 | switch (item->tag) { | ||
400 | |||
401 | case HID_LOCAL_ITEM_TAG_DELIMITER: | ||
402 | |||
403 | if (data) { | ||
404 | /* | ||
405 | * We treat items before the first delimiter | ||
406 | * as global to all usage sets (branch 0). | ||
407 | * In the moment we process only these global | ||
408 | * items and the first delimiter set. | ||
409 | */ | ||
410 | if (parser->local.delimiter_depth != 0) { | ||
411 | dbg("nested delimiters"); | ||
412 | return -1; | ||
413 | } | ||
414 | parser->local.delimiter_depth++; | ||
415 | parser->local.delimiter_branch++; | ||
416 | } else { | ||
417 | if (parser->local.delimiter_depth < 1) { | ||
418 | dbg("bogus close delimiter"); | ||
419 | return -1; | ||
420 | } | ||
421 | parser->local.delimiter_depth--; | ||
422 | } | ||
423 | return 1; | ||
424 | |||
425 | case HID_LOCAL_ITEM_TAG_USAGE: | ||
426 | |||
427 | if (parser->local.delimiter_branch > 1) { | ||
428 | dbg("alternative usage ignored"); | ||
429 | return 0; | ||
430 | } | ||
431 | |||
432 | if (item->size <= 2) | ||
433 | data = (parser->global.usage_page << 16) + data; | ||
434 | |||
435 | return hid_add_usage(parser, data); | ||
436 | |||
437 | case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM: | ||
438 | |||
439 | if (parser->local.delimiter_branch > 1) { | ||
440 | dbg("alternative usage ignored"); | ||
441 | return 0; | ||
442 | } | ||
443 | |||
444 | if (item->size <= 2) | ||
445 | data = (parser->global.usage_page << 16) + data; | ||
446 | |||
447 | parser->local.usage_minimum = data; | ||
448 | return 0; | ||
449 | |||
450 | case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM: | ||
451 | |||
452 | if (parser->local.delimiter_branch > 1) { | ||
453 | dbg("alternative usage ignored"); | ||
454 | return 0; | ||
455 | } | ||
456 | |||
457 | if (item->size <= 2) | ||
458 | data = (parser->global.usage_page << 16) + data; | ||
459 | |||
460 | for (n = parser->local.usage_minimum; n <= data; n++) | ||
461 | if (hid_add_usage(parser, n)) { | ||
462 | dbg("hid_add_usage failed\n"); | ||
463 | return -1; | ||
464 | } | ||
465 | return 0; | ||
466 | |||
467 | default: | ||
468 | |||
469 | dbg("unknown local item tag 0x%x", item->tag); | ||
470 | return 0; | ||
471 | } | ||
472 | return 0; | ||
473 | } | ||
474 | |||
475 | /* | ||
476 | * Process a main item. | ||
477 | */ | ||
478 | |||
479 | static int hid_parser_main(struct hid_parser *parser, struct hid_item *item) | ||
480 | { | ||
481 | __u32 data; | ||
482 | int ret; | ||
483 | |||
484 | data = item_udata(item); | ||
485 | |||
486 | switch (item->tag) { | ||
487 | case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION: | ||
488 | ret = open_collection(parser, data & 0xff); | ||
489 | break; | ||
490 | case HID_MAIN_ITEM_TAG_END_COLLECTION: | ||
491 | ret = close_collection(parser); | ||
492 | break; | ||
493 | case HID_MAIN_ITEM_TAG_INPUT: | ||
494 | ret = hid_add_field(parser, HID_INPUT_REPORT, data); | ||
495 | break; | ||
496 | case HID_MAIN_ITEM_TAG_OUTPUT: | ||
497 | ret = hid_add_field(parser, HID_OUTPUT_REPORT, data); | ||
498 | break; | ||
499 | case HID_MAIN_ITEM_TAG_FEATURE: | ||
500 | ret = hid_add_field(parser, HID_FEATURE_REPORT, data); | ||
501 | break; | ||
502 | default: | ||
503 | dbg("unknown main item tag 0x%x", item->tag); | ||
504 | ret = 0; | ||
505 | } | ||
506 | |||
507 | memset(&parser->local, 0, sizeof(parser->local)); /* Reset the local parser environment */ | ||
508 | |||
509 | return ret; | ||
510 | } | ||
511 | |||
512 | /* | ||
513 | * Process a reserved item. | ||
514 | */ | ||
515 | |||
516 | static int hid_parser_reserved(struct hid_parser *parser, struct hid_item *item) | ||
517 | { | ||
518 | dbg("reserved item type, tag 0x%x", item->tag); | ||
519 | return 0; | ||
520 | } | ||
521 | |||
522 | /* | ||
523 | * Free a report and all registered fields. The field->usage and | ||
524 | * field->value table's are allocated behind the field, so we need | ||
525 | * only to free(field) itself. | ||
526 | */ | ||
527 | |||
528 | static void hid_free_report(struct hid_report *report) | ||
529 | { | ||
530 | unsigned n; | ||
531 | |||
532 | for (n = 0; n < report->maxfield; n++) | ||
533 | kfree(report->field[n]); | ||
534 | kfree(report); | ||
535 | } | ||
536 | |||
537 | /* | ||
538 | * Free a device structure, all reports, and all fields. | ||
539 | */ | ||
540 | |||
541 | static void hid_free_device(struct hid_device *device) | ||
542 | { | ||
543 | unsigned i,j; | ||
544 | |||
545 | for (i = 0; i < HID_REPORT_TYPES; i++) { | ||
546 | struct hid_report_enum *report_enum = device->report_enum + i; | ||
547 | |||
548 | for (j = 0; j < 256; j++) { | ||
549 | struct hid_report *report = report_enum->report_id_hash[j]; | ||
550 | if (report) | ||
551 | hid_free_report(report); | ||
552 | } | ||
553 | } | ||
554 | |||
555 | kfree(device->rdesc); | ||
556 | kfree(device); | ||
557 | } | ||
558 | |||
559 | /* | ||
560 | * Fetch a report description item from the data stream. We support long | ||
561 | * items, though they are not used yet. | ||
562 | */ | ||
563 | |||
564 | static u8 *fetch_item(__u8 *start, __u8 *end, struct hid_item *item) | ||
565 | { | ||
566 | u8 b; | ||
567 | |||
568 | if ((end - start) <= 0) | ||
569 | return NULL; | ||
570 | |||
571 | b = *start++; | ||
572 | |||
573 | item->type = (b >> 2) & 3; | ||
574 | item->tag = (b >> 4) & 15; | ||
575 | |||
576 | if (item->tag == HID_ITEM_TAG_LONG) { | ||
577 | |||
578 | item->format = HID_ITEM_FORMAT_LONG; | ||
579 | |||
580 | if ((end - start) < 2) | ||
581 | return NULL; | ||
582 | |||
583 | item->size = *start++; | ||
584 | item->tag = *start++; | ||
585 | |||
586 | if ((end - start) < item->size) | ||
587 | return NULL; | ||
588 | |||
589 | item->data.longdata = start; | ||
590 | start += item->size; | ||
591 | return start; | ||
592 | } | ||
593 | |||
594 | item->format = HID_ITEM_FORMAT_SHORT; | ||
595 | item->size = b & 3; | ||
596 | |||
597 | switch (item->size) { | ||
598 | |||
599 | case 0: | ||
600 | return start; | ||
601 | |||
602 | case 1: | ||
603 | if ((end - start) < 1) | ||
604 | return NULL; | ||
605 | item->data.u8 = *start++; | ||
606 | return start; | ||
607 | |||
608 | case 2: | ||
609 | if ((end - start) < 2) | ||
610 | return NULL; | ||
611 | item->data.u16 = le16_to_cpu(get_unaligned((__le16*)start)); | ||
612 | start = (__u8 *)((__le16 *)start + 1); | ||
613 | return start; | ||
614 | |||
615 | case 3: | ||
616 | item->size++; | ||
617 | if ((end - start) < 4) | ||
618 | return NULL; | ||
619 | item->data.u32 = le32_to_cpu(get_unaligned((__le32*)start)); | ||
620 | start = (__u8 *)((__le32 *)start + 1); | ||
621 | return start; | ||
622 | } | ||
623 | |||
624 | return NULL; | ||
625 | } | ||
626 | |||
627 | /* | ||
628 | * Parse a report description into a hid_device structure. Reports are | ||
629 | * enumerated, fields are attached to these reports. | ||
630 | */ | ||
631 | |||
632 | static struct hid_device *hid_parse_report(__u8 *start, unsigned size) | ||
633 | { | ||
634 | struct hid_device *device; | ||
635 | struct hid_parser *parser; | ||
636 | struct hid_item item; | ||
637 | __u8 *end; | ||
638 | unsigned i; | ||
639 | static int (*dispatch_type[])(struct hid_parser *parser, | ||
640 | struct hid_item *item) = { | ||
641 | hid_parser_main, | ||
642 | hid_parser_global, | ||
643 | hid_parser_local, | ||
644 | hid_parser_reserved | ||
645 | }; | ||
646 | |||
647 | if (!(device = kzalloc(sizeof(struct hid_device), GFP_KERNEL))) | ||
648 | return NULL; | ||
649 | |||
650 | if (!(device->collection = kzalloc(sizeof(struct hid_collection) * | ||
651 | HID_DEFAULT_NUM_COLLECTIONS, GFP_KERNEL))) { | ||
652 | kfree(device); | ||
653 | return NULL; | ||
654 | } | ||
655 | device->collection_size = HID_DEFAULT_NUM_COLLECTIONS; | ||
656 | |||
657 | for (i = 0; i < HID_REPORT_TYPES; i++) | ||
658 | INIT_LIST_HEAD(&device->report_enum[i].report_list); | ||
659 | |||
660 | if (!(device->rdesc = (__u8 *)kmalloc(size, GFP_KERNEL))) { | ||
661 | kfree(device->collection); | ||
662 | kfree(device); | ||
663 | return NULL; | ||
664 | } | ||
665 | memcpy(device->rdesc, start, size); | ||
666 | device->rsize = size; | ||
667 | |||
668 | if (!(parser = kzalloc(sizeof(struct hid_parser), GFP_KERNEL))) { | ||
669 | kfree(device->rdesc); | ||
670 | kfree(device->collection); | ||
671 | kfree(device); | ||
672 | return NULL; | ||
673 | } | ||
674 | parser->device = device; | ||
675 | |||
676 | end = start + size; | ||
677 | while ((start = fetch_item(start, end, &item)) != NULL) { | ||
678 | |||
679 | if (item.format != HID_ITEM_FORMAT_SHORT) { | ||
680 | dbg("unexpected long global item"); | ||
681 | kfree(device->collection); | ||
682 | hid_free_device(device); | ||
683 | kfree(parser); | ||
684 | return NULL; | ||
685 | } | ||
686 | |||
687 | if (dispatch_type[item.type](parser, &item)) { | ||
688 | dbg("item %u %u %u %u parsing failed\n", | ||
689 | item.format, (unsigned)item.size, (unsigned)item.type, (unsigned)item.tag); | ||
690 | kfree(device->collection); | ||
691 | hid_free_device(device); | ||
692 | kfree(parser); | ||
693 | return NULL; | ||
694 | } | ||
695 | |||
696 | if (start == end) { | ||
697 | if (parser->collection_stack_ptr) { | ||
698 | dbg("unbalanced collection at end of report description"); | ||
699 | kfree(device->collection); | ||
700 | hid_free_device(device); | ||
701 | kfree(parser); | ||
702 | return NULL; | ||
703 | } | ||
704 | if (parser->local.delimiter_depth) { | ||
705 | dbg("unbalanced delimiter at end of report description"); | ||
706 | kfree(device->collection); | ||
707 | hid_free_device(device); | ||
708 | kfree(parser); | ||
709 | return NULL; | ||
710 | } | ||
711 | kfree(parser); | ||
712 | return device; | ||
713 | } | ||
714 | } | ||
715 | |||
716 | dbg("item fetching failed at offset %d\n", (int)(end - start)); | ||
717 | kfree(device->collection); | ||
718 | hid_free_device(device); | ||
719 | kfree(parser); | ||
720 | return NULL; | ||
721 | } | ||
722 | |||
723 | /* | ||
724 | * Convert a signed n-bit integer to signed 32-bit integer. Common | ||
725 | * cases are done through the compiler, the screwed things has to be | ||
726 | * done by hand. | ||
727 | */ | ||
728 | |||
729 | static s32 snto32(__u32 value, unsigned n) | ||
730 | { | ||
731 | switch (n) { | ||
732 | case 8: return ((__s8)value); | ||
733 | case 16: return ((__s16)value); | ||
734 | case 32: return ((__s32)value); | ||
735 | } | ||
736 | return value & (1 << (n - 1)) ? value | (-1 << n) : value; | ||
737 | } | ||
738 | |||
739 | /* | ||
740 | * Convert a signed 32-bit integer to a signed n-bit integer. | ||
741 | */ | ||
742 | |||
743 | static u32 s32ton(__s32 value, unsigned n) | ||
744 | { | ||
745 | s32 a = value >> (n - 1); | ||
746 | if (a && a != -1) | ||
747 | return value < 0 ? 1 << (n - 1) : (1 << (n - 1)) - 1; | ||
748 | return value & ((1 << n) - 1); | ||
749 | } | ||
750 | |||
751 | /* | ||
752 | * Extract/implement a data field from/to a little endian report (bit array). | ||
753 | * | ||
754 | * Code sort-of follows HID spec: | ||
755 | * http://www.usb.org/developers/devclass_docs/HID1_11.pdf | ||
756 | * | ||
757 | * While the USB HID spec allows unlimited length bit fields in "report | ||
758 | * descriptors", most devices never use more than 16 bits. | ||
759 | * One model of UPS is claimed to report "LINEV" as a 32-bit field. | ||
760 | * Search linux-kernel and linux-usb-devel archives for "hid-core extract". | ||
761 | */ | ||
762 | |||
763 | static __inline__ __u32 extract(__u8 *report, unsigned offset, unsigned n) | ||
764 | { | ||
765 | u64 x; | ||
766 | |||
767 | WARN_ON(n > 32); | ||
768 | |||
769 | report += offset >> 3; /* adjust byte index */ | ||
770 | offset &= 7; /* now only need bit offset into one byte */ | ||
771 | x = get_unaligned((u64 *) report); | ||
772 | x = le64_to_cpu(x); | ||
773 | x = (x >> offset) & ((1ULL << n) - 1); /* extract bit field */ | ||
774 | return (u32) x; | ||
775 | } | ||
776 | |||
777 | /* | ||
778 | * "implement" : set bits in a little endian bit stream. | ||
779 | * Same concepts as "extract" (see comments above). | ||
780 | * The data mangled in the bit stream remains in little endian | ||
781 | * order the whole time. It make more sense to talk about | ||
782 | * endianness of register values by considering a register | ||
783 | * a "cached" copy of the little endiad bit stream. | ||
784 | */ | ||
785 | static __inline__ void implement(__u8 *report, unsigned offset, unsigned n, __u32 value) | ||
786 | { | ||
787 | u64 x; | ||
788 | u64 m = (1ULL << n) - 1; | ||
789 | |||
790 | WARN_ON(n > 32); | ||
791 | |||
792 | WARN_ON(value > m); | ||
793 | value &= m; | ||
794 | |||
795 | report += offset >> 3; | ||
796 | offset &= 7; | ||
797 | |||
798 | x = get_unaligned((u64 *)report); | ||
799 | x &= cpu_to_le64(~(m << offset)); | ||
800 | x |= cpu_to_le64(((u64) value) << offset); | ||
801 | put_unaligned(x, (u64 *) report); | ||
802 | } | ||
803 | |||
804 | /* | ||
805 | * Search an array for a value. | ||
806 | */ | ||
807 | |||
808 | static __inline__ int search(__s32 *array, __s32 value, unsigned n) | ||
809 | { | ||
810 | while (n--) { | ||
811 | if (*array++ == value) | ||
812 | return 0; | ||
813 | } | ||
814 | return -1; | ||
815 | } | ||
816 | |||
817 | static void hid_process_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value, int interrupt) | ||
818 | { | ||
819 | hid_dump_input(usage, value); | ||
820 | if (hid->claimed & HID_CLAIMED_INPUT) | ||
821 | hidinput_hid_event(hid, field, usage, value); | ||
822 | if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt) | ||
823 | hiddev_hid_event(hid, field, usage, value); | ||
824 | } | ||
825 | |||
826 | /* | ||
827 | * Analyse a received field, and fetch the data from it. The field | ||
828 | * content is stored for next report processing (we do differential | ||
829 | * reporting to the layer). | ||
830 | */ | ||
831 | |||
832 | static void hid_input_field(struct hid_device *hid, struct hid_field *field, __u8 *data, int interrupt) | ||
833 | { | ||
834 | unsigned n; | ||
835 | unsigned count = field->report_count; | ||
836 | unsigned offset = field->report_offset; | ||
837 | unsigned size = field->report_size; | ||
838 | __s32 min = field->logical_minimum; | ||
839 | __s32 max = field->logical_maximum; | ||
840 | __s32 *value; | ||
841 | |||
842 | if (!(value = kmalloc(sizeof(__s32) * count, GFP_ATOMIC))) | ||
843 | return; | ||
844 | |||
845 | for (n = 0; n < count; n++) { | ||
846 | |||
847 | value[n] = min < 0 ? snto32(extract(data, offset + n * size, size), size) : | ||
848 | extract(data, offset + n * size, size); | ||
849 | |||
850 | if (!(field->flags & HID_MAIN_ITEM_VARIABLE) /* Ignore report if ErrorRollOver */ | ||
851 | && value[n] >= min && value[n] <= max | ||
852 | && field->usage[value[n] - min].hid == HID_UP_KEYBOARD + 1) | ||
853 | goto exit; | ||
854 | } | ||
855 | |||
856 | for (n = 0; n < count; n++) { | ||
857 | |||
858 | if (HID_MAIN_ITEM_VARIABLE & field->flags) { | ||
859 | hid_process_event(hid, field, &field->usage[n], value[n], interrupt); | ||
860 | continue; | ||
861 | } | ||
862 | |||
863 | if (field->value[n] >= min && field->value[n] <= max | ||
864 | && field->usage[field->value[n] - min].hid | ||
865 | && search(value, field->value[n], count)) | ||
866 | hid_process_event(hid, field, &field->usage[field->value[n] - min], 0, interrupt); | ||
867 | |||
868 | if (value[n] >= min && value[n] <= max | ||
869 | && field->usage[value[n] - min].hid | ||
870 | && search(field->value, value[n], count)) | ||
871 | hid_process_event(hid, field, &field->usage[value[n] - min], 1, interrupt); | ||
872 | } | ||
873 | |||
874 | memcpy(field->value, value, count * sizeof(__s32)); | ||
875 | exit: | ||
876 | kfree(value); | ||
877 | } | ||
878 | |||
879 | |||
880 | /* | ||
881 | * Output the field into the report. | ||
882 | */ | ||
883 | |||
884 | static void hid_output_field(struct hid_field *field, __u8 *data) | ||
885 | { | ||
886 | unsigned count = field->report_count; | ||
887 | unsigned offset = field->report_offset; | ||
888 | unsigned size = field->report_size; | ||
889 | unsigned n; | ||
890 | |||
891 | for (n = 0; n < count; n++) { | ||
892 | if (field->logical_minimum < 0) /* signed values */ | ||
893 | implement(data, offset + n * size, size, s32ton(field->value[n], size)); | ||
894 | else /* unsigned values */ | ||
895 | implement(data, offset + n * size, size, field->value[n]); | ||
896 | } | ||
897 | } | ||
898 | |||
899 | /* | ||
900 | * Create a report. | ||
901 | */ | ||
902 | |||
903 | static void hid_output_report(struct hid_report *report, __u8 *data) | ||
904 | { | ||
905 | unsigned n; | ||
906 | |||
907 | if (report->id > 0) | ||
908 | *data++ = report->id; | ||
909 | |||
910 | for (n = 0; n < report->maxfield; n++) | ||
911 | hid_output_field(report->field[n], data); | ||
912 | } | ||
913 | |||
914 | /* | ||
915 | * Set a field value. The report this field belongs to has to be | ||
916 | * created and transferred to the device, to set this value in the | ||
917 | * device. | ||
918 | */ | ||
919 | |||
920 | int hid_set_field(struct hid_field *field, unsigned offset, __s32 value) | ||
921 | { | ||
922 | unsigned size = field->report_size; | ||
923 | |||
924 | hid_dump_input(field->usage + offset, value); | ||
925 | |||
926 | if (offset >= field->report_count) { | ||
927 | dbg("offset (%d) exceeds report_count (%d)", offset, field->report_count); | ||
928 | hid_dump_field(field, 8); | ||
929 | return -1; | ||
930 | } | ||
931 | if (field->logical_minimum < 0) { | ||
932 | if (value != snto32(s32ton(value, size), size)) { | ||
933 | dbg("value %d is out of range", value); | ||
934 | return -1; | ||
935 | } | ||
936 | } | ||
937 | field->value[offset] = value; | ||
938 | return 0; | ||
939 | } | ||
940 | |||
diff --git a/drivers/hid/hid-input.c b/drivers/hid/hid-input.c new file mode 100644 index 000000000000..d459005062e0 --- /dev/null +++ b/drivers/hid/hid-input.c | |||
@@ -0,0 +1,840 @@ | |||
1 | /* | ||
2 | * $Id: hid-input.c,v 1.2 2002/04/23 00:59:25 rdamazio Exp $ | ||
3 | * | ||
4 | * Copyright (c) 2000-2001 Vojtech Pavlik | ||
5 | * Copyright (c) 2006 Jiri Kosina | ||
6 | * | ||
7 | * HID to Linux Input mapping | ||
8 | */ | ||
9 | |||
10 | /* | ||
11 | * This program is free software; you can redistribute it and/or modify | ||
12 | * it under the terms of the GNU General Public License as published by | ||
13 | * the Free Software Foundation; either version 2 of the License, or | ||
14 | * (at your option) any later version. | ||
15 | * | ||
16 | * This program is distributed in the hope that it will be useful, | ||
17 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
19 | * GNU General Public License for more details. | ||
20 | * | ||
21 | * You should have received a copy of the GNU General Public License | ||
22 | * along with this program; if not, write to the Free Software | ||
23 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | ||
24 | * | ||
25 | * Should you need to contact me, the author, you can do so either by | ||
26 | * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail: | ||
27 | * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic | ||
28 | */ | ||
29 | |||
30 | #include <linux/module.h> | ||
31 | #include <linux/slab.h> | ||
32 | #include <linux/kernel.h> | ||
33 | #include <linux/usb/input.h> | ||
34 | |||
35 | #undef DEBUG | ||
36 | |||
37 | #include <linux/hid.h> | ||
38 | |||
39 | #define unk KEY_UNKNOWN | ||
40 | |||
41 | static const unsigned char hid_keyboard[256] = { | ||
42 | 0, 0, 0, 0, 30, 48, 46, 32, 18, 33, 34, 35, 23, 36, 37, 38, | ||
43 | 50, 49, 24, 25, 16, 19, 31, 20, 22, 47, 17, 45, 21, 44, 2, 3, | ||
44 | 4, 5, 6, 7, 8, 9, 10, 11, 28, 1, 14, 15, 57, 12, 13, 26, | ||
45 | 27, 43, 43, 39, 40, 41, 51, 52, 53, 58, 59, 60, 61, 62, 63, 64, | ||
46 | 65, 66, 67, 68, 87, 88, 99, 70,119,110,102,104,111,107,109,106, | ||
47 | 105,108,103, 69, 98, 55, 74, 78, 96, 79, 80, 81, 75, 76, 77, 71, | ||
48 | 72, 73, 82, 83, 86,127,116,117,183,184,185,186,187,188,189,190, | ||
49 | 191,192,193,194,134,138,130,132,128,129,131,137,133,135,136,113, | ||
50 | 115,114,unk,unk,unk,121,unk, 89, 93,124, 92, 94, 95,unk,unk,unk, | ||
51 | 122,123, 90, 91, 85,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk, | ||
52 | unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk, | ||
53 | unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk, | ||
54 | unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk, | ||
55 | unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk, | ||
56 | 29, 42, 56,125, 97, 54,100,126,164,166,165,163,161,115,114,113, | ||
57 | 150,158,159,128,136,177,178,176,142,152,173,140,unk,unk,unk,unk | ||
58 | }; | ||
59 | |||
60 | static const struct { | ||
61 | __s32 x; | ||
62 | __s32 y; | ||
63 | } hid_hat_to_axis[] = {{ 0, 0}, { 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}}; | ||
64 | |||
65 | #define map_abs(c) do { usage->code = c; usage->type = EV_ABS; bit = input->absbit; max = ABS_MAX; } while (0) | ||
66 | #define map_rel(c) do { usage->code = c; usage->type = EV_REL; bit = input->relbit; max = REL_MAX; } while (0) | ||
67 | #define map_key(c) do { usage->code = c; usage->type = EV_KEY; bit = input->keybit; max = KEY_MAX; } while (0) | ||
68 | #define map_led(c) do { usage->code = c; usage->type = EV_LED; bit = input->ledbit; max = LED_MAX; } while (0) | ||
69 | |||
70 | #define map_abs_clear(c) do { map_abs(c); clear_bit(c, bit); } while (0) | ||
71 | #define map_key_clear(c) do { map_key(c); clear_bit(c, bit); } while (0) | ||
72 | |||
73 | #ifdef CONFIG_USB_HIDINPUT_POWERBOOK | ||
74 | |||
75 | struct hidinput_key_translation { | ||
76 | u16 from; | ||
77 | u16 to; | ||
78 | u8 flags; | ||
79 | }; | ||
80 | |||
81 | #define POWERBOOK_FLAG_FKEY 0x01 | ||
82 | |||
83 | static struct hidinput_key_translation powerbook_fn_keys[] = { | ||
84 | { KEY_BACKSPACE, KEY_DELETE }, | ||
85 | { KEY_F1, KEY_BRIGHTNESSDOWN, POWERBOOK_FLAG_FKEY }, | ||
86 | { KEY_F2, KEY_BRIGHTNESSUP, POWERBOOK_FLAG_FKEY }, | ||
87 | { KEY_F3, KEY_MUTE, POWERBOOK_FLAG_FKEY }, | ||
88 | { KEY_F4, KEY_VOLUMEDOWN, POWERBOOK_FLAG_FKEY }, | ||
89 | { KEY_F5, KEY_VOLUMEUP, POWERBOOK_FLAG_FKEY }, | ||
90 | { KEY_F6, KEY_NUMLOCK, POWERBOOK_FLAG_FKEY }, | ||
91 | { KEY_F7, KEY_SWITCHVIDEOMODE, POWERBOOK_FLAG_FKEY }, | ||
92 | { KEY_F8, KEY_KBDILLUMTOGGLE, POWERBOOK_FLAG_FKEY }, | ||
93 | { KEY_F9, KEY_KBDILLUMDOWN, POWERBOOK_FLAG_FKEY }, | ||
94 | { KEY_F10, KEY_KBDILLUMUP, POWERBOOK_FLAG_FKEY }, | ||
95 | { KEY_UP, KEY_PAGEUP }, | ||
96 | { KEY_DOWN, KEY_PAGEDOWN }, | ||
97 | { KEY_LEFT, KEY_HOME }, | ||
98 | { KEY_RIGHT, KEY_END }, | ||
99 | { } | ||
100 | }; | ||
101 | |||
102 | static struct hidinput_key_translation powerbook_numlock_keys[] = { | ||
103 | { KEY_J, KEY_KP1 }, | ||
104 | { KEY_K, KEY_KP2 }, | ||
105 | { KEY_L, KEY_KP3 }, | ||
106 | { KEY_U, KEY_KP4 }, | ||
107 | { KEY_I, KEY_KP5 }, | ||
108 | { KEY_O, KEY_KP6 }, | ||
109 | { KEY_7, KEY_KP7 }, | ||
110 | { KEY_8, KEY_KP8 }, | ||
111 | { KEY_9, KEY_KP9 }, | ||
112 | { KEY_M, KEY_KP0 }, | ||
113 | { KEY_DOT, KEY_KPDOT }, | ||
114 | { KEY_SLASH, KEY_KPPLUS }, | ||
115 | { KEY_SEMICOLON, KEY_KPMINUS }, | ||
116 | { KEY_P, KEY_KPASTERISK }, | ||
117 | { KEY_MINUS, KEY_KPEQUAL }, | ||
118 | { KEY_0, KEY_KPSLASH }, | ||
119 | { KEY_F6, KEY_NUMLOCK }, | ||
120 | { KEY_KPENTER, KEY_KPENTER }, | ||
121 | { KEY_BACKSPACE, KEY_BACKSPACE }, | ||
122 | { } | ||
123 | }; | ||
124 | |||
125 | static struct hidinput_key_translation powerbook_iso_keyboard[] = { | ||
126 | { KEY_GRAVE, KEY_102ND }, | ||
127 | { KEY_102ND, KEY_GRAVE }, | ||
128 | { } | ||
129 | }; | ||
130 | |||
131 | |||
132 | static int usbhid_pb_fnmode = 1; | ||
133 | module_param_named(pb_fnmode, usbhid_pb_fnmode, int, 0644); | ||
134 | MODULE_PARM_DESC(pb_fnmode, | ||
135 | "Mode of fn key on PowerBooks (0 = disabled, 1 = fkeyslast, 2 = fkeysfirst)"); | ||
136 | |||
137 | static struct hidinput_key_translation *find_translation(struct hidinput_key_translation *table, u16 from) | ||
138 | { | ||
139 | struct hidinput_key_translation *trans; | ||
140 | |||
141 | /* Look for the translation */ | ||
142 | for (trans = table; trans->from; trans++) | ||
143 | if (trans->from == from) | ||
144 | return trans; | ||
145 | |||
146 | return NULL; | ||
147 | } | ||
148 | |||
149 | static int hidinput_pb_event(struct hid_device *hid, struct input_dev *input, | ||
150 | struct hid_usage *usage, __s32 value) | ||
151 | { | ||
152 | struct hidinput_key_translation *trans; | ||
153 | |||
154 | if (usage->code == KEY_FN) { | ||
155 | if (value) hid->quirks |= HID_QUIRK_POWERBOOK_FN_ON; | ||
156 | else hid->quirks &= ~HID_QUIRK_POWERBOOK_FN_ON; | ||
157 | |||
158 | input_event(input, usage->type, usage->code, value); | ||
159 | |||
160 | return 1; | ||
161 | } | ||
162 | |||
163 | if (usbhid_pb_fnmode) { | ||
164 | int do_translate; | ||
165 | |||
166 | trans = find_translation(powerbook_fn_keys, usage->code); | ||
167 | if (trans) { | ||
168 | if (test_bit(usage->code, hid->pb_pressed_fn)) | ||
169 | do_translate = 1; | ||
170 | else if (trans->flags & POWERBOOK_FLAG_FKEY) | ||
171 | do_translate = | ||
172 | (usbhid_pb_fnmode == 2 && (hid->quirks & HID_QUIRK_POWERBOOK_FN_ON)) || | ||
173 | (usbhid_pb_fnmode == 1 && !(hid->quirks & HID_QUIRK_POWERBOOK_FN_ON)); | ||
174 | else | ||
175 | do_translate = (hid->quirks & HID_QUIRK_POWERBOOK_FN_ON); | ||
176 | |||
177 | if (do_translate) { | ||
178 | if (value) | ||
179 | set_bit(usage->code, hid->pb_pressed_fn); | ||
180 | else | ||
181 | clear_bit(usage->code, hid->pb_pressed_fn); | ||
182 | |||
183 | input_event(input, usage->type, trans->to, value); | ||
184 | |||
185 | return 1; | ||
186 | } | ||
187 | } | ||
188 | |||
189 | if (test_bit(usage->code, hid->pb_pressed_numlock) || | ||
190 | test_bit(LED_NUML, input->led)) { | ||
191 | trans = find_translation(powerbook_numlock_keys, usage->code); | ||
192 | |||
193 | if (trans) { | ||
194 | if (value) | ||
195 | set_bit(usage->code, hid->pb_pressed_numlock); | ||
196 | else | ||
197 | clear_bit(usage->code, hid->pb_pressed_numlock); | ||
198 | |||
199 | input_event(input, usage->type, trans->to, value); | ||
200 | } | ||
201 | |||
202 | return 1; | ||
203 | } | ||
204 | } | ||
205 | |||
206 | if (hid->quirks & HID_QUIRK_POWERBOOK_ISO_KEYBOARD) { | ||
207 | trans = find_translation(powerbook_iso_keyboard, usage->code); | ||
208 | if (trans) { | ||
209 | input_event(input, usage->type, trans->to, value); | ||
210 | return 1; | ||
211 | } | ||
212 | } | ||
213 | |||
214 | return 0; | ||
215 | } | ||
216 | |||
217 | static void hidinput_pb_setup(struct input_dev *input) | ||
218 | { | ||
219 | struct hidinput_key_translation *trans; | ||
220 | |||
221 | set_bit(KEY_NUMLOCK, input->keybit); | ||
222 | |||
223 | /* Enable all needed keys */ | ||
224 | for (trans = powerbook_fn_keys; trans->from; trans++) | ||
225 | set_bit(trans->to, input->keybit); | ||
226 | |||
227 | for (trans = powerbook_numlock_keys; trans->from; trans++) | ||
228 | set_bit(trans->to, input->keybit); | ||
229 | |||
230 | for (trans = powerbook_iso_keyboard; trans->from; trans++) | ||
231 | set_bit(trans->to, input->keybit); | ||
232 | |||
233 | } | ||
234 | #else | ||
235 | static inline int hidinput_pb_event(struct hid_device *hid, struct input_dev *input, | ||
236 | struct hid_usage *usage, __s32 value) | ||
237 | { | ||
238 | return 0; | ||
239 | } | ||
240 | |||
241 | static inline void hidinput_pb_setup(struct input_dev *input) | ||
242 | { | ||
243 | } | ||
244 | #endif | ||
245 | |||
246 | static void hidinput_configure_usage(struct hid_input *hidinput, struct hid_field *field, | ||
247 | struct hid_usage *usage) | ||
248 | { | ||
249 | struct input_dev *input = hidinput->input; | ||
250 | struct hid_device *device = input->private; | ||
251 | int max = 0, code; | ||
252 | unsigned long *bit = NULL; | ||
253 | |||
254 | field->hidinput = hidinput; | ||
255 | |||
256 | #ifdef DEBUG | ||
257 | printk(KERN_DEBUG "Mapping: "); | ||
258 | resolv_usage(usage->hid); | ||
259 | printk(" ---> "); | ||
260 | #endif | ||
261 | |||
262 | if (field->flags & HID_MAIN_ITEM_CONSTANT) | ||
263 | goto ignore; | ||
264 | |||
265 | switch (usage->hid & HID_USAGE_PAGE) { | ||
266 | |||
267 | case HID_UP_UNDEFINED: | ||
268 | goto ignore; | ||
269 | |||
270 | case HID_UP_KEYBOARD: | ||
271 | |||
272 | set_bit(EV_REP, input->evbit); | ||
273 | |||
274 | if ((usage->hid & HID_USAGE) < 256) { | ||
275 | if (!hid_keyboard[usage->hid & HID_USAGE]) goto ignore; | ||
276 | map_key_clear(hid_keyboard[usage->hid & HID_USAGE]); | ||
277 | } else | ||
278 | map_key(KEY_UNKNOWN); | ||
279 | |||
280 | break; | ||
281 | |||
282 | case HID_UP_BUTTON: | ||
283 | |||
284 | code = ((usage->hid - 1) & 0xf); | ||
285 | |||
286 | switch (field->application) { | ||
287 | case HID_GD_MOUSE: | ||
288 | case HID_GD_POINTER: code += 0x110; break; | ||
289 | case HID_GD_JOYSTICK: code += 0x120; break; | ||
290 | case HID_GD_GAMEPAD: code += 0x130; break; | ||
291 | default: | ||
292 | switch (field->physical) { | ||
293 | case HID_GD_MOUSE: | ||
294 | case HID_GD_POINTER: code += 0x110; break; | ||
295 | case HID_GD_JOYSTICK: code += 0x120; break; | ||
296 | case HID_GD_GAMEPAD: code += 0x130; break; | ||
297 | default: code += 0x100; | ||
298 | } | ||
299 | } | ||
300 | |||
301 | map_key(code); | ||
302 | break; | ||
303 | |||
304 | |||
305 | case HID_UP_SIMULATION: | ||
306 | |||
307 | switch (usage->hid & 0xffff) { | ||
308 | case 0xba: map_abs(ABS_RUDDER); break; | ||
309 | case 0xbb: map_abs(ABS_THROTTLE); break; | ||
310 | case 0xc4: map_abs(ABS_GAS); break; | ||
311 | case 0xc5: map_abs(ABS_BRAKE); break; | ||
312 | case 0xc8: map_abs(ABS_WHEEL); break; | ||
313 | default: goto ignore; | ||
314 | } | ||
315 | break; | ||
316 | |||
317 | case HID_UP_GENDESK: | ||
318 | |||
319 | if ((usage->hid & 0xf0) == 0x80) { /* SystemControl */ | ||
320 | switch (usage->hid & 0xf) { | ||
321 | case 0x1: map_key_clear(KEY_POWER); break; | ||
322 | case 0x2: map_key_clear(KEY_SLEEP); break; | ||
323 | case 0x3: map_key_clear(KEY_WAKEUP); break; | ||
324 | default: goto unknown; | ||
325 | } | ||
326 | break; | ||
327 | } | ||
328 | |||
329 | if ((usage->hid & 0xf0) == 0x90) { /* D-pad */ | ||
330 | switch (usage->hid) { | ||
331 | case HID_GD_UP: usage->hat_dir = 1; break; | ||
332 | case HID_GD_DOWN: usage->hat_dir = 5; break; | ||
333 | case HID_GD_RIGHT: usage->hat_dir = 3; break; | ||
334 | case HID_GD_LEFT: usage->hat_dir = 7; break; | ||
335 | default: goto unknown; | ||
336 | } | ||
337 | if (field->dpad) { | ||
338 | map_abs(field->dpad); | ||
339 | goto ignore; | ||
340 | } | ||
341 | map_abs(ABS_HAT0X); | ||
342 | break; | ||
343 | } | ||
344 | |||
345 | switch (usage->hid) { | ||
346 | |||
347 | /* These usage IDs map directly to the usage codes. */ | ||
348 | case HID_GD_X: case HID_GD_Y: case HID_GD_Z: | ||
349 | case HID_GD_RX: case HID_GD_RY: case HID_GD_RZ: | ||
350 | case HID_GD_SLIDER: case HID_GD_DIAL: case HID_GD_WHEEL: | ||
351 | if (field->flags & HID_MAIN_ITEM_RELATIVE) | ||
352 | map_rel(usage->hid & 0xf); | ||
353 | else | ||
354 | map_abs(usage->hid & 0xf); | ||
355 | break; | ||
356 | |||
357 | case HID_GD_HATSWITCH: | ||
358 | usage->hat_min = field->logical_minimum; | ||
359 | usage->hat_max = field->logical_maximum; | ||
360 | map_abs(ABS_HAT0X); | ||
361 | break; | ||
362 | |||
363 | case HID_GD_START: map_key_clear(BTN_START); break; | ||
364 | case HID_GD_SELECT: map_key_clear(BTN_SELECT); break; | ||
365 | |||
366 | default: goto unknown; | ||
367 | } | ||
368 | |||
369 | break; | ||
370 | |||
371 | case HID_UP_LED: | ||
372 | if (((usage->hid - 1) & 0xffff) >= LED_MAX) | ||
373 | goto ignore; | ||
374 | map_led((usage->hid - 1) & 0xffff); | ||
375 | break; | ||
376 | |||
377 | case HID_UP_DIGITIZER: | ||
378 | |||
379 | switch (usage->hid & 0xff) { | ||
380 | |||
381 | case 0x30: /* TipPressure */ | ||
382 | if (!test_bit(BTN_TOUCH, input->keybit)) { | ||
383 | device->quirks |= HID_QUIRK_NOTOUCH; | ||
384 | set_bit(EV_KEY, input->evbit); | ||
385 | set_bit(BTN_TOUCH, input->keybit); | ||
386 | } | ||
387 | |||
388 | map_abs_clear(ABS_PRESSURE); | ||
389 | break; | ||
390 | |||
391 | case 0x32: /* InRange */ | ||
392 | switch (field->physical & 0xff) { | ||
393 | case 0x21: map_key(BTN_TOOL_MOUSE); break; | ||
394 | case 0x22: map_key(BTN_TOOL_FINGER); break; | ||
395 | default: map_key(BTN_TOOL_PEN); break; | ||
396 | } | ||
397 | break; | ||
398 | |||
399 | case 0x3c: /* Invert */ | ||
400 | map_key_clear(BTN_TOOL_RUBBER); | ||
401 | break; | ||
402 | |||
403 | case 0x33: /* Touch */ | ||
404 | case 0x42: /* TipSwitch */ | ||
405 | case 0x43: /* TipSwitch2 */ | ||
406 | device->quirks &= ~HID_QUIRK_NOTOUCH; | ||
407 | map_key_clear(BTN_TOUCH); | ||
408 | break; | ||
409 | |||
410 | case 0x44: /* BarrelSwitch */ | ||
411 | map_key_clear(BTN_STYLUS); | ||
412 | break; | ||
413 | |||
414 | default: goto unknown; | ||
415 | } | ||
416 | break; | ||
417 | |||
418 | case HID_UP_CONSUMER: /* USB HUT v1.1, pages 56-62 */ | ||
419 | |||
420 | switch (usage->hid & HID_USAGE) { | ||
421 | case 0x000: goto ignore; | ||
422 | case 0x034: map_key_clear(KEY_SLEEP); break; | ||
423 | case 0x036: map_key_clear(BTN_MISC); break; | ||
424 | case 0x045: map_key_clear(KEY_RADIO); break; | ||
425 | case 0x08a: map_key_clear(KEY_WWW); break; | ||
426 | case 0x08d: map_key_clear(KEY_PROGRAM); break; | ||
427 | case 0x095: map_key_clear(KEY_HELP); break; | ||
428 | case 0x09c: map_key_clear(KEY_CHANNELUP); break; | ||
429 | case 0x09d: map_key_clear(KEY_CHANNELDOWN); break; | ||
430 | case 0x0b0: map_key_clear(KEY_PLAY); break; | ||
431 | case 0x0b1: map_key_clear(KEY_PAUSE); break; | ||
432 | case 0x0b2: map_key_clear(KEY_RECORD); break; | ||
433 | case 0x0b3: map_key_clear(KEY_FASTFORWARD); break; | ||
434 | case 0x0b4: map_key_clear(KEY_REWIND); break; | ||
435 | case 0x0b5: map_key_clear(KEY_NEXTSONG); break; | ||
436 | case 0x0b6: map_key_clear(KEY_PREVIOUSSONG); break; | ||
437 | case 0x0b7: map_key_clear(KEY_STOPCD); break; | ||
438 | case 0x0b8: map_key_clear(KEY_EJECTCD); break; | ||
439 | case 0x0cd: map_key_clear(KEY_PLAYPAUSE); break; | ||
440 | case 0x0e0: map_abs_clear(ABS_VOLUME); break; | ||
441 | case 0x0e2: map_key_clear(KEY_MUTE); break; | ||
442 | case 0x0e5: map_key_clear(KEY_BASSBOOST); break; | ||
443 | case 0x0e9: map_key_clear(KEY_VOLUMEUP); break; | ||
444 | case 0x0ea: map_key_clear(KEY_VOLUMEDOWN); break; | ||
445 | case 0x183: map_key_clear(KEY_CONFIG); break; | ||
446 | case 0x18a: map_key_clear(KEY_MAIL); break; | ||
447 | case 0x192: map_key_clear(KEY_CALC); break; | ||
448 | case 0x194: map_key_clear(KEY_FILE); break; | ||
449 | case 0x1a7: map_key_clear(KEY_DOCUMENTS); break; | ||
450 | case 0x201: map_key_clear(KEY_NEW); break; | ||
451 | case 0x207: map_key_clear(KEY_SAVE); break; | ||
452 | case 0x208: map_key_clear(KEY_PRINT); break; | ||
453 | case 0x209: map_key_clear(KEY_PROPS); break; | ||
454 | case 0x21a: map_key_clear(KEY_UNDO); break; | ||
455 | case 0x21b: map_key_clear(KEY_COPY); break; | ||
456 | case 0x21c: map_key_clear(KEY_CUT); break; | ||
457 | case 0x21d: map_key_clear(KEY_PASTE); break; | ||
458 | case 0x221: map_key_clear(KEY_FIND); break; | ||
459 | case 0x223: map_key_clear(KEY_HOMEPAGE); break; | ||
460 | case 0x224: map_key_clear(KEY_BACK); break; | ||
461 | case 0x225: map_key_clear(KEY_FORWARD); break; | ||
462 | case 0x226: map_key_clear(KEY_STOP); break; | ||
463 | case 0x227: map_key_clear(KEY_REFRESH); break; | ||
464 | case 0x22a: map_key_clear(KEY_BOOKMARKS); break; | ||
465 | case 0x233: map_key_clear(KEY_SCROLLUP); break; | ||
466 | case 0x234: map_key_clear(KEY_SCROLLDOWN); break; | ||
467 | case 0x238: map_rel(REL_HWHEEL); break; | ||
468 | case 0x279: map_key_clear(KEY_REDO); break; | ||
469 | case 0x289: map_key_clear(KEY_REPLY); break; | ||
470 | case 0x28b: map_key_clear(KEY_FORWARDMAIL); break; | ||
471 | case 0x28c: map_key_clear(KEY_SEND); break; | ||
472 | |||
473 | /* Reported on a Cherry Cymotion keyboard */ | ||
474 | case 0x301: map_key_clear(KEY_PROG1); break; | ||
475 | case 0x302: map_key_clear(KEY_PROG2); break; | ||
476 | case 0x303: map_key_clear(KEY_PROG3); break; | ||
477 | |||
478 | default: goto ignore; | ||
479 | } | ||
480 | break; | ||
481 | |||
482 | case HID_UP_HPVENDOR: /* Reported on a Dutch layout HP5308 */ | ||
483 | |||
484 | set_bit(EV_REP, input->evbit); | ||
485 | switch (usage->hid & HID_USAGE) { | ||
486 | case 0x021: map_key_clear(KEY_PRINT); break; | ||
487 | case 0x070: map_key_clear(KEY_HP); break; | ||
488 | case 0x071: map_key_clear(KEY_CAMERA); break; | ||
489 | case 0x072: map_key_clear(KEY_SOUND); break; | ||
490 | case 0x073: map_key_clear(KEY_QUESTION); break; | ||
491 | case 0x080: map_key_clear(KEY_EMAIL); break; | ||
492 | case 0x081: map_key_clear(KEY_CHAT); break; | ||
493 | case 0x082: map_key_clear(KEY_SEARCH); break; | ||
494 | case 0x083: map_key_clear(KEY_CONNECT); break; | ||
495 | case 0x084: map_key_clear(KEY_FINANCE); break; | ||
496 | case 0x085: map_key_clear(KEY_SPORT); break; | ||
497 | case 0x086: map_key_clear(KEY_SHOP); break; | ||
498 | default: goto ignore; | ||
499 | } | ||
500 | break; | ||
501 | |||
502 | case HID_UP_MSVENDOR: | ||
503 | goto ignore; | ||
504 | |||
505 | case HID_UP_CUSTOM: /* Reported on Logitech and Powerbook USB keyboards */ | ||
506 | |||
507 | set_bit(EV_REP, input->evbit); | ||
508 | switch(usage->hid & HID_USAGE) { | ||
509 | case 0x003: | ||
510 | /* The fn key on Apple PowerBooks */ | ||
511 | map_key_clear(KEY_FN); | ||
512 | hidinput_pb_setup(input); | ||
513 | break; | ||
514 | |||
515 | default: goto ignore; | ||
516 | } | ||
517 | break; | ||
518 | |||
519 | case HID_UP_LOGIVENDOR: /* Reported on Logitech Ultra X Media Remote */ | ||
520 | |||
521 | set_bit(EV_REP, input->evbit); | ||
522 | switch(usage->hid & HID_USAGE) { | ||
523 | case 0x004: map_key_clear(KEY_AGAIN); break; | ||
524 | case 0x00d: map_key_clear(KEY_HOME); break; | ||
525 | case 0x024: map_key_clear(KEY_SHUFFLE); break; | ||
526 | case 0x025: map_key_clear(KEY_TV); break; | ||
527 | case 0x026: map_key_clear(KEY_MENU); break; | ||
528 | case 0x031: map_key_clear(KEY_AUDIO); break; | ||
529 | case 0x032: map_key_clear(KEY_TEXT); break; | ||
530 | case 0x033: map_key_clear(KEY_LAST); break; | ||
531 | case 0x047: map_key_clear(KEY_MP3); break; | ||
532 | case 0x048: map_key_clear(KEY_DVD); break; | ||
533 | case 0x049: map_key_clear(KEY_MEDIA); break; | ||
534 | case 0x04a: map_key_clear(KEY_VIDEO); break; | ||
535 | case 0x04b: map_key_clear(KEY_ANGLE); break; | ||
536 | case 0x04c: map_key_clear(KEY_LANGUAGE); break; | ||
537 | case 0x04d: map_key_clear(KEY_SUBTITLE); break; | ||
538 | case 0x051: map_key_clear(KEY_RED); break; | ||
539 | case 0x052: map_key_clear(KEY_CLOSE); break; | ||
540 | default: goto ignore; | ||
541 | } | ||
542 | break; | ||
543 | |||
544 | case HID_UP_PID: | ||
545 | |||
546 | switch(usage->hid & HID_USAGE) { | ||
547 | case 0xa4: map_key_clear(BTN_DEAD); break; | ||
548 | default: goto ignore; | ||
549 | } | ||
550 | break; | ||
551 | |||
552 | default: | ||
553 | unknown: | ||
554 | if (field->report_size == 1) { | ||
555 | if (field->report->type == HID_OUTPUT_REPORT) { | ||
556 | map_led(LED_MISC); | ||
557 | break; | ||
558 | } | ||
559 | map_key(BTN_MISC); | ||
560 | break; | ||
561 | } | ||
562 | if (field->flags & HID_MAIN_ITEM_RELATIVE) { | ||
563 | map_rel(REL_MISC); | ||
564 | break; | ||
565 | } | ||
566 | map_abs(ABS_MISC); | ||
567 | break; | ||
568 | } | ||
569 | |||
570 | if (device->quirks & HID_QUIRK_MIGHTYMOUSE) { | ||
571 | if (usage->hid == HID_GD_Z) | ||
572 | map_rel(REL_HWHEEL); | ||
573 | else if (usage->code == BTN_1) | ||
574 | map_key(BTN_2); | ||
575 | else if (usage->code == BTN_2) | ||
576 | map_key(BTN_1); | ||
577 | } | ||
578 | |||
579 | if ((device->quirks & (HID_QUIRK_2WHEEL_MOUSE_HACK_7 | HID_QUIRK_2WHEEL_MOUSE_HACK_5)) && | ||
580 | (usage->type == EV_REL) && (usage->code == REL_WHEEL)) | ||
581 | set_bit(REL_HWHEEL, bit); | ||
582 | |||
583 | if (((device->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_5) && (usage->hid == 0x00090005)) | ||
584 | || ((device->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_7) && (usage->hid == 0x00090007))) | ||
585 | goto ignore; | ||
586 | |||
587 | if ((device->quirks & HID_QUIRK_BAD_RELATIVE_KEYS) && | ||
588 | usage->type == EV_KEY && (field->flags & HID_MAIN_ITEM_RELATIVE)) | ||
589 | field->flags &= ~HID_MAIN_ITEM_RELATIVE; | ||
590 | |||
591 | set_bit(usage->type, input->evbit); | ||
592 | |||
593 | while (usage->code <= max && test_and_set_bit(usage->code, bit)) | ||
594 | usage->code = find_next_zero_bit(bit, max + 1, usage->code); | ||
595 | |||
596 | if (usage->code > max) | ||
597 | goto ignore; | ||
598 | |||
599 | |||
600 | if (usage->type == EV_ABS) { | ||
601 | |||
602 | int a = field->logical_minimum; | ||
603 | int b = field->logical_maximum; | ||
604 | |||
605 | if ((device->quirks & HID_QUIRK_BADPAD) && (usage->code == ABS_X || usage->code == ABS_Y)) { | ||
606 | a = field->logical_minimum = 0; | ||
607 | b = field->logical_maximum = 255; | ||
608 | } | ||
609 | |||
610 | if (field->application == HID_GD_GAMEPAD || field->application == HID_GD_JOYSTICK) | ||
611 | input_set_abs_params(input, usage->code, a, b, (b - a) >> 8, (b - a) >> 4); | ||
612 | else input_set_abs_params(input, usage->code, a, b, 0, 0); | ||
613 | |||
614 | } | ||
615 | |||
616 | if (usage->type == EV_ABS && | ||
617 | (usage->hat_min < usage->hat_max || usage->hat_dir)) { | ||
618 | int i; | ||
619 | for (i = usage->code; i < usage->code + 2 && i <= max; i++) { | ||
620 | input_set_abs_params(input, i, -1, 1, 0, 0); | ||
621 | set_bit(i, input->absbit); | ||
622 | } | ||
623 | if (usage->hat_dir && !field->dpad) | ||
624 | field->dpad = usage->code; | ||
625 | } | ||
626 | |||
627 | #ifdef DEBUG | ||
628 | resolv_event(usage->type, usage->code); | ||
629 | printk("\n"); | ||
630 | #endif | ||
631 | return; | ||
632 | |||
633 | ignore: | ||
634 | #ifdef DEBUG | ||
635 | printk("IGNORED\n"); | ||
636 | #endif | ||
637 | return; | ||
638 | } | ||
639 | |||
640 | void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value) | ||
641 | { | ||
642 | struct input_dev *input; | ||
643 | int *quirks = &hid->quirks; | ||
644 | |||
645 | if (!field->hidinput) | ||
646 | return; | ||
647 | |||
648 | input = field->hidinput->input; | ||
649 | |||
650 | if (!usage->type) | ||
651 | return; | ||
652 | |||
653 | if (((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_5) && (usage->hid == 0x00090005)) | ||
654 | || ((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_7) && (usage->hid == 0x00090007))) { | ||
655 | if (value) hid->quirks |= HID_QUIRK_2WHEEL_MOUSE_HACK_ON; | ||
656 | else hid->quirks &= ~HID_QUIRK_2WHEEL_MOUSE_HACK_ON; | ||
657 | return; | ||
658 | } | ||
659 | |||
660 | if ((hid->quirks & HID_QUIRK_INVERT_HWHEEL) && (usage->code == REL_HWHEEL)) { | ||
661 | input_event(input, usage->type, usage->code, -value); | ||
662 | return; | ||
663 | } | ||
664 | |||
665 | if ((hid->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_ON) && (usage->code == REL_WHEEL)) { | ||
666 | input_event(input, usage->type, REL_HWHEEL, value); | ||
667 | return; | ||
668 | } | ||
669 | |||
670 | if ((hid->quirks & HID_QUIRK_POWERBOOK_HAS_FN) && hidinput_pb_event(hid, input, usage, value)) | ||
671 | return; | ||
672 | |||
673 | if (usage->hat_min < usage->hat_max || usage->hat_dir) { | ||
674 | int hat_dir = usage->hat_dir; | ||
675 | if (!hat_dir) | ||
676 | hat_dir = (value - usage->hat_min) * 8 / (usage->hat_max - usage->hat_min + 1) + 1; | ||
677 | if (hat_dir < 0 || hat_dir > 8) hat_dir = 0; | ||
678 | input_event(input, usage->type, usage->code , hid_hat_to_axis[hat_dir].x); | ||
679 | input_event(input, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y); | ||
680 | return; | ||
681 | } | ||
682 | |||
683 | if (usage->hid == (HID_UP_DIGITIZER | 0x003c)) { /* Invert */ | ||
684 | *quirks = value ? (*quirks | HID_QUIRK_INVERT) : (*quirks & ~HID_QUIRK_INVERT); | ||
685 | return; | ||
686 | } | ||
687 | |||
688 | if (usage->hid == (HID_UP_DIGITIZER | 0x0032)) { /* InRange */ | ||
689 | if (value) { | ||
690 | input_event(input, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1); | ||
691 | return; | ||
692 | } | ||
693 | input_event(input, usage->type, usage->code, 0); | ||
694 | input_event(input, usage->type, BTN_TOOL_RUBBER, 0); | ||
695 | return; | ||
696 | } | ||
697 | |||
698 | if (usage->hid == (HID_UP_DIGITIZER | 0x0030) && (*quirks & HID_QUIRK_NOTOUCH)) { /* Pressure */ | ||
699 | int a = field->logical_minimum; | ||
700 | int b = field->logical_maximum; | ||
701 | input_event(input, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3)); | ||
702 | } | ||
703 | |||
704 | if (usage->hid == (HID_UP_PID | 0x83UL)) { /* Simultaneous Effects Max */ | ||
705 | dbg("Maximum Effects - %d",value); | ||
706 | return; | ||
707 | } | ||
708 | |||
709 | if (usage->hid == (HID_UP_PID | 0x7fUL)) { | ||
710 | dbg("PID Pool Report\n"); | ||
711 | return; | ||
712 | } | ||
713 | |||
714 | if ((usage->type == EV_KEY) && (usage->code == 0)) /* Key 0 is "unassigned", not KEY_UNKNOWN */ | ||
715 | return; | ||
716 | |||
717 | input_event(input, usage->type, usage->code, value); | ||
718 | |||
719 | if ((field->flags & HID_MAIN_ITEM_RELATIVE) && (usage->type == EV_KEY)) | ||
720 | input_event(input, usage->type, usage->code, 0); | ||
721 | } | ||
722 | |||
723 | void hidinput_report_event(struct hid_device *hid, struct hid_report *report) | ||
724 | { | ||
725 | struct hid_input *hidinput; | ||
726 | |||
727 | list_for_each_entry(hidinput, &hid->inputs, list) | ||
728 | input_sync(hidinput->input); | ||
729 | } | ||
730 | |||
731 | static int hidinput_find_field(struct hid_device *hid, unsigned int type, unsigned int code, struct hid_field **field) | ||
732 | { | ||
733 | struct hid_report *report; | ||
734 | int i, j; | ||
735 | |||
736 | list_for_each_entry(report, &hid->report_enum[HID_OUTPUT_REPORT].report_list, list) { | ||
737 | for (i = 0; i < report->maxfield; i++) { | ||
738 | *field = report->field[i]; | ||
739 | for (j = 0; j < (*field)->maxusage; j++) | ||
740 | if ((*field)->usage[j].type == type && (*field)->usage[j].code == code) | ||
741 | return j; | ||
742 | } | ||
743 | } | ||
744 | return -1; | ||
745 | } | ||
746 | |||
747 | /* | ||
748 | * Register the input device; print a message. | ||
749 | * Configure the input layer interface | ||
750 | * Read all reports and initialize the absolute field values. | ||
751 | */ | ||
752 | |||
753 | int hidinput_connect(struct hid_device *hid) | ||
754 | { | ||
755 | struct usb_device *dev = hid->dev; | ||
756 | struct hid_report *report; | ||
757 | struct hid_input *hidinput = NULL; | ||
758 | struct input_dev *input_dev; | ||
759 | int i, j, k; | ||
760 | |||
761 | INIT_LIST_HEAD(&hid->inputs); | ||
762 | |||
763 | for (i = 0; i < hid->maxcollection; i++) | ||
764 | if (hid->collection[i].type == HID_COLLECTION_APPLICATION || | ||
765 | hid->collection[i].type == HID_COLLECTION_PHYSICAL) | ||
766 | if (IS_INPUT_APPLICATION(hid->collection[i].usage)) | ||
767 | break; | ||
768 | |||
769 | if (i == hid->maxcollection) | ||
770 | return -1; | ||
771 | |||
772 | for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) | ||
773 | list_for_each_entry(report, &hid->report_enum[k].report_list, list) { | ||
774 | |||
775 | if (!report->maxfield) | ||
776 | continue; | ||
777 | |||
778 | if (!hidinput) { | ||
779 | hidinput = kzalloc(sizeof(*hidinput), GFP_KERNEL); | ||
780 | input_dev = input_allocate_device(); | ||
781 | if (!hidinput || !input_dev) { | ||
782 | kfree(hidinput); | ||
783 | input_free_device(input_dev); | ||
784 | err("Out of memory during hid input probe"); | ||
785 | return -1; | ||
786 | } | ||
787 | |||
788 | input_dev->private = hid; | ||
789 | input_dev->event = hidinput_input_event; | ||
790 | input_dev->open = hidinput_open; | ||
791 | input_dev->close = hidinput_close; | ||
792 | |||
793 | input_dev->name = hid->name; | ||
794 | input_dev->phys = hid->phys; | ||
795 | input_dev->uniq = hid->uniq; | ||
796 | usb_to_input_id(dev, &input_dev->id); | ||
797 | input_dev->cdev.dev = &hid->intf->dev; | ||
798 | |||
799 | hidinput->input = input_dev; | ||
800 | list_add_tail(&hidinput->list, &hid->inputs); | ||
801 | } | ||
802 | |||
803 | for (i = 0; i < report->maxfield; i++) | ||
804 | for (j = 0; j < report->field[i]->maxusage; j++) | ||
805 | hidinput_configure_usage(hidinput, report->field[i], | ||
806 | report->field[i]->usage + j); | ||
807 | |||
808 | if (hid->quirks & HID_QUIRK_MULTI_INPUT) { | ||
809 | /* This will leave hidinput NULL, so that it | ||
810 | * allocates another one if we have more inputs on | ||
811 | * the same interface. Some devices (e.g. Happ's | ||
812 | * UGCI) cram a lot of unrelated inputs into the | ||
813 | * same interface. */ | ||
814 | hidinput->report = report; | ||
815 | input_register_device(hidinput->input); | ||
816 | hidinput = NULL; | ||
817 | } | ||
818 | } | ||
819 | |||
820 | /* This only gets called when we are a single-input (most of the | ||
821 | * time). IOW, not a HID_QUIRK_MULTI_INPUT. The hid_ff_init() is | ||
822 | * only useful in this case, and not for multi-input quirks. */ | ||
823 | if (hidinput) { | ||
824 | hid_ff_init(hid); | ||
825 | input_register_device(hidinput->input); | ||
826 | } | ||
827 | |||
828 | return 0; | ||
829 | } | ||
830 | |||
831 | void hidinput_disconnect(struct hid_device *hid) | ||
832 | { | ||
833 | struct hid_input *hidinput, *next; | ||
834 | |||
835 | list_for_each_entry_safe(hidinput, next, &hid->inputs, list) { | ||
836 | list_del(&hidinput->list); | ||
837 | input_unregister_device(hidinput->input); | ||
838 | kfree(hidinput); | ||
839 | } | ||
840 | } | ||