Pileus Git - ~andy/linux/blob - 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 static __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         if (code == ABS_X || code == ABS_Y || code == ABS_Z) {
 229                 if (field->unit == 0x11) {              /* If centimeters */
 230                         /* Convert to millimeters */
 231                         unit_exponent += 1;
 232                 } else if (field->unit == 0x13) {       /* If inches */
 233                         /* Convert to millimeters */
 234                         prev = physical_extents;
 235                         physical_extents *= 254;
 236                         if (physical_extents < prev)
 237                                 return 0;
 238                         unit_exponent -= 1;
 239                 } else {
 240                         return 0;
 241                 }
 242         } else if (code == ABS_RX || code == ABS_RY || code == ABS_RZ) {
 243                 if (field->unit == 0x14) {              /* If degrees */
 244                         /* Convert to radians */
 245                         prev = logical_extents;
 246                         logical_extents *= 573;
 247                         if (logical_extents < prev)
 248                                 return 0;
 249                         unit_exponent += 1;
 250                 } else if (field->unit != 0x12) {       /* If not radians */
 251                         return 0;
 252                 }
 253         } else {
 254                 return 0;
 255         }
 256
 257         /* Apply negative unit exponent */
 258         for (; unit_exponent < 0; unit_exponent++) {
 259                 prev = logical_extents;
 260                 logical_extents *= 10;
 261                 if (logical_extents < prev)
 262                         return 0;
 263         }
 264         /* Apply positive unit exponent */
 265         for (; unit_exponent > 0; unit_exponent--) {
 266                 prev = physical_extents;
 267                 physical_extents *= 10;
 268                 if (physical_extents < prev)
 269                         return 0;
 270         }
 271
 272         /* Calculate resolution */
 273         return logical_extents / physical_extents;
 274 }
 275
 276 #ifdef CONFIG_HID_BATTERY_STRENGTH
 277 static enum power_supply_property hidinput_battery_props[] = {
 278         POWER_SUPPLY_PROP_PRESENT,
 279         POWER_SUPPLY_PROP_ONLINE,
 280         POWER_SUPPLY_PROP_CAPACITY,
 281         POWER_SUPPLY_PROP_MODEL_NAME,
 282         POWER_SUPPLY_PROP_STATUS
 283 };
 284
 285 #define HID_BATTERY_QUIRK_PERCENT       (1 << 0) /* always reports percent */
 286 #define HID_BATTERY_QUIRK_FEATURE       (1 << 1) /* ask for feature report */
 287
 288 static const struct hid_device_id hid_battery_quirks[] = {
 289         { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
 290                                USB_DEVICE_ID_APPLE_ALU_WIRELESS_2011_ANSI),
 291           HID_BATTERY_QUIRK_PERCENT | HID_BATTERY_QUIRK_FEATURE },
 292         {}
 293 };
 294
 295 static unsigned find_battery_quirk(struct hid_device *hdev)
 296 {
 297         unsigned quirks = 0;
 298         const struct hid_device_id *match;
 299
 300         match = hid_match_id(hdev, hid_battery_quirks);
 301         if (match != NULL)
 302                 quirks = match->driver_data;
 303
 304         return quirks;
 305 }
 306
 307 static int hidinput_get_battery_property(struct power_supply *psy,
 308                                          enum power_supply_property prop,
 309                                          union power_supply_propval *val)
 310 {
 311         struct hid_device *dev = container_of(psy, struct hid_device, battery);
 312         int ret = 0;
 313         __u8 buf[2] = {};
 314
 315         switch (prop) {
 316         case POWER_SUPPLY_PROP_PRESENT:
 317         case POWER_SUPPLY_PROP_ONLINE:
 318                 val->intval = 1;
 319                 break;
 320
 321         case POWER_SUPPLY_PROP_CAPACITY:
 322                 ret = dev->hid_get_raw_report(dev, dev->battery_report_id,
 323                                               buf, sizeof(buf),
 324                                               dev->battery_report_type);
 325
 326                 if (ret != 2) {
 327                         if (ret >= 0)
 328                                 ret = -EINVAL;
 329                         break;
 330                 }
 331
 332                 if (dev->battery_min < dev->battery_max &&
 333                     buf[1] >= dev->battery_min &&
 334                     buf[1] <= dev->battery_max)
 335                         val->intval = (100 * (buf[1] - dev->battery_min)) /
 336                                 (dev->battery_max - dev->battery_min);
 337                 break;
 338
 339         case POWER_SUPPLY_PROP_MODEL_NAME:
 340                 val->strval = dev->name;
 341                 break;
 342
 343         case POWER_SUPPLY_PROP_STATUS:
 344                 val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
 345                 break;
 346
 347         default:
 348                 ret = -EINVAL;
 349                 break;
 350         }
 351
 352         return ret;
 353 }
 354
 355 static bool hidinput_setup_battery(struct hid_device *dev, unsigned report_type, struct hid_field *field)
 356 {
 357         struct power_supply *battery = &dev->battery;
 358         int ret;
 359         unsigned quirks;
 360         s32 min, max;
 361
 362         if (field->usage->hid != HID_DC_BATTERYSTRENGTH)
 363                 return false;   /* no match */
 364
 365         if (battery->name != NULL)
 366                 goto out;       /* already initialized? */
 367
 368         battery->name = kasprintf(GFP_KERNEL, "hid-%s-battery", dev->uniq);
 369         if (battery->name == NULL)
 370                 goto out;
 371
 372         battery->type = POWER_SUPPLY_TYPE_BATTERY;
 373         battery->properties = hidinput_battery_props;
 374         battery->num_properties = ARRAY_SIZE(hidinput_battery_props);
 375         battery->use_for_apm = 0;
 376         battery->get_property = hidinput_get_battery_property;
 377
 378         quirks = find_battery_quirk(dev);
 379
 380         hid_dbg(dev, "device %x:%x:%x %d quirks %d\n",
 381                 dev->bus, dev->vendor, dev->product, dev->version, quirks);
 382
 383         min = field->logical_minimum;
 384         max = field->logical_maximum;
 385
 386         if (quirks & HID_BATTERY_QUIRK_PERCENT) {
 387                 min = 0;
 388                 max = 100;
 389         }
 390
 391         if (quirks & HID_BATTERY_QUIRK_FEATURE)
 392                 report_type = HID_FEATURE_REPORT;
 393
 394         dev->battery_min = min;
 395         dev->battery_max = max;
 396         dev->battery_report_type = report_type;
 397         dev->battery_report_id = field->report->id;
 398
 399         ret = power_supply_register(&dev->dev, battery);
 400         if (ret != 0) {
 401                 hid_warn(dev, "can't register power supply: %d\n", ret);
 402                 kfree(battery->name);
 403                 battery->name = NULL;
 404         }
 405
 406 out:
 407         return true;
 408 }
 409
 410 static void hidinput_cleanup_battery(struct hid_device *dev)
 411 {
 412         if (!dev->battery.name)
 413                 return;
 414
 415         power_supply_unregister(&dev->battery);
 416         kfree(dev->battery.name);
 417         dev->battery.name = NULL;
 418 }
 419 #else  /* !CONFIG_HID_BATTERY_STRENGTH */
 420 static bool hidinput_setup_battery(struct hid_device *dev, unsigned report_type,
 421                                    struct hid_field *field)
 422 {
 423         return false;
 424 }
 425
 426 static void hidinput_cleanup_battery(struct hid_device *dev)
 427 {
 428 }
 429 #endif  /* CONFIG_HID_BATTERY_STRENGTH */
 430
 431 static void hidinput_configure_usage(struct hid_input *hidinput, struct hid_field *field,
 432                                      struct hid_usage *usage)
 433 {
 434         struct input_dev *input = hidinput->input;
 435         struct hid_device *device = input_get_drvdata(input);
 436         int max = 0, code;
 437         unsigned long *bit = NULL;
 438
 439         field->hidinput = hidinput;
 440
 441         if (field->flags & HID_MAIN_ITEM_CONSTANT)
 442                 goto ignore;
 443
 444         /* only LED usages are supported in output fields */
 445         if (field->report_type == HID_OUTPUT_REPORT &&
 446                         (usage->hid & HID_USAGE_PAGE) != HID_UP_LED) {
 447                 goto ignore;
 448         }
 449
 450         if (device->driver->input_mapping) {
 451                 int ret = device->driver->input_mapping(device, hidinput, field,
 452                                 usage, &bit, &max);
 453                 if (ret > 0)
 454                         goto mapped;
 455                 if (ret < 0)
 456                         goto ignore;
 457         }
 458
 459         switch (usage->hid & HID_USAGE_PAGE) {
 460         case HID_UP_UNDEFINED:
 461                 goto ignore;
 462
 463         case HID_UP_KEYBOARD:
 464                 set_bit(EV_REP, input->evbit);
 465
 466                 if ((usage->hid & HID_USAGE) < 256) {
 467                         if (!hid_keyboard[usage->hid & HID_USAGE]) goto ignore;
 468                         map_key_clear(hid_keyboard[usage->hid & HID_USAGE]);
 469                 } else
 470                         map_key(KEY_UNKNOWN);
 471
 472                 break;
 473
 474         case HID_UP_BUTTON:
 475                 code = ((usage->hid - 1) & HID_USAGE);
 476
 477                 switch (field->application) {
 478                 case HID_GD_MOUSE:
 479                 case HID_GD_POINTER:  code += BTN_MOUSE; break;
 480                 case HID_GD_JOYSTICK:
 481                                 if (code <= 0xf)
 482                                         code += BTN_JOYSTICK;
 483                                 else
 484                                         code += BTN_TRIGGER_HAPPY;
 485                                 break;
 486                 case HID_GD_GAMEPAD:  code += BTN_GAMEPAD; break;
 487                 default:
 488                         switch (field->physical) {
 489                         case HID_GD_MOUSE:
 490                         case HID_GD_POINTER:  code += BTN_MOUSE; break;
 491                         case HID_GD_JOYSTICK: code += BTN_JOYSTICK; break;
 492                         case HID_GD_GAMEPAD:  code += BTN_GAMEPAD; break;
 493                         default:              code += BTN_MISC;
 494                         }
 495                 }
 496
 497                 map_key(code);
 498                 break;
 499
 500         case HID_UP_SIMULATION:
 501                 switch (usage->hid & 0xffff) {
 502                 case 0xba: map_abs(ABS_RUDDER);   break;
 503                 case 0xbb: map_abs(ABS_THROTTLE); break;
 504                 case 0xc4: map_abs(ABS_GAS);      break;
 505                 case 0xc5: map_abs(ABS_BRAKE);    break;
 506                 case 0xc8: map_abs(ABS_WHEEL);    break;
 507                 default:   goto ignore;
 508                 }
 509                 break;
 510
 511         case HID_UP_GENDESK:
 512                 if ((usage->hid & 0xf0) == 0x80) {      /* SystemControl */
 513                         switch (usage->hid & 0xf) {
 514                         case 0x1: map_key_clear(KEY_POWER);  break;
 515                         case 0x2: map_key_clear(KEY_SLEEP);  break;
 516                         case 0x3: map_key_clear(KEY_WAKEUP); break;
 517                         case 0x4: map_key_clear(KEY_CONTEXT_MENU); break;
 518                         case 0x5: map_key_clear(KEY_MENU); break;
 519                         case 0x6: map_key_clear(KEY_PROG1); break;
 520                         case 0x7: map_key_clear(KEY_HELP); break;
 521                         case 0x8: map_key_clear(KEY_EXIT); break;
 522                         case 0x9: map_key_clear(KEY_SELECT); break;
 523                         case 0xa: map_key_clear(KEY_RIGHT); break;
 524                         case 0xb: map_key_clear(KEY_LEFT); break;
 525                         case 0xc: map_key_clear(KEY_UP); break;
 526                         case 0xd: map_key_clear(KEY_DOWN); break;
 527                         case 0xe: map_key_clear(KEY_POWER2); break;
 528                         case 0xf: map_key_clear(KEY_RESTART); break;
 529                         default: goto unknown;
 530                         }
 531                         break;
 532                 }
 533
 534                 if ((usage->hid & 0xf0) == 0x90) {      /* D-pad */
 535                         switch (usage->hid) {
 536                         case HID_GD_UP:    usage->hat_dir = 1; break;
 537                         case HID_GD_DOWN:  usage->hat_dir = 5; break;
 538                         case HID_GD_RIGHT: usage->hat_dir = 3; break;
 539                         case HID_GD_LEFT:  usage->hat_dir = 7; break;
 540                         default: goto unknown;
 541                         }
 542                         if (field->dpad) {
 543                                 map_abs(field->dpad);
 544                                 goto ignore;
 545                         }
 546                         map_abs(ABS_HAT0X);
 547                         break;
 548                 }
 549
 550                 switch (usage->hid) {
 551                 /* These usage IDs map directly to the usage codes. */
 552                 case HID_GD_X: case HID_GD_Y: case HID_GD_Z:
 553                 case HID_GD_RX: case HID_GD_RY: case HID_GD_RZ:
 554                 case HID_GD_SLIDER: case HID_GD_DIAL: case HID_GD_WHEEL:
 555                         if (field->flags & HID_MAIN_ITEM_RELATIVE)
 556                                 map_rel(usage->hid & 0xf);
 557                         else
 558                                 map_abs(usage->hid & 0xf);
 559                         break;
 560
 561                 case HID_GD_HATSWITCH:
 562                         usage->hat_min = field->logical_minimum;
 563                         usage->hat_max = field->logical_maximum;
 564                         map_abs(ABS_HAT0X);
 565                         break;
 566
 567                 case HID_GD_START:      map_key_clear(BTN_START);       break;
 568                 case HID_GD_SELECT:     map_key_clear(BTN_SELECT);      break;
 569
 570                 default: goto unknown;
 571                 }
 572
 573                 break;
 574
 575         case HID_UP_LED:
 576                 switch (usage->hid & 0xffff) {                /* HID-Value:                   */
 577                 case 0x01:  map_led (LED_NUML);     break;    /*   "Num Lock"                 */
 578                 case 0x02:  map_led (LED_CAPSL);    break;    /*   "Caps Lock"                */
 579                 case 0x03:  map_led (LED_SCROLLL);  break;    /*   "Scroll Lock"              */
 580                 case 0x04:  map_led (LED_COMPOSE);  break;    /*   "Compose"                  */
 581                 case 0x05:  map_led (LED_KANA);     break;    /*   "Kana"                     */
 582                 case 0x27:  map_led (LED_SLEEP);    break;    /*   "Stand-By"                 */
 583                 case 0x4c:  map_led (LED_SUSPEND);  break;    /*   "System Suspend"           */
 584                 case 0x09:  map_led (LED_MUTE);     break;    /*   "Mute"                     */
 585                 case 0x4b:  map_led (LED_MISC);     break;    /*   "Generic Indicator"        */
 586                 case 0x19:  map_led (LED_MAIL);     break;    /*   "Message Waiting"          */
 587                 case 0x4d:  map_led (LED_CHARGING); break;    /*   "External Power Connected" */
 588
 589                 default: goto ignore;
 590                 }
 591                 break;
 592
 593         case HID_UP_DIGITIZER:
 594                 switch (usage->hid & 0xff) {
 595                 case 0x00: /* Undefined */
 596                         goto ignore;
 597
 598                 case 0x30: /* TipPressure */
 599                         if (!test_bit(BTN_TOUCH, input->keybit)) {
 600                                 device->quirks |= HID_QUIRK_NOTOUCH;
 601                                 set_bit(EV_KEY, input->evbit);
 602                                 set_bit(BTN_TOUCH, input->keybit);
 603                         }
 604                         map_abs_clear(ABS_PRESSURE);
 605                         break;
 606
 607                 case 0x32: /* InRange */
 608                         switch (field->physical & 0xff) {
 609                         case 0x21: map_key(BTN_TOOL_MOUSE); break;
 610                         case 0x22: map_key(BTN_TOOL_FINGER); break;
 611                         default: map_key(BTN_TOOL_PEN); break;
 612                         }
 613                         break;
 614
 615                 case 0x3c: /* Invert */
 616                         map_key_clear(BTN_TOOL_RUBBER);
 617                         break;
 618
 619                 case 0x33: /* Touch */
 620                 case 0x42: /* TipSwitch */
 621                 case 0x43: /* TipSwitch2 */
 622                         device->quirks &= ~HID_QUIRK_NOTOUCH;
 623                         map_key_clear(BTN_TOUCH);
 624                         break;
 625
 626                 case 0x44: /* BarrelSwitch */
 627                         map_key_clear(BTN_STYLUS);
 628                         break;
 629
 630                 case 0x46: /* TabletPick */
 631                         map_key_clear(BTN_STYLUS2);
 632                         break;
 633
 634                 case 0x51: /* ContactID */
 635                         device->quirks |= HID_QUIRK_MULTITOUCH;
 636                         goto unknown;
 637
 638                 default:  goto unknown;
 639                 }
 640                 break;
 641
 642         case HID_UP_CONSUMER:   /* USB HUT v1.12, pages 75-84 */
 643                 switch (usage->hid & HID_USAGE) {
 644                 case 0x000: goto ignore;
 645                 case 0x030: map_key_clear(KEY_POWER);           break;
 646                 case 0x031: map_key_clear(KEY_RESTART);         break;
 647                 case 0x032: map_key_clear(KEY_SLEEP);           break;
 648                 case 0x034: map_key_clear(KEY_SLEEP);           break;
 649                 case 0x035: map_key_clear(KEY_KBDILLUMTOGGLE);  break;
 650                 case 0x036: map_key_clear(BTN_MISC);            break;
 651
 652                 case 0x040: map_key_clear(KEY_MENU);            break; /* Menu */
 653                 case 0x041: map_key_clear(KEY_SELECT);          break; /* Menu Pick */
 654                 case 0x042: map_key_clear(KEY_UP);              break; /* Menu Up */
 655                 case 0x043: map_key_clear(KEY_DOWN);            break; /* Menu Down */
 656                 case 0x044: map_key_clear(KEY_LEFT);            break; /* Menu Left */
 657                 case 0x045: map_key_clear(KEY_RIGHT);           break; /* Menu Right */
 658                 case 0x046: map_key_clear(KEY_ESC);             break; /* Menu Escape */
 659                 case 0x047: map_key_clear(KEY_KPPLUS);          break; /* Menu Value Increase */
 660                 case 0x048: map_key_clear(KEY_KPMINUS);         break; /* Menu Value Decrease */
 661
 662                 case 0x060: map_key_clear(KEY_INFO);            break; /* Data On Screen */
 663                 case 0x061: map_key_clear(KEY_SUBTITLE);        break; /* Closed Caption */
 664                 case 0x063: map_key_clear(KEY_VCR);             break; /* VCR/TV */
 665                 case 0x065: map_key_clear(KEY_CAMERA);          break; /* Snapshot */
 666                 case 0x069: map_key_clear(KEY_RED);             break;
 667                 case 0x06a: map_key_clear(KEY_GREEN);           break;
 668                 case 0x06b: map_key_clear(KEY_BLUE);            break;
 669                 case 0x06c: map_key_clear(KEY_YELLOW);          break;
 670                 case 0x06d: map_key_clear(KEY_ZOOM);            break;
 671
 672                 case 0x082: map_key_clear(KEY_VIDEO_NEXT);      break;
 673                 case 0x083: map_key_clear(KEY_LAST);            break;
 674                 case 0x084: map_key_clear(KEY_ENTER);           break;
 675                 case 0x088: map_key_clear(KEY_PC);              break;
 676                 case 0x089: map_key_clear(KEY_TV);              break;
 677                 case 0x08a: map_key_clear(KEY_WWW);             break;
 678                 case 0x08b: map_key_clear(KEY_DVD);             break;
 679                 case 0x08c: map_key_clear(KEY_PHONE);           break;
 680                 case 0x08d: map_key_clear(KEY_PROGRAM);         break;
 681                 case 0x08e: map_key_clear(KEY_VIDEOPHONE);      break;
 682                 case 0x08f: map_key_clear(KEY_GAMES);           break;
 683                 case 0x090: map_key_clear(KEY_MEMO);            break;
 684                 case 0x091: map_key_clear(KEY_CD);              break;
 685                 case 0x092: map_key_clear(KEY_VCR);             break;
 686                 case 0x093: map_key_clear(KEY_TUNER);           break;
 687                 case 0x094: map_key_clear(KEY_EXIT);            break;
 688                 case 0x095: map_key_clear(KEY_HELP);            break;
 689                 case 0x096: map_key_clear(KEY_TAPE);            break;
 690                 case 0x097: map_key_clear(KEY_TV2);             break;
 691                 case 0x098: map_key_clear(KEY_SAT);             break;
 692                 case 0x09a: map_key_clear(KEY_PVR);             break;
 693
 694                 case 0x09c: map_key_clear(KEY_CHANNELUP);       break;
 695                 case 0x09d: map_key_clear(KEY_CHANNELDOWN);     break;
 696                 case 0x0a0: map_key_clear(KEY_VCR2);            break;
 697
 698                 case 0x0b0: map_key_clear(KEY_PLAY);            break;
 699                 case 0x0b1: map_key_clear(KEY_PAUSE);           break;
 700                 case 0x0b2: map_key_clear(KEY_RECORD);          break;
 701                 case 0x0b3: map_key_clear(KEY_FASTFORWARD);     break;
 702                 case 0x0b4: map_key_clear(KEY_REWIND);          break;
 703                 case 0x0b5: map_key_clear(KEY_NEXTSONG);        break;
 704                 case 0x0b6: map_key_clear(KEY_PREVIOUSSONG);    break;
 705                 case 0x0b7: map_key_clear(KEY_STOPCD);          break;
 706                 case 0x0b8: map_key_clear(KEY_EJECTCD);         break;
 707                 case 0x0bc: map_key_clear(KEY_MEDIA_REPEAT);    break;
 708                 case 0x0b9: map_key_clear(KEY_SHUFFLE);         break;
 709                 case 0x0bf: map_key_clear(KEY_SLOW);            break;
 710
 711                 case 0x0cd: map_key_clear(KEY_PLAYPAUSE);       break;
 712                 case 0x0e0: map_abs_clear(ABS_VOLUME);          break;
 713                 case 0x0e2: map_key_clear(KEY_MUTE);            break;
 714                 case 0x0e5: map_key_clear(KEY_BASSBOOST);       break;
 715                 case 0x0e9: map_key_clear(KEY_VOLUMEUP);        break;
 716                 case 0x0ea: map_key_clear(KEY_VOLUMEDOWN);      break;
 717                 case 0x0f5: map_key_clear(KEY_SLOW);            break;
 718
 719                 case 0x182: map_key_clear(KEY_BOOKMARKS);       break;
 720                 case 0x183: map_key_clear(KEY_CONFIG);          break;
 721                 case 0x184: map_key_clear(KEY_WORDPROCESSOR);   break;
 722                 case 0x185: map_key_clear(KEY_EDITOR);          break;
 723                 case 0x186: map_key_clear(KEY_SPREADSHEET);     break;
 724                 case 0x187: map_key_clear(KEY_GRAPHICSEDITOR);  break;
 725                 case 0x188: map_key_clear(KEY_PRESENTATION);    break;
 726                 case 0x189: map_key_clear(KEY_DATABASE);        break;
 727                 case 0x18a: map_key_clear(KEY_MAIL);            break;
 728                 case 0x18b: map_key_clear(KEY_NEWS);            break;
 729                 case 0x18c: map_key_clear(KEY_VOICEMAIL);       break;
 730                 case 0x18d: map_key_clear(KEY_ADDRESSBOOK);     break;
 731                 case 0x18e: map_key_clear(KEY_CALENDAR);        break;
 732                 case 0x191: map_key_clear(KEY_FINANCE);         break;
 733                 case 0x192: map_key_clear(KEY_CALC);            break;
 734                 case 0x193: map_key_clear(KEY_PLAYER);          break;
 735                 case 0x194: map_key_clear(KEY_FILE);            break;
 736                 case 0x196: map_key_clear(KEY_WWW);             break;
 737                 case 0x199: map_key_clear(KEY_CHAT);            break;
 738                 case 0x19c: map_key_clear(KEY_LOGOFF);          break;
 739                 case 0x19e: map_key_clear(KEY_COFFEE);          break;
 740                 case 0x1a6: map_key_clear(KEY_HELP);            break;
 741                 case 0x1a7: map_key_clear(KEY_DOCUMENTS);       break;
 742                 case 0x1ab: map_key_clear(KEY_SPELLCHECK);      break;
 743                 case 0x1ae: map_key_clear(KEY_KEYBOARD);        break;
 744                 case 0x1b6: map_key_clear(KEY_IMAGES);          break;
 745                 case 0x1b7: map_key_clear(KEY_AUDIO);           break;
 746                 case 0x1b8: map_key_clear(KEY_VIDEO);           break;
 747                 case 0x1bc: map_key_clear(KEY_MESSENGER);       break;
 748                 case 0x1bd: map_key_clear(KEY_INFO);            break;
 749                 case 0x201: map_key_clear(KEY_NEW);             break;
 750                 case 0x202: map_key_clear(KEY_OPEN);            break;
 751                 case 0x203: map_key_clear(KEY_CLOSE);           break;
 752                 case 0x204: map_key_clear(KEY_EXIT);            break;
 753                 case 0x207: map_key_clear(KEY_SAVE);            break;
 754                 case 0x208: map_key_clear(KEY_PRINT);           break;
 755                 case 0x209: map_key_clear(KEY_PROPS);           break;
 756                 case 0x21a: map_key_clear(KEY_UNDO);            break;
 757                 case 0x21b: map_key_clear(KEY_COPY);            break;
 758                 case 0x21c: map_key_clear(KEY_CUT);             break;
 759                 case 0x21d: map_key_clear(KEY_PASTE);           break;
 760                 case 0x21f: map_key_clear(KEY_FIND);            break;
 761                 case 0x221: map_key_clear(KEY_SEARCH);          break;
 762                 case 0x222: map_key_clear(KEY_GOTO);            break;
 763                 case 0x223: map_key_clear(KEY_HOMEPAGE);        break;
 764                 case 0x224: map_key_clear(KEY_BACK);            break;
 765                 case 0x225: map_key_clear(KEY_FORWARD);         break;
 766                 case 0x226: map_key_clear(KEY_STOP);            break;
 767                 case 0x227: map_key_clear(KEY_REFRESH);         break;
 768                 case 0x22a: map_key_clear(KEY_BOOKMARKS);       break;
 769                 case 0x22d: map_key_clear(KEY_ZOOMIN);          break;
 770                 case 0x22e: map_key_clear(KEY_ZOOMOUT);         break;
 771                 case 0x22f: map_key_clear(KEY_ZOOMRESET);       break;
 772                 case 0x233: map_key_clear(KEY_SCROLLUP);        break;
 773                 case 0x234: map_key_clear(KEY_SCROLLDOWN);      break;
 774                 case 0x238: map_rel(REL_HWHEEL);                break;
 775                 case 0x23d: map_key_clear(KEY_EDIT);            break;
 776                 case 0x25f: map_key_clear(KEY_CANCEL);          break;
 777                 case 0x269: map_key_clear(KEY_INSERT);          break;
 778                 case 0x26a: map_key_clear(KEY_DELETE);          break;
 779                 case 0x279: map_key_clear(KEY_REDO);            break;
 780
 781                 case 0x289: map_key_clear(KEY_REPLY);           break;
 782                 case 0x28b: map_key_clear(KEY_FORWARDMAIL);     break;
 783                 case 0x28c: map_key_clear(KEY_SEND);            break;
 784
 785                 default:    goto ignore;
 786                 }
 787                 break;
 788
 789         case HID_UP_GENDEVCTRLS:
 790                 if (hidinput_setup_battery(device, HID_INPUT_REPORT, field))
 791                         goto ignore;
 792                 else
 793                         goto unknown;
 794                 break;
 795
 796         case HID_UP_HPVENDOR:   /* Reported on a Dutch layout HP5308 */
 797                 set_bit(EV_REP, input->evbit);
 798                 switch (usage->hid & HID_USAGE) {
 799                 case 0x021: map_key_clear(KEY_PRINT);           break;
 800                 case 0x070: map_key_clear(KEY_HP);              break;
 801                 case 0x071: map_key_clear(KEY_CAMERA);          break;
 802                 case 0x072: map_key_clear(KEY_SOUND);           break;
 803                 case 0x073: map_key_clear(KEY_QUESTION);        break;
 804                 case 0x080: map_key_clear(KEY_EMAIL);           break;
 805                 case 0x081: map_key_clear(KEY_CHAT);            break;
 806                 case 0x082: map_key_clear(KEY_SEARCH);          break;
 807                 case 0x083: map_key_clear(KEY_CONNECT);         break;
 808                 case 0x084: map_key_clear(KEY_FINANCE);         break;
 809                 case 0x085: map_key_clear(KEY_SPORT);           break;
 810                 case 0x086: map_key_clear(KEY_SHOP);            break;
 811                 default:    goto ignore;
 812                 }
 813                 break;
 814
 815         case HID_UP_MSVENDOR:
 816                 goto ignore;
 817
 818         case HID_UP_CUSTOM: /* Reported on Logitech and Apple USB keyboards */
 819                 set_bit(EV_REP, input->evbit);
 820                 goto ignore;
 821
 822         case HID_UP_LOGIVENDOR:
 823                 goto ignore;
 824
 825         case HID_UP_PID:
 826                 switch (usage->hid & HID_USAGE) {
 827                 case 0xa4: map_key_clear(BTN_DEAD);     break;
 828                 default: goto ignore;
 829                 }
 830                 break;
 831
 832         default:
 833         unknown:
 834                 if (field->report_size == 1) {
 835                         if (field->report->type == HID_OUTPUT_REPORT) {
 836                                 map_led(LED_MISC);
 837                                 break;
 838                         }
 839                         map_key(BTN_MISC);
 840                         break;
 841                 }
 842                 if (field->flags & HID_MAIN_ITEM_RELATIVE) {
 843                         map_rel(REL_MISC);
 844                         break;
 845                 }
 846                 map_abs(ABS_MISC);
 847                 break;
 848         }
 849
 850 mapped:
 851         if (device->driver->input_mapped && device->driver->input_mapped(device,
 852                                 hidinput, field, usage, &bit, &max) < 0)
 853                 goto ignore;
 854
 855         set_bit(usage->type, input->evbit);
 856
 857         while (usage->code <= max && test_and_set_bit(usage->code, bit))
 858                 usage->code = find_next_zero_bit(bit, max + 1, usage->code);
 859
 860         if (usage->code > max)
 861                 goto ignore;
 862
 863
 864         if (usage->type == EV_ABS) {
 865
 866                 int a = field->logical_minimum;
 867                 int b = field->logical_maximum;
 868
 869                 if ((device->quirks & HID_QUIRK_BADPAD) && (usage->code == ABS_X || usage->code == ABS_Y)) {
 870                         a = field->logical_minimum = 0;
 871                         b = field->logical_maximum = 255;
 872                 }
 873
 874                 if (field->application == HID_GD_GAMEPAD || field->application == HID_GD_JOYSTICK)
 875                         input_set_abs_params(input, usage->code, a, b, (b - a) >> 8, (b - a) >> 4);
 876                 else    input_set_abs_params(input, usage->code, a, b, 0, 0);
 877
 878                 input_abs_set_res(input, usage->code,
 879                                   hidinput_calc_abs_res(field, usage->code));
 880
 881                 /* use a larger default input buffer for MT devices */
 882                 if (usage->code == ABS_MT_POSITION_X && input->hint_events_per_packet == 0)
 883                         input_set_events_per_packet(input, 60);
 884         }
 885
 886         if (usage->type == EV_ABS &&
 887             (usage->hat_min < usage->hat_max || usage->hat_dir)) {
 888                 int i;
 889                 for (i = usage->code; i < usage->code + 2 && i <= max; i++) {
 890                         input_set_abs_params(input, i, -1, 1, 0, 0);
 891                         set_bit(i, input->absbit);
 892                 }
 893                 if (usage->hat_dir && !field->dpad)
 894                         field->dpad = usage->code;
 895         }
 896
 897         /* for those devices which produce Consumer volume usage as relative,
 898          * we emulate pressing volumeup/volumedown appropriate number of times
 899          * in hidinput_hid_event()
 900          */
 901         if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
 902                         (usage->code == ABS_VOLUME)) {
 903                 set_bit(KEY_VOLUMEUP, input->keybit);
 904                 set_bit(KEY_VOLUMEDOWN, input->keybit);
 905         }
 906
 907         if (usage->type == EV_KEY) {
 908                 set_bit(EV_MSC, input->evbit);
 909                 set_bit(MSC_SCAN, input->mscbit);
 910         }
 911
 912 ignore:
 913         return;
 914
 915 }
 916
 917 void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value)
 918 {
 919         struct input_dev *input;
 920         unsigned *quirks = &hid->quirks;
 921
 922         if (!field->hidinput)
 923                 return;
 924
 925         input = field->hidinput->input;
 926
 927         if (!usage->type)
 928                 return;
 929
 930         if (usage->hat_min < usage->hat_max || usage->hat_dir) {
 931                 int hat_dir = usage->hat_dir;
 932                 if (!hat_dir)
 933                         hat_dir = (value - usage->hat_min) * 8 / (usage->hat_max - usage->hat_min + 1) + 1;
 934                 if (hat_dir < 0 || hat_dir > 8) hat_dir = 0;
 935                 input_event(input, usage->type, usage->code    , hid_hat_to_axis[hat_dir].x);
 936                 input_event(input, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y);
 937                 return;
 938         }
 939
 940         if (usage->hid == (HID_UP_DIGITIZER | 0x003c)) { /* Invert */
 941                 *quirks = value ? (*quirks | HID_QUIRK_INVERT) : (*quirks & ~HID_QUIRK_INVERT);
 942                 return;
 943         }
 944
 945         if (usage->hid == (HID_UP_DIGITIZER | 0x0032)) { /* InRange */
 946                 if (value) {
 947                         input_event(input, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1);
 948                         return;
 949                 }
 950                 input_event(input, usage->type, usage->code, 0);
 951                 input_event(input, usage->type, BTN_TOOL_RUBBER, 0);
 952                 return;
 953         }
 954
 955         if (usage->hid == (HID_UP_DIGITIZER | 0x0030) && (*quirks & HID_QUIRK_NOTOUCH)) { /* Pressure */
 956                 int a = field->logical_minimum;
 957                 int b = field->logical_maximum;
 958                 input_event(input, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3));
 959         }
 960
 961         if (usage->hid == (HID_UP_PID | 0x83UL)) { /* Simultaneous Effects Max */
 962                 dbg_hid("Maximum Effects - %d\n",value);
 963                 return;
 964         }
 965
 966         if (usage->hid == (HID_UP_PID | 0x7fUL)) {
 967                 dbg_hid("PID Pool Report\n");
 968                 return;
 969         }
 970
 971         if ((usage->type == EV_KEY) && (usage->code == 0)) /* Key 0 is "unassigned", not KEY_UNKNOWN */
 972                 return;
 973
 974         if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
 975                         (usage->code == ABS_VOLUME)) {
 976                 int count = abs(value);
 977                 int direction = value > 0 ? KEY_VOLUMEUP : KEY_VOLUMEDOWN;
 978                 int i;
 979
 980                 for (i = 0; i < count; i++) {
 981                         input_event(input, EV_KEY, direction, 1);
 982                         input_sync(input);
 983                         input_event(input, EV_KEY, direction, 0);
 984                         input_sync(input);
 985                 }
 986                 return;
 987         }
 988
 989         /* Ignore out-of-range values as per HID specification, section 5.10 */
 990         if (value < field->logical_minimum || value > field->logical_maximum) {
 991                 dbg_hid("Ignoring out-of-range value %x\n", value);
 992                 return;
 993         }
 994
 995         /* report the usage code as scancode if the key status has changed */
 996         if (usage->type == EV_KEY && !!test_bit(usage->code, input->key) != value)
 997                 input_event(input, EV_MSC, MSC_SCAN, usage->hid);
 998
 999         input_event(input, usage->type, usage->code, value);
1000
1001         if ((field->flags & HID_MAIN_ITEM_RELATIVE) && (usage->type == EV_KEY))
1002                 input_event(input, usage->type, usage->code, 0);
1003 }
1004
1005 void hidinput_report_event(struct hid_device *hid, struct hid_report *report)
1006 {
1007         struct hid_input *hidinput;
1008
1009         if (hid->quirks & HID_QUIRK_NO_INPUT_SYNC)
1010                 return;
1011
1012         list_for_each_entry(hidinput, &hid->inputs, list)
1013                 input_sync(hidinput->input);
1014 }
1015 EXPORT_SYMBOL_GPL(hidinput_report_event);
1016
1017 int hidinput_find_field(struct hid_device *hid, unsigned int type, unsigned int code, struct hid_field **field)
1018 {
1019         struct hid_report *report;
1020         int i, j;
1021
1022         list_for_each_entry(report, &hid->report_enum[HID_OUTPUT_REPORT].report_list, list) {
1023                 for (i = 0; i < report->maxfield; i++) {
1024                         *field = report->field[i];
1025                         for (j = 0; j < (*field)->maxusage; j++)
1026                                 if ((*field)->usage[j].type == type && (*field)->usage[j].code == code)
1027                                         return j;
1028                 }
1029         }
1030         return -1;
1031 }
1032 EXPORT_SYMBOL_GPL(hidinput_find_field);
1033
1034 struct hid_field *hidinput_get_led_field(struct hid_device *hid)
1035 {
1036         struct hid_report *report;
1037         struct hid_field *field;
1038         int i, j;
1039
1040         list_for_each_entry(report,
1041                             &hid->report_enum[HID_OUTPUT_REPORT].report_list,
1042                             list) {
1043                 for (i = 0; i < report->maxfield; i++) {
1044                         field = report->field[i];
1045                         for (j = 0; j < field->maxusage; j++)
1046                                 if (field->usage[j].type == EV_LED)
1047                                         return field;
1048                 }
1049         }
1050         return NULL;
1051 }
1052 EXPORT_SYMBOL_GPL(hidinput_get_led_field);
1053
1054 unsigned int hidinput_count_leds(struct hid_device *hid)
1055 {
1056         struct hid_report *report;
1057         struct hid_field *field;
1058         int i, j;
1059         unsigned int count = 0;
1060
1061         list_for_each_entry(report,
1062                             &hid->report_enum[HID_OUTPUT_REPORT].report_list,
1063                             list) {
1064                 for (i = 0; i < report->maxfield; i++) {
1065                         field = report->field[i];
1066                         for (j = 0; j < field->maxusage; j++)
1067                                 if (field->usage[j].type == EV_LED &&
1068                                     field->value[j])
1069                                         count += 1;
1070                 }
1071         }
1072         return count;
1073 }
1074 EXPORT_SYMBOL_GPL(hidinput_count_leds);
1075
1076 static int hidinput_open(struct input_dev *dev)
1077 {
1078         struct hid_device *hid = input_get_drvdata(dev);
1079
1080         return hid_hw_open(hid);
1081 }
1082
1083 static void hidinput_close(struct input_dev *dev)
1084 {
1085         struct hid_device *hid = input_get_drvdata(dev);
1086
1087         hid_hw_close(hid);
1088 }
1089
1090 static void report_features(struct hid_device *hid)
1091 {
1092         struct hid_driver *drv = hid->driver;
1093         struct hid_report_enum *rep_enum;
1094         struct hid_report *rep;
1095         int i, j;
1096
1097         rep_enum = &hid->report_enum[HID_FEATURE_REPORT];
1098         list_for_each_entry(rep, &rep_enum->report_list, list)
1099                 for (i = 0; i < rep->maxfield; i++)
1100                         for (j = 0; j < rep->field[i]->maxusage; j++) {
1101                                 /* Verify if Battery Strength feature is available */
1102                                 hidinput_setup_battery(hid, HID_FEATURE_REPORT, rep->field[i]);
1103
1104                                 if (drv->feature_mapping)
1105                                         drv->feature_mapping(hid, rep->field[i],
1106                                                              rep->field[i]->usage + j);
1107                         }
1108 }
1109
1110 /*
1111  * Register the input device; print a message.
1112  * Configure the input layer interface
1113  * Read all reports and initialize the absolute field values.
1114  */
1115
1116 int hidinput_connect(struct hid_device *hid, unsigned int force)
1117 {
1118         struct hid_report *report;
1119         struct hid_input *hidinput = NULL;
1120         struct input_dev *input_dev;
1121         int i, j, k;
1122
1123         INIT_LIST_HEAD(&hid->inputs);
1124
1125         if (!force) {
1126                 for (i = 0; i < hid->maxcollection; i++) {
1127                         struct hid_collection *col = &hid->collection[i];
1128                         if (col->type == HID_COLLECTION_APPLICATION ||
1129                                         col->type == HID_COLLECTION_PHYSICAL)
1130                                 if (IS_INPUT_APPLICATION(col->usage))
1131                                         break;
1132                 }
1133
1134                 if (i == hid->maxcollection)
1135                         return -1;
1136         }
1137
1138         report_features(hid);
1139
1140         for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) {
1141                 if (k == HID_OUTPUT_REPORT &&
1142                         hid->quirks & HID_QUIRK_SKIP_OUTPUT_REPORTS)
1143                         continue;
1144
1145                 list_for_each_entry(report, &hid->report_enum[k].report_list, list) {
1146
1147                         if (!report->maxfield)
1148                                 continue;
1149
1150                         if (!hidinput) {
1151                                 hidinput = kzalloc(sizeof(*hidinput), GFP_KERNEL);
1152                                 input_dev = input_allocate_device();
1153                                 if (!hidinput || !input_dev) {
1154                                         kfree(hidinput);
1155                                         input_free_device(input_dev);
1156                                         hid_err(hid, "Out of memory during hid input probe\n");
1157                                         goto out_unwind;
1158                                 }
1159
1160                                 input_set_drvdata(input_dev, hid);
1161                                 input_dev->event =
1162                                         hid->ll_driver->hidinput_input_event;
1163                                 input_dev->open = hidinput_open;
1164                                 input_dev->close = hidinput_close;
1165                                 input_dev->setkeycode = hidinput_setkeycode;
1166                                 input_dev->getkeycode = hidinput_getkeycode;
1167
1168                                 input_dev->name = hid->name;
1169                                 input_dev->phys = hid->phys;
1170                                 input_dev->uniq = hid->uniq;
1171                                 input_dev->id.bustype = hid->bus;
1172                                 input_dev->id.vendor  = hid->vendor;
1173                                 input_dev->id.product = hid->product;
1174                                 input_dev->id.version = hid->version;
1175                                 input_dev->dev.parent = hid->dev.parent;
1176                                 hidinput->input = input_dev;
1177                                 list_add_tail(&hidinput->list, &hid->inputs);
1178                         }
1179
1180                         for (i = 0; i < report->maxfield; i++)
1181                                 for (j = 0; j < report->field[i]->maxusage; j++)
1182                                         hidinput_configure_usage(hidinput, report->field[i],
1183                                                                  report->field[i]->usage + j);
1184
1185                         if (hid->quirks & HID_QUIRK_MULTI_INPUT) {
1186                                 /* This will leave hidinput NULL, so that it
1187                                  * allocates another one if we have more inputs on
1188                                  * the same interface. Some devices (e.g. Happ's
1189                                  * UGCI) cram a lot of unrelated inputs into the
1190                                  * same interface. */
1191                                 hidinput->report = report;
1192                                 if (input_register_device(hidinput->input))
1193                                         goto out_cleanup;
1194                                 hidinput = NULL;
1195                         }
1196                 }
1197         }
1198
1199         if (hid->quirks & HID_QUIRK_MULTITOUCH) {
1200                 /* generic hid does not know how to handle multitouch devices */
1201                 if (hidinput)
1202                         goto out_cleanup;
1203                 goto out_unwind;
1204         }
1205
1206         if (hidinput && input_register_device(hidinput->input))
1207                 goto out_cleanup;
1208
1209         return 0;
1210
1211 out_cleanup:
1212         list_del(&hidinput->list);
1213         input_free_device(hidinput->input);
1214         kfree(hidinput);
1215 out_unwind:
1216         /* unwind the ones we already registered */
1217         hidinput_disconnect(hid);
1218
1219         return -1;
1220 }
1221 EXPORT_SYMBOL_GPL(hidinput_connect);
1222
1223 void hidinput_disconnect(struct hid_device *hid)
1224 {
1225         struct hid_input *hidinput, *next;
1226
1227         hidinput_cleanup_battery(hid);
1228
1229         list_for_each_entry_safe(hidinput, next, &hid->inputs, list) {
1230                 list_del(&hidinput->list);
1231                 input_unregister_device(hidinput->input);
1232                 kfree(hidinput);
1233         }
1234 }
1235 EXPORT_SYMBOL_GPL(hidinput_disconnect);
1236