x86: Disable generation of traditional x87 instructions
[cascardo/linux.git] / drivers / hid / hid-input.c
1 /*
2  *  Copyright (c) 2000-2001 Vojtech Pavlik
3  *  Copyright (c) 2006-2010 Jiri Kosina
4  *
5  *  HID to Linux Input mapping
6  */
7
8 /*
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License as published by
11  * the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program is distributed in the hope that it will be useful,
15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
22  *
23  * Should you need to contact me, the author, you can do so either by
24  * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
25  * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
26  */
27
28 #include <linux/module.h>
29 #include <linux/slab.h>
30 #include <linux/kernel.h>
31
32 #include <linux/hid.h>
33 #include <linux/hid-debug.h>
34
35 #include "hid-ids.h"
36
37 #define unk     KEY_UNKNOWN
38
39 static const unsigned char hid_keyboard[256] = {
40           0,  0,  0,  0, 30, 48, 46, 32, 18, 33, 34, 35, 23, 36, 37, 38,
41          50, 49, 24, 25, 16, 19, 31, 20, 22, 47, 17, 45, 21, 44,  2,  3,
42           4,  5,  6,  7,  8,  9, 10, 11, 28,  1, 14, 15, 57, 12, 13, 26,
43          27, 43, 43, 39, 40, 41, 51, 52, 53, 58, 59, 60, 61, 62, 63, 64,
44          65, 66, 67, 68, 87, 88, 99, 70,119,110,102,104,111,107,109,106,
45         105,108,103, 69, 98, 55, 74, 78, 96, 79, 80, 81, 75, 76, 77, 71,
46          72, 73, 82, 83, 86,127,116,117,183,184,185,186,187,188,189,190,
47         191,192,193,194,134,138,130,132,128,129,131,137,133,135,136,113,
48         115,114,unk,unk,unk,121,unk, 89, 93,124, 92, 94, 95,unk,unk,unk,
49         122,123, 90, 91, 85,unk,unk,unk,unk,unk,unk,unk,111,unk,unk,unk,
50         unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,
51         unk,unk,unk,unk,unk,unk,179,180,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,111,unk,unk,unk,unk,unk,unk,unk,
54          29, 42, 56,125, 97, 54,100,126,164,166,165,163,161,115,114,113,
55         150,158,159,128,136,177,178,176,142,152,173,140,unk,unk,unk,unk
56 };
57
58 static const struct {
59         __s32 x;
60         __s32 y;
61 }  hid_hat_to_axis[] = {{ 0, 0}, { 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}};
62
63 #define map_abs(c)      hid_map_usage(hidinput, usage, &bit, &max, EV_ABS, (c))
64 #define map_rel(c)      hid_map_usage(hidinput, usage, &bit, &max, EV_REL, (c))
65 #define map_key(c)      hid_map_usage(hidinput, usage, &bit, &max, EV_KEY, (c))
66 #define map_led(c)      hid_map_usage(hidinput, usage, &bit, &max, EV_LED, (c))
67
68 #define map_abs_clear(c)        hid_map_usage_clear(hidinput, usage, &bit, \
69                 &max, EV_ABS, (c))
70 #define map_key_clear(c)        hid_map_usage_clear(hidinput, usage, &bit, \
71                 &max, EV_KEY, (c))
72
73 static bool match_scancode(struct hid_usage *usage,
74                            unsigned int cur_idx, unsigned int scancode)
75 {
76         return (usage->hid & (HID_USAGE_PAGE | HID_USAGE)) == scancode;
77 }
78
79 static bool match_keycode(struct hid_usage *usage,
80                           unsigned int cur_idx, unsigned int keycode)
81 {
82         /*
83          * We should exclude unmapped usages when doing lookup by keycode.
84          */
85         return (usage->type == EV_KEY && usage->code == keycode);
86 }
87
88 static bool match_index(struct hid_usage *usage,
89                         unsigned int cur_idx, unsigned int idx)
90 {
91         return cur_idx == idx;
92 }
93
94 typedef bool (*hid_usage_cmp_t)(struct hid_usage *usage,
95                                 unsigned int cur_idx, unsigned int val);
96
97 static struct hid_usage *hidinput_find_key(struct hid_device *hid,
98                                            hid_usage_cmp_t match,
99                                            unsigned int value,
100                                            unsigned int *usage_idx)
101 {
102         unsigned int i, j, k, cur_idx = 0;
103         struct hid_report *report;
104         struct hid_usage *usage;
105
106         for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) {
107                 list_for_each_entry(report, &hid->report_enum[k].report_list, list) {
108                         for (i = 0; i < report->maxfield; i++) {
109                                 for (j = 0; j < report->field[i]->maxusage; j++) {
110                                         usage = report->field[i]->usage + j;
111                                         if (usage->type == EV_KEY || usage->type == 0) {
112                                                 if (match(usage, cur_idx, value)) {
113                                                         if (usage_idx)
114                                                                 *usage_idx = cur_idx;
115                                                         return usage;
116                                                 }
117                                                 cur_idx++;
118                                         }
119                                 }
120                         }
121                 }
122         }
123         return NULL;
124 }
125
126 static struct hid_usage *hidinput_locate_usage(struct hid_device *hid,
127                                         const struct input_keymap_entry *ke,
128                                         unsigned int *index)
129 {
130         struct hid_usage *usage;
131         unsigned int scancode;
132
133         if (ke->flags & INPUT_KEYMAP_BY_INDEX)
134                 usage = hidinput_find_key(hid, match_index, ke->index, index);
135         else if (input_scancode_to_scalar(ke, &scancode) == 0)
136                 usage = hidinput_find_key(hid, match_scancode, scancode, index);
137         else
138                 usage = NULL;
139
140         return usage;
141 }
142
143 static int hidinput_getkeycode(struct input_dev *dev,
144                                struct input_keymap_entry *ke)
145 {
146         struct hid_device *hid = input_get_drvdata(dev);
147         struct hid_usage *usage;
148         unsigned int scancode, index;
149
150         usage = hidinput_locate_usage(hid, ke, &index);
151         if (usage) {
152                 ke->keycode = usage->type == EV_KEY ?
153                                 usage->code : KEY_RESERVED;
154                 ke->index = index;
155                 scancode = usage->hid & (HID_USAGE_PAGE | HID_USAGE);
156                 ke->len = sizeof(scancode);
157                 memcpy(ke->scancode, &scancode, sizeof(scancode));
158                 return 0;
159         }
160
161         return -EINVAL;
162 }
163
164 static int hidinput_setkeycode(struct input_dev *dev,
165                                const struct input_keymap_entry *ke,
166                                unsigned int *old_keycode)
167 {
168         struct hid_device *hid = input_get_drvdata(dev);
169         struct hid_usage *usage;
170
171         usage = hidinput_locate_usage(hid, ke, NULL);
172         if (usage) {
173                 *old_keycode = usage->type == EV_KEY ?
174                                 usage->code : KEY_RESERVED;
175                 usage->code = ke->keycode;
176
177                 clear_bit(*old_keycode, dev->keybit);
178                 set_bit(usage->code, dev->keybit);
179                 dbg_hid("Assigned keycode %d to HID usage code %x\n",
180                         usage->code, usage->hid);
181
182                 /*
183                  * Set the keybit for the old keycode if the old keycode is used
184                  * by another key
185                  */
186                 if (hidinput_find_key(hid, match_keycode, *old_keycode, NULL))
187                         set_bit(*old_keycode, dev->keybit);
188
189                 return 0;
190         }
191
192         return -EINVAL;
193 }
194
195
196 /**
197  * hidinput_calc_abs_res - calculate an absolute axis resolution
198  * @field: the HID report field to calculate resolution for
199  * @code: axis code
200  *
201  * The formula is:
202  *                         (logical_maximum - logical_minimum)
203  * resolution = ----------------------------------------------------------
204  *              (physical_maximum - physical_minimum) * 10 ^ unit_exponent
205  *
206  * as seen in the HID specification v1.11 6.2.2.7 Global Items.
207  *
208  * Only exponent 1 length units are processed. Centimeters and inches are
209  * converted to millimeters. Degrees are converted to radians.
210  */
211 __s32 hidinput_calc_abs_res(const struct hid_field *field, __u16 code)
212 {
213         __s32 unit_exponent = field->unit_exponent;
214         __s32 logical_extents = field->logical_maximum -
215                                         field->logical_minimum;
216         __s32 physical_extents = field->physical_maximum -
217                                         field->physical_minimum;
218         __s32 prev;
219
220         /* Check if the extents are sane */
221         if (logical_extents <= 0 || physical_extents <= 0)
222                 return 0;
223
224         /*
225          * Verify and convert units.
226          * See HID specification v1.11 6.2.2.7 Global Items for unit decoding
227          */
228         switch (code) {
229         case ABS_X:
230         case ABS_Y:
231         case ABS_Z:
232         case ABS_MT_POSITION_X:
233         case ABS_MT_POSITION_Y:
234         case ABS_MT_TOOL_X:
235         case ABS_MT_TOOL_Y:
236         case ABS_MT_TOUCH_MAJOR:
237         case ABS_MT_TOUCH_MINOR:
238                 if (field->unit == 0x11) {              /* If centimeters */
239                         /* Convert to millimeters */
240                         unit_exponent += 1;
241                 } else if (field->unit == 0x13) {       /* If inches */
242                         /* Convert to millimeters */
243                         prev = physical_extents;
244                         physical_extents *= 254;
245                         if (physical_extents < prev)
246                                 return 0;
247                         unit_exponent -= 1;
248                 } else {
249                         return 0;
250                 }
251                 break;
252
253         case ABS_RX:
254         case ABS_RY:
255         case ABS_RZ:
256         case ABS_TILT_X:
257         case ABS_TILT_Y:
258                 if (field->unit == 0x14) {              /* If degrees */
259                         /* Convert to radians */
260                         prev = logical_extents;
261                         logical_extents *= 573;
262                         if (logical_extents < prev)
263                                 return 0;
264                         unit_exponent += 1;
265                 } else if (field->unit != 0x12) {       /* If not radians */
266                         return 0;
267                 }
268                 break;
269
270         default:
271                 return 0;
272         }
273
274         /* Apply negative unit exponent */
275         for (; unit_exponent < 0; unit_exponent++) {
276                 prev = logical_extents;
277                 logical_extents *= 10;
278                 if (logical_extents < prev)
279                         return 0;
280         }
281         /* Apply positive unit exponent */
282         for (; unit_exponent > 0; unit_exponent--) {
283                 prev = physical_extents;
284                 physical_extents *= 10;
285                 if (physical_extents < prev)
286                         return 0;
287         }
288
289         /* Calculate resolution */
290         return DIV_ROUND_CLOSEST(logical_extents, physical_extents);
291 }
292 EXPORT_SYMBOL_GPL(hidinput_calc_abs_res);
293
294 #ifdef CONFIG_HID_BATTERY_STRENGTH
295 static enum power_supply_property hidinput_battery_props[] = {
296         POWER_SUPPLY_PROP_PRESENT,
297         POWER_SUPPLY_PROP_ONLINE,
298         POWER_SUPPLY_PROP_CAPACITY,
299         POWER_SUPPLY_PROP_MODEL_NAME,
300         POWER_SUPPLY_PROP_STATUS,
301         POWER_SUPPLY_PROP_SCOPE,
302 };
303
304 #define HID_BATTERY_QUIRK_PERCENT       (1 << 0) /* always reports percent */
305 #define HID_BATTERY_QUIRK_FEATURE       (1 << 1) /* ask for feature report */
306
307 static const struct hid_device_id hid_battery_quirks[] = {
308         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
309                         USB_DEVICE_ID_APPLE_ALU_WIRELESS_2009_ISO),
310         HID_BATTERY_QUIRK_PERCENT | HID_BATTERY_QUIRK_FEATURE },
311         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
312                                USB_DEVICE_ID_APPLE_ALU_WIRELESS_2011_ANSI),
313           HID_BATTERY_QUIRK_PERCENT | HID_BATTERY_QUIRK_FEATURE },
314         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
315                 USB_DEVICE_ID_APPLE_ALU_WIRELESS_ANSI),
316           HID_BATTERY_QUIRK_PERCENT | HID_BATTERY_QUIRK_FEATURE },
317         {}
318 };
319
320 static unsigned find_battery_quirk(struct hid_device *hdev)
321 {
322         unsigned quirks = 0;
323         const struct hid_device_id *match;
324
325         match = hid_match_id(hdev, hid_battery_quirks);
326         if (match != NULL)
327                 quirks = match->driver_data;
328
329         return quirks;
330 }
331
332 static int hidinput_get_battery_property(struct power_supply *psy,
333                                          enum power_supply_property prop,
334                                          union power_supply_propval *val)
335 {
336         struct hid_device *dev = container_of(psy, struct hid_device, battery);
337         int ret = 0;
338         __u8 *buf;
339
340         switch (prop) {
341         case POWER_SUPPLY_PROP_PRESENT:
342         case POWER_SUPPLY_PROP_ONLINE:
343                 val->intval = 1;
344                 break;
345
346         case POWER_SUPPLY_PROP_CAPACITY:
347
348                 buf = kmalloc(2 * sizeof(__u8), GFP_KERNEL);
349                 if (!buf) {
350                         ret = -ENOMEM;
351                         break;
352                 }
353                 ret = dev->hid_get_raw_report(dev, dev->battery_report_id,
354                                               buf, 2,
355                                               dev->battery_report_type);
356
357                 if (ret != 2) {
358                         ret = -ENODATA;
359                         kfree(buf);
360                         break;
361                 }
362                 ret = 0;
363
364                 if (dev->battery_min < dev->battery_max &&
365                     buf[1] >= dev->battery_min &&
366                     buf[1] <= dev->battery_max)
367                         val->intval = (100 * (buf[1] - dev->battery_min)) /
368                                 (dev->battery_max - dev->battery_min);
369                 kfree(buf);
370                 break;
371
372         case POWER_SUPPLY_PROP_MODEL_NAME:
373                 val->strval = dev->name;
374                 break;
375
376         case POWER_SUPPLY_PROP_STATUS:
377                 val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
378                 break;
379
380         case POWER_SUPPLY_PROP_SCOPE:
381                 val->intval = POWER_SUPPLY_SCOPE_DEVICE;
382                 break;
383
384         default:
385                 ret = -EINVAL;
386                 break;
387         }
388
389         return ret;
390 }
391
392 static bool hidinput_setup_battery(struct hid_device *dev, unsigned report_type, struct hid_field *field)
393 {
394         struct power_supply *battery = &dev->battery;
395         int ret;
396         unsigned quirks;
397         s32 min, max;
398
399         if (field->usage->hid != HID_DC_BATTERYSTRENGTH)
400                 return false;   /* no match */
401
402         if (battery->name != NULL)
403                 goto out;       /* already initialized? */
404
405         battery->name = kasprintf(GFP_KERNEL, "hid-%s-battery", dev->uniq);
406         if (battery->name == NULL)
407                 goto out;
408
409         battery->type = POWER_SUPPLY_TYPE_BATTERY;
410         battery->properties = hidinput_battery_props;
411         battery->num_properties = ARRAY_SIZE(hidinput_battery_props);
412         battery->use_for_apm = 0;
413         battery->get_property = hidinput_get_battery_property;
414
415         quirks = find_battery_quirk(dev);
416
417         hid_dbg(dev, "device %x:%x:%x %d quirks %d\n",
418                 dev->bus, dev->vendor, dev->product, dev->version, quirks);
419
420         min = field->logical_minimum;
421         max = field->logical_maximum;
422
423         if (quirks & HID_BATTERY_QUIRK_PERCENT) {
424                 min = 0;
425                 max = 100;
426         }
427
428         if (quirks & HID_BATTERY_QUIRK_FEATURE)
429                 report_type = HID_FEATURE_REPORT;
430
431         dev->battery_min = min;
432         dev->battery_max = max;
433         dev->battery_report_type = report_type;
434         dev->battery_report_id = field->report->id;
435
436         ret = power_supply_register(&dev->dev, battery);
437         if (ret != 0) {
438                 hid_warn(dev, "can't register power supply: %d\n", ret);
439                 kfree(battery->name);
440                 battery->name = NULL;
441         }
442
443         power_supply_powers(battery, &dev->dev);
444
445 out:
446         return true;
447 }
448
449 static void hidinput_cleanup_battery(struct hid_device *dev)
450 {
451         if (!dev->battery.name)
452                 return;
453
454         power_supply_unregister(&dev->battery);
455         kfree(dev->battery.name);
456         dev->battery.name = NULL;
457 }
458 #else  /* !CONFIG_HID_BATTERY_STRENGTH */
459 static bool hidinput_setup_battery(struct hid_device *dev, unsigned report_type,
460                                    struct hid_field *field)
461 {
462         return false;
463 }
464
465 static void hidinput_cleanup_battery(struct hid_device *dev)
466 {
467 }
468 #endif  /* CONFIG_HID_BATTERY_STRENGTH */
469
470 static void hidinput_configure_usage(struct hid_input *hidinput, struct hid_field *field,
471                                      struct hid_usage *usage)
472 {
473         struct input_dev *input = hidinput->input;
474         struct hid_device *device = input_get_drvdata(input);
475         int max = 0, code;
476         unsigned long *bit = NULL;
477
478         field->hidinput = hidinput;
479
480         if (field->flags & HID_MAIN_ITEM_CONSTANT)
481                 goto ignore;
482
483         /* Ignore if report count is out of bounds. */
484         if (field->report_count < 1)
485                 goto ignore;
486
487         /* only LED usages are supported in output fields */
488         if (field->report_type == HID_OUTPUT_REPORT &&
489                         (usage->hid & HID_USAGE_PAGE) != HID_UP_LED) {
490                 goto ignore;
491         }
492
493         if (device->driver->input_mapping) {
494                 int ret = device->driver->input_mapping(device, hidinput, field,
495                                 usage, &bit, &max);
496                 if (ret > 0)
497                         goto mapped;
498                 if (ret < 0)
499                         goto ignore;
500         }
501
502         switch (usage->hid & HID_USAGE_PAGE) {
503         case HID_UP_UNDEFINED:
504                 goto ignore;
505
506         case HID_UP_KEYBOARD:
507                 set_bit(EV_REP, input->evbit);
508
509                 if ((usage->hid & HID_USAGE) < 256) {
510                         if (!hid_keyboard[usage->hid & HID_USAGE]) goto ignore;
511                         map_key_clear(hid_keyboard[usage->hid & HID_USAGE]);
512                 } else
513                         map_key(KEY_UNKNOWN);
514
515                 break;
516
517         case HID_UP_BUTTON:
518                 code = ((usage->hid - 1) & HID_USAGE);
519
520                 switch (field->application) {
521                 case HID_GD_MOUSE:
522                 case HID_GD_POINTER:  code += BTN_MOUSE; break;
523                 case HID_GD_JOYSTICK:
524                                 if (code <= 0xf)
525                                         code += BTN_JOYSTICK;
526                                 else
527                                         code += BTN_TRIGGER_HAPPY - 0x10;
528                                 break;
529                 case HID_GD_GAMEPAD:
530                                 if (code <= 0xf)
531                                         code += BTN_GAMEPAD;
532                                 else
533                                         code += BTN_TRIGGER_HAPPY - 0x10;
534                                 break;
535                 default:
536                         switch (field->physical) {
537                         case HID_GD_MOUSE:
538                         case HID_GD_POINTER:  code += BTN_MOUSE; break;
539                         case HID_GD_JOYSTICK: code += BTN_JOYSTICK; break;
540                         case HID_GD_GAMEPAD:  code += BTN_GAMEPAD; break;
541                         default:              code += BTN_MISC;
542                         }
543                 }
544
545                 map_key(code);
546                 break;
547
548         case HID_UP_SIMULATION:
549                 switch (usage->hid & 0xffff) {
550                 case 0xba: map_abs(ABS_RUDDER);   break;
551                 case 0xbb: map_abs(ABS_THROTTLE); break;
552                 case 0xc4: map_abs(ABS_GAS);      break;
553                 case 0xc5: map_abs(ABS_BRAKE);    break;
554                 case 0xc8: map_abs(ABS_WHEEL);    break;
555                 default:   goto ignore;
556                 }
557                 break;
558
559         case HID_UP_GENDESK:
560                 if ((usage->hid & 0xf0) == 0x80) {      /* SystemControl */
561                         switch (usage->hid & 0xf) {
562                         case 0x1: map_key_clear(KEY_POWER);  break;
563                         case 0x2: map_key_clear(KEY_SLEEP);  break;
564                         case 0x3: map_key_clear(KEY_WAKEUP); break;
565                         case 0x4: map_key_clear(KEY_CONTEXT_MENU); break;
566                         case 0x5: map_key_clear(KEY_MENU); break;
567                         case 0x6: map_key_clear(KEY_PROG1); break;
568                         case 0x7: map_key_clear(KEY_HELP); break;
569                         case 0x8: map_key_clear(KEY_EXIT); break;
570                         case 0x9: map_key_clear(KEY_SELECT); break;
571                         case 0xa: map_key_clear(KEY_RIGHT); break;
572                         case 0xb: map_key_clear(KEY_LEFT); break;
573                         case 0xc: map_key_clear(KEY_UP); break;
574                         case 0xd: map_key_clear(KEY_DOWN); break;
575                         case 0xe: map_key_clear(KEY_POWER2); break;
576                         case 0xf: map_key_clear(KEY_RESTART); break;
577                         default: goto unknown;
578                         }
579                         break;
580                 }
581
582                 if ((usage->hid & 0xf0) == 0x90) {      /* D-pad */
583                         switch (usage->hid) {
584                         case HID_GD_UP:    usage->hat_dir = 1; break;
585                         case HID_GD_DOWN:  usage->hat_dir = 5; break;
586                         case HID_GD_RIGHT: usage->hat_dir = 3; break;
587                         case HID_GD_LEFT:  usage->hat_dir = 7; break;
588                         default: goto unknown;
589                         }
590                         if (field->dpad) {
591                                 map_abs(field->dpad);
592                                 goto ignore;
593                         }
594                         map_abs(ABS_HAT0X);
595                         break;
596                 }
597
598                 switch (usage->hid) {
599                 /* These usage IDs map directly to the usage codes. */
600                 case HID_GD_X: case HID_GD_Y: case HID_GD_Z:
601                 case HID_GD_RX: case HID_GD_RY: case HID_GD_RZ:
602                 case HID_GD_SLIDER: case HID_GD_DIAL: case HID_GD_WHEEL:
603                         if (field->flags & HID_MAIN_ITEM_RELATIVE)
604                                 map_rel(usage->hid & 0xf);
605                         else
606                                 map_abs(usage->hid & 0xf);
607                         break;
608
609                 case HID_GD_HATSWITCH:
610                         usage->hat_min = field->logical_minimum;
611                         usage->hat_max = field->logical_maximum;
612                         map_abs(ABS_HAT0X);
613                         break;
614
615                 case HID_GD_START:      map_key_clear(BTN_START);       break;
616                 case HID_GD_SELECT:     map_key_clear(BTN_SELECT);      break;
617
618                 default: goto unknown;
619                 }
620
621                 break;
622
623         case HID_UP_LED:
624                 switch (usage->hid & 0xffff) {                /* HID-Value:                   */
625                 case 0x01:  map_led (LED_NUML);     break;    /*   "Num Lock"                 */
626                 case 0x02:  map_led (LED_CAPSL);    break;    /*   "Caps Lock"                */
627                 case 0x03:  map_led (LED_SCROLLL);  break;    /*   "Scroll Lock"              */
628                 case 0x04:  map_led (LED_COMPOSE);  break;    /*   "Compose"                  */
629                 case 0x05:  map_led (LED_KANA);     break;    /*   "Kana"                     */
630                 case 0x27:  map_led (LED_SLEEP);    break;    /*   "Stand-By"                 */
631                 case 0x4c:  map_led (LED_SUSPEND);  break;    /*   "System Suspend"           */
632                 case 0x09:  map_led (LED_MUTE);     break;    /*   "Mute"                     */
633                 case 0x4b:  map_led (LED_MISC);     break;    /*   "Generic Indicator"        */
634                 case 0x19:  map_led (LED_MAIL);     break;    /*   "Message Waiting"          */
635                 case 0x4d:  map_led (LED_CHARGING); break;    /*   "External Power Connected" */
636
637                 default: goto ignore;
638                 }
639                 break;
640
641         case HID_UP_DIGITIZER:
642                 switch (usage->hid & 0xff) {
643                 case 0x00: /* Undefined */
644                         goto ignore;
645
646                 case 0x30: /* TipPressure */
647                         if (!test_bit(BTN_TOUCH, input->keybit)) {
648                                 device->quirks |= HID_QUIRK_NOTOUCH;
649                                 set_bit(EV_KEY, input->evbit);
650                                 set_bit(BTN_TOUCH, input->keybit);
651                         }
652                         map_abs_clear(ABS_PRESSURE);
653                         break;
654
655                 case 0x32: /* InRange */
656                         switch (field->physical & 0xff) {
657                         case 0x21: map_key(BTN_TOOL_MOUSE); break;
658                         case 0x22: map_key(BTN_TOOL_FINGER); break;
659                         default: map_key(BTN_TOOL_PEN); break;
660                         }
661                         break;
662
663                 case 0x3c: /* Invert */
664                         map_key_clear(BTN_TOOL_RUBBER);
665                         break;
666
667                 case 0x3d: /* X Tilt */
668                         map_abs_clear(ABS_TILT_X);
669                         break;
670
671                 case 0x3e: /* Y Tilt */
672                         map_abs_clear(ABS_TILT_Y);
673                         break;
674
675                 case 0x33: /* Touch */
676                 case 0x42: /* TipSwitch */
677                 case 0x43: /* TipSwitch2 */
678                         device->quirks &= ~HID_QUIRK_NOTOUCH;
679                         map_key_clear(BTN_TOUCH);
680                         break;
681
682                 case 0x44: /* BarrelSwitch */
683                         map_key_clear(BTN_STYLUS);
684                         break;
685
686                 case 0x46: /* TabletPick */
687                         map_key_clear(BTN_STYLUS2);
688                         break;
689
690                 default:  goto unknown;
691                 }
692                 break;
693
694         case HID_UP_CONSUMER:   /* USB HUT v1.12, pages 75-84 */
695                 switch (usage->hid & HID_USAGE) {
696                 case 0x000: goto ignore;
697                 case 0x030: map_key_clear(KEY_POWER);           break;
698                 case 0x031: map_key_clear(KEY_RESTART);         break;
699                 case 0x032: map_key_clear(KEY_SLEEP);           break;
700                 case 0x034: map_key_clear(KEY_SLEEP);           break;
701                 case 0x035: map_key_clear(KEY_KBDILLUMTOGGLE);  break;
702                 case 0x036: map_key_clear(BTN_MISC);            break;
703
704                 case 0x040: map_key_clear(KEY_MENU);            break; /* Menu */
705                 case 0x041: map_key_clear(KEY_SELECT);          break; /* Menu Pick */
706                 case 0x042: map_key_clear(KEY_UP);              break; /* Menu Up */
707                 case 0x043: map_key_clear(KEY_DOWN);            break; /* Menu Down */
708                 case 0x044: map_key_clear(KEY_LEFT);            break; /* Menu Left */
709                 case 0x045: map_key_clear(KEY_RIGHT);           break; /* Menu Right */
710                 case 0x046: map_key_clear(KEY_ESC);             break; /* Menu Escape */
711                 case 0x047: map_key_clear(KEY_KPPLUS);          break; /* Menu Value Increase */
712                 case 0x048: map_key_clear(KEY_KPMINUS);         break; /* Menu Value Decrease */
713
714                 case 0x060: map_key_clear(KEY_INFO);            break; /* Data On Screen */
715                 case 0x061: map_key_clear(KEY_SUBTITLE);        break; /* Closed Caption */
716                 case 0x063: map_key_clear(KEY_VCR);             break; /* VCR/TV */
717                 case 0x065: map_key_clear(KEY_CAMERA);          break; /* Snapshot */
718                 case 0x069: map_key_clear(KEY_RED);             break;
719                 case 0x06a: map_key_clear(KEY_GREEN);           break;
720                 case 0x06b: map_key_clear(KEY_BLUE);            break;
721                 case 0x06c: map_key_clear(KEY_YELLOW);          break;
722                 case 0x06d: map_key_clear(KEY_ZOOM);            break;
723
724                 case 0x082: map_key_clear(KEY_VIDEO_NEXT);      break;
725                 case 0x083: map_key_clear(KEY_LAST);            break;
726                 case 0x084: map_key_clear(KEY_ENTER);           break;
727                 case 0x088: map_key_clear(KEY_PC);              break;
728                 case 0x089: map_key_clear(KEY_TV);              break;
729                 case 0x08a: map_key_clear(KEY_WWW);             break;
730                 case 0x08b: map_key_clear(KEY_DVD);             break;
731                 case 0x08c: map_key_clear(KEY_PHONE);           break;
732                 case 0x08d: map_key_clear(KEY_PROGRAM);         break;
733                 case 0x08e: map_key_clear(KEY_VIDEOPHONE);      break;
734                 case 0x08f: map_key_clear(KEY_GAMES);           break;
735                 case 0x090: map_key_clear(KEY_MEMO);            break;
736                 case 0x091: map_key_clear(KEY_CD);              break;
737                 case 0x092: map_key_clear(KEY_VCR);             break;
738                 case 0x093: map_key_clear(KEY_TUNER);           break;
739                 case 0x094: map_key_clear(KEY_EXIT);            break;
740                 case 0x095: map_key_clear(KEY_HELP);            break;
741                 case 0x096: map_key_clear(KEY_TAPE);            break;
742                 case 0x097: map_key_clear(KEY_TV2);             break;
743                 case 0x098: map_key_clear(KEY_SAT);             break;
744                 case 0x09a: map_key_clear(KEY_PVR);             break;
745
746                 case 0x09c: map_key_clear(KEY_CHANNELUP);       break;
747                 case 0x09d: map_key_clear(KEY_CHANNELDOWN);     break;
748                 case 0x0a0: map_key_clear(KEY_VCR2);            break;
749
750                 case 0x0b0: map_key_clear(KEY_PLAY);            break;
751                 case 0x0b1: map_key_clear(KEY_PAUSE);           break;
752                 case 0x0b2: map_key_clear(KEY_RECORD);          break;
753                 case 0x0b3: map_key_clear(KEY_FASTFORWARD);     break;
754                 case 0x0b4: map_key_clear(KEY_REWIND);          break;
755                 case 0x0b5: map_key_clear(KEY_NEXTSONG);        break;
756                 case 0x0b6: map_key_clear(KEY_PREVIOUSSONG);    break;
757                 case 0x0b7: map_key_clear(KEY_STOPCD);          break;
758                 case 0x0b8: map_key_clear(KEY_EJECTCD);         break;
759                 case 0x0bc: map_key_clear(KEY_MEDIA_REPEAT);    break;
760                 case 0x0b9: map_key_clear(KEY_SHUFFLE);         break;
761                 case 0x0bf: map_key_clear(KEY_SLOW);            break;
762
763                 case 0x0cd: map_key_clear(KEY_PLAYPAUSE);       break;
764                 case 0x0e0: map_abs_clear(ABS_VOLUME);          break;
765                 case 0x0e2: map_key_clear(KEY_MUTE);            break;
766                 case 0x0e5: map_key_clear(KEY_BASSBOOST);       break;
767                 case 0x0e9: map_key_clear(KEY_VOLUMEUP);        break;
768                 case 0x0ea: map_key_clear(KEY_VOLUMEDOWN);      break;
769                 case 0x0f5: map_key_clear(KEY_SLOW);            break;
770
771                 case 0x182: map_key_clear(KEY_BOOKMARKS);       break;
772                 case 0x183: map_key_clear(KEY_CONFIG);          break;
773                 case 0x184: map_key_clear(KEY_WORDPROCESSOR);   break;
774                 case 0x185: map_key_clear(KEY_EDITOR);          break;
775                 case 0x186: map_key_clear(KEY_SPREADSHEET);     break;
776                 case 0x187: map_key_clear(KEY_GRAPHICSEDITOR);  break;
777                 case 0x188: map_key_clear(KEY_PRESENTATION);    break;
778                 case 0x189: map_key_clear(KEY_DATABASE);        break;
779                 case 0x18a: map_key_clear(KEY_MAIL);            break;
780                 case 0x18b: map_key_clear(KEY_NEWS);            break;
781                 case 0x18c: map_key_clear(KEY_VOICEMAIL);       break;
782                 case 0x18d: map_key_clear(KEY_ADDRESSBOOK);     break;
783                 case 0x18e: map_key_clear(KEY_CALENDAR);        break;
784                 case 0x191: map_key_clear(KEY_FINANCE);         break;
785                 case 0x192: map_key_clear(KEY_CALC);            break;
786                 case 0x193: map_key_clear(KEY_PLAYER);          break;
787                 case 0x194: map_key_clear(KEY_FILE);            break;
788                 case 0x196: map_key_clear(KEY_WWW);             break;
789                 case 0x199: map_key_clear(KEY_CHAT);            break;
790                 case 0x19c: map_key_clear(KEY_LOGOFF);          break;
791                 case 0x19e: map_key_clear(KEY_COFFEE);          break;
792                 case 0x1a6: map_key_clear(KEY_HELP);            break;
793                 case 0x1a7: map_key_clear(KEY_DOCUMENTS);       break;
794                 case 0x1ab: map_key_clear(KEY_SPELLCHECK);      break;
795                 case 0x1ae: map_key_clear(KEY_KEYBOARD);        break;
796                 case 0x1b6: map_key_clear(KEY_IMAGES);          break;
797                 case 0x1b7: map_key_clear(KEY_AUDIO);           break;
798                 case 0x1b8: map_key_clear(KEY_VIDEO);           break;
799                 case 0x1bc: map_key_clear(KEY_MESSENGER);       break;
800                 case 0x1bd: map_key_clear(KEY_INFO);            break;
801                 case 0x201: map_key_clear(KEY_NEW);             break;
802                 case 0x202: map_key_clear(KEY_OPEN);            break;
803                 case 0x203: map_key_clear(KEY_CLOSE);           break;
804                 case 0x204: map_key_clear(KEY_EXIT);            break;
805                 case 0x207: map_key_clear(KEY_SAVE);            break;
806                 case 0x208: map_key_clear(KEY_PRINT);           break;
807                 case 0x209: map_key_clear(KEY_PROPS);           break;
808                 case 0x21a: map_key_clear(KEY_UNDO);            break;
809                 case 0x21b: map_key_clear(KEY_COPY);            break;
810                 case 0x21c: map_key_clear(KEY_CUT);             break;
811                 case 0x21d: map_key_clear(KEY_PASTE);           break;
812                 case 0x21f: map_key_clear(KEY_FIND);            break;
813                 case 0x221: map_key_clear(KEY_SEARCH);          break;
814                 case 0x222: map_key_clear(KEY_GOTO);            break;
815                 case 0x223: map_key_clear(KEY_HOMEPAGE);        break;
816                 case 0x224: map_key_clear(KEY_BACK);            break;
817                 case 0x225: map_key_clear(KEY_FORWARD);         break;
818                 case 0x226: map_key_clear(KEY_STOP);            break;
819                 case 0x227: map_key_clear(KEY_REFRESH);         break;
820                 case 0x22a: map_key_clear(KEY_BOOKMARKS);       break;
821                 case 0x22d: map_key_clear(KEY_ZOOMIN);          break;
822                 case 0x22e: map_key_clear(KEY_ZOOMOUT);         break;
823                 case 0x22f: map_key_clear(KEY_ZOOMRESET);       break;
824                 case 0x233: map_key_clear(KEY_SCROLLUP);        break;
825                 case 0x234: map_key_clear(KEY_SCROLLDOWN);      break;
826                 case 0x238: map_rel(REL_HWHEEL);                break;
827                 case 0x23d: map_key_clear(KEY_EDIT);            break;
828                 case 0x25f: map_key_clear(KEY_CANCEL);          break;
829                 case 0x269: map_key_clear(KEY_INSERT);          break;
830                 case 0x26a: map_key_clear(KEY_DELETE);          break;
831                 case 0x279: map_key_clear(KEY_REDO);            break;
832
833                 case 0x289: map_key_clear(KEY_REPLY);           break;
834                 case 0x28b: map_key_clear(KEY_FORWARDMAIL);     break;
835                 case 0x28c: map_key_clear(KEY_SEND);            break;
836
837                 default:    goto ignore;
838                 }
839                 break;
840
841         case HID_UP_GENDEVCTRLS:
842                 if (hidinput_setup_battery(device, HID_INPUT_REPORT, field))
843                         goto ignore;
844                 else
845                         goto unknown;
846                 break;
847
848         case HID_UP_HPVENDOR:   /* Reported on a Dutch layout HP5308 */
849                 set_bit(EV_REP, input->evbit);
850                 switch (usage->hid & HID_USAGE) {
851                 case 0x021: map_key_clear(KEY_PRINT);           break;
852                 case 0x070: map_key_clear(KEY_HP);              break;
853                 case 0x071: map_key_clear(KEY_CAMERA);          break;
854                 case 0x072: map_key_clear(KEY_SOUND);           break;
855                 case 0x073: map_key_clear(KEY_QUESTION);        break;
856                 case 0x080: map_key_clear(KEY_EMAIL);           break;
857                 case 0x081: map_key_clear(KEY_CHAT);            break;
858                 case 0x082: map_key_clear(KEY_SEARCH);          break;
859                 case 0x083: map_key_clear(KEY_CONNECT);         break;
860                 case 0x084: map_key_clear(KEY_FINANCE);         break;
861                 case 0x085: map_key_clear(KEY_SPORT);           break;
862                 case 0x086: map_key_clear(KEY_SHOP);            break;
863                 default:    goto ignore;
864                 }
865                 break;
866
867         case HID_UP_HPVENDOR2:
868                 set_bit(EV_REP, input->evbit);
869                 switch (usage->hid & HID_USAGE) {
870                 case 0x003: map_key_clear(KEY_BRIGHTNESSDOWN);  break;
871                 case 0x004: map_key_clear(KEY_BRIGHTNESSUP);    break;
872                 default:    goto ignore;
873                 }
874                 break;
875
876         case HID_UP_MSVENDOR:
877                 goto ignore;
878
879         case HID_UP_CUSTOM: /* Reported on Logitech and Apple USB keyboards */
880                 set_bit(EV_REP, input->evbit);
881                 goto ignore;
882
883         case HID_UP_LOGIVENDOR:
884                 goto ignore;
885
886         case HID_UP_PID:
887                 switch (usage->hid & HID_USAGE) {
888                 case 0xa4: map_key_clear(BTN_DEAD);     break;
889                 default: goto ignore;
890                 }
891                 break;
892
893         default:
894         unknown:
895                 if (field->report_size == 1) {
896                         if (field->report->type == HID_OUTPUT_REPORT) {
897                                 map_led(LED_MISC);
898                                 break;
899                         }
900                         map_key(BTN_MISC);
901                         break;
902                 }
903                 if (field->flags & HID_MAIN_ITEM_RELATIVE) {
904                         map_rel(REL_MISC);
905                         break;
906                 }
907                 map_abs(ABS_MISC);
908                 break;
909         }
910
911 mapped:
912         if (device->driver->input_mapped && device->driver->input_mapped(device,
913                                 hidinput, field, usage, &bit, &max) < 0)
914                 goto ignore;
915
916         set_bit(usage->type, input->evbit);
917
918         while (usage->code <= max && test_and_set_bit(usage->code, bit))
919                 usage->code = find_next_zero_bit(bit, max + 1, usage->code);
920
921         if (usage->code > max)
922                 goto ignore;
923
924
925         if (usage->type == EV_ABS) {
926
927                 int a = field->logical_minimum;
928                 int b = field->logical_maximum;
929
930                 if ((device->quirks & HID_QUIRK_BADPAD) && (usage->code == ABS_X || usage->code == ABS_Y)) {
931                         a = field->logical_minimum = 0;
932                         b = field->logical_maximum = 255;
933                 }
934
935                 if (field->application == HID_GD_GAMEPAD || field->application == HID_GD_JOYSTICK)
936                         input_set_abs_params(input, usage->code, a, b, (b - a) >> 8, (b - a) >> 4);
937                 else    input_set_abs_params(input, usage->code, a, b, 0, 0);
938
939                 input_abs_set_res(input, usage->code,
940                                   hidinput_calc_abs_res(field, usage->code));
941
942                 /* use a larger default input buffer for MT devices */
943                 if (usage->code == ABS_MT_POSITION_X && input->hint_events_per_packet == 0)
944                         input_set_events_per_packet(input, 60);
945         }
946
947         if (usage->type == EV_ABS &&
948             (usage->hat_min < usage->hat_max || usage->hat_dir)) {
949                 int i;
950                 for (i = usage->code; i < usage->code + 2 && i <= max; i++) {
951                         input_set_abs_params(input, i, -1, 1, 0, 0);
952                         set_bit(i, input->absbit);
953                 }
954                 if (usage->hat_dir && !field->dpad)
955                         field->dpad = usage->code;
956         }
957
958         /* for those devices which produce Consumer volume usage as relative,
959          * we emulate pressing volumeup/volumedown appropriate number of times
960          * in hidinput_hid_event()
961          */
962         if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
963                         (usage->code == ABS_VOLUME)) {
964                 set_bit(KEY_VOLUMEUP, input->keybit);
965                 set_bit(KEY_VOLUMEDOWN, input->keybit);
966         }
967
968         if (usage->type == EV_KEY) {
969                 set_bit(EV_MSC, input->evbit);
970                 set_bit(MSC_SCAN, input->mscbit);
971         }
972
973 ignore:
974         return;
975
976 }
977
978 void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value)
979 {
980         struct input_dev *input;
981         unsigned *quirks = &hid->quirks;
982
983         if (!field->hidinput)
984                 return;
985
986         input = field->hidinput->input;
987
988         if (!usage->type)
989                 return;
990
991         if (usage->hat_min < usage->hat_max || usage->hat_dir) {
992                 int hat_dir = usage->hat_dir;
993                 if (!hat_dir)
994                         hat_dir = (value - usage->hat_min) * 8 / (usage->hat_max - usage->hat_min + 1) + 1;
995                 if (hat_dir < 0 || hat_dir > 8) hat_dir = 0;
996                 input_event(input, usage->type, usage->code    , hid_hat_to_axis[hat_dir].x);
997                 input_event(input, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y);
998                 return;
999         }
1000
1001         if (usage->hid == (HID_UP_DIGITIZER | 0x003c)) { /* Invert */
1002                 *quirks = value ? (*quirks | HID_QUIRK_INVERT) : (*quirks & ~HID_QUIRK_INVERT);
1003                 return;
1004         }
1005
1006         if (usage->hid == (HID_UP_DIGITIZER | 0x0032)) { /* InRange */
1007                 if (value) {
1008                         input_event(input, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1);
1009                         return;
1010                 }
1011                 input_event(input, usage->type, usage->code, 0);
1012                 input_event(input, usage->type, BTN_TOOL_RUBBER, 0);
1013                 return;
1014         }
1015
1016         if (usage->hid == (HID_UP_DIGITIZER | 0x0030) && (*quirks & HID_QUIRK_NOTOUCH)) { /* Pressure */
1017                 int a = field->logical_minimum;
1018                 int b = field->logical_maximum;
1019                 input_event(input, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3));
1020         }
1021
1022         if (usage->hid == (HID_UP_PID | 0x83UL)) { /* Simultaneous Effects Max */
1023                 dbg_hid("Maximum Effects - %d\n",value);
1024                 return;
1025         }
1026
1027         if (usage->hid == (HID_UP_PID | 0x7fUL)) {
1028                 dbg_hid("PID Pool Report\n");
1029                 return;
1030         }
1031
1032         if ((usage->type == EV_KEY) && (usage->code == 0)) /* Key 0 is "unassigned", not KEY_UNKNOWN */
1033                 return;
1034
1035         if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
1036                         (usage->code == ABS_VOLUME)) {
1037                 int count = abs(value);
1038                 int direction = value > 0 ? KEY_VOLUMEUP : KEY_VOLUMEDOWN;
1039                 int i;
1040
1041                 for (i = 0; i < count; i++) {
1042                         input_event(input, EV_KEY, direction, 1);
1043                         input_sync(input);
1044                         input_event(input, EV_KEY, direction, 0);
1045                         input_sync(input);
1046                 }
1047                 return;
1048         }
1049
1050         /*
1051          * Ignore out-of-range values as per HID specification,
1052          * section 5.10 and 6.2.25.
1053          *
1054          * The logical_minimum < logical_maximum check is done so that we
1055          * don't unintentionally discard values sent by devices which
1056          * don't specify logical min and max.
1057          */
1058         if ((field->flags & HID_MAIN_ITEM_VARIABLE) &&
1059             (field->logical_minimum < field->logical_maximum) &&
1060             (value < field->logical_minimum ||
1061              value > field->logical_maximum)) {
1062                 dbg_hid("Ignoring out-of-range value %x\n", value);
1063                 return;
1064         }
1065
1066         /* report the usage code as scancode if the key status has changed */
1067         if (usage->type == EV_KEY && !!test_bit(usage->code, input->key) != value)
1068                 input_event(input, EV_MSC, MSC_SCAN, usage->hid);
1069
1070         input_event(input, usage->type, usage->code, value);
1071
1072         if ((field->flags & HID_MAIN_ITEM_RELATIVE) && (usage->type == EV_KEY))
1073                 input_event(input, usage->type, usage->code, 0);
1074 }
1075
1076 void hidinput_report_event(struct hid_device *hid, struct hid_report *report)
1077 {
1078         struct hid_input *hidinput;
1079
1080         if (hid->quirks & HID_QUIRK_NO_INPUT_SYNC)
1081                 return;
1082
1083         list_for_each_entry(hidinput, &hid->inputs, list)
1084                 input_sync(hidinput->input);
1085 }
1086 EXPORT_SYMBOL_GPL(hidinput_report_event);
1087
1088 int hidinput_find_field(struct hid_device *hid, unsigned int type, unsigned int code, struct hid_field **field)
1089 {
1090         struct hid_report *report;
1091         int i, j;
1092
1093         list_for_each_entry(report, &hid->report_enum[HID_OUTPUT_REPORT].report_list, list) {
1094                 for (i = 0; i < report->maxfield; i++) {
1095                         *field = report->field[i];
1096                         for (j = 0; j < (*field)->maxusage; j++)
1097                                 if ((*field)->usage[j].type == type && (*field)->usage[j].code == code)
1098                                         return j;
1099                 }
1100         }
1101         return -1;
1102 }
1103 EXPORT_SYMBOL_GPL(hidinput_find_field);
1104
1105 struct hid_field *hidinput_get_led_field(struct hid_device *hid)
1106 {
1107         struct hid_report *report;
1108         struct hid_field *field;
1109         int i, j;
1110
1111         list_for_each_entry(report,
1112                             &hid->report_enum[HID_OUTPUT_REPORT].report_list,
1113                             list) {
1114                 for (i = 0; i < report->maxfield; i++) {
1115                         field = report->field[i];
1116                         for (j = 0; j < field->maxusage; j++)
1117                                 if (field->usage[j].type == EV_LED)
1118                                         return field;
1119                 }
1120         }
1121         return NULL;
1122 }
1123 EXPORT_SYMBOL_GPL(hidinput_get_led_field);
1124
1125 unsigned int hidinput_count_leds(struct hid_device *hid)
1126 {
1127         struct hid_report *report;
1128         struct hid_field *field;
1129         int i, j;
1130         unsigned int count = 0;
1131
1132         list_for_each_entry(report,
1133                             &hid->report_enum[HID_OUTPUT_REPORT].report_list,
1134                             list) {
1135                 for (i = 0; i < report->maxfield; i++) {
1136                         field = report->field[i];
1137                         for (j = 0; j < field->maxusage; j++)
1138                                 if (field->usage[j].type == EV_LED &&
1139                                     field->value[j])
1140                                         count += 1;
1141                 }
1142         }
1143         return count;
1144 }
1145 EXPORT_SYMBOL_GPL(hidinput_count_leds);
1146
1147 static void hidinput_led_worker(struct work_struct *work)
1148 {
1149         struct hid_device *hid = container_of(work, struct hid_device,
1150                                               led_work);
1151         struct hid_field *field;
1152         struct hid_report *report;
1153         int len;
1154         __u8 *buf;
1155
1156         field = hidinput_get_led_field(hid);
1157         if (!field)
1158                 return;
1159
1160         /*
1161          * field->report is accessed unlocked regarding HID core. So there might
1162          * be another incoming SET-LED request from user-space, which changes
1163          * the LED state while we assemble our outgoing buffer. However, this
1164          * doesn't matter as hid_output_report() correctly converts it into a
1165          * boolean value no matter what information is currently set on the LED
1166          * field (even garbage). So the remote device will always get a valid
1167          * request.
1168          * And in case we send a wrong value, a next led worker is spawned
1169          * for every SET-LED request so the following worker will send the
1170          * correct value, guaranteed!
1171          */
1172
1173         report = field->report;
1174
1175         /* use custom SET_REPORT request if possible (asynchronous) */
1176         if (hid->ll_driver->request)
1177                 return hid->ll_driver->request(hid, report, HID_REQ_SET_REPORT);
1178
1179         /* fall back to generic raw-output-report */
1180         len = ((report->size - 1) >> 3) + 1 + (report->id > 0);
1181         buf = kmalloc(len, GFP_KERNEL);
1182         if (!buf)
1183                 return;
1184
1185         hid_output_report(report, buf);
1186         /* synchronous output report */
1187         hid->hid_output_raw_report(hid, buf, len, HID_OUTPUT_REPORT);
1188         kfree(buf);
1189 }
1190
1191 static int hidinput_input_event(struct input_dev *dev, unsigned int type,
1192                                 unsigned int code, int value)
1193 {
1194         struct hid_device *hid = input_get_drvdata(dev);
1195         struct hid_field *field;
1196         int offset;
1197
1198         if (type == EV_FF)
1199                 return input_ff_event(dev, type, code, value);
1200
1201         if (type != EV_LED)
1202                 return -1;
1203
1204         if ((offset = hidinput_find_field(hid, type, code, &field)) == -1) {
1205                 hid_warn(dev, "event field not found\n");
1206                 return -1;
1207         }
1208
1209         hid_set_field(field, offset, value);
1210
1211         schedule_work(&hid->led_work);
1212         return 0;
1213 }
1214
1215 static int hidinput_open(struct input_dev *dev)
1216 {
1217         struct hid_device *hid = input_get_drvdata(dev);
1218
1219         return hid_hw_open(hid);
1220 }
1221
1222 static void hidinput_close(struct input_dev *dev)
1223 {
1224         struct hid_device *hid = input_get_drvdata(dev);
1225
1226         hid_hw_close(hid);
1227 }
1228
1229 static void report_features(struct hid_device *hid)
1230 {
1231         struct hid_driver *drv = hid->driver;
1232         struct hid_report_enum *rep_enum;
1233         struct hid_report *rep;
1234         int i, j;
1235
1236         rep_enum = &hid->report_enum[HID_FEATURE_REPORT];
1237         list_for_each_entry(rep, &rep_enum->report_list, list)
1238                 for (i = 0; i < rep->maxfield; i++) {
1239                         /* Ignore if report count is out of bounds. */
1240                         if (rep->field[i]->report_count < 1)
1241                                 continue;
1242
1243                         for (j = 0; j < rep->field[i]->maxusage; j++) {
1244                                 /* Verify if Battery Strength feature is available */
1245                                 hidinput_setup_battery(hid, HID_FEATURE_REPORT, rep->field[i]);
1246
1247                                 if (drv->feature_mapping)
1248                                         drv->feature_mapping(hid, rep->field[i],
1249                                                              rep->field[i]->usage + j);
1250                         }
1251                 }
1252 }
1253
1254 static struct hid_input *hidinput_allocate(struct hid_device *hid)
1255 {
1256         struct hid_input *hidinput = kzalloc(sizeof(*hidinput), GFP_KERNEL);
1257         struct input_dev *input_dev = input_allocate_device();
1258         if (!hidinput || !input_dev) {
1259                 kfree(hidinput);
1260                 input_free_device(input_dev);
1261                 hid_err(hid, "Out of memory during hid input probe\n");
1262                 return NULL;
1263         }
1264
1265         input_set_drvdata(input_dev, hid);
1266         if (hid->ll_driver->hidinput_input_event)
1267                 input_dev->event = hid->ll_driver->hidinput_input_event;
1268         else if (hid->ll_driver->request || hid->hid_output_raw_report)
1269                 input_dev->event = hidinput_input_event;
1270         input_dev->open = hidinput_open;
1271         input_dev->close = hidinput_close;
1272         input_dev->setkeycode = hidinput_setkeycode;
1273         input_dev->getkeycode = hidinput_getkeycode;
1274
1275         input_dev->name = hid->name;
1276         input_dev->phys = hid->phys;
1277         input_dev->uniq = hid->uniq;
1278         input_dev->id.bustype = hid->bus;
1279         input_dev->id.vendor  = hid->vendor;
1280         input_dev->id.product = hid->product;
1281         input_dev->id.version = hid->version;
1282         input_dev->dev.parent = &hid->dev;
1283         hidinput->input = input_dev;
1284         list_add_tail(&hidinput->list, &hid->inputs);
1285
1286         return hidinput;
1287 }
1288
1289 static bool hidinput_has_been_populated(struct hid_input *hidinput)
1290 {
1291         int i;
1292         unsigned long r = 0;
1293
1294         for (i = 0; i < BITS_TO_LONGS(EV_CNT); i++)
1295                 r |= hidinput->input->evbit[i];
1296
1297         for (i = 0; i < BITS_TO_LONGS(KEY_CNT); i++)
1298                 r |= hidinput->input->keybit[i];
1299
1300         for (i = 0; i < BITS_TO_LONGS(REL_CNT); i++)
1301                 r |= hidinput->input->relbit[i];
1302
1303         for (i = 0; i < BITS_TO_LONGS(ABS_CNT); i++)
1304                 r |= hidinput->input->absbit[i];
1305
1306         for (i = 0; i < BITS_TO_LONGS(MSC_CNT); i++)
1307                 r |= hidinput->input->mscbit[i];
1308
1309         for (i = 0; i < BITS_TO_LONGS(LED_CNT); i++)
1310                 r |= hidinput->input->ledbit[i];
1311
1312         for (i = 0; i < BITS_TO_LONGS(SND_CNT); i++)
1313                 r |= hidinput->input->sndbit[i];
1314
1315         for (i = 0; i < BITS_TO_LONGS(FF_CNT); i++)
1316                 r |= hidinput->input->ffbit[i];
1317
1318         for (i = 0; i < BITS_TO_LONGS(SW_CNT); i++)
1319                 r |= hidinput->input->swbit[i];
1320
1321         return !!r;
1322 }
1323
1324 static void hidinput_cleanup_hidinput(struct hid_device *hid,
1325                 struct hid_input *hidinput)
1326 {
1327         struct hid_report *report;
1328         int i, k;
1329
1330         list_del(&hidinput->list);
1331         input_free_device(hidinput->input);
1332
1333         for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) {
1334                 if (k == HID_OUTPUT_REPORT &&
1335                         hid->quirks & HID_QUIRK_SKIP_OUTPUT_REPORTS)
1336                         continue;
1337
1338                 list_for_each_entry(report, &hid->report_enum[k].report_list,
1339                                     list) {
1340
1341                         for (i = 0; i < report->maxfield; i++)
1342                                 if (report->field[i]->hidinput == hidinput)
1343                                         report->field[i]->hidinput = NULL;
1344                 }
1345         }
1346
1347         kfree(hidinput);
1348 }
1349
1350 /*
1351  * Register the input device; print a message.
1352  * Configure the input layer interface
1353  * Read all reports and initialize the absolute field values.
1354  */
1355
1356 int hidinput_connect(struct hid_device *hid, unsigned int force)
1357 {
1358         struct hid_driver *drv = hid->driver;
1359         struct hid_report *report;
1360         struct hid_input *hidinput = NULL;
1361         int i, j, k;
1362
1363         INIT_LIST_HEAD(&hid->inputs);
1364         INIT_WORK(&hid->led_work, hidinput_led_worker);
1365
1366         if (!force) {
1367                 for (i = 0; i < hid->maxcollection; i++) {
1368                         struct hid_collection *col = &hid->collection[i];
1369                         if (col->type == HID_COLLECTION_APPLICATION ||
1370                                         col->type == HID_COLLECTION_PHYSICAL)
1371                                 if (IS_INPUT_APPLICATION(col->usage))
1372                                         break;
1373                 }
1374
1375                 if (i == hid->maxcollection)
1376                         return -1;
1377         }
1378
1379         report_features(hid);
1380
1381         for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) {
1382                 if (k == HID_OUTPUT_REPORT &&
1383                         hid->quirks & HID_QUIRK_SKIP_OUTPUT_REPORTS)
1384                         continue;
1385
1386                 list_for_each_entry(report, &hid->report_enum[k].report_list, list) {
1387
1388                         if (!report->maxfield)
1389                                 continue;
1390
1391                         if (!hidinput) {
1392                                 hidinput = hidinput_allocate(hid);
1393                                 if (!hidinput)
1394                                         goto out_unwind;
1395                         }
1396
1397                         for (i = 0; i < report->maxfield; i++)
1398                                 for (j = 0; j < report->field[i]->maxusage; j++)
1399                                         hidinput_configure_usage(hidinput, report->field[i],
1400                                                                  report->field[i]->usage + j);
1401
1402                         if ((hid->quirks & HID_QUIRK_NO_EMPTY_INPUT) &&
1403                             !hidinput_has_been_populated(hidinput))
1404                                 continue;
1405
1406                         if (hid->quirks & HID_QUIRK_MULTI_INPUT) {
1407                                 /* This will leave hidinput NULL, so that it
1408                                  * allocates another one if we have more inputs on
1409                                  * the same interface. Some devices (e.g. Happ's
1410                                  * UGCI) cram a lot of unrelated inputs into the
1411                                  * same interface. */
1412                                 hidinput->report = report;
1413                                 if (drv->input_configured)
1414                                         drv->input_configured(hid, hidinput);
1415                                 if (input_register_device(hidinput->input))
1416                                         goto out_cleanup;
1417                                 hidinput = NULL;
1418                         }
1419                 }
1420         }
1421
1422         if (hidinput && (hid->quirks & HID_QUIRK_NO_EMPTY_INPUT) &&
1423             !hidinput_has_been_populated(hidinput)) {
1424                 /* no need to register an input device not populated */
1425                 hidinput_cleanup_hidinput(hid, hidinput);
1426                 hidinput = NULL;
1427         }
1428
1429         if (list_empty(&hid->inputs)) {
1430                 hid_err(hid, "No inputs registered, leaving\n");
1431                 goto out_unwind;
1432         }
1433
1434         if (hidinput) {
1435                 if (drv->input_configured)
1436                         drv->input_configured(hid, hidinput);
1437                 if (input_register_device(hidinput->input))
1438                         goto out_cleanup;
1439         }
1440
1441         return 0;
1442
1443 out_cleanup:
1444         list_del(&hidinput->list);
1445         input_free_device(hidinput->input);
1446         kfree(hidinput);
1447 out_unwind:
1448         /* unwind the ones we already registered */
1449         hidinput_disconnect(hid);
1450
1451         return -1;
1452 }
1453 EXPORT_SYMBOL_GPL(hidinput_connect);
1454
1455 void hidinput_disconnect(struct hid_device *hid)
1456 {
1457         struct hid_input *hidinput, *next;
1458
1459         hidinput_cleanup_battery(hid);
1460
1461         list_for_each_entry_safe(hidinput, next, &hid->inputs, list) {
1462                 list_del(&hidinput->list);
1463                 input_unregister_device(hidinput->input);
1464                 kfree(hidinput);
1465         }
1466
1467         /* led_work is spawned by input_dev callbacks, but doesn't access the
1468          * parent input_dev at all. Once all input devices are removed, we
1469          * know that led_work will never get restarted, so we can cancel it
1470          * synchronously and are safe. */
1471         cancel_work_sync(&hid->led_work);
1472 }
1473 EXPORT_SYMBOL_GPL(hidinput_disconnect);
1474