hid-input.c 33 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101
  1. /*
  2. * Copyright (c) 2000-2001 Vojtech Pavlik
  3. * Copyright (c) 2006-2007 Jiri Kosina
  4. *
  5. * HID to Linux Input mapping
  6. */
  7. /*
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  21. *
  22. * Should you need to contact me, the author, you can do so either by
  23. * e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
  24. * Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
  25. */
  26. #include <linux/module.h>
  27. #include <linux/slab.h>
  28. #include <linux/kernel.h>
  29. #include <linux/hid.h>
  30. #include <linux/hid-debug.h>
  31. static int hid_apple_fnmode = 1;
  32. module_param_named(pb_fnmode, hid_apple_fnmode, int, 0644);
  33. MODULE_PARM_DESC(pb_fnmode,
  34. "Mode of fn key on Apple keyboards (0 = disabled, 1 = fkeyslast, 2 = fkeysfirst)");
  35. #define unk KEY_UNKNOWN
  36. static const unsigned char hid_keyboard[256] = {
  37. 0, 0, 0, 0, 30, 48, 46, 32, 18, 33, 34, 35, 23, 36, 37, 38,
  38. 50, 49, 24, 25, 16, 19, 31, 20, 22, 47, 17, 45, 21, 44, 2, 3,
  39. 4, 5, 6, 7, 8, 9, 10, 11, 28, 1, 14, 15, 57, 12, 13, 26,
  40. 27, 43, 43, 39, 40, 41, 51, 52, 53, 58, 59, 60, 61, 62, 63, 64,
  41. 65, 66, 67, 68, 87, 88, 99, 70,119,110,102,104,111,107,109,106,
  42. 105,108,103, 69, 98, 55, 74, 78, 96, 79, 80, 81, 75, 76, 77, 71,
  43. 72, 73, 82, 83, 86,127,116,117,183,184,185,186,187,188,189,190,
  44. 191,192,193,194,134,138,130,132,128,129,131,137,133,135,136,113,
  45. 115,114,unk,unk,unk,121,unk, 89, 93,124, 92, 94, 95,unk,unk,unk,
  46. 122,123, 90, 91, 85,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,
  47. unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,
  48. unk,unk,unk,unk,unk,unk,179,180,unk,unk,unk,unk,unk,unk,unk,unk,
  49. unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,
  50. unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,unk,
  51. 29, 42, 56,125, 97, 54,100,126,164,166,165,163,161,115,114,113,
  52. 150,158,159,128,136,177,178,176,142,152,173,140,unk,unk,unk,unk
  53. };
  54. /* extended mapping for certain Logitech hardware (Logitech cordless desktop LX500) */
  55. #define LOGITECH_EXPANDED_KEYMAP_SIZE 80
  56. static int logitech_expanded_keymap[LOGITECH_EXPANDED_KEYMAP_SIZE] = {
  57. 0,216, 0,213,175,156, 0, 0, 0, 0,
  58. 144, 0, 0, 0, 0, 0, 0, 0, 0,212,
  59. 174,167,152,161,112, 0, 0, 0,154, 0,
  60. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  61. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  62. 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
  63. 0, 0, 0, 0, 0,183,184,185,186,187,
  64. 188,189,190,191,192,193,194, 0, 0, 0
  65. };
  66. static const struct {
  67. __s32 x;
  68. __s32 y;
  69. } hid_hat_to_axis[] = {{ 0, 0}, { 0,-1}, { 1,-1}, { 1, 0}, { 1, 1}, { 0, 1}, {-1, 1}, {-1, 0}, {-1,-1}};
  70. #define map_abs(c) hid_map_usage(hidinput, usage, &bit, &max, EV_ABS, (c))
  71. #define map_rel(c) hid_map_usage(hidinput, usage, &bit, &max, EV_REL, (c))
  72. #define map_key(c) hid_map_usage(hidinput, usage, &bit, &max, EV_KEY, (c))
  73. #define map_led(c) hid_map_usage(hidinput, usage, &bit, &max, EV_LED, (c))
  74. #define map_abs_clear(c) hid_map_usage_clear(hidinput, usage, &bit, \
  75. &max, EV_ABS, (c))
  76. #define map_key_clear(c) hid_map_usage_clear(hidinput, usage, &bit, \
  77. &max, EV_KEY, (c))
  78. #ifdef CONFIG_USB_HIDINPUT_POWERBOOK
  79. struct hidinput_key_translation {
  80. u16 from;
  81. u16 to;
  82. u8 flags;
  83. };
  84. #define APPLE_FLAG_FKEY 0x01
  85. static struct hidinput_key_translation apple_fn_keys[] = {
  86. { KEY_BACKSPACE, KEY_DELETE },
  87. { KEY_F1, KEY_BRIGHTNESSDOWN, APPLE_FLAG_FKEY },
  88. { KEY_F2, KEY_BRIGHTNESSUP, APPLE_FLAG_FKEY },
  89. { KEY_F3, KEY_FN_F5, APPLE_FLAG_FKEY }, /* Exposé */
  90. { KEY_F4, KEY_FN_F4, APPLE_FLAG_FKEY }, /* Dashboard */
  91. { KEY_F5, KEY_KBDILLUMDOWN, APPLE_FLAG_FKEY },
  92. { KEY_F6, KEY_KBDILLUMUP, APPLE_FLAG_FKEY },
  93. { KEY_F7, KEY_PREVIOUSSONG, APPLE_FLAG_FKEY },
  94. { KEY_F8, KEY_PLAYPAUSE, APPLE_FLAG_FKEY },
  95. { KEY_F9, KEY_NEXTSONG, APPLE_FLAG_FKEY },
  96. { KEY_F10, KEY_MUTE, APPLE_FLAG_FKEY },
  97. { KEY_F11, KEY_VOLUMEDOWN, APPLE_FLAG_FKEY },
  98. { KEY_F12, KEY_VOLUMEUP, APPLE_FLAG_FKEY },
  99. { KEY_UP, KEY_PAGEUP },
  100. { KEY_DOWN, KEY_PAGEDOWN },
  101. { KEY_LEFT, KEY_HOME },
  102. { KEY_RIGHT, KEY_END },
  103. { }
  104. };
  105. static struct hidinput_key_translation powerbook_fn_keys[] = {
  106. { KEY_BACKSPACE, KEY_DELETE },
  107. { KEY_F1, KEY_BRIGHTNESSDOWN, APPLE_FLAG_FKEY },
  108. { KEY_F2, KEY_BRIGHTNESSUP, APPLE_FLAG_FKEY },
  109. { KEY_F3, KEY_MUTE, APPLE_FLAG_FKEY },
  110. { KEY_F4, KEY_VOLUMEDOWN, APPLE_FLAG_FKEY },
  111. { KEY_F5, KEY_VOLUMEUP, APPLE_FLAG_FKEY },
  112. { KEY_F6, KEY_NUMLOCK, APPLE_FLAG_FKEY },
  113. { KEY_F7, KEY_SWITCHVIDEOMODE, APPLE_FLAG_FKEY },
  114. { KEY_F8, KEY_KBDILLUMTOGGLE, APPLE_FLAG_FKEY },
  115. { KEY_F9, KEY_KBDILLUMDOWN, APPLE_FLAG_FKEY },
  116. { KEY_F10, KEY_KBDILLUMUP, APPLE_FLAG_FKEY },
  117. { KEY_UP, KEY_PAGEUP },
  118. { KEY_DOWN, KEY_PAGEDOWN },
  119. { KEY_LEFT, KEY_HOME },
  120. { KEY_RIGHT, KEY_END },
  121. { }
  122. };
  123. static struct hidinput_key_translation powerbook_numlock_keys[] = {
  124. { KEY_J, KEY_KP1 },
  125. { KEY_K, KEY_KP2 },
  126. { KEY_L, KEY_KP3 },
  127. { KEY_U, KEY_KP4 },
  128. { KEY_I, KEY_KP5 },
  129. { KEY_O, KEY_KP6 },
  130. { KEY_7, KEY_KP7 },
  131. { KEY_8, KEY_KP8 },
  132. { KEY_9, KEY_KP9 },
  133. { KEY_M, KEY_KP0 },
  134. { KEY_DOT, KEY_KPDOT },
  135. { KEY_SLASH, KEY_KPPLUS },
  136. { KEY_SEMICOLON, KEY_KPMINUS },
  137. { KEY_P, KEY_KPASTERISK },
  138. { KEY_MINUS, KEY_KPEQUAL },
  139. { KEY_0, KEY_KPSLASH },
  140. { KEY_F6, KEY_NUMLOCK },
  141. { KEY_KPENTER, KEY_KPENTER },
  142. { KEY_BACKSPACE, KEY_BACKSPACE },
  143. { }
  144. };
  145. static struct hidinput_key_translation apple_iso_keyboard[] = {
  146. { KEY_GRAVE, KEY_102ND },
  147. { KEY_102ND, KEY_GRAVE },
  148. { }
  149. };
  150. static struct hidinput_key_translation *find_translation(struct hidinput_key_translation *table, u16 from)
  151. {
  152. struct hidinput_key_translation *trans;
  153. /* Look for the translation */
  154. for (trans = table; trans->from; trans++)
  155. if (trans->from == from)
  156. return trans;
  157. return NULL;
  158. }
  159. int hidinput_apple_event(struct hid_device *hid, struct input_dev *input,
  160. struct hid_usage *usage, __s32 value)
  161. {
  162. struct hidinput_key_translation *trans;
  163. if (usage->code == KEY_FN) {
  164. if (value) hid->quirks |= HID_QUIRK_APPLE_FN_ON;
  165. else hid->quirks &= ~HID_QUIRK_APPLE_FN_ON;
  166. input_event(input, usage->type, usage->code, value);
  167. return 1;
  168. }
  169. if (hid_apple_fnmode) {
  170. int do_translate;
  171. trans = find_translation((hid->product < 0x220 ||
  172. hid->product >= 0x300) ?
  173. powerbook_fn_keys : apple_fn_keys,
  174. usage->code);
  175. if (trans) {
  176. if (test_bit(usage->code, hid->apple_pressed_fn))
  177. do_translate = 1;
  178. else if (trans->flags & APPLE_FLAG_FKEY)
  179. do_translate =
  180. (hid_apple_fnmode == 2 && (hid->quirks & HID_QUIRK_APPLE_FN_ON)) ||
  181. (hid_apple_fnmode == 1 && !(hid->quirks & HID_QUIRK_APPLE_FN_ON));
  182. else
  183. do_translate = (hid->quirks & HID_QUIRK_APPLE_FN_ON);
  184. if (do_translate) {
  185. if (value)
  186. set_bit(usage->code, hid->apple_pressed_fn);
  187. else
  188. clear_bit(usage->code, hid->apple_pressed_fn);
  189. input_event(input, usage->type, trans->to, value);
  190. return 1;
  191. }
  192. }
  193. if (hid->quirks & HID_QUIRK_APPLE_NUMLOCK_EMULATION && (
  194. test_bit(usage->code, hid->pb_pressed_numlock) ||
  195. test_bit(LED_NUML, input->led))) {
  196. trans = find_translation(powerbook_numlock_keys, usage->code);
  197. if (trans) {
  198. if (value)
  199. set_bit(usage->code, hid->pb_pressed_numlock);
  200. else
  201. clear_bit(usage->code, hid->pb_pressed_numlock);
  202. input_event(input, usage->type, trans->to, value);
  203. }
  204. return 1;
  205. }
  206. }
  207. if (hid->quirks & HID_QUIRK_APPLE_ISO_KEYBOARD) {
  208. trans = find_translation(apple_iso_keyboard, usage->code);
  209. if (trans) {
  210. input_event(input, usage->type, trans->to, value);
  211. return 1;
  212. }
  213. }
  214. return 0;
  215. }
  216. static void hidinput_apple_setup(struct input_dev *input)
  217. {
  218. struct hidinput_key_translation *trans;
  219. set_bit(KEY_NUMLOCK, input->keybit);
  220. /* Enable all needed keys */
  221. for (trans = apple_fn_keys; trans->from; trans++)
  222. set_bit(trans->to, input->keybit);
  223. for (trans = powerbook_fn_keys; trans->from; trans++)
  224. set_bit(trans->to, input->keybit);
  225. for (trans = powerbook_numlock_keys; trans->from; trans++)
  226. set_bit(trans->to, input->keybit);
  227. for (trans = apple_iso_keyboard; trans->from; trans++)
  228. set_bit(trans->to, input->keybit);
  229. }
  230. #else
  231. inline int hidinput_apple_event(struct hid_device *hid,
  232. struct input_dev *input,
  233. struct hid_usage *usage, __s32 value)
  234. {
  235. return 0;
  236. }
  237. static inline void hidinput_apple_setup(struct input_dev *input)
  238. {
  239. }
  240. #endif
  241. static inline int match_scancode(int code, int scancode)
  242. {
  243. if (scancode == 0)
  244. return 1;
  245. return ((code & (HID_USAGE_PAGE | HID_USAGE)) == scancode);
  246. }
  247. static inline int match_keycode(int code, int keycode)
  248. {
  249. if (keycode == 0)
  250. return 1;
  251. return (code == keycode);
  252. }
  253. static struct hid_usage *hidinput_find_key(struct hid_device *hid,
  254. int scancode, int keycode)
  255. {
  256. int i, j, k;
  257. struct hid_report *report;
  258. struct hid_usage *usage;
  259. for (k = HID_INPUT_REPORT; k <= HID_OUTPUT_REPORT; k++) {
  260. list_for_each_entry(report, &hid->report_enum[k].report_list, list) {
  261. for (i = 0; i < report->maxfield; i++) {
  262. for ( j = 0; j < report->field[i]->maxusage; j++) {
  263. usage = report->field[i]->usage + j;
  264. if (usage->type == EV_KEY &&
  265. match_scancode(usage->hid, scancode) &&
  266. match_keycode(usage->code, keycode))
  267. return usage;
  268. }
  269. }
  270. }
  271. }
  272. return NULL;
  273. }
  274. static int hidinput_getkeycode(struct input_dev *dev, int scancode,
  275. int *keycode)
  276. {
  277. struct hid_device *hid = input_get_drvdata(dev);
  278. struct hid_usage *usage;
  279. usage = hidinput_find_key(hid, scancode, 0);
  280. if (usage) {
  281. *keycode = usage->code;
  282. return 0;
  283. }
  284. return -EINVAL;
  285. }
  286. static int hidinput_setkeycode(struct input_dev *dev, int scancode,
  287. int keycode)
  288. {
  289. struct hid_device *hid = input_get_drvdata(dev);
  290. struct hid_usage *usage;
  291. int old_keycode;
  292. if (keycode < 0 || keycode > KEY_MAX)
  293. return -EINVAL;
  294. usage = hidinput_find_key(hid, scancode, 0);
  295. if (usage) {
  296. old_keycode = usage->code;
  297. usage->code = keycode;
  298. clear_bit(old_keycode, dev->keybit);
  299. set_bit(usage->code, dev->keybit);
  300. dbg_hid(KERN_DEBUG "Assigned keycode %d to HID usage code %x\n", keycode, scancode);
  301. /* Set the keybit for the old keycode if the old keycode is used
  302. * by another key */
  303. if (hidinput_find_key (hid, 0, old_keycode))
  304. set_bit(old_keycode, dev->keybit);
  305. return 0;
  306. }
  307. return -EINVAL;
  308. }
  309. static void hidinput_configure_usage(struct hid_input *hidinput, struct hid_field *field,
  310. struct hid_usage *usage)
  311. {
  312. struct input_dev *input = hidinput->input;
  313. struct hid_device *device = input_get_drvdata(input);
  314. int max = 0, code, ret;
  315. unsigned long *bit = NULL;
  316. field->hidinput = hidinput;
  317. dbg_hid("Mapping: ");
  318. hid_resolv_usage(usage->hid);
  319. dbg_hid_line(" ---> ");
  320. if (field->flags & HID_MAIN_ITEM_CONSTANT)
  321. goto ignore;
  322. /* only LED usages are supported in output fields */
  323. if (field->report_type == HID_OUTPUT_REPORT &&
  324. (usage->hid & HID_USAGE_PAGE) != HID_UP_LED) {
  325. dbg_hid_line(" [non-LED output field] ");
  326. goto ignore;
  327. }
  328. /* handle input mappings for quirky devices */
  329. ret = hidinput_mapping_quirks(usage, hidinput, &bit, &max);
  330. if (ret)
  331. goto mapped;
  332. if (device->driver->input_mapping) {
  333. int ret = device->driver->input_mapping(device, hidinput, field,
  334. usage, &bit, &max);
  335. if (ret > 0)
  336. goto mapped;
  337. if (ret < 0)
  338. goto ignore;
  339. }
  340. switch (usage->hid & HID_USAGE_PAGE) {
  341. case HID_UP_UNDEFINED:
  342. goto ignore;
  343. case HID_UP_KEYBOARD:
  344. set_bit(EV_REP, input->evbit);
  345. if ((usage->hid & HID_USAGE) < 256) {
  346. if (!hid_keyboard[usage->hid & HID_USAGE]) goto ignore;
  347. map_key_clear(hid_keyboard[usage->hid & HID_USAGE]);
  348. } else
  349. map_key(KEY_UNKNOWN);
  350. break;
  351. case HID_UP_BUTTON:
  352. code = ((usage->hid - 1) & 0xf);
  353. switch (field->application) {
  354. case HID_GD_MOUSE:
  355. case HID_GD_POINTER: code += 0x110; break;
  356. case HID_GD_JOYSTICK: code += 0x120; break;
  357. case HID_GD_GAMEPAD: code += 0x130; break;
  358. default:
  359. switch (field->physical) {
  360. case HID_GD_MOUSE:
  361. case HID_GD_POINTER: code += 0x110; break;
  362. case HID_GD_JOYSTICK: code += 0x120; break;
  363. case HID_GD_GAMEPAD: code += 0x130; break;
  364. default: code += 0x100;
  365. }
  366. }
  367. /* Special handling for Logitech Cordless Desktop */
  368. if (field->application != HID_GD_MOUSE) {
  369. if (device->quirks & HID_QUIRK_LOGITECH_EXPANDED_KEYMAP) {
  370. int hid = usage->hid & HID_USAGE;
  371. if (hid < LOGITECH_EXPANDED_KEYMAP_SIZE && logitech_expanded_keymap[hid] != 0)
  372. code = logitech_expanded_keymap[hid];
  373. }
  374. } else {
  375. if (device->quirks & HID_QUIRK_LOGITECH_IGNORE_DOUBLED_WHEEL) {
  376. int hid = usage->hid & HID_USAGE;
  377. if (hid == 7 || hid == 8)
  378. goto ignore;
  379. }
  380. }
  381. map_key(code);
  382. break;
  383. case HID_UP_SIMULATION:
  384. switch (usage->hid & 0xffff) {
  385. case 0xba: map_abs(ABS_RUDDER); break;
  386. case 0xbb: map_abs(ABS_THROTTLE); break;
  387. case 0xc4: map_abs(ABS_GAS); break;
  388. case 0xc5: map_abs(ABS_BRAKE); break;
  389. case 0xc8: map_abs(ABS_WHEEL); break;
  390. default: goto ignore;
  391. }
  392. break;
  393. case HID_UP_GENDESK:
  394. if ((usage->hid & 0xf0) == 0x80) { /* SystemControl */
  395. switch (usage->hid & 0xf) {
  396. case 0x1: map_key_clear(KEY_POWER); break;
  397. case 0x2: map_key_clear(KEY_SLEEP); break;
  398. case 0x3: map_key_clear(KEY_WAKEUP); break;
  399. default: goto unknown;
  400. }
  401. break;
  402. }
  403. if ((usage->hid & 0xf0) == 0x90) { /* D-pad */
  404. switch (usage->hid) {
  405. case HID_GD_UP: usage->hat_dir = 1; break;
  406. case HID_GD_DOWN: usage->hat_dir = 5; break;
  407. case HID_GD_RIGHT: usage->hat_dir = 3; break;
  408. case HID_GD_LEFT: usage->hat_dir = 7; break;
  409. default: goto unknown;
  410. }
  411. if (field->dpad) {
  412. map_abs(field->dpad);
  413. goto ignore;
  414. }
  415. map_abs(ABS_HAT0X);
  416. break;
  417. }
  418. switch (usage->hid) {
  419. /* These usage IDs map directly to the usage codes. */
  420. case HID_GD_X: case HID_GD_Y: case HID_GD_Z:
  421. case HID_GD_RX: case HID_GD_RY: case HID_GD_RZ:
  422. case HID_GD_SLIDER: case HID_GD_DIAL: case HID_GD_WHEEL:
  423. if (field->flags & HID_MAIN_ITEM_RELATIVE)
  424. map_rel(usage->hid & 0xf);
  425. else
  426. map_abs(usage->hid & 0xf);
  427. break;
  428. case HID_GD_HATSWITCH:
  429. usage->hat_min = field->logical_minimum;
  430. usage->hat_max = field->logical_maximum;
  431. map_abs(ABS_HAT0X);
  432. break;
  433. case HID_GD_START: map_key_clear(BTN_START); break;
  434. case HID_GD_SELECT: map_key_clear(BTN_SELECT); break;
  435. default: goto unknown;
  436. }
  437. break;
  438. case HID_UP_LED:
  439. switch (usage->hid & 0xffff) { /* HID-Value: */
  440. case 0x01: map_led (LED_NUML); break; /* "Num Lock" */
  441. case 0x02: map_led (LED_CAPSL); break; /* "Caps Lock" */
  442. case 0x03: map_led (LED_SCROLLL); break; /* "Scroll Lock" */
  443. case 0x04: map_led (LED_COMPOSE); break; /* "Compose" */
  444. case 0x05: map_led (LED_KANA); break; /* "Kana" */
  445. case 0x27: map_led (LED_SLEEP); break; /* "Stand-By" */
  446. case 0x4c: map_led (LED_SUSPEND); break; /* "System Suspend" */
  447. case 0x09: map_led (LED_MUTE); break; /* "Mute" */
  448. case 0x4b: map_led (LED_MISC); break; /* "Generic Indicator" */
  449. case 0x19: map_led (LED_MAIL); break; /* "Message Waiting" */
  450. case 0x4d: map_led (LED_CHARGING); break; /* "External Power Connected" */
  451. default: goto ignore;
  452. }
  453. break;
  454. case HID_UP_DIGITIZER:
  455. switch (usage->hid & 0xff) {
  456. case 0x30: /* TipPressure */
  457. if (!test_bit(BTN_TOUCH, input->keybit)) {
  458. device->quirks |= HID_QUIRK_NOTOUCH;
  459. set_bit(EV_KEY, input->evbit);
  460. set_bit(BTN_TOUCH, input->keybit);
  461. }
  462. map_abs_clear(ABS_PRESSURE);
  463. break;
  464. case 0x32: /* InRange */
  465. switch (field->physical & 0xff) {
  466. case 0x21: map_key(BTN_TOOL_MOUSE); break;
  467. case 0x22: map_key(BTN_TOOL_FINGER); break;
  468. default: map_key(BTN_TOOL_PEN); break;
  469. }
  470. break;
  471. case 0x3c: /* Invert */
  472. map_key_clear(BTN_TOOL_RUBBER);
  473. break;
  474. case 0x33: /* Touch */
  475. case 0x42: /* TipSwitch */
  476. case 0x43: /* TipSwitch2 */
  477. device->quirks &= ~HID_QUIRK_NOTOUCH;
  478. map_key_clear(BTN_TOUCH);
  479. break;
  480. case 0x44: /* BarrelSwitch */
  481. map_key_clear(BTN_STYLUS);
  482. break;
  483. default: goto unknown;
  484. }
  485. break;
  486. case HID_UP_CONSUMER: /* USB HUT v1.1, pages 56-62 */
  487. switch (usage->hid & HID_USAGE) {
  488. case 0x000: goto ignore;
  489. case 0x034: map_key_clear(KEY_SLEEP); break;
  490. case 0x036: map_key_clear(BTN_MISC); break;
  491. case 0x040: map_key_clear(KEY_MENU); break;
  492. case 0x045: map_key_clear(KEY_RADIO); break;
  493. case 0x083: map_key_clear(KEY_LAST); break;
  494. case 0x088: map_key_clear(KEY_PC); break;
  495. case 0x089: map_key_clear(KEY_TV); break;
  496. case 0x08a: map_key_clear(KEY_WWW); break;
  497. case 0x08b: map_key_clear(KEY_DVD); break;
  498. case 0x08c: map_key_clear(KEY_PHONE); break;
  499. case 0x08d: map_key_clear(KEY_PROGRAM); break;
  500. case 0x08e: map_key_clear(KEY_VIDEOPHONE); break;
  501. case 0x08f: map_key_clear(KEY_GAMES); break;
  502. case 0x090: map_key_clear(KEY_MEMO); break;
  503. case 0x091: map_key_clear(KEY_CD); break;
  504. case 0x092: map_key_clear(KEY_VCR); break;
  505. case 0x093: map_key_clear(KEY_TUNER); break;
  506. case 0x094: map_key_clear(KEY_EXIT); break;
  507. case 0x095: map_key_clear(KEY_HELP); break;
  508. case 0x096: map_key_clear(KEY_TAPE); break;
  509. case 0x097: map_key_clear(KEY_TV2); break;
  510. case 0x098: map_key_clear(KEY_SAT); break;
  511. case 0x09a: map_key_clear(KEY_PVR); break;
  512. case 0x09c: map_key_clear(KEY_CHANNELUP); break;
  513. case 0x09d: map_key_clear(KEY_CHANNELDOWN); break;
  514. case 0x0a0: map_key_clear(KEY_VCR2); break;
  515. case 0x0b0: map_key_clear(KEY_PLAY); break;
  516. case 0x0b1: map_key_clear(KEY_PAUSE); break;
  517. case 0x0b2: map_key_clear(KEY_RECORD); break;
  518. case 0x0b3: map_key_clear(KEY_FASTFORWARD); break;
  519. case 0x0b4: map_key_clear(KEY_REWIND); break;
  520. case 0x0b5: map_key_clear(KEY_NEXTSONG); break;
  521. case 0x0b6: map_key_clear(KEY_PREVIOUSSONG); break;
  522. case 0x0b7: map_key_clear(KEY_STOPCD); break;
  523. case 0x0b8: map_key_clear(KEY_EJECTCD); break;
  524. case 0x0bc: map_key_clear(KEY_MEDIA_REPEAT); break;
  525. case 0x0cd: map_key_clear(KEY_PLAYPAUSE); break;
  526. case 0x0e0: map_abs_clear(ABS_VOLUME); break;
  527. case 0x0e2: map_key_clear(KEY_MUTE); break;
  528. case 0x0e5: map_key_clear(KEY_BASSBOOST); break;
  529. case 0x0e9: map_key_clear(KEY_VOLUMEUP); break;
  530. case 0x0ea: map_key_clear(KEY_VOLUMEDOWN); break;
  531. case 0x182: map_key_clear(KEY_BOOKMARKS); break;
  532. case 0x183: map_key_clear(KEY_CONFIG); break;
  533. case 0x184: map_key_clear(KEY_WORDPROCESSOR); break;
  534. case 0x185: map_key_clear(KEY_EDITOR); break;
  535. case 0x186: map_key_clear(KEY_SPREADSHEET); break;
  536. case 0x187: map_key_clear(KEY_GRAPHICSEDITOR); break;
  537. case 0x188: map_key_clear(KEY_PRESENTATION); break;
  538. case 0x189: map_key_clear(KEY_DATABASE); break;
  539. case 0x18a: map_key_clear(KEY_MAIL); break;
  540. case 0x18b: map_key_clear(KEY_NEWS); break;
  541. case 0x18c: map_key_clear(KEY_VOICEMAIL); break;
  542. case 0x18d: map_key_clear(KEY_ADDRESSBOOK); break;
  543. case 0x18e: map_key_clear(KEY_CALENDAR); break;
  544. case 0x191: map_key_clear(KEY_FINANCE); break;
  545. case 0x192: map_key_clear(KEY_CALC); break;
  546. case 0x194: map_key_clear(KEY_FILE); break;
  547. case 0x196: map_key_clear(KEY_WWW); break;
  548. case 0x19c: map_key_clear(KEY_LOGOFF); break;
  549. case 0x19e: map_key_clear(KEY_COFFEE); break;
  550. case 0x1a6: map_key_clear(KEY_HELP); break;
  551. case 0x1a7: map_key_clear(KEY_DOCUMENTS); break;
  552. case 0x1ab: map_key_clear(KEY_SPELLCHECK); break;
  553. case 0x1b6: map_key_clear(KEY_MEDIA); break;
  554. case 0x1b7: map_key_clear(KEY_SOUND); break;
  555. case 0x1bc: map_key_clear(KEY_MESSENGER); break;
  556. case 0x1bd: map_key_clear(KEY_INFO); break;
  557. case 0x201: map_key_clear(KEY_NEW); break;
  558. case 0x202: map_key_clear(KEY_OPEN); break;
  559. case 0x203: map_key_clear(KEY_CLOSE); break;
  560. case 0x204: map_key_clear(KEY_EXIT); break;
  561. case 0x207: map_key_clear(KEY_SAVE); break;
  562. case 0x208: map_key_clear(KEY_PRINT); break;
  563. case 0x209: map_key_clear(KEY_PROPS); break;
  564. case 0x21a: map_key_clear(KEY_UNDO); break;
  565. case 0x21b: map_key_clear(KEY_COPY); break;
  566. case 0x21c: map_key_clear(KEY_CUT); break;
  567. case 0x21d: map_key_clear(KEY_PASTE); break;
  568. case 0x21f: map_key_clear(KEY_FIND); break;
  569. case 0x221: map_key_clear(KEY_SEARCH); break;
  570. case 0x222: map_key_clear(KEY_GOTO); break;
  571. case 0x223: map_key_clear(KEY_HOMEPAGE); break;
  572. case 0x224: map_key_clear(KEY_BACK); break;
  573. case 0x225: map_key_clear(KEY_FORWARD); break;
  574. case 0x226: map_key_clear(KEY_STOP); break;
  575. case 0x227: map_key_clear(KEY_REFRESH); break;
  576. case 0x22a: map_key_clear(KEY_BOOKMARKS); break;
  577. case 0x22d: map_key_clear(KEY_ZOOMIN); break;
  578. case 0x22e: map_key_clear(KEY_ZOOMOUT); break;
  579. case 0x22f: map_key_clear(KEY_ZOOMRESET); break;
  580. case 0x233: map_key_clear(KEY_SCROLLUP); break;
  581. case 0x234: map_key_clear(KEY_SCROLLDOWN); break;
  582. case 0x238: map_rel(REL_HWHEEL); break;
  583. case 0x25f: map_key_clear(KEY_CANCEL); break;
  584. case 0x279: map_key_clear(KEY_REDO); break;
  585. case 0x289: map_key_clear(KEY_REPLY); break;
  586. case 0x28b: map_key_clear(KEY_FORWARDMAIL); break;
  587. case 0x28c: map_key_clear(KEY_SEND); break;
  588. default: goto ignore;
  589. }
  590. break;
  591. case HID_UP_HPVENDOR: /* Reported on a Dutch layout HP5308 */
  592. set_bit(EV_REP, input->evbit);
  593. switch (usage->hid & HID_USAGE) {
  594. case 0x021: map_key_clear(KEY_PRINT); break;
  595. case 0x070: map_key_clear(KEY_HP); break;
  596. case 0x071: map_key_clear(KEY_CAMERA); break;
  597. case 0x072: map_key_clear(KEY_SOUND); break;
  598. case 0x073: map_key_clear(KEY_QUESTION); break;
  599. case 0x080: map_key_clear(KEY_EMAIL); break;
  600. case 0x081: map_key_clear(KEY_CHAT); break;
  601. case 0x082: map_key_clear(KEY_SEARCH); break;
  602. case 0x083: map_key_clear(KEY_CONNECT); break;
  603. case 0x084: map_key_clear(KEY_FINANCE); break;
  604. case 0x085: map_key_clear(KEY_SPORT); break;
  605. case 0x086: map_key_clear(KEY_SHOP); break;
  606. default: goto ignore;
  607. }
  608. break;
  609. case HID_UP_MSVENDOR:
  610. goto ignore;
  611. case HID_UP_CUSTOM: /* Reported on Logitech and Apple USB keyboards */
  612. set_bit(EV_REP, input->evbit);
  613. switch(usage->hid & HID_USAGE) {
  614. case 0x003:
  615. /* The fn key on Apple USB keyboards */
  616. map_key_clear(KEY_FN);
  617. hidinput_apple_setup(input);
  618. break;
  619. default: goto ignore;
  620. }
  621. break;
  622. case HID_UP_LOGIVENDOR:
  623. goto ignore;
  624. case HID_UP_PID:
  625. switch(usage->hid & HID_USAGE) {
  626. case 0xa4: map_key_clear(BTN_DEAD); break;
  627. default: goto ignore;
  628. }
  629. break;
  630. default:
  631. unknown:
  632. if (field->report_size == 1) {
  633. if (field->report->type == HID_OUTPUT_REPORT) {
  634. map_led(LED_MISC);
  635. break;
  636. }
  637. map_key(BTN_MISC);
  638. break;
  639. }
  640. if (field->flags & HID_MAIN_ITEM_RELATIVE) {
  641. map_rel(REL_MISC);
  642. break;
  643. }
  644. map_abs(ABS_MISC);
  645. break;
  646. }
  647. mapped:
  648. if (device->driver->input_mapped && device->driver->input_mapped(device,
  649. hidinput, field, usage, &bit, &max) < 0)
  650. goto ignore;
  651. if (device->quirks & HID_QUIRK_MIGHTYMOUSE) {
  652. if (usage->hid == HID_GD_Z)
  653. map_rel(REL_HWHEEL);
  654. else if (usage->code == BTN_1)
  655. map_key(BTN_2);
  656. else if (usage->code == BTN_2)
  657. map_key(BTN_1);
  658. }
  659. if ((device->quirks & (HID_QUIRK_2WHEEL_MOUSE_HACK_7 | HID_QUIRK_2WHEEL_MOUSE_HACK_5 |
  660. HID_QUIRK_2WHEEL_MOUSE_HACK_B8)) && (usage->type == EV_REL) &&
  661. (usage->code == REL_WHEEL))
  662. set_bit(REL_HWHEEL, bit);
  663. if (((device->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_5) && (usage->hid == 0x00090005))
  664. || ((device->quirks & HID_QUIRK_2WHEEL_MOUSE_HACK_7) && (usage->hid == 0x00090007)))
  665. goto ignore;
  666. if ((device->quirks & HID_QUIRK_BAD_RELATIVE_KEYS) &&
  667. usage->type == EV_KEY && (field->flags & HID_MAIN_ITEM_RELATIVE))
  668. field->flags &= ~HID_MAIN_ITEM_RELATIVE;
  669. set_bit(usage->type, input->evbit);
  670. if (device->quirks & HID_QUIRK_DUPLICATE_USAGES &&
  671. (usage->type == EV_KEY ||
  672. usage->type == EV_REL ||
  673. usage->type == EV_ABS))
  674. clear_bit(usage->code, bit);
  675. while (usage->code <= max && test_and_set_bit(usage->code, bit))
  676. usage->code = find_next_zero_bit(bit, max + 1, usage->code);
  677. if (usage->code > max)
  678. goto ignore;
  679. if (usage->type == EV_ABS) {
  680. int a = field->logical_minimum;
  681. int b = field->logical_maximum;
  682. if ((device->quirks & HID_QUIRK_BADPAD) && (usage->code == ABS_X || usage->code == ABS_Y)) {
  683. a = field->logical_minimum = 0;
  684. b = field->logical_maximum = 255;
  685. }
  686. if (field->application == HID_GD_GAMEPAD || field->application == HID_GD_JOYSTICK)
  687. input_set_abs_params(input, usage->code, a, b, (b - a) >> 8, (b - a) >> 4);
  688. else input_set_abs_params(input, usage->code, a, b, 0, 0);
  689. }
  690. if (usage->type == EV_ABS &&
  691. (usage->hat_min < usage->hat_max || usage->hat_dir)) {
  692. int i;
  693. for (i = usage->code; i < usage->code + 2 && i <= max; i++) {
  694. input_set_abs_params(input, i, -1, 1, 0, 0);
  695. set_bit(i, input->absbit);
  696. }
  697. if (usage->hat_dir && !field->dpad)
  698. field->dpad = usage->code;
  699. }
  700. /* for those devices which produce Consumer volume usage as relative,
  701. * we emulate pressing volumeup/volumedown appropriate number of times
  702. * in hidinput_hid_event()
  703. */
  704. if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
  705. (usage->code == ABS_VOLUME)) {
  706. set_bit(KEY_VOLUMEUP, input->keybit);
  707. set_bit(KEY_VOLUMEDOWN, input->keybit);
  708. }
  709. if (usage->type == EV_KEY) {
  710. set_bit(EV_MSC, input->evbit);
  711. set_bit(MSC_SCAN, input->mscbit);
  712. }
  713. hid_resolv_event(usage->type, usage->code);
  714. dbg_hid_line("\n");
  715. return;
  716. ignore:
  717. dbg_hid_line("IGNORED\n");
  718. return;
  719. }
  720. void hidinput_hid_event(struct hid_device *hid, struct hid_field *field, struct hid_usage *usage, __s32 value)
  721. {
  722. struct input_dev *input;
  723. unsigned *quirks = &hid->quirks;
  724. if (!field->hidinput)
  725. return;
  726. input = field->hidinput->input;
  727. if (!usage->type)
  728. return;
  729. /* handle input events for quirky devices */
  730. if (hidinput_event_quirks(hid, field, usage, value))
  731. return;
  732. if (usage->hat_min < usage->hat_max || usage->hat_dir) {
  733. int hat_dir = usage->hat_dir;
  734. if (!hat_dir)
  735. hat_dir = (value - usage->hat_min) * 8 / (usage->hat_max - usage->hat_min + 1) + 1;
  736. if (hat_dir < 0 || hat_dir > 8) hat_dir = 0;
  737. input_event(input, usage->type, usage->code , hid_hat_to_axis[hat_dir].x);
  738. input_event(input, usage->type, usage->code + 1, hid_hat_to_axis[hat_dir].y);
  739. return;
  740. }
  741. if (usage->hid == (HID_UP_DIGITIZER | 0x003c)) { /* Invert */
  742. *quirks = value ? (*quirks | HID_QUIRK_INVERT) : (*quirks & ~HID_QUIRK_INVERT);
  743. return;
  744. }
  745. if (usage->hid == (HID_UP_DIGITIZER | 0x0032)) { /* InRange */
  746. if (value) {
  747. input_event(input, usage->type, (*quirks & HID_QUIRK_INVERT) ? BTN_TOOL_RUBBER : usage->code, 1);
  748. return;
  749. }
  750. input_event(input, usage->type, usage->code, 0);
  751. input_event(input, usage->type, BTN_TOOL_RUBBER, 0);
  752. return;
  753. }
  754. if (usage->hid == (HID_UP_DIGITIZER | 0x0030) && (*quirks & HID_QUIRK_NOTOUCH)) { /* Pressure */
  755. int a = field->logical_minimum;
  756. int b = field->logical_maximum;
  757. input_event(input, EV_KEY, BTN_TOUCH, value > a + ((b - a) >> 3));
  758. }
  759. if (usage->hid == (HID_UP_PID | 0x83UL)) { /* Simultaneous Effects Max */
  760. dbg_hid("Maximum Effects - %d\n",value);
  761. return;
  762. }
  763. if (usage->hid == (HID_UP_PID | 0x7fUL)) {
  764. dbg_hid("PID Pool Report\n");
  765. return;
  766. }
  767. if ((usage->type == EV_KEY) && (usage->code == 0)) /* Key 0 is "unassigned", not KEY_UNKNOWN */
  768. return;
  769. if ((usage->type == EV_ABS) && (field->flags & HID_MAIN_ITEM_RELATIVE) &&
  770. (usage->code == ABS_VOLUME)) {
  771. int count = abs(value);
  772. int direction = value > 0 ? KEY_VOLUMEUP : KEY_VOLUMEDOWN;
  773. int i;
  774. for (i = 0; i < count; i++) {
  775. input_event(input, EV_KEY, direction, 1);
  776. input_sync(input);
  777. input_event(input, EV_KEY, direction, 0);
  778. input_sync(input);
  779. }
  780. return;
  781. }
  782. /* report the usage code as scancode if the key status has changed */
  783. if (usage->type == EV_KEY && !!test_bit(usage->code, input->key) != value)
  784. input_event(input, EV_MSC, MSC_SCAN, usage->hid);
  785. input_event(input, usage->type, usage->code, value);
  786. if ((field->flags & HID_MAIN_ITEM_RELATIVE) && (usage->type == EV_KEY))
  787. input_event(input, usage->type, usage->code, 0);
  788. }
  789. void hidinput_report_event(struct hid_device *hid, struct hid_report *report)
  790. {
  791. struct hid_input *hidinput;
  792. list_for_each_entry(hidinput, &hid->inputs, list)
  793. input_sync(hidinput->input);
  794. }
  795. EXPORT_SYMBOL_GPL(hidinput_report_event);
  796. int hidinput_find_field(struct hid_device *hid, unsigned int type, unsigned int code, struct hid_field **field)
  797. {
  798. struct hid_report *report;
  799. int i, j;
  800. list_for_each_entry(report, &hid->report_enum[HID_OUTPUT_REPORT].report_list, list) {
  801. for (i = 0; i < report->maxfield; i++) {
  802. *field = report->field[i];
  803. for (j = 0; j < (*field)->maxusage; j++)
  804. if ((*field)->usage[j].type == type && (*field)->usage[j].code == code)
  805. return j;
  806. }
  807. }
  808. return -1;
  809. }
  810. EXPORT_SYMBOL_GPL(hidinput_find_field);
  811. static int hidinput_open(struct input_dev *dev)
  812. {
  813. struct hid_device *hid = input_get_drvdata(dev);
  814. return hid->ll_driver->open(hid);
  815. }
  816. static void hidinput_close(struct input_dev *dev)
  817. {
  818. struct hid_device *hid = input_get_drvdata(dev);
  819. hid->ll_driver->close(hid);
  820. }
  821. /*
  822. * Register the input device; print a message.
  823. * Configure the input layer interface
  824. * Read all reports and initialize the absolute field values.
  825. */
  826. int hidinput_connect(struct hid_device *hid)
  827. {
  828. struct hid_report *report;
  829. struct hid_input *hidinput = NULL;
  830. struct input_dev *input_dev;
  831. int i, j, k;
  832. int max_report_type = HID_OUTPUT_REPORT;
  833. if (hid->quirks & HID_QUIRK_IGNORE_HIDINPUT)
  834. return -1;
  835. INIT_LIST_HEAD(&hid->inputs);
  836. for (i = 0; i < hid->maxcollection; i++)
  837. if (hid->collection[i].type == HID_COLLECTION_APPLICATION ||
  838. hid->collection[i].type == HID_COLLECTION_PHYSICAL)
  839. if (IS_INPUT_APPLICATION(hid->collection[i].usage))
  840. break;
  841. if (i == hid->maxcollection && (hid->quirks & HID_QUIRK_HIDINPUT) == 0)
  842. return -1;
  843. if (hid->quirks & HID_QUIRK_SKIP_OUTPUT_REPORTS)
  844. max_report_type = HID_INPUT_REPORT;
  845. for (k = HID_INPUT_REPORT; k <= max_report_type; k++)
  846. list_for_each_entry(report, &hid->report_enum[k].report_list, list) {
  847. if (!report->maxfield)
  848. continue;
  849. if (!hidinput) {
  850. hidinput = kzalloc(sizeof(*hidinput), GFP_KERNEL);
  851. input_dev = input_allocate_device();
  852. if (!hidinput || !input_dev) {
  853. kfree(hidinput);
  854. input_free_device(input_dev);
  855. err_hid("Out of memory during hid input probe");
  856. goto out_unwind;
  857. }
  858. input_set_drvdata(input_dev, hid);
  859. input_dev->event =
  860. hid->ll_driver->hidinput_input_event;
  861. input_dev->open = hidinput_open;
  862. input_dev->close = hidinput_close;
  863. input_dev->setkeycode = hidinput_setkeycode;
  864. input_dev->getkeycode = hidinput_getkeycode;
  865. input_dev->name = hid->name;
  866. input_dev->phys = hid->phys;
  867. input_dev->uniq = hid->uniq;
  868. input_dev->id.bustype = hid->bus;
  869. input_dev->id.vendor = hid->vendor;
  870. input_dev->id.product = hid->product;
  871. input_dev->id.version = hid->version;
  872. input_dev->dev.parent = hid->dev.parent;
  873. hidinput->input = input_dev;
  874. list_add_tail(&hidinput->list, &hid->inputs);
  875. }
  876. for (i = 0; i < report->maxfield; i++)
  877. for (j = 0; j < report->field[i]->maxusage; j++)
  878. hidinput_configure_usage(hidinput, report->field[i],
  879. report->field[i]->usage + j);
  880. if (hid->quirks & HID_QUIRK_MULTI_INPUT) {
  881. /* This will leave hidinput NULL, so that it
  882. * allocates another one if we have more inputs on
  883. * the same interface. Some devices (e.g. Happ's
  884. * UGCI) cram a lot of unrelated inputs into the
  885. * same interface. */
  886. hidinput->report = report;
  887. if (input_register_device(hidinput->input))
  888. goto out_cleanup;
  889. hidinput = NULL;
  890. }
  891. }
  892. if (hidinput && input_register_device(hidinput->input))
  893. goto out_cleanup;
  894. return 0;
  895. out_cleanup:
  896. input_free_device(hidinput->input);
  897. kfree(hidinput);
  898. out_unwind:
  899. /* unwind the ones we already registered */
  900. hidinput_disconnect(hid);
  901. return -1;
  902. }
  903. EXPORT_SYMBOL_GPL(hidinput_connect);
  904. void hidinput_disconnect(struct hid_device *hid)
  905. {
  906. struct hid_input *hidinput, *next;
  907. list_for_each_entry_safe(hidinput, next, &hid->inputs, list) {
  908. list_del(&hidinput->list);
  909. input_unregister_device(hidinput->input);
  910. kfree(hidinput);
  911. }
  912. }
  913. EXPORT_SYMBOL_GPL(hidinput_disconnect);