hid-core.c 46 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580
  1. /*
  2. * HID support for Linux
  3. *
  4. * Copyright (c) 1999 Andreas Gal
  5. * Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz>
  6. * Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc
  7. * Copyright (c) 2006-2007 Jiri Kosina
  8. */
  9. /*
  10. * This program is free software; you can redistribute it and/or modify it
  11. * under the terms of the GNU General Public License as published by the Free
  12. * Software Foundation; either version 2 of the License, or (at your option)
  13. * any later version.
  14. */
  15. #include <linux/module.h>
  16. #include <linux/slab.h>
  17. #include <linux/init.h>
  18. #include <linux/kernel.h>
  19. #include <linux/list.h>
  20. #include <linux/mm.h>
  21. #include <linux/spinlock.h>
  22. #include <asm/unaligned.h>
  23. #include <asm/byteorder.h>
  24. #include <linux/input.h>
  25. #include <linux/wait.h>
  26. #include <linux/vmalloc.h>
  27. #include <linux/sched.h>
  28. #include <linux/hid.h>
  29. #include <linux/hiddev.h>
  30. #include <linux/hid-debug.h>
  31. #include <linux/hidraw.h>
  32. #include "hid-ids.h"
  33. /*
  34. * Version Information
  35. */
  36. #define DRIVER_VERSION "v2.6"
  37. #define DRIVER_AUTHOR "Andreas Gal, Vojtech Pavlik, Jiri Kosina"
  38. #define DRIVER_DESC "HID core driver"
  39. #define DRIVER_LICENSE "GPL"
  40. #ifdef CONFIG_HID_DEBUG
  41. int hid_debug = 0;
  42. module_param_named(debug, hid_debug, int, 0600);
  43. MODULE_PARM_DESC(debug, "HID debugging (0=off, 1=probing info, 2=continuous data dumping)");
  44. EXPORT_SYMBOL_GPL(hid_debug);
  45. #endif
  46. /*
  47. * Register a new report for a device.
  48. */
  49. static struct hid_report *hid_register_report(struct hid_device *device, unsigned type, unsigned id)
  50. {
  51. struct hid_report_enum *report_enum = device->report_enum + type;
  52. struct hid_report *report;
  53. if (report_enum->report_id_hash[id])
  54. return report_enum->report_id_hash[id];
  55. if (!(report = kzalloc(sizeof(struct hid_report), GFP_KERNEL)))
  56. return NULL;
  57. if (id != 0)
  58. report_enum->numbered = 1;
  59. report->id = id;
  60. report->type = type;
  61. report->size = 0;
  62. report->device = device;
  63. report_enum->report_id_hash[id] = report;
  64. list_add_tail(&report->list, &report_enum->report_list);
  65. return report;
  66. }
  67. /*
  68. * Register a new field for this report.
  69. */
  70. static struct hid_field *hid_register_field(struct hid_report *report, unsigned usages, unsigned values)
  71. {
  72. struct hid_field *field;
  73. if (report->maxfield == HID_MAX_FIELDS) {
  74. dbg_hid("too many fields in report\n");
  75. return NULL;
  76. }
  77. if (!(field = kzalloc(sizeof(struct hid_field) + usages * sizeof(struct hid_usage)
  78. + values * sizeof(unsigned), GFP_KERNEL))) return NULL;
  79. field->index = report->maxfield++;
  80. report->field[field->index] = field;
  81. field->usage = (struct hid_usage *)(field + 1);
  82. field->value = (s32 *)(field->usage + usages);
  83. field->report = report;
  84. return field;
  85. }
  86. /*
  87. * Open a collection. The type/usage is pushed on the stack.
  88. */
  89. static int open_collection(struct hid_parser *parser, unsigned type)
  90. {
  91. struct hid_collection *collection;
  92. unsigned usage;
  93. usage = parser->local.usage[0];
  94. if (parser->collection_stack_ptr == HID_COLLECTION_STACK_SIZE) {
  95. dbg_hid("collection stack overflow\n");
  96. return -1;
  97. }
  98. if (parser->device->maxcollection == parser->device->collection_size) {
  99. collection = kmalloc(sizeof(struct hid_collection) *
  100. parser->device->collection_size * 2, GFP_KERNEL);
  101. if (collection == NULL) {
  102. dbg_hid("failed to reallocate collection array\n");
  103. return -1;
  104. }
  105. memcpy(collection, parser->device->collection,
  106. sizeof(struct hid_collection) *
  107. parser->device->collection_size);
  108. memset(collection + parser->device->collection_size, 0,
  109. sizeof(struct hid_collection) *
  110. parser->device->collection_size);
  111. kfree(parser->device->collection);
  112. parser->device->collection = collection;
  113. parser->device->collection_size *= 2;
  114. }
  115. parser->collection_stack[parser->collection_stack_ptr++] =
  116. parser->device->maxcollection;
  117. collection = parser->device->collection +
  118. parser->device->maxcollection++;
  119. collection->type = type;
  120. collection->usage = usage;
  121. collection->level = parser->collection_stack_ptr - 1;
  122. if (type == HID_COLLECTION_APPLICATION)
  123. parser->device->maxapplication++;
  124. return 0;
  125. }
  126. /*
  127. * Close a collection.
  128. */
  129. static int close_collection(struct hid_parser *parser)
  130. {
  131. if (!parser->collection_stack_ptr) {
  132. dbg_hid("collection stack underflow\n");
  133. return -1;
  134. }
  135. parser->collection_stack_ptr--;
  136. return 0;
  137. }
  138. /*
  139. * Climb up the stack, search for the specified collection type
  140. * and return the usage.
  141. */
  142. static unsigned hid_lookup_collection(struct hid_parser *parser, unsigned type)
  143. {
  144. int n;
  145. for (n = parser->collection_stack_ptr - 1; n >= 0; n--)
  146. if (parser->device->collection[parser->collection_stack[n]].type == type)
  147. return parser->device->collection[parser->collection_stack[n]].usage;
  148. return 0; /* we know nothing about this usage type */
  149. }
  150. /*
  151. * Add a usage to the temporary parser table.
  152. */
  153. static int hid_add_usage(struct hid_parser *parser, unsigned usage)
  154. {
  155. if (parser->local.usage_index >= HID_MAX_USAGES) {
  156. dbg_hid("usage index exceeded\n");
  157. return -1;
  158. }
  159. parser->local.usage[parser->local.usage_index] = usage;
  160. parser->local.collection_index[parser->local.usage_index] =
  161. parser->collection_stack_ptr ?
  162. parser->collection_stack[parser->collection_stack_ptr - 1] : 0;
  163. parser->local.usage_index++;
  164. return 0;
  165. }
  166. /*
  167. * Register a new field for this report.
  168. */
  169. static int hid_add_field(struct hid_parser *parser, unsigned report_type, unsigned flags)
  170. {
  171. struct hid_report *report;
  172. struct hid_field *field;
  173. int usages;
  174. unsigned offset;
  175. int i;
  176. if (!(report = hid_register_report(parser->device, report_type, parser->global.report_id))) {
  177. dbg_hid("hid_register_report failed\n");
  178. return -1;
  179. }
  180. if (parser->global.logical_maximum < parser->global.logical_minimum) {
  181. dbg_hid("logical range invalid %d %d\n", parser->global.logical_minimum, parser->global.logical_maximum);
  182. return -1;
  183. }
  184. offset = report->size;
  185. report->size += parser->global.report_size * parser->global.report_count;
  186. if (!parser->local.usage_index) /* Ignore padding fields */
  187. return 0;
  188. usages = max_t(int, parser->local.usage_index, parser->global.report_count);
  189. if ((field = hid_register_field(report, usages, parser->global.report_count)) == NULL)
  190. return 0;
  191. field->physical = hid_lookup_collection(parser, HID_COLLECTION_PHYSICAL);
  192. field->logical = hid_lookup_collection(parser, HID_COLLECTION_LOGICAL);
  193. field->application = hid_lookup_collection(parser, HID_COLLECTION_APPLICATION);
  194. for (i = 0; i < usages; i++) {
  195. int j = i;
  196. /* Duplicate the last usage we parsed if we have excess values */
  197. if (i >= parser->local.usage_index)
  198. j = parser->local.usage_index - 1;
  199. field->usage[i].hid = parser->local.usage[j];
  200. field->usage[i].collection_index =
  201. parser->local.collection_index[j];
  202. }
  203. field->maxusage = usages;
  204. field->flags = flags;
  205. field->report_offset = offset;
  206. field->report_type = report_type;
  207. field->report_size = parser->global.report_size;
  208. field->report_count = parser->global.report_count;
  209. field->logical_minimum = parser->global.logical_minimum;
  210. field->logical_maximum = parser->global.logical_maximum;
  211. field->physical_minimum = parser->global.physical_minimum;
  212. field->physical_maximum = parser->global.physical_maximum;
  213. field->unit_exponent = parser->global.unit_exponent;
  214. field->unit = parser->global.unit;
  215. return 0;
  216. }
  217. /*
  218. * Read data value from item.
  219. */
  220. static u32 item_udata(struct hid_item *item)
  221. {
  222. switch (item->size) {
  223. case 1: return item->data.u8;
  224. case 2: return item->data.u16;
  225. case 4: return item->data.u32;
  226. }
  227. return 0;
  228. }
  229. static s32 item_sdata(struct hid_item *item)
  230. {
  231. switch (item->size) {
  232. case 1: return item->data.s8;
  233. case 2: return item->data.s16;
  234. case 4: return item->data.s32;
  235. }
  236. return 0;
  237. }
  238. /*
  239. * Process a global item.
  240. */
  241. static int hid_parser_global(struct hid_parser *parser, struct hid_item *item)
  242. {
  243. switch (item->tag) {
  244. case HID_GLOBAL_ITEM_TAG_PUSH:
  245. if (parser->global_stack_ptr == HID_GLOBAL_STACK_SIZE) {
  246. dbg_hid("global enviroment stack overflow\n");
  247. return -1;
  248. }
  249. memcpy(parser->global_stack + parser->global_stack_ptr++,
  250. &parser->global, sizeof(struct hid_global));
  251. return 0;
  252. case HID_GLOBAL_ITEM_TAG_POP:
  253. if (!parser->global_stack_ptr) {
  254. dbg_hid("global enviroment stack underflow\n");
  255. return -1;
  256. }
  257. memcpy(&parser->global, parser->global_stack +
  258. --parser->global_stack_ptr, sizeof(struct hid_global));
  259. return 0;
  260. case HID_GLOBAL_ITEM_TAG_USAGE_PAGE:
  261. parser->global.usage_page = item_udata(item);
  262. return 0;
  263. case HID_GLOBAL_ITEM_TAG_LOGICAL_MINIMUM:
  264. parser->global.logical_minimum = item_sdata(item);
  265. return 0;
  266. case HID_GLOBAL_ITEM_TAG_LOGICAL_MAXIMUM:
  267. if (parser->global.logical_minimum < 0)
  268. parser->global.logical_maximum = item_sdata(item);
  269. else
  270. parser->global.logical_maximum = item_udata(item);
  271. return 0;
  272. case HID_GLOBAL_ITEM_TAG_PHYSICAL_MINIMUM:
  273. parser->global.physical_minimum = item_sdata(item);
  274. return 0;
  275. case HID_GLOBAL_ITEM_TAG_PHYSICAL_MAXIMUM:
  276. if (parser->global.physical_minimum < 0)
  277. parser->global.physical_maximum = item_sdata(item);
  278. else
  279. parser->global.physical_maximum = item_udata(item);
  280. return 0;
  281. case HID_GLOBAL_ITEM_TAG_UNIT_EXPONENT:
  282. parser->global.unit_exponent = item_sdata(item);
  283. return 0;
  284. case HID_GLOBAL_ITEM_TAG_UNIT:
  285. parser->global.unit = item_udata(item);
  286. return 0;
  287. case HID_GLOBAL_ITEM_TAG_REPORT_SIZE:
  288. parser->global.report_size = item_udata(item);
  289. if (parser->global.report_size > 32) {
  290. dbg_hid("invalid report_size %d\n",
  291. parser->global.report_size);
  292. return -1;
  293. }
  294. return 0;
  295. case HID_GLOBAL_ITEM_TAG_REPORT_COUNT:
  296. parser->global.report_count = item_udata(item);
  297. if (parser->global.report_count > HID_MAX_USAGES) {
  298. dbg_hid("invalid report_count %d\n",
  299. parser->global.report_count);
  300. return -1;
  301. }
  302. return 0;
  303. case HID_GLOBAL_ITEM_TAG_REPORT_ID:
  304. parser->global.report_id = item_udata(item);
  305. if (parser->global.report_id == 0) {
  306. dbg_hid("report_id 0 is invalid\n");
  307. return -1;
  308. }
  309. return 0;
  310. default:
  311. dbg_hid("unknown global tag 0x%x\n", item->tag);
  312. return -1;
  313. }
  314. }
  315. /*
  316. * Process a local item.
  317. */
  318. static int hid_parser_local(struct hid_parser *parser, struct hid_item *item)
  319. {
  320. __u32 data;
  321. unsigned n;
  322. if (item->size == 0) {
  323. dbg_hid("item data expected for local item\n");
  324. return -1;
  325. }
  326. data = item_udata(item);
  327. switch (item->tag) {
  328. case HID_LOCAL_ITEM_TAG_DELIMITER:
  329. if (data) {
  330. /*
  331. * We treat items before the first delimiter
  332. * as global to all usage sets (branch 0).
  333. * In the moment we process only these global
  334. * items and the first delimiter set.
  335. */
  336. if (parser->local.delimiter_depth != 0) {
  337. dbg_hid("nested delimiters\n");
  338. return -1;
  339. }
  340. parser->local.delimiter_depth++;
  341. parser->local.delimiter_branch++;
  342. } else {
  343. if (parser->local.delimiter_depth < 1) {
  344. dbg_hid("bogus close delimiter\n");
  345. return -1;
  346. }
  347. parser->local.delimiter_depth--;
  348. }
  349. return 1;
  350. case HID_LOCAL_ITEM_TAG_USAGE:
  351. if (parser->local.delimiter_branch > 1) {
  352. dbg_hid("alternative usage ignored\n");
  353. return 0;
  354. }
  355. if (item->size <= 2)
  356. data = (parser->global.usage_page << 16) + data;
  357. return hid_add_usage(parser, data);
  358. case HID_LOCAL_ITEM_TAG_USAGE_MINIMUM:
  359. if (parser->local.delimiter_branch > 1) {
  360. dbg_hid("alternative usage ignored\n");
  361. return 0;
  362. }
  363. if (item->size <= 2)
  364. data = (parser->global.usage_page << 16) + data;
  365. parser->local.usage_minimum = data;
  366. return 0;
  367. case HID_LOCAL_ITEM_TAG_USAGE_MAXIMUM:
  368. if (parser->local.delimiter_branch > 1) {
  369. dbg_hid("alternative usage ignored\n");
  370. return 0;
  371. }
  372. if (item->size <= 2)
  373. data = (parser->global.usage_page << 16) + data;
  374. for (n = parser->local.usage_minimum; n <= data; n++)
  375. if (hid_add_usage(parser, n)) {
  376. dbg_hid("hid_add_usage failed\n");
  377. return -1;
  378. }
  379. return 0;
  380. default:
  381. dbg_hid("unknown local item tag 0x%x\n", item->tag);
  382. return 0;
  383. }
  384. return 0;
  385. }
  386. /*
  387. * Process a main item.
  388. */
  389. static int hid_parser_main(struct hid_parser *parser, struct hid_item *item)
  390. {
  391. __u32 data;
  392. int ret;
  393. data = item_udata(item);
  394. switch (item->tag) {
  395. case HID_MAIN_ITEM_TAG_BEGIN_COLLECTION:
  396. ret = open_collection(parser, data & 0xff);
  397. break;
  398. case HID_MAIN_ITEM_TAG_END_COLLECTION:
  399. ret = close_collection(parser);
  400. break;
  401. case HID_MAIN_ITEM_TAG_INPUT:
  402. ret = hid_add_field(parser, HID_INPUT_REPORT, data);
  403. break;
  404. case HID_MAIN_ITEM_TAG_OUTPUT:
  405. ret = hid_add_field(parser, HID_OUTPUT_REPORT, data);
  406. break;
  407. case HID_MAIN_ITEM_TAG_FEATURE:
  408. ret = hid_add_field(parser, HID_FEATURE_REPORT, data);
  409. break;
  410. default:
  411. dbg_hid("unknown main item tag 0x%x\n", item->tag);
  412. ret = 0;
  413. }
  414. memset(&parser->local, 0, sizeof(parser->local)); /* Reset the local parser environment */
  415. return ret;
  416. }
  417. /*
  418. * Process a reserved item.
  419. */
  420. static int hid_parser_reserved(struct hid_parser *parser, struct hid_item *item)
  421. {
  422. dbg_hid("reserved item type, tag 0x%x\n", item->tag);
  423. return 0;
  424. }
  425. /*
  426. * Free a report and all registered fields. The field->usage and
  427. * field->value table's are allocated behind the field, so we need
  428. * only to free(field) itself.
  429. */
  430. static void hid_free_report(struct hid_report *report)
  431. {
  432. unsigned n;
  433. for (n = 0; n < report->maxfield; n++)
  434. kfree(report->field[n]);
  435. kfree(report);
  436. }
  437. /*
  438. * Free a device structure, all reports, and all fields.
  439. */
  440. static void hid_device_release(struct device *dev)
  441. {
  442. struct hid_device *device = container_of(dev, struct hid_device, dev);
  443. unsigned i, j;
  444. for (i = 0; i < HID_REPORT_TYPES; i++) {
  445. struct hid_report_enum *report_enum = device->report_enum + i;
  446. for (j = 0; j < 256; j++) {
  447. struct hid_report *report = report_enum->report_id_hash[j];
  448. if (report)
  449. hid_free_report(report);
  450. }
  451. }
  452. kfree(device->rdesc);
  453. kfree(device->collection);
  454. kfree(device);
  455. }
  456. /*
  457. * Fetch a report description item from the data stream. We support long
  458. * items, though they are not used yet.
  459. */
  460. static u8 *fetch_item(__u8 *start, __u8 *end, struct hid_item *item)
  461. {
  462. u8 b;
  463. if ((end - start) <= 0)
  464. return NULL;
  465. b = *start++;
  466. item->type = (b >> 2) & 3;
  467. item->tag = (b >> 4) & 15;
  468. if (item->tag == HID_ITEM_TAG_LONG) {
  469. item->format = HID_ITEM_FORMAT_LONG;
  470. if ((end - start) < 2)
  471. return NULL;
  472. item->size = *start++;
  473. item->tag = *start++;
  474. if ((end - start) < item->size)
  475. return NULL;
  476. item->data.longdata = start;
  477. start += item->size;
  478. return start;
  479. }
  480. item->format = HID_ITEM_FORMAT_SHORT;
  481. item->size = b & 3;
  482. switch (item->size) {
  483. case 0:
  484. return start;
  485. case 1:
  486. if ((end - start) < 1)
  487. return NULL;
  488. item->data.u8 = *start++;
  489. return start;
  490. case 2:
  491. if ((end - start) < 2)
  492. return NULL;
  493. item->data.u16 = get_unaligned_le16(start);
  494. start = (__u8 *)((__le16 *)start + 1);
  495. return start;
  496. case 3:
  497. item->size++;
  498. if ((end - start) < 4)
  499. return NULL;
  500. item->data.u32 = get_unaligned_le32(start);
  501. start = (__u8 *)((__le32 *)start + 1);
  502. return start;
  503. }
  504. return NULL;
  505. }
  506. /**
  507. * hid_parse_report - parse device report
  508. *
  509. * @device: hid device
  510. * @start: report start
  511. * @size: report size
  512. *
  513. * Parse a report description into a hid_device structure. Reports are
  514. * enumerated, fields are attached to these reports.
  515. * 0 returned on success, otherwise nonzero error value.
  516. */
  517. int hid_parse_report(struct hid_device *device, __u8 *start,
  518. unsigned size)
  519. {
  520. struct hid_parser *parser;
  521. struct hid_item item;
  522. __u8 *end;
  523. int ret;
  524. static int (*dispatch_type[])(struct hid_parser *parser,
  525. struct hid_item *item) = {
  526. hid_parser_main,
  527. hid_parser_global,
  528. hid_parser_local,
  529. hid_parser_reserved
  530. };
  531. if (device->driver->report_fixup)
  532. device->driver->report_fixup(device, start, size);
  533. device->rdesc = kmalloc(size, GFP_KERNEL);
  534. if (device->rdesc == NULL)
  535. return -ENOMEM;
  536. memcpy(device->rdesc, start, size);
  537. device->rsize = size;
  538. parser = vmalloc(sizeof(struct hid_parser));
  539. if (!parser) {
  540. ret = -ENOMEM;
  541. goto err;
  542. }
  543. memset(parser, 0, sizeof(struct hid_parser));
  544. parser->device = device;
  545. end = start + size;
  546. ret = -EINVAL;
  547. while ((start = fetch_item(start, end, &item)) != NULL) {
  548. if (item.format != HID_ITEM_FORMAT_SHORT) {
  549. dbg_hid("unexpected long global item\n");
  550. goto err;
  551. }
  552. if (dispatch_type[item.type](parser, &item)) {
  553. dbg_hid("item %u %u %u %u parsing failed\n",
  554. item.format, (unsigned)item.size, (unsigned)item.type, (unsigned)item.tag);
  555. goto err;
  556. }
  557. if (start == end) {
  558. if (parser->collection_stack_ptr) {
  559. dbg_hid("unbalanced collection at end of report description\n");
  560. goto err;
  561. }
  562. if (parser->local.delimiter_depth) {
  563. dbg_hid("unbalanced delimiter at end of report description\n");
  564. goto err;
  565. }
  566. vfree(parser);
  567. return 0;
  568. }
  569. }
  570. dbg_hid("item fetching failed at offset %d\n", (int)(end - start));
  571. err:
  572. vfree(parser);
  573. return ret;
  574. }
  575. EXPORT_SYMBOL_GPL(hid_parse_report);
  576. /*
  577. * Convert a signed n-bit integer to signed 32-bit integer. Common
  578. * cases are done through the compiler, the screwed things has to be
  579. * done by hand.
  580. */
  581. static s32 snto32(__u32 value, unsigned n)
  582. {
  583. switch (n) {
  584. case 8: return ((__s8)value);
  585. case 16: return ((__s16)value);
  586. case 32: return ((__s32)value);
  587. }
  588. return value & (1 << (n - 1)) ? value | (-1 << n) : value;
  589. }
  590. /*
  591. * Convert a signed 32-bit integer to a signed n-bit integer.
  592. */
  593. static u32 s32ton(__s32 value, unsigned n)
  594. {
  595. s32 a = value >> (n - 1);
  596. if (a && a != -1)
  597. return value < 0 ? 1 << (n - 1) : (1 << (n - 1)) - 1;
  598. return value & ((1 << n) - 1);
  599. }
  600. /*
  601. * Extract/implement a data field from/to a little endian report (bit array).
  602. *
  603. * Code sort-of follows HID spec:
  604. * http://www.usb.org/developers/devclass_docs/HID1_11.pdf
  605. *
  606. * While the USB HID spec allows unlimited length bit fields in "report
  607. * descriptors", most devices never use more than 16 bits.
  608. * One model of UPS is claimed to report "LINEV" as a 32-bit field.
  609. * Search linux-kernel and linux-usb-devel archives for "hid-core extract".
  610. */
  611. static __inline__ __u32 extract(__u8 *report, unsigned offset, unsigned n)
  612. {
  613. u64 x;
  614. if (n > 32)
  615. printk(KERN_WARNING "HID: extract() called with n (%d) > 32! (%s)\n",
  616. n, current->comm);
  617. report += offset >> 3; /* adjust byte index */
  618. offset &= 7; /* now only need bit offset into one byte */
  619. x = get_unaligned_le64(report);
  620. x = (x >> offset) & ((1ULL << n) - 1); /* extract bit field */
  621. return (u32) x;
  622. }
  623. /*
  624. * "implement" : set bits in a little endian bit stream.
  625. * Same concepts as "extract" (see comments above).
  626. * The data mangled in the bit stream remains in little endian
  627. * order the whole time. It make more sense to talk about
  628. * endianness of register values by considering a register
  629. * a "cached" copy of the little endiad bit stream.
  630. */
  631. static __inline__ void implement(__u8 *report, unsigned offset, unsigned n, __u32 value)
  632. {
  633. u64 x;
  634. u64 m = (1ULL << n) - 1;
  635. if (n > 32)
  636. printk(KERN_WARNING "HID: implement() called with n (%d) > 32! (%s)\n",
  637. n, current->comm);
  638. if (value > m)
  639. printk(KERN_WARNING "HID: implement() called with too large value %d! (%s)\n",
  640. value, current->comm);
  641. WARN_ON(value > m);
  642. value &= m;
  643. report += offset >> 3;
  644. offset &= 7;
  645. x = get_unaligned_le64(report);
  646. x &= ~(m << offset);
  647. x |= ((u64)value) << offset;
  648. put_unaligned_le64(x, report);
  649. }
  650. /*
  651. * Search an array for a value.
  652. */
  653. static __inline__ int search(__s32 *array, __s32 value, unsigned n)
  654. {
  655. while (n--) {
  656. if (*array++ == value)
  657. return 0;
  658. }
  659. return -1;
  660. }
  661. /**
  662. * hid_match_report - check if driver's raw_event should be called
  663. *
  664. * @hid: hid device
  665. * @report_type: type to match against
  666. *
  667. * compare hid->driver->report_table->report_type to report->type
  668. */
  669. static int hid_match_report(struct hid_device *hid, struct hid_report *report)
  670. {
  671. const struct hid_report_id *id = hid->driver->report_table;
  672. if (!id) /* NULL means all */
  673. return 1;
  674. for (; id->report_type != HID_TERMINATOR; id++)
  675. if (id->report_type == HID_ANY_ID ||
  676. id->report_type == report->type)
  677. return 1;
  678. return 0;
  679. }
  680. /**
  681. * hid_match_usage - check if driver's event should be called
  682. *
  683. * @hid: hid device
  684. * @usage: usage to match against
  685. *
  686. * compare hid->driver->usage_table->usage_{type,code} to
  687. * usage->usage_{type,code}
  688. */
  689. static int hid_match_usage(struct hid_device *hid, struct hid_usage *usage)
  690. {
  691. const struct hid_usage_id *id = hid->driver->usage_table;
  692. if (!id) /* NULL means all */
  693. return 1;
  694. for (; id->usage_type != HID_ANY_ID - 1; id++)
  695. if ((id->usage_hid == HID_ANY_ID ||
  696. id->usage_hid == usage->hid) &&
  697. (id->usage_type == HID_ANY_ID ||
  698. id->usage_type == usage->type) &&
  699. (id->usage_code == HID_ANY_ID ||
  700. id->usage_code == usage->code))
  701. return 1;
  702. return 0;
  703. }
  704. static void hid_process_event(struct hid_device *hid, struct hid_field *field,
  705. struct hid_usage *usage, __s32 value, int interrupt)
  706. {
  707. struct hid_driver *hdrv = hid->driver;
  708. int ret;
  709. hid_dump_input(usage, value);
  710. if (hdrv && hdrv->event && hid_match_usage(hid, usage)) {
  711. ret = hdrv->event(hid, field, usage, value);
  712. if (ret != 0) {
  713. if (ret < 0)
  714. dbg_hid("%s's event failed with %d\n",
  715. hdrv->name, ret);
  716. return;
  717. }
  718. }
  719. if (hid->claimed & HID_CLAIMED_INPUT)
  720. hidinput_hid_event(hid, field, usage, value);
  721. if (hid->claimed & HID_CLAIMED_HIDDEV && interrupt && hid->hiddev_hid_event)
  722. hid->hiddev_hid_event(hid, field, usage, value);
  723. }
  724. /*
  725. * Analyse a received field, and fetch the data from it. The field
  726. * content is stored for next report processing (we do differential
  727. * reporting to the layer).
  728. */
  729. static void hid_input_field(struct hid_device *hid, struct hid_field *field,
  730. __u8 *data, int interrupt)
  731. {
  732. unsigned n;
  733. unsigned count = field->report_count;
  734. unsigned offset = field->report_offset;
  735. unsigned size = field->report_size;
  736. __s32 min = field->logical_minimum;
  737. __s32 max = field->logical_maximum;
  738. __s32 *value;
  739. if (!(value = kmalloc(sizeof(__s32) * count, GFP_ATOMIC)))
  740. return;
  741. for (n = 0; n < count; n++) {
  742. value[n] = min < 0 ? snto32(extract(data, offset + n * size, size), size) :
  743. extract(data, offset + n * size, size);
  744. if (!(field->flags & HID_MAIN_ITEM_VARIABLE) /* Ignore report if ErrorRollOver */
  745. && value[n] >= min && value[n] <= max
  746. && field->usage[value[n] - min].hid == HID_UP_KEYBOARD + 1)
  747. goto exit;
  748. }
  749. for (n = 0; n < count; n++) {
  750. if (HID_MAIN_ITEM_VARIABLE & field->flags) {
  751. hid_process_event(hid, field, &field->usage[n], value[n], interrupt);
  752. continue;
  753. }
  754. if (field->value[n] >= min && field->value[n] <= max
  755. && field->usage[field->value[n] - min].hid
  756. && search(value, field->value[n], count))
  757. hid_process_event(hid, field, &field->usage[field->value[n] - min], 0, interrupt);
  758. if (value[n] >= min && value[n] <= max
  759. && field->usage[value[n] - min].hid
  760. && search(field->value, value[n], count))
  761. hid_process_event(hid, field, &field->usage[value[n] - min], 1, interrupt);
  762. }
  763. memcpy(field->value, value, count * sizeof(__s32));
  764. exit:
  765. kfree(value);
  766. }
  767. /*
  768. * Output the field into the report.
  769. */
  770. static void hid_output_field(struct hid_field *field, __u8 *data)
  771. {
  772. unsigned count = field->report_count;
  773. unsigned offset = field->report_offset;
  774. unsigned size = field->report_size;
  775. unsigned bitsused = offset + count * size;
  776. unsigned n;
  777. /* make sure the unused bits in the last byte are zeros */
  778. if (count > 0 && size > 0 && (bitsused % 8) != 0)
  779. data[(bitsused-1)/8] &= (1 << (bitsused % 8)) - 1;
  780. for (n = 0; n < count; n++) {
  781. if (field->logical_minimum < 0) /* signed values */
  782. implement(data, offset + n * size, size, s32ton(field->value[n], size));
  783. else /* unsigned values */
  784. implement(data, offset + n * size, size, field->value[n]);
  785. }
  786. }
  787. /*
  788. * Create a report.
  789. */
  790. void hid_output_report(struct hid_report *report, __u8 *data)
  791. {
  792. unsigned n;
  793. if (report->id > 0)
  794. *data++ = report->id;
  795. for (n = 0; n < report->maxfield; n++)
  796. hid_output_field(report->field[n], data);
  797. }
  798. EXPORT_SYMBOL_GPL(hid_output_report);
  799. /*
  800. * Set a field value. The report this field belongs to has to be
  801. * created and transferred to the device, to set this value in the
  802. * device.
  803. */
  804. int hid_set_field(struct hid_field *field, unsigned offset, __s32 value)
  805. {
  806. unsigned size = field->report_size;
  807. hid_dump_input(field->usage + offset, value);
  808. if (offset >= field->report_count) {
  809. dbg_hid("offset (%d) exceeds report_count (%d)\n", offset, field->report_count);
  810. hid_dump_field(field, 8);
  811. return -1;
  812. }
  813. if (field->logical_minimum < 0) {
  814. if (value != snto32(s32ton(value, size), size)) {
  815. dbg_hid("value %d is out of range\n", value);
  816. return -1;
  817. }
  818. }
  819. field->value[offset] = value;
  820. return 0;
  821. }
  822. EXPORT_SYMBOL_GPL(hid_set_field);
  823. static struct hid_report *hid_get_report(struct hid_report_enum *report_enum,
  824. const u8 *data)
  825. {
  826. struct hid_report *report;
  827. unsigned int n = 0; /* Normally report number is 0 */
  828. /* Device uses numbered reports, data[0] is report number */
  829. if (report_enum->numbered)
  830. n = *data;
  831. report = report_enum->report_id_hash[n];
  832. if (report == NULL)
  833. dbg_hid("undefined report_id %u received\n", n);
  834. return report;
  835. }
  836. void hid_report_raw_event(struct hid_device *hid, int type, u8 *data, int size,
  837. int interrupt)
  838. {
  839. struct hid_report_enum *report_enum = hid->report_enum + type;
  840. struct hid_report *report;
  841. unsigned int a;
  842. int rsize, csize = size;
  843. u8 *cdata = data;
  844. report = hid_get_report(report_enum, data);
  845. if (!report)
  846. return;
  847. if (report_enum->numbered) {
  848. cdata++;
  849. csize--;
  850. }
  851. rsize = ((report->size - 1) >> 3) + 1;
  852. if (csize < rsize) {
  853. dbg_hid("report %d is too short, (%d < %d)\n", report->id,
  854. csize, rsize);
  855. memset(cdata + csize, 0, rsize - csize);
  856. }
  857. if ((hid->claimed & HID_CLAIMED_HIDDEV) && hid->hiddev_report_event)
  858. hid->hiddev_report_event(hid, report);
  859. if (hid->claimed & HID_CLAIMED_HIDRAW) {
  860. /* numbered reports need to be passed with the report num */
  861. if (report_enum->numbered)
  862. hidraw_report_event(hid, data - 1, size + 1);
  863. else
  864. hidraw_report_event(hid, data, size);
  865. }
  866. for (a = 0; a < report->maxfield; a++)
  867. hid_input_field(hid, report->field[a], cdata, interrupt);
  868. if (hid->claimed & HID_CLAIMED_INPUT)
  869. hidinput_report_event(hid, report);
  870. }
  871. EXPORT_SYMBOL_GPL(hid_report_raw_event);
  872. /**
  873. * hid_input_report - report data from lower layer (usb, bt...)
  874. *
  875. * @hid: hid device
  876. * @type: HID report type (HID_*_REPORT)
  877. * @data: report contents
  878. * @size: size of data parameter
  879. * @interrupt: called from atomic?
  880. *
  881. * This is data entry for lower layers.
  882. */
  883. int hid_input_report(struct hid_device *hid, int type, u8 *data, int size, int interrupt)
  884. {
  885. struct hid_report_enum *report_enum = hid->report_enum + type;
  886. struct hid_driver *hdrv = hid->driver;
  887. struct hid_report *report;
  888. unsigned int i;
  889. int ret;
  890. if (!hid || !hid->driver)
  891. return -ENODEV;
  892. if (!size) {
  893. dbg_hid("empty report\n");
  894. return -1;
  895. }
  896. dbg_hid("report (size %u) (%snumbered)\n", size, report_enum->numbered ? "" : "un");
  897. report = hid_get_report(report_enum, data);
  898. if (!report)
  899. return -1;
  900. /* dump the report */
  901. dbg_hid("report %d (size %u) = ", report->id, size);
  902. for (i = 0; i < size; i++)
  903. dbg_hid_line(" %02x", data[i]);
  904. dbg_hid_line("\n");
  905. if (hdrv && hdrv->raw_event && hid_match_report(hid, report)) {
  906. ret = hdrv->raw_event(hid, report, data, size);
  907. if (ret != 0)
  908. return ret < 0 ? ret : 0;
  909. }
  910. hid_report_raw_event(hid, type, data, size, interrupt);
  911. return 0;
  912. }
  913. EXPORT_SYMBOL_GPL(hid_input_report);
  914. static bool hid_match_one_id(struct hid_device *hdev,
  915. const struct hid_device_id *id)
  916. {
  917. return id->bus == hdev->bus &&
  918. (id->vendor == HID_ANY_ID || id->vendor == hdev->vendor) &&
  919. (id->product == HID_ANY_ID || id->product == hdev->product);
  920. }
  921. static const struct hid_device_id *hid_match_id(struct hid_device *hdev,
  922. const struct hid_device_id *id)
  923. {
  924. for (; id->bus; id++)
  925. if (hid_match_one_id(hdev, id))
  926. return id;
  927. return NULL;
  928. }
  929. static const struct hid_device_id hid_blacklist[] = {
  930. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_IRCONTROL4) },
  931. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_MIGHTYMOUSE) },
  932. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_FOUNTAIN_ANSI) },
  933. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_FOUNTAIN_ISO) },
  934. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER_ANSI) },
  935. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER_ISO) },
  936. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER_JIS) },
  937. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER3_ANSI) },
  938. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER3_ISO) },
  939. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER3_JIS) },
  940. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_ANSI) },
  941. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_ISO) },
  942. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_JIS) },
  943. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_ANSI) },
  944. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_ISO) },
  945. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_JIS) },
  946. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_HF_ANSI) },
  947. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_HF_ISO) },
  948. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER4_HF_JIS) },
  949. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_WIRELESS_ANSI) },
  950. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_WIRELESS_ISO) },
  951. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_ALU_WIRELESS_JIS) },
  952. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING_ANSI) },
  953. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING_ISO) },
  954. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING_JIS) },
  955. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING2_ANSI) },
  956. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING2_ISO) },
  957. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_WELLSPRING2_JIS) },
  958. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_FOUNTAIN_TP_ONLY) },
  959. { HID_USB_DEVICE(USB_VENDOR_ID_APPLE, USB_DEVICE_ID_APPLE_GEYSER1_TP_ONLY) },
  960. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_MX3000_RECEIVER) },
  961. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER) },
  962. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_S510_RECEIVER_2) },
  963. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_RECEIVER) },
  964. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_DESKTOP) },
  965. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_EDGE) },
  966. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_DINOVO_MINI) },
  967. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_KBD) },
  968. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_ELITE_KBD) },
  969. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_CORDLESS_DESKTOP_LX500) },
  970. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_LX3) },
  971. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_V150) },
  972. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_EXTREME_3D) },
  973. { HID_USB_DEVICE(USB_VENDOR_ID_LOGITECH, USB_DEVICE_ID_LOGITECH_WHEEL) },
  974. { HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE, 0x030c) },
  975. { }
  976. };
  977. static int hid_bus_match(struct device *dev, struct device_driver *drv)
  978. {
  979. struct hid_driver *hdrv = container_of(drv, struct hid_driver, driver);
  980. struct hid_device *hdev = container_of(dev, struct hid_device, dev);
  981. if (!hid_match_id(hdev, hdrv->id_table))
  982. return 0;
  983. /* generic wants all non-blacklisted */
  984. if (!strncmp(hdrv->name, "generic-", 8))
  985. return !hid_match_id(hdev, hid_blacklist);
  986. return 1;
  987. }
  988. static int hid_device_probe(struct device *dev)
  989. {
  990. struct hid_driver *hdrv = container_of(dev->driver,
  991. struct hid_driver, driver);
  992. struct hid_device *hdev = container_of(dev, struct hid_device, dev);
  993. const struct hid_device_id *id;
  994. int ret = 0;
  995. if (!hdev->driver) {
  996. id = hid_match_id(hdev, hdrv->id_table);
  997. if (id == NULL)
  998. return -ENODEV;
  999. hdev->driver = hdrv;
  1000. if (hdrv->probe) {
  1001. ret = hdrv->probe(hdev, id);
  1002. } else { /* default probe */
  1003. ret = hid_parse(hdev);
  1004. if (!ret)
  1005. ret = hid_hw_start(hdev);
  1006. }
  1007. if (ret)
  1008. hdev->driver = NULL;
  1009. }
  1010. return ret;
  1011. }
  1012. static int hid_device_remove(struct device *dev)
  1013. {
  1014. struct hid_device *hdev = container_of(dev, struct hid_device, dev);
  1015. struct hid_driver *hdrv = hdev->driver;
  1016. if (hdrv) {
  1017. if (hdrv->remove)
  1018. hdrv->remove(hdev);
  1019. else /* default remove */
  1020. hid_hw_stop(hdev);
  1021. hdev->driver = NULL;
  1022. }
  1023. return 0;
  1024. }
  1025. static int hid_uevent(struct device *dev, struct kobj_uevent_env *env)
  1026. {
  1027. struct hid_device *hdev = container_of(dev, struct hid_device, dev);
  1028. if (add_uevent_var(env, "HID_ID=%04X:%08X:%08X",
  1029. hdev->bus, hdev->vendor, hdev->product))
  1030. return -ENOMEM;
  1031. if (add_uevent_var(env, "HID_NAME=%s", hdev->name))
  1032. return -ENOMEM;
  1033. if (add_uevent_var(env, "HID_PHYS=%s", hdev->phys))
  1034. return -ENOMEM;
  1035. if (add_uevent_var(env, "HID_UNIQ=%s", hdev->uniq))
  1036. return -ENOMEM;
  1037. if (add_uevent_var(env, "MODALIAS=hid:b%04Xv%08Xp%08X",
  1038. hdev->bus, hdev->vendor, hdev->product))
  1039. return -ENOMEM;
  1040. return 0;
  1041. }
  1042. static struct bus_type hid_bus_type = {
  1043. .name = "hid",
  1044. .match = hid_bus_match,
  1045. .probe = hid_device_probe,
  1046. .remove = hid_device_remove,
  1047. .uevent = hid_uevent,
  1048. };
  1049. static const struct hid_device_id hid_ignore_list[] = {
  1050. { HID_USB_DEVICE(USB_VENDOR_ID_ACECAD, USB_DEVICE_ID_ACECAD_FLAIR) },
  1051. { HID_USB_DEVICE(USB_VENDOR_ID_ACECAD, USB_DEVICE_ID_ACECAD_302) },
  1052. { HID_USB_DEVICE(USB_VENDOR_ID_ADS_TECH, USB_DEVICE_ID_ADS_TECH_RADIO_SI470X) },
  1053. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_01) },
  1054. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_10) },
  1055. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_20) },
  1056. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_21) },
  1057. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_22) },
  1058. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_23) },
  1059. { HID_USB_DEVICE(USB_VENDOR_ID_AIPTEK, USB_DEVICE_ID_AIPTEK_24) },
  1060. { HID_USB_DEVICE(USB_VENDOR_ID_AIRCABLE, USB_DEVICE_ID_AIRCABLE1) },
  1061. { HID_USB_DEVICE(USB_VENDOR_ID_ALCOR, USB_DEVICE_ID_ALCOR_USBRS232) },
  1062. { HID_USB_DEVICE(USB_VENDOR_ID_ASUS, USB_DEVICE_ID_ASUS_LCM)},
  1063. { HID_USB_DEVICE(USB_VENDOR_ID_BERKSHIRE, USB_DEVICE_ID_BERKSHIRE_PCWD) },
  1064. { HID_USB_DEVICE(USB_VENDOR_ID_CIDC, 0x0103) },
  1065. { HID_USB_DEVICE(USB_VENDOR_ID_CYGNAL, USB_DEVICE_ID_CYGNAL_RADIO_SI470X) },
  1066. { HID_USB_DEVICE(USB_VENDOR_ID_CMEDIA, USB_DEVICE_ID_CM109) },
  1067. { HID_USB_DEVICE(USB_VENDOR_ID_CYPRESS, USB_DEVICE_ID_CYPRESS_HIDCOM) },
  1068. { HID_USB_DEVICE(USB_VENDOR_ID_CYPRESS, USB_DEVICE_ID_CYPRESS_ULTRAMOUSE) },
  1069. { HID_USB_DEVICE(USB_VENDOR_ID_DELORME, USB_DEVICE_ID_DELORME_EARTHMATE) },
  1070. { HID_USB_DEVICE(USB_VENDOR_ID_DELORME, USB_DEVICE_ID_DELORME_EM_LT20) },
  1071. { HID_USB_DEVICE(USB_VENDOR_ID_ESSENTIAL_REALITY, USB_DEVICE_ID_ESSENTIAL_REALITY_P5) },
  1072. { HID_USB_DEVICE(USB_VENDOR_ID_GENERAL_TOUCH, 0x0001) },
  1073. { HID_USB_DEVICE(USB_VENDOR_ID_GENERAL_TOUCH, 0x0002) },
  1074. { HID_USB_DEVICE(USB_VENDOR_ID_GENERAL_TOUCH, 0x0003) },
  1075. { HID_USB_DEVICE(USB_VENDOR_ID_GENERAL_TOUCH, 0x0004) },
  1076. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_4_PHIDGETSERVO_30) },
  1077. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_1_PHIDGETSERVO_30) },
  1078. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_0_0_4_IF_KIT) },
  1079. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_0_16_16_IF_KIT) },
  1080. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_8_8_8_IF_KIT) },
  1081. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_0_8_7_IF_KIT) },
  1082. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_0_8_8_IF_KIT) },
  1083. { HID_USB_DEVICE(USB_VENDOR_ID_GLAB, USB_DEVICE_ID_PHIDGET_MOTORCONTROL) },
  1084. { HID_USB_DEVICE(USB_VENDOR_ID_GOTOP, USB_DEVICE_ID_SUPER_Q2) },
  1085. { HID_USB_DEVICE(USB_VENDOR_ID_GOTOP, USB_DEVICE_ID_GOGOPEN) },
  1086. { HID_USB_DEVICE(USB_VENDOR_ID_GOTOP, USB_DEVICE_ID_PENPOWER) },
  1087. { HID_USB_DEVICE(USB_VENDOR_ID_GRETAGMACBETH, USB_DEVICE_ID_GRETAGMACBETH_HUEY) },
  1088. { HID_USB_DEVICE(USB_VENDOR_ID_GRIFFIN, USB_DEVICE_ID_POWERMATE) },
  1089. { HID_USB_DEVICE(USB_VENDOR_ID_GRIFFIN, USB_DEVICE_ID_SOUNDKNOB) },
  1090. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_90) },
  1091. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_100) },
  1092. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_101) },
  1093. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_103) },
  1094. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_104) },
  1095. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_105) },
  1096. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_106) },
  1097. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_107) },
  1098. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_108) },
  1099. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_200) },
  1100. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_201) },
  1101. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_202) },
  1102. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_203) },
  1103. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_204) },
  1104. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_205) },
  1105. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_206) },
  1106. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_207) },
  1107. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_300) },
  1108. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_301) },
  1109. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_302) },
  1110. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_303) },
  1111. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_304) },
  1112. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_305) },
  1113. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_306) },
  1114. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_307) },
  1115. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_308) },
  1116. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_309) },
  1117. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_400) },
  1118. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_401) },
  1119. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_402) },
  1120. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_403) },
  1121. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_404) },
  1122. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_405) },
  1123. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_500) },
  1124. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_501) },
  1125. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_502) },
  1126. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_503) },
  1127. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_504) },
  1128. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1000) },
  1129. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1001) },
  1130. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1002) },
  1131. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1003) },
  1132. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1004) },
  1133. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1005) },
  1134. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1006) },
  1135. { HID_USB_DEVICE(USB_VENDOR_ID_GTCO, USB_DEVICE_ID_GTCO_1007) },
  1136. { HID_USB_DEVICE(USB_VENDOR_ID_IMATION, USB_DEVICE_ID_DISC_STAKKA) },
  1137. { HID_USB_DEVICE(USB_VENDOR_ID_KBGEAR, USB_DEVICE_ID_KBGEAR_JAMSTUDIO) },
  1138. { HID_USB_DEVICE(USB_VENDOR_ID_KYE, USB_DEVICE_ID_KYE_GPEN_560) },
  1139. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_CASSY) },
  1140. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_POCKETCASSY) },
  1141. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_MOBILECASSY) },
  1142. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_JWM) },
  1143. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_DMMP) },
  1144. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_UMIP) },
  1145. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_XRAY1) },
  1146. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_XRAY2) },
  1147. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_VIDEOCOM) },
  1148. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_COM3LAB) },
  1149. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_TELEPORT) },
  1150. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_NETWORKANALYSER) },
  1151. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_POWERCONTROL) },
  1152. { HID_USB_DEVICE(USB_VENDOR_ID_LD, USB_DEVICE_ID_LD_MACHINETEST) },
  1153. { HID_USB_DEVICE(USB_VENDOR_ID_MCC, USB_DEVICE_ID_MCC_PMD1024LS) },
  1154. { HID_USB_DEVICE(USB_VENDOR_ID_MCC, USB_DEVICE_ID_MCC_PMD1208LS) },
  1155. { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS) },
  1156. { HID_USB_DEVICE(USB_VENDOR_ID_MGE, USB_DEVICE_ID_MGE_UPS1) },
  1157. { HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICKIT1) },
  1158. { HID_USB_DEVICE(USB_VENDOR_ID_MICROCHIP, USB_DEVICE_ID_PICKIT2) },
  1159. { HID_USB_DEVICE(USB_VENDOR_ID_NATIONAL_SEMICONDUCTOR, USB_DEVICE_ID_N_S_HARMONY) },
  1160. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100) },
  1161. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 20) },
  1162. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 30) },
  1163. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 100) },
  1164. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 108) },
  1165. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 118) },
  1166. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 200) },
  1167. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 300) },
  1168. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 400) },
  1169. { HID_USB_DEVICE(USB_VENDOR_ID_ONTRAK, USB_DEVICE_ID_ONTRAK_ADU100 + 500) },
  1170. { HID_USB_DEVICE(USB_VENDOR_ID_PANJIT, 0x0001) },
  1171. { HID_USB_DEVICE(USB_VENDOR_ID_PANJIT, 0x0002) },
  1172. { HID_USB_DEVICE(USB_VENDOR_ID_PANJIT, 0x0003) },
  1173. { HID_USB_DEVICE(USB_VENDOR_ID_PANJIT, 0x0004) },
  1174. { HID_USB_DEVICE(USB_VENDOR_ID_SOUNDGRAPH, USB_DEVICE_ID_SOUNDGRAPH_IMON_LCD) },
  1175. { HID_USB_DEVICE(USB_VENDOR_ID_VERNIER, USB_DEVICE_ID_VERNIER_LABPRO) },
  1176. { HID_USB_DEVICE(USB_VENDOR_ID_VERNIER, USB_DEVICE_ID_VERNIER_GOTEMP) },
  1177. { HID_USB_DEVICE(USB_VENDOR_ID_VERNIER, USB_DEVICE_ID_VERNIER_SKIP) },
  1178. { HID_USB_DEVICE(USB_VENDOR_ID_VERNIER, USB_DEVICE_ID_VERNIER_CYCLOPS) },
  1179. { HID_USB_DEVICE(USB_VENDOR_ID_VERNIER, USB_DEVICE_ID_VERNIER_LCSPEC) },
  1180. { HID_USB_DEVICE(USB_VENDOR_ID_WACOM, HID_ANY_ID) },
  1181. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_4_PHIDGETSERVO_20) },
  1182. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_1_PHIDGETSERVO_20) },
  1183. { HID_USB_DEVICE(USB_VENDOR_ID_WISEGROUP, USB_DEVICE_ID_8_8_4_IF_KIT) },
  1184. { HID_USB_DEVICE(USB_VENDOR_ID_YEALINK, USB_DEVICE_ID_YEALINK_P1K_P4K_B2K) },
  1185. { }
  1186. };
  1187. static bool hid_ignore(struct hid_device *hdev)
  1188. {
  1189. switch (hdev->vendor) {
  1190. case USB_VENDOR_ID_CODEMERCS:
  1191. /* ignore all Code Mercenaries IOWarrior devices */
  1192. if (hdev->product >= USB_DEVICE_ID_CODEMERCS_IOW_FIRST &&
  1193. hdev->product <= USB_DEVICE_ID_CODEMERCS_IOW_LAST)
  1194. return true;
  1195. break;
  1196. case USB_VENDOR_ID_LOGITECH:
  1197. if (hdev->product >= USB_DEVICE_ID_LOGITECH_HARMONY_FIRST &&
  1198. hdev->product <= USB_DEVICE_ID_LOGITECH_HARMONY_LAST)
  1199. return true;
  1200. break;
  1201. }
  1202. return !!hid_match_id(hdev, hid_ignore_list);
  1203. }
  1204. int hid_add_device(struct hid_device *hdev)
  1205. {
  1206. static atomic_t id = ATOMIC_INIT(0);
  1207. int ret;
  1208. if (WARN_ON(hdev->status & HID_STAT_ADDED))
  1209. return -EBUSY;
  1210. /* we need to kill them here, otherwise they will stay allocated to
  1211. * wait for coming driver */
  1212. if (hid_ignore(hdev))
  1213. return -ENODEV;
  1214. /* XXX hack, any other cleaner solution < 20 bus_id bytes? */
  1215. sprintf(hdev->dev.bus_id, "%04X:%04X:%04X.%04X", hdev->bus,
  1216. hdev->vendor, hdev->product, atomic_inc_return(&id));
  1217. ret = device_add(&hdev->dev);
  1218. if (!ret)
  1219. hdev->status |= HID_STAT_ADDED;
  1220. return ret;
  1221. }
  1222. EXPORT_SYMBOL_GPL(hid_add_device);
  1223. /**
  1224. * hid_allocate_device - allocate new hid device descriptor
  1225. *
  1226. * Allocate and initialize hid device, so that hid_destroy_device might be
  1227. * used to free it.
  1228. *
  1229. * New hid_device pointer is returned on success, otherwise ERR_PTR encoded
  1230. * error value.
  1231. */
  1232. struct hid_device *hid_allocate_device(void)
  1233. {
  1234. struct hid_device *hdev;
  1235. unsigned int i;
  1236. int ret = -ENOMEM;
  1237. hdev = kzalloc(sizeof(*hdev), GFP_KERNEL);
  1238. if (hdev == NULL)
  1239. return ERR_PTR(ret);
  1240. device_initialize(&hdev->dev);
  1241. hdev->dev.release = hid_device_release;
  1242. hdev->dev.bus = &hid_bus_type;
  1243. hdev->collection = kcalloc(HID_DEFAULT_NUM_COLLECTIONS,
  1244. sizeof(struct hid_collection), GFP_KERNEL);
  1245. if (hdev->collection == NULL)
  1246. goto err;
  1247. hdev->collection_size = HID_DEFAULT_NUM_COLLECTIONS;
  1248. for (i = 0; i < HID_REPORT_TYPES; i++)
  1249. INIT_LIST_HEAD(&hdev->report_enum[i].report_list);
  1250. return hdev;
  1251. err:
  1252. put_device(&hdev->dev);
  1253. return ERR_PTR(ret);
  1254. }
  1255. EXPORT_SYMBOL_GPL(hid_allocate_device);
  1256. static void hid_remove_device(struct hid_device *hdev)
  1257. {
  1258. if (hdev->status & HID_STAT_ADDED) {
  1259. device_del(&hdev->dev);
  1260. hdev->status &= ~HID_STAT_ADDED;
  1261. }
  1262. }
  1263. /**
  1264. * hid_destroy_device - free previously allocated device
  1265. *
  1266. * @hdev: hid device
  1267. *
  1268. * If you allocate hid_device through hid_allocate_device, you should ever
  1269. * free by this function.
  1270. */
  1271. void hid_destroy_device(struct hid_device *hdev)
  1272. {
  1273. hid_remove_device(hdev);
  1274. put_device(&hdev->dev);
  1275. }
  1276. EXPORT_SYMBOL_GPL(hid_destroy_device);
  1277. int __hid_register_driver(struct hid_driver *hdrv, struct module *owner,
  1278. const char *mod_name)
  1279. {
  1280. hdrv->driver.name = hdrv->name;
  1281. hdrv->driver.bus = &hid_bus_type;
  1282. hdrv->driver.owner = owner;
  1283. hdrv->driver.mod_name = mod_name;
  1284. return driver_register(&hdrv->driver);
  1285. }
  1286. EXPORT_SYMBOL_GPL(__hid_register_driver);
  1287. void hid_unregister_driver(struct hid_driver *hdrv)
  1288. {
  1289. driver_unregister(&hdrv->driver);
  1290. }
  1291. EXPORT_SYMBOL_GPL(hid_unregister_driver);
  1292. #ifdef CONFIG_HID_COMPAT
  1293. static void hid_compat_load(struct work_struct *ws)
  1294. {
  1295. request_module("hid-dummy");
  1296. }
  1297. static DECLARE_WORK(hid_compat_work, hid_compat_load);
  1298. #endif
  1299. static int __init hid_init(void)
  1300. {
  1301. int ret;
  1302. ret = bus_register(&hid_bus_type);
  1303. if (ret) {
  1304. printk(KERN_ERR "HID: can't register hid bus\n");
  1305. goto err;
  1306. }
  1307. ret = hidraw_init();
  1308. if (ret)
  1309. goto err_bus;
  1310. #ifdef CONFIG_HID_COMPAT
  1311. schedule_work(&hid_compat_work);
  1312. #endif
  1313. return 0;
  1314. err_bus:
  1315. bus_unregister(&hid_bus_type);
  1316. err:
  1317. return ret;
  1318. }
  1319. static void __exit hid_exit(void)
  1320. {
  1321. hidraw_exit();
  1322. bus_unregister(&hid_bus_type);
  1323. }
  1324. module_init(hid_init);
  1325. module_exit(hid_exit);
  1326. MODULE_LICENSE(DRIVER_LICENSE);