2 * USB HID support for Linux
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
11 * This program is free software; you can redistribute it and/or modify it
12 * under the terms of the GNU General Public License as published by the Free
13 * Software Foundation; either version 2 of the License, or (at your option)
17 #include <linux/module.h>
18 #include <linux/slab.h>
19 #include <linux/init.h>
20 #include <linux/kernel.h>
21 #include <linux/list.h>
23 #include <linux/mutex.h>
24 #include <linux/smp_lock.h>
25 #include <linux/spinlock.h>
26 #include <asm/unaligned.h>
27 #include <asm/byteorder.h>
28 #include <linux/input.h>
29 #include <linux/wait.h>
31 #include <linux/usb.h>
33 #include <linux/hid.h>
34 #include <linux/hiddev.h>
35 #include <linux/hid-debug.h>
36 #include <linux/hidraw.h>
43 #define DRIVER_VERSION "v2.6"
44 #define DRIVER_AUTHOR "Andreas Gal, Vojtech Pavlik, Jiri Kosina"
45 #define DRIVER_DESC "USB HID core driver"
46 #define DRIVER_LICENSE "GPL"
52 static unsigned int hid_mousepoll_interval
;
53 module_param_named(mousepoll
, hid_mousepoll_interval
, uint
, 0644);
54 MODULE_PARM_DESC(mousepoll
, "Polling interval of mice");
56 /* Quirks specified at module load time */
57 static char *quirks_param
[MAX_USBHID_BOOT_QUIRKS
] = { [ 0 ... (MAX_USBHID_BOOT_QUIRKS
- 1) ] = NULL
};
58 module_param_array_named(quirks
, quirks_param
, charp
, NULL
, 0444);
59 MODULE_PARM_DESC(quirks
, "Add/modify USB HID quirks by specifying "
60 " quirks=vendorID:productID:quirks"
61 " where vendorID, productID, and quirks are all in"
64 * Input submission and I/O error handler.
67 static void hid_io_error(struct hid_device
*hid
);
69 /* Start up the input URB */
70 static int hid_start_in(struct hid_device
*hid
)
74 struct usbhid_device
*usbhid
= hid
->driver_data
;
76 spin_lock_irqsave(&usbhid
->inlock
, flags
);
77 if (hid
->open
> 0 && !test_bit(HID_SUSPENDED
, &usbhid
->iofl
) &&
78 !test_bit(HID_DISCONNECTED
, &usbhid
->iofl
) &&
79 !test_and_set_bit(HID_IN_RUNNING
, &usbhid
->iofl
)) {
80 rc
= usb_submit_urb(usbhid
->urbin
, GFP_ATOMIC
);
82 clear_bit(HID_IN_RUNNING
, &usbhid
->iofl
);
84 spin_unlock_irqrestore(&usbhid
->inlock
, flags
);
88 /* I/O retry timer routine */
89 static void hid_retry_timeout(unsigned long _hid
)
91 struct hid_device
*hid
= (struct hid_device
*) _hid
;
92 struct usbhid_device
*usbhid
= hid
->driver_data
;
94 dev_dbg(&usbhid
->intf
->dev
, "retrying intr urb\n");
95 if (hid_start_in(hid
))
99 /* Workqueue routine to reset the device or clear a halt */
100 static void hid_reset(struct work_struct
*work
)
102 struct usbhid_device
*usbhid
=
103 container_of(work
, struct usbhid_device
, reset_work
);
104 struct hid_device
*hid
= usbhid
->hid
;
107 if (test_bit(HID_CLEAR_HALT
, &usbhid
->iofl
)) {
108 dev_dbg(&usbhid
->intf
->dev
, "clear halt\n");
109 rc
= usb_clear_halt(hid_to_usb_dev(hid
), usbhid
->urbin
->pipe
);
110 clear_bit(HID_CLEAR_HALT
, &usbhid
->iofl
);
114 else if (test_bit(HID_RESET_PENDING
, &usbhid
->iofl
)) {
115 dev_dbg(&usbhid
->intf
->dev
, "resetting device\n");
116 rc
= rc_lock
= usb_lock_device_for_reset(hid_to_usb_dev(hid
), usbhid
->intf
);
118 rc
= usb_reset_device(hid_to_usb_dev(hid
));
120 usb_unlock_device(hid_to_usb_dev(hid
));
122 clear_bit(HID_RESET_PENDING
, &usbhid
->iofl
);
127 if (!test_bit(HID_IN_RUNNING
, &usbhid
->iofl
))
131 err_hid("can't reset device, %s-%s/input%d, status %d",
132 hid_to_usb_dev(hid
)->bus
->bus_name
,
133 hid_to_usb_dev(hid
)->devpath
,
143 /* Main I/O error handler */
144 static void hid_io_error(struct hid_device
*hid
)
147 struct usbhid_device
*usbhid
= hid
->driver_data
;
149 spin_lock_irqsave(&usbhid
->inlock
, flags
);
151 /* Stop when disconnected */
152 if (test_bit(HID_DISCONNECTED
, &usbhid
->iofl
))
155 /* If it has been a while since the last error, we'll assume
156 * this a brand new error and reset the retry timeout. */
157 if (time_after(jiffies
, usbhid
->stop_retry
+ HZ
/2))
158 usbhid
->retry_delay
= 0;
160 /* When an error occurs, retry at increasing intervals */
161 if (usbhid
->retry_delay
== 0) {
162 usbhid
->retry_delay
= 13; /* Then 26, 52, 104, 104, ... */
163 usbhid
->stop_retry
= jiffies
+ msecs_to_jiffies(1000);
164 } else if (usbhid
->retry_delay
< 100)
165 usbhid
->retry_delay
*= 2;
167 if (time_after(jiffies
, usbhid
->stop_retry
)) {
169 /* Retries failed, so do a port reset */
170 if (!test_and_set_bit(HID_RESET_PENDING
, &usbhid
->iofl
)) {
171 schedule_work(&usbhid
->reset_work
);
176 mod_timer(&usbhid
->io_retry
,
177 jiffies
+ msecs_to_jiffies(usbhid
->retry_delay
));
179 spin_unlock_irqrestore(&usbhid
->inlock
, flags
);
183 * Input interrupt completion handler.
186 static void hid_irq_in(struct urb
*urb
)
188 struct hid_device
*hid
= urb
->context
;
189 struct usbhid_device
*usbhid
= hid
->driver_data
;
192 switch (urb
->status
) {
193 case 0: /* success */
194 usbhid
->retry_delay
= 0;
195 hid_input_report(urb
->context
, HID_INPUT_REPORT
,
196 urb
->transfer_buffer
,
197 urb
->actual_length
, 1);
199 case -EPIPE
: /* stall */
200 clear_bit(HID_IN_RUNNING
, &usbhid
->iofl
);
201 set_bit(HID_CLEAR_HALT
, &usbhid
->iofl
);
202 schedule_work(&usbhid
->reset_work
);
204 case -ECONNRESET
: /* unlink */
206 case -ESHUTDOWN
: /* unplug */
207 clear_bit(HID_IN_RUNNING
, &usbhid
->iofl
);
209 case -EILSEQ
: /* protocol error or unplug */
210 case -EPROTO
: /* protocol error or unplug */
211 case -ETIME
: /* protocol error or unplug */
212 case -ETIMEDOUT
: /* Should never happen, but... */
213 clear_bit(HID_IN_RUNNING
, &usbhid
->iofl
);
217 dev_warn(&urb
->dev
->dev
, "input irq status %d "
218 "received\n", urb
->status
);
221 status
= usb_submit_urb(urb
, GFP_ATOMIC
);
223 clear_bit(HID_IN_RUNNING
, &usbhid
->iofl
);
224 if (status
!= -EPERM
) {
225 err_hid("can't resubmit intr, %s-%s/input%d, status %d",
226 hid_to_usb_dev(hid
)->bus
->bus_name
,
227 hid_to_usb_dev(hid
)->devpath
,
228 usbhid
->ifnum
, status
);
234 static int hid_submit_out(struct hid_device
*hid
)
236 struct hid_report
*report
;
238 struct usbhid_device
*usbhid
= hid
->driver_data
;
240 report
= usbhid
->out
[usbhid
->outtail
].report
;
241 raw_report
= usbhid
->out
[usbhid
->outtail
].raw_report
;
243 usbhid
->urbout
->transfer_buffer_length
= ((report
->size
- 1) >> 3) + 1 + (report
->id
> 0);
244 usbhid
->urbout
->dev
= hid_to_usb_dev(hid
);
245 memcpy(usbhid
->outbuf
, raw_report
, usbhid
->urbout
->transfer_buffer_length
);
248 dbg_hid("submitting out urb\n");
250 if (usb_submit_urb(usbhid
->urbout
, GFP_ATOMIC
)) {
251 err_hid("usb_submit_urb(out) failed");
258 static int hid_submit_ctrl(struct hid_device
*hid
)
260 struct hid_report
*report
;
264 struct usbhid_device
*usbhid
= hid
->driver_data
;
266 report
= usbhid
->ctrl
[usbhid
->ctrltail
].report
;
267 raw_report
= usbhid
->ctrl
[usbhid
->ctrltail
].raw_report
;
268 dir
= usbhid
->ctrl
[usbhid
->ctrltail
].dir
;
270 len
= ((report
->size
- 1) >> 3) + 1 + (report
->id
> 0);
271 if (dir
== USB_DIR_OUT
) {
272 usbhid
->urbctrl
->pipe
= usb_sndctrlpipe(hid_to_usb_dev(hid
), 0);
273 usbhid
->urbctrl
->transfer_buffer_length
= len
;
274 memcpy(usbhid
->ctrlbuf
, raw_report
, len
);
277 int maxpacket
, padlen
;
279 usbhid
->urbctrl
->pipe
= usb_rcvctrlpipe(hid_to_usb_dev(hid
), 0);
280 maxpacket
= usb_maxpacket(hid_to_usb_dev(hid
), usbhid
->urbctrl
->pipe
, 0);
282 padlen
= DIV_ROUND_UP(len
, maxpacket
);
284 if (padlen
> usbhid
->bufsize
)
285 padlen
= usbhid
->bufsize
;
288 usbhid
->urbctrl
->transfer_buffer_length
= padlen
;
290 usbhid
->urbctrl
->dev
= hid_to_usb_dev(hid
);
292 usbhid
->cr
->bRequestType
= USB_TYPE_CLASS
| USB_RECIP_INTERFACE
| dir
;
293 usbhid
->cr
->bRequest
= (dir
== USB_DIR_OUT
) ? HID_REQ_SET_REPORT
: HID_REQ_GET_REPORT
;
294 usbhid
->cr
->wValue
= cpu_to_le16(((report
->type
+ 1) << 8) | report
->id
);
295 usbhid
->cr
->wIndex
= cpu_to_le16(usbhid
->ifnum
);
296 usbhid
->cr
->wLength
= cpu_to_le16(len
);
298 dbg_hid("submitting ctrl urb: %s wValue=0x%04x wIndex=0x%04x wLength=%u\n",
299 usbhid
->cr
->bRequest
== HID_REQ_SET_REPORT
? "Set_Report" : "Get_Report",
300 usbhid
->cr
->wValue
, usbhid
->cr
->wIndex
, usbhid
->cr
->wLength
);
302 if (usb_submit_urb(usbhid
->urbctrl
, GFP_ATOMIC
)) {
303 err_hid("usb_submit_urb(ctrl) failed");
311 * Output interrupt completion handler.
314 static void hid_irq_out(struct urb
*urb
)
316 struct hid_device
*hid
= urb
->context
;
317 struct usbhid_device
*usbhid
= hid
->driver_data
;
321 switch (urb
->status
) {
322 case 0: /* success */
324 case -ESHUTDOWN
: /* unplug */
326 case -EILSEQ
: /* protocol error or unplug */
327 case -EPROTO
: /* protocol error or unplug */
328 case -ECONNRESET
: /* unlink */
332 dev_warn(&urb
->dev
->dev
, "output irq status %d "
333 "received\n", urb
->status
);
336 spin_lock_irqsave(&usbhid
->outlock
, flags
);
339 usbhid
->outtail
= usbhid
->outhead
;
341 usbhid
->outtail
= (usbhid
->outtail
+ 1) & (HID_OUTPUT_FIFO_SIZE
- 1);
343 if (usbhid
->outhead
!= usbhid
->outtail
) {
344 if (hid_submit_out(hid
)) {
345 clear_bit(HID_OUT_RUNNING
, &usbhid
->iofl
);
346 wake_up(&usbhid
->wait
);
348 spin_unlock_irqrestore(&usbhid
->outlock
, flags
);
352 clear_bit(HID_OUT_RUNNING
, &usbhid
->iofl
);
353 spin_unlock_irqrestore(&usbhid
->outlock
, flags
);
354 wake_up(&usbhid
->wait
);
358 * Control pipe completion handler.
361 static void hid_ctrl(struct urb
*urb
)
363 struct hid_device
*hid
= urb
->context
;
364 struct usbhid_device
*usbhid
= hid
->driver_data
;
368 spin_lock_irqsave(&usbhid
->ctrllock
, flags
);
370 switch (urb
->status
) {
371 case 0: /* success */
372 if (usbhid
->ctrl
[usbhid
->ctrltail
].dir
== USB_DIR_IN
)
373 hid_input_report(urb
->context
,
374 usbhid
->ctrl
[usbhid
->ctrltail
].report
->type
,
375 urb
->transfer_buffer
, urb
->actual_length
, 0);
377 case -ESHUTDOWN
: /* unplug */
379 case -EILSEQ
: /* protocol error or unplug */
380 case -EPROTO
: /* protocol error or unplug */
381 case -ECONNRESET
: /* unlink */
383 case -EPIPE
: /* report not available */
386 dev_warn(&urb
->dev
->dev
, "ctrl urb status %d "
387 "received\n", urb
->status
);
391 usbhid
->ctrltail
= usbhid
->ctrlhead
;
393 usbhid
->ctrltail
= (usbhid
->ctrltail
+ 1) & (HID_CONTROL_FIFO_SIZE
- 1);
395 if (usbhid
->ctrlhead
!= usbhid
->ctrltail
) {
396 if (hid_submit_ctrl(hid
)) {
397 clear_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
);
398 wake_up(&usbhid
->wait
);
400 spin_unlock_irqrestore(&usbhid
->ctrllock
, flags
);
404 clear_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
);
405 spin_unlock_irqrestore(&usbhid
->ctrllock
, flags
);
406 wake_up(&usbhid
->wait
);
409 void usbhid_submit_report(struct hid_device
*hid
, struct hid_report
*report
, unsigned char dir
)
413 struct usbhid_device
*usbhid
= hid
->driver_data
;
414 int len
= ((report
->size
- 1) >> 3) + 1 + (report
->id
> 0);
416 if ((hid
->quirks
& HID_QUIRK_NOGET
) && dir
== USB_DIR_IN
)
419 if (usbhid
->urbout
&& dir
== USB_DIR_OUT
&& report
->type
== HID_OUTPUT_REPORT
) {
421 spin_lock_irqsave(&usbhid
->outlock
, flags
);
423 if ((head
= (usbhid
->outhead
+ 1) & (HID_OUTPUT_FIFO_SIZE
- 1)) == usbhid
->outtail
) {
424 spin_unlock_irqrestore(&usbhid
->outlock
, flags
);
425 dev_warn(&hid
->dev
, "output queue full\n");
429 usbhid
->out
[usbhid
->outhead
].raw_report
= kmalloc(len
, GFP_ATOMIC
);
430 if (!usbhid
->out
[usbhid
->outhead
].raw_report
) {
431 spin_unlock_irqrestore(&usbhid
->outlock
, flags
);
432 dev_warn(&hid
->dev
, "output queueing failed\n");
435 hid_output_report(report
, usbhid
->out
[usbhid
->outhead
].raw_report
);
436 usbhid
->out
[usbhid
->outhead
].report
= report
;
437 usbhid
->outhead
= head
;
439 if (!test_and_set_bit(HID_OUT_RUNNING
, &usbhid
->iofl
))
440 if (hid_submit_out(hid
))
441 clear_bit(HID_OUT_RUNNING
, &usbhid
->iofl
);
443 spin_unlock_irqrestore(&usbhid
->outlock
, flags
);
447 spin_lock_irqsave(&usbhid
->ctrllock
, flags
);
449 if ((head
= (usbhid
->ctrlhead
+ 1) & (HID_CONTROL_FIFO_SIZE
- 1)) == usbhid
->ctrltail
) {
450 spin_unlock_irqrestore(&usbhid
->ctrllock
, flags
);
451 dev_warn(&hid
->dev
, "control queue full\n");
455 if (dir
== USB_DIR_OUT
) {
456 usbhid
->ctrl
[usbhid
->ctrlhead
].raw_report
= kmalloc(len
, GFP_ATOMIC
);
457 if (!usbhid
->ctrl
[usbhid
->ctrlhead
].raw_report
) {
458 spin_unlock_irqrestore(&usbhid
->ctrllock
, flags
);
459 dev_warn(&hid
->dev
, "control queueing failed\n");
462 hid_output_report(report
, usbhid
->ctrl
[usbhid
->ctrlhead
].raw_report
);
464 usbhid
->ctrl
[usbhid
->ctrlhead
].report
= report
;
465 usbhid
->ctrl
[usbhid
->ctrlhead
].dir
= dir
;
466 usbhid
->ctrlhead
= head
;
468 if (!test_and_set_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
))
469 if (hid_submit_ctrl(hid
))
470 clear_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
);
472 spin_unlock_irqrestore(&usbhid
->ctrllock
, flags
);
474 EXPORT_SYMBOL_GPL(usbhid_submit_report
);
476 static int usb_hidinput_input_event(struct input_dev
*dev
, unsigned int type
, unsigned int code
, int value
)
478 struct hid_device
*hid
= input_get_drvdata(dev
);
479 struct hid_field
*field
;
483 return input_ff_event(dev
, type
, code
, value
);
488 if ((offset
= hidinput_find_field(hid
, type
, code
, &field
)) == -1) {
489 dev_warn(&dev
->dev
, "event field not found\n");
493 hid_set_field(field
, offset
, value
);
494 usbhid_submit_report(hid
, field
->report
, USB_DIR_OUT
);
499 int usbhid_wait_io(struct hid_device
*hid
)
501 struct usbhid_device
*usbhid
= hid
->driver_data
;
503 if (!wait_event_timeout(usbhid
->wait
,
504 (!test_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
) &&
505 !test_bit(HID_OUT_RUNNING
, &usbhid
->iofl
)),
507 dbg_hid("timeout waiting for ctrl or out queue to clear\n");
514 static int hid_set_idle(struct usb_device
*dev
, int ifnum
, int report
, int idle
)
516 return usb_control_msg(dev
, usb_sndctrlpipe(dev
, 0),
517 HID_REQ_SET_IDLE
, USB_TYPE_CLASS
| USB_RECIP_INTERFACE
, (idle
<< 8) | report
,
518 ifnum
, NULL
, 0, USB_CTRL_SET_TIMEOUT
);
521 static int hid_get_class_descriptor(struct usb_device
*dev
, int ifnum
,
522 unsigned char type
, void *buf
, int size
)
524 int result
, retries
= 4;
526 memset(buf
, 0, size
);
529 result
= usb_control_msg(dev
, usb_rcvctrlpipe(dev
, 0),
530 USB_REQ_GET_DESCRIPTOR
, USB_RECIP_INTERFACE
| USB_DIR_IN
,
531 (type
<< 8), ifnum
, buf
, size
, USB_CTRL_GET_TIMEOUT
);
533 } while (result
< size
&& retries
);
537 int usbhid_open(struct hid_device
*hid
)
539 struct usbhid_device
*usbhid
= hid
->driver_data
;
543 res
= usb_autopm_get_interface(usbhid
->intf
);
549 if (hid_start_in(hid
))
554 void usbhid_close(struct hid_device
*hid
)
556 struct usbhid_device
*usbhid
= hid
->driver_data
;
559 usb_kill_urb(usbhid
->urbin
);
560 usb_autopm_put_interface(usbhid
->intf
);
565 * Initialize all reports
568 void usbhid_init_reports(struct hid_device
*hid
)
570 struct hid_report
*report
;
571 struct usbhid_device
*usbhid
= hid
->driver_data
;
574 list_for_each_entry(report
, &hid
->report_enum
[HID_INPUT_REPORT
].report_list
, list
)
575 usbhid_submit_report(hid
, report
, USB_DIR_IN
);
577 list_for_each_entry(report
, &hid
->report_enum
[HID_FEATURE_REPORT
].report_list
, list
)
578 usbhid_submit_report(hid
, report
, USB_DIR_IN
);
581 ret
= usbhid_wait_io(hid
);
584 if (test_bit(HID_CTRL_RUNNING
, &usbhid
->iofl
))
585 usb_kill_urb(usbhid
->urbctrl
);
586 if (test_bit(HID_OUT_RUNNING
, &usbhid
->iofl
))
587 usb_kill_urb(usbhid
->urbout
);
588 ret
= usbhid_wait_io(hid
);
592 dev_warn(&hid
->dev
, "timeout initializing reports\n");
596 * Reset LEDs which BIOS might have left on. For now, just NumLock (0x01).
598 static int hid_find_field_early(struct hid_device
*hid
, unsigned int page
,
599 unsigned int hid_code
, struct hid_field
**pfield
)
601 struct hid_report
*report
;
602 struct hid_field
*field
;
603 struct hid_usage
*usage
;
606 list_for_each_entry(report
, &hid
->report_enum
[HID_OUTPUT_REPORT
].report_list
, list
) {
607 for (i
= 0; i
< report
->maxfield
; i
++) {
608 field
= report
->field
[i
];
609 for (j
= 0; j
< field
->maxusage
; j
++) {
610 usage
= &field
->usage
[j
];
611 if ((usage
->hid
& HID_USAGE_PAGE
) == page
&&
612 (usage
->hid
& 0xFFFF) == hid_code
) {
622 void usbhid_set_leds(struct hid_device
*hid
)
624 struct hid_field
*field
;
627 if ((offset
= hid_find_field_early(hid
, HID_UP_LED
, 0x01, &field
)) != -1) {
628 hid_set_field(field
, offset
, 0);
629 usbhid_submit_report(hid
, field
->report
, USB_DIR_OUT
);
632 EXPORT_SYMBOL_GPL(usbhid_set_leds
);
635 * Traverse the supplied list of reports and find the longest
637 static void hid_find_max_report(struct hid_device
*hid
, unsigned int type
,
640 struct hid_report
*report
;
643 list_for_each_entry(report
, &hid
->report_enum
[type
].report_list
, list
) {
644 size
= ((report
->size
- 1) >> 3) + 1;
645 if (type
== HID_INPUT_REPORT
&& hid
->report_enum
[type
].numbered
)
652 static int hid_alloc_buffers(struct usb_device
*dev
, struct hid_device
*hid
)
654 struct usbhid_device
*usbhid
= hid
->driver_data
;
656 if (!(usbhid
->inbuf
= usb_buffer_alloc(dev
, usbhid
->bufsize
, GFP_ATOMIC
, &usbhid
->inbuf_dma
)))
658 if (!(usbhid
->outbuf
= usb_buffer_alloc(dev
, usbhid
->bufsize
, GFP_ATOMIC
, &usbhid
->outbuf_dma
)))
660 if (!(usbhid
->cr
= usb_buffer_alloc(dev
, sizeof(*(usbhid
->cr
)), GFP_ATOMIC
, &usbhid
->cr_dma
)))
662 if (!(usbhid
->ctrlbuf
= usb_buffer_alloc(dev
, usbhid
->bufsize
, GFP_ATOMIC
, &usbhid
->ctrlbuf_dma
)))
668 static int usbhid_output_raw_report(struct hid_device
*hid
, __u8
*buf
, size_t count
)
670 struct usbhid_device
*usbhid
= hid
->driver_data
;
671 struct usb_device
*dev
= hid_to_usb_dev(hid
);
672 struct usb_interface
*intf
= usbhid
->intf
;
673 struct usb_host_interface
*interface
= intf
->cur_altsetting
;
676 ret
= usb_control_msg(dev
, usb_sndctrlpipe(dev
, 0),
678 USB_DIR_OUT
| USB_TYPE_CLASS
| USB_RECIP_INTERFACE
,
679 ((HID_OUTPUT_REPORT
+ 1) << 8) | *buf
,
680 interface
->desc
.bInterfaceNumber
, buf
+ 1, count
- 1,
681 USB_CTRL_SET_TIMEOUT
);
683 /* count also the report id */
690 static void hid_free_buffers(struct usb_device
*dev
, struct hid_device
*hid
)
692 struct usbhid_device
*usbhid
= hid
->driver_data
;
694 usb_buffer_free(dev
, usbhid
->bufsize
, usbhid
->inbuf
, usbhid
->inbuf_dma
);
695 usb_buffer_free(dev
, usbhid
->bufsize
, usbhid
->outbuf
, usbhid
->outbuf_dma
);
696 usb_buffer_free(dev
, sizeof(*(usbhid
->cr
)), usbhid
->cr
, usbhid
->cr_dma
);
697 usb_buffer_free(dev
, usbhid
->bufsize
, usbhid
->ctrlbuf
, usbhid
->ctrlbuf_dma
);
700 static int usbhid_parse(struct hid_device
*hid
)
702 struct usb_interface
*intf
= to_usb_interface(hid
->dev
.parent
);
703 struct usb_host_interface
*interface
= intf
->cur_altsetting
;
704 struct usb_device
*dev
= interface_to_usbdev (intf
);
705 struct hid_descriptor
*hdesc
;
707 unsigned int rsize
= 0;
711 quirks
= usbhid_lookup_quirk(le16_to_cpu(dev
->descriptor
.idVendor
),
712 le16_to_cpu(dev
->descriptor
.idProduct
));
714 /* Many keyboards and mice don't like to be polled for reports,
715 * so we will always set the HID_QUIRK_NOGET flag for them. */
716 if (interface
->desc
.bInterfaceSubClass
== USB_INTERFACE_SUBCLASS_BOOT
) {
717 if (interface
->desc
.bInterfaceProtocol
== USB_INTERFACE_PROTOCOL_KEYBOARD
||
718 interface
->desc
.bInterfaceProtocol
== USB_INTERFACE_PROTOCOL_MOUSE
)
719 quirks
|= HID_QUIRK_NOGET
;
722 if (usb_get_extra_descriptor(interface
, HID_DT_HID
, &hdesc
) &&
723 (!interface
->desc
.bNumEndpoints
||
724 usb_get_extra_descriptor(&interface
->endpoint
[0], HID_DT_HID
, &hdesc
))) {
725 dbg_hid("class descriptor not present\n");
729 hid
->version
= le16_to_cpu(hdesc
->bcdHID
);
730 hid
->country
= hdesc
->bCountryCode
;
732 for (n
= 0; n
< hdesc
->bNumDescriptors
; n
++)
733 if (hdesc
->desc
[n
].bDescriptorType
== HID_DT_REPORT
)
734 rsize
= le16_to_cpu(hdesc
->desc
[n
].wDescriptorLength
);
736 if (!rsize
|| rsize
> HID_MAX_DESCRIPTOR_SIZE
) {
737 dbg_hid("weird size of report descriptor (%u)\n", rsize
);
741 if (!(rdesc
= kmalloc(rsize
, GFP_KERNEL
))) {
742 dbg_hid("couldn't allocate rdesc memory\n");
746 hid_set_idle(dev
, interface
->desc
.bInterfaceNumber
, 0, 0);
748 ret
= hid_get_class_descriptor(dev
, interface
->desc
.bInterfaceNumber
,
749 HID_DT_REPORT
, rdesc
, rsize
);
751 dbg_hid("reading report descriptor failed\n");
756 dbg_hid("report descriptor (size %u, read %d) = ", rsize
, n
);
757 for (n
= 0; n
< rsize
; n
++)
758 dbg_hid_line(" %02x", (unsigned char) rdesc
[n
]);
761 ret
= hid_parse_report(hid
, rdesc
, rsize
);
764 dbg_hid("parsing report descriptor failed\n");
768 hid
->quirks
= quirks
;
775 static int usbhid_start(struct hid_device
*hid
)
777 struct usb_interface
*intf
= to_usb_interface(hid
->dev
.parent
);
778 struct usb_host_interface
*interface
= intf
->cur_altsetting
;
779 struct usb_device
*dev
= interface_to_usbdev(intf
);
780 struct usbhid_device
*usbhid
= hid
->driver_data
;
781 unsigned int n
, insize
= 0;
784 clear_bit(HID_DISCONNECTED
, &usbhid
->iofl
);
786 usbhid
->bufsize
= HID_MIN_BUFFER_SIZE
;
787 hid_find_max_report(hid
, HID_INPUT_REPORT
, &usbhid
->bufsize
);
788 hid_find_max_report(hid
, HID_OUTPUT_REPORT
, &usbhid
->bufsize
);
789 hid_find_max_report(hid
, HID_FEATURE_REPORT
, &usbhid
->bufsize
);
791 if (usbhid
->bufsize
> HID_MAX_BUFFER_SIZE
)
792 usbhid
->bufsize
= HID_MAX_BUFFER_SIZE
;
794 hid_find_max_report(hid
, HID_INPUT_REPORT
, &insize
);
796 if (insize
> HID_MAX_BUFFER_SIZE
)
797 insize
= HID_MAX_BUFFER_SIZE
;
799 mutex_lock(&usbhid
->setup
);
800 if (hid_alloc_buffers(dev
, hid
)) {
805 for (n
= 0; n
< interface
->desc
.bNumEndpoints
; n
++) {
806 struct usb_endpoint_descriptor
*endpoint
;
810 endpoint
= &interface
->endpoint
[n
].desc
;
811 if ((endpoint
->bmAttributes
& 3) != 3) /* Not an interrupt endpoint */
814 interval
= endpoint
->bInterval
;
816 /* Some vendors give fullspeed interval on highspeed devides */
817 if (hid
->quirks
& HID_QUIRK_FULLSPEED_INTERVAL
&&
818 dev
->speed
== USB_SPEED_HIGH
) {
819 interval
= fls(endpoint
->bInterval
*8);
820 printk(KERN_INFO
"%s: Fixing fullspeed to highspeed interval: %d -> %d\n",
821 hid
->name
, endpoint
->bInterval
, interval
);
824 /* Change the polling interval of mice. */
825 if (hid
->collection
->usage
== HID_GD_MOUSE
&& hid_mousepoll_interval
> 0)
826 interval
= hid_mousepoll_interval
;
829 if (usb_endpoint_dir_in(endpoint
)) {
832 if (!(usbhid
->urbin
= usb_alloc_urb(0, GFP_KERNEL
)))
834 pipe
= usb_rcvintpipe(dev
, endpoint
->bEndpointAddress
);
835 usb_fill_int_urb(usbhid
->urbin
, dev
, pipe
, usbhid
->inbuf
, insize
,
836 hid_irq_in
, hid
, interval
);
837 usbhid
->urbin
->transfer_dma
= usbhid
->inbuf_dma
;
838 usbhid
->urbin
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
842 if (!(usbhid
->urbout
= usb_alloc_urb(0, GFP_KERNEL
)))
844 pipe
= usb_sndintpipe(dev
, endpoint
->bEndpointAddress
);
845 usb_fill_int_urb(usbhid
->urbout
, dev
, pipe
, usbhid
->outbuf
, 0,
846 hid_irq_out
, hid
, interval
);
847 usbhid
->urbout
->transfer_dma
= usbhid
->outbuf_dma
;
848 usbhid
->urbout
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
852 if (!usbhid
->urbin
) {
853 err_hid("couldn't find an input interrupt endpoint");
858 init_waitqueue_head(&usbhid
->wait
);
859 INIT_WORK(&usbhid
->reset_work
, hid_reset
);
860 setup_timer(&usbhid
->io_retry
, hid_retry_timeout
, (unsigned long) hid
);
862 spin_lock_init(&usbhid
->inlock
);
863 spin_lock_init(&usbhid
->outlock
);
864 spin_lock_init(&usbhid
->ctrllock
);
867 usbhid
->ifnum
= interface
->desc
.bInterfaceNumber
;
869 usbhid
->urbctrl
= usb_alloc_urb(0, GFP_KERNEL
);
870 if (!usbhid
->urbctrl
) {
875 usb_fill_control_urb(usbhid
->urbctrl
, dev
, 0, (void *) usbhid
->cr
,
876 usbhid
->ctrlbuf
, 1, hid_ctrl
, hid
);
877 usbhid
->urbctrl
->setup_dma
= usbhid
->cr_dma
;
878 usbhid
->urbctrl
->transfer_dma
= usbhid
->ctrlbuf_dma
;
879 usbhid
->urbctrl
->transfer_flags
|= (URB_NO_TRANSFER_DMA_MAP
| URB_NO_SETUP_DMA_MAP
);
881 usbhid_init_reports(hid
);
882 hid_dump_device(hid
);
884 set_bit(HID_STARTED
, &usbhid
->iofl
);
885 mutex_unlock(&usbhid
->setup
);
890 usb_free_urb(usbhid
->urbin
);
891 usb_free_urb(usbhid
->urbout
);
892 usb_free_urb(usbhid
->urbctrl
);
893 usbhid
->urbin
= NULL
;
894 usbhid
->urbout
= NULL
;
895 usbhid
->urbctrl
= NULL
;
896 hid_free_buffers(dev
, hid
);
897 mutex_unlock(&usbhid
->setup
);
901 static void usbhid_stop(struct hid_device
*hid
)
903 struct usbhid_device
*usbhid
= hid
->driver_data
;
905 if (WARN_ON(!usbhid
))
908 mutex_lock(&usbhid
->setup
);
909 clear_bit(HID_STARTED
, &usbhid
->iofl
);
910 spin_lock_irq(&usbhid
->inlock
); /* Sync with error handler */
911 set_bit(HID_DISCONNECTED
, &usbhid
->iofl
);
912 spin_unlock_irq(&usbhid
->inlock
);
913 usb_kill_urb(usbhid
->urbin
);
914 usb_kill_urb(usbhid
->urbout
);
915 usb_kill_urb(usbhid
->urbctrl
);
917 del_timer_sync(&usbhid
->io_retry
);
918 cancel_work_sync(&usbhid
->reset_work
);
920 if (hid
->claimed
& HID_CLAIMED_INPUT
)
921 hidinput_disconnect(hid
);
922 if (hid
->claimed
& HID_CLAIMED_HIDDEV
)
923 hiddev_disconnect(hid
);
924 if (hid
->claimed
& HID_CLAIMED_HIDRAW
)
925 hidraw_disconnect(hid
);
929 usb_free_urb(usbhid
->urbin
);
930 usb_free_urb(usbhid
->urbctrl
);
931 usb_free_urb(usbhid
->urbout
);
932 usbhid
->urbin
= NULL
; /* don't mess up next start */
933 usbhid
->urbctrl
= NULL
;
934 usbhid
->urbout
= NULL
;
936 hid_free_buffers(hid_to_usb_dev(hid
), hid
);
937 mutex_unlock(&usbhid
->setup
);
940 static struct hid_ll_driver usb_hid_driver
= {
941 .parse
= usbhid_parse
,
942 .start
= usbhid_start
,
945 .close
= usbhid_close
,
946 .hidinput_input_event
= usb_hidinput_input_event
,
949 static int hid_probe(struct usb_interface
*intf
, const struct usb_device_id
*id
)
951 struct usb_device
*dev
= interface_to_usbdev(intf
);
952 struct usbhid_device
*usbhid
;
953 struct hid_device
*hid
;
957 dbg_hid("HID probe called for ifnum %d\n",
958 intf
->altsetting
->desc
.bInterfaceNumber
);
960 hid
= hid_allocate_device();
964 usb_set_intfdata(intf
, hid
);
965 hid
->ll_driver
= &usb_hid_driver
;
966 hid
->hid_output_raw_report
= usbhid_output_raw_report
;
967 hid
->ff_init
= hid_pidff_init
;
968 #ifdef CONFIG_USB_HIDDEV
969 hid
->hiddev_connect
= hiddev_connect
;
970 hid
->hiddev_hid_event
= hiddev_hid_event
;
971 hid
->hiddev_report_event
= hiddev_report_event
;
973 hid
->dev
.parent
= &intf
->dev
;
975 hid
->vendor
= le16_to_cpu(dev
->descriptor
.idVendor
);
976 hid
->product
= le16_to_cpu(dev
->descriptor
.idProduct
);
978 if (intf
->cur_altsetting
->desc
.bInterfaceProtocol
==
979 USB_INTERFACE_PROTOCOL_MOUSE
)
980 hid
->type
= HID_TYPE_USBMOUSE
;
982 if (dev
->manufacturer
)
983 strlcpy(hid
->name
, dev
->manufacturer
, sizeof(hid
->name
));
986 if (dev
->manufacturer
)
987 strlcat(hid
->name
, " ", sizeof(hid
->name
));
988 strlcat(hid
->name
, dev
->product
, sizeof(hid
->name
));
991 if (!strlen(hid
->name
))
992 snprintf(hid
->name
, sizeof(hid
->name
), "HID %04x:%04x",
993 le16_to_cpu(dev
->descriptor
.idVendor
),
994 le16_to_cpu(dev
->descriptor
.idProduct
));
996 usb_make_path(dev
, hid
->phys
, sizeof(hid
->phys
));
997 strlcat(hid
->phys
, "/input", sizeof(hid
->phys
));
998 len
= strlen(hid
->phys
);
999 if (len
< sizeof(hid
->phys
) - 1)
1000 snprintf(hid
->phys
+ len
, sizeof(hid
->phys
) - len
,
1001 "%d", intf
->altsetting
[0].desc
.bInterfaceNumber
);
1003 if (usb_string(dev
, dev
->descriptor
.iSerialNumber
, hid
->uniq
, 64) <= 0)
1006 usbhid
= kzalloc(sizeof(*usbhid
), GFP_KERNEL
);
1007 if (usbhid
== NULL
) {
1012 hid
->driver_data
= usbhid
;
1014 mutex_init(&usbhid
->setup
); /* needed on suspend/resume */
1016 ret
= hid_add_device(hid
);
1019 dev_err(&intf
->dev
, "can't add hid device: %d\n", ret
);
1027 hid_destroy_device(hid
);
1031 static void hid_disconnect(struct usb_interface
*intf
)
1033 struct hid_device
*hid
= usb_get_intfdata(intf
);
1034 struct usbhid_device
*usbhid
;
1039 usbhid
= hid
->driver_data
;
1040 hid_destroy_device(hid
);
1044 static int hid_suspend(struct usb_interface
*intf
, pm_message_t message
)
1046 struct hid_device
*hid
= usb_get_intfdata (intf
);
1047 struct usbhid_device
*usbhid
= hid
->driver_data
;
1049 mutex_lock(&usbhid
->setup
);
1050 if (!test_bit(HID_STARTED
, &usbhid
->iofl
)) {
1051 mutex_unlock(&usbhid
->setup
);
1055 spin_lock_irq(&usbhid
->inlock
); /* Sync with error handler */
1056 set_bit(HID_SUSPENDED
, &usbhid
->iofl
);
1057 spin_unlock_irq(&usbhid
->inlock
);
1058 del_timer_sync(&usbhid
->io_retry
);
1059 usb_kill_urb(usbhid
->urbin
);
1060 mutex_unlock(&usbhid
->setup
);
1061 dev_dbg(&intf
->dev
, "suspend\n");
1065 static int hid_resume(struct usb_interface
*intf
)
1067 struct hid_device
*hid
= usb_get_intfdata (intf
);
1068 struct usbhid_device
*usbhid
= hid
->driver_data
;
1071 mutex_lock(&usbhid
->setup
);
1072 if (!test_bit(HID_STARTED
, &usbhid
->iofl
)) {
1073 mutex_unlock(&usbhid
->setup
);
1077 clear_bit(HID_SUSPENDED
, &usbhid
->iofl
);
1078 usbhid
->retry_delay
= 0;
1079 status
= hid_start_in(hid
);
1080 mutex_unlock(&usbhid
->setup
);
1081 dev_dbg(&intf
->dev
, "resume status %d\n", status
);
1085 /* Treat USB reset pretty much the same as suspend/resume */
1086 static int hid_pre_reset(struct usb_interface
*intf
)
1088 /* FIXME: What if the interface is already suspended? */
1089 hid_suspend(intf
, PMSG_ON
);
1093 /* Same routine used for post_reset and reset_resume */
1094 static int hid_post_reset(struct usb_interface
*intf
)
1096 struct usb_device
*dev
= interface_to_usbdev (intf
);
1098 hid_set_idle(dev
, intf
->cur_altsetting
->desc
.bInterfaceNumber
, 0, 0);
1099 /* FIXME: Any more reinitialization needed? */
1101 return hid_resume(intf
);
1104 static struct usb_device_id hid_usb_ids
[] = {
1105 { .match_flags
= USB_DEVICE_ID_MATCH_INT_CLASS
,
1106 .bInterfaceClass
= USB_INTERFACE_CLASS_HID
},
1107 { } /* Terminating entry */
1110 MODULE_DEVICE_TABLE (usb
, hid_usb_ids
);
1112 static struct usb_driver hid_driver
= {
1115 .disconnect
= hid_disconnect
,
1116 .suspend
= hid_suspend
,
1117 .resume
= hid_resume
,
1118 .reset_resume
= hid_post_reset
,
1119 .pre_reset
= hid_pre_reset
,
1120 .post_reset
= hid_post_reset
,
1121 .id_table
= hid_usb_ids
,
1122 .supports_autosuspend
= 1,
1125 static const struct hid_device_id hid_usb_table
[] = {
1126 { HID_USB_DEVICE(HID_ANY_ID
, HID_ANY_ID
) },
1130 static struct hid_driver hid_usb_driver
= {
1131 .name
= "generic-usb",
1132 .id_table
= hid_usb_table
,
1135 static int __init
hid_init(void)
1138 retval
= hid_register_driver(&hid_usb_driver
);
1140 goto hid_register_fail
;
1141 retval
= usbhid_quirks_init(quirks_param
);
1143 goto usbhid_quirks_init_fail
;
1144 retval
= hiddev_init();
1146 goto hiddev_init_fail
;
1147 retval
= usb_register(&hid_driver
);
1149 goto usb_register_fail
;
1150 printk(KERN_INFO KBUILD_MODNAME
": " DRIVER_VERSION
":"
1157 usbhid_quirks_exit();
1158 usbhid_quirks_init_fail
:
1159 hid_unregister_driver(&hid_usb_driver
);
1164 static void __exit
hid_exit(void)
1166 usb_deregister(&hid_driver
);
1168 usbhid_quirks_exit();
1169 hid_unregister_driver(&hid_usb_driver
);
1172 module_init(hid_init
);
1173 module_exit(hid_exit
);
1175 MODULE_AUTHOR(DRIVER_AUTHOR
);
1176 MODULE_DESCRIPTION(DRIVER_DESC
);
1177 MODULE_LICENSE(DRIVER_LICENSE
);