hid-core.c 38.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4
/*
 *  USB HID support for Linux
 *
 *  Copyright (c) 1999 Andreas Gal
5 6
 *  Copyright (c) 2000-2005 Vojtech Pavlik <vojtech@suse.cz>
 *  Copyright (c) 2005 Michael Haboustak <mike-@cinci.rr.com> for Concept2, Inc
7
 *  Copyright (c) 2006-2008 Jiri Kosina
8
 *  Copyright (c) 2007-2008 Oliver Neukum
L
Linus Torvalds 已提交
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
 */

/*
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; either version 2 of the License, or (at your option)
 * any later version.
 */

#include <linux/module.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/list.h>
#include <linux/mm.h>
24
#include <linux/mutex.h>
L
Linus Torvalds 已提交
25 26 27 28 29
#include <linux/spinlock.h>
#include <asm/unaligned.h>
#include <asm/byteorder.h>
#include <linux/input.h>
#include <linux/wait.h>
30
#include <linux/workqueue.h>
L
Linus Torvalds 已提交
31 32 33

#include <linux/usb.h>

34
#include <linux/hid.h>
L
Linus Torvalds 已提交
35
#include <linux/hiddev.h>
36
#include <linux/hid-debug.h>
J
Jiri Kosina 已提交
37
#include <linux/hidraw.h>
J
Jiri Kosina 已提交
38
#include "usbhid.h"
L
Linus Torvalds 已提交
39 40 41 42 43

/*
 * Version Information
 */

44
#define DRIVER_VERSION "v2.6"
45
#define DRIVER_AUTHOR "Andreas Gal, Vojtech Pavlik, Jiri Kosina"
L
Linus Torvalds 已提交
46 47 48 49 50 51 52 53 54 55 56
#define DRIVER_DESC "USB HID core driver"
#define DRIVER_LICENSE "GPL"

/*
 * Module parameters.
 */

static unsigned int hid_mousepoll_interval;
module_param_named(mousepoll, hid_mousepoll_interval, uint, 0644);
MODULE_PARM_DESC(mousepoll, "Polling interval of mice");

57 58 59 60
static unsigned int ignoreled;
module_param_named(ignoreled, ignoreled, uint, 0644);
MODULE_PARM_DESC(ignoreled, "Autosuspend with active leds");

61 62 63 64 65 66 67
/* Quirks specified at module load time */
static char *quirks_param[MAX_USBHID_BOOT_QUIRKS] = { [ 0 ... (MAX_USBHID_BOOT_QUIRKS - 1) ] = NULL };
module_param_array_named(quirks, quirks_param, charp, NULL, 0444);
MODULE_PARM_DESC(quirks, "Add/modify USB HID quirks by specifying "
		" quirks=vendorID:productID:quirks"
		" where vendorID, productID, and quirks are all in"
		" 0x-prefixed hex");
L
Linus Torvalds 已提交
68
/*
69
 * Input submission and I/O error handler.
L
Linus Torvalds 已提交
70
 */
71 72
static DEFINE_MUTEX(hid_open_mut);
static struct workqueue_struct *resumption_waker;
L
Linus Torvalds 已提交
73

74
static void hid_io_error(struct hid_device *hid);
75 76 77
static int hid_submit_out(struct hid_device *hid);
static int hid_submit_ctrl(struct hid_device *hid);
static void hid_cancel_delayed_stuff(struct usbhid_device *usbhid);
78 79 80

/* Start up the input URB */
static int hid_start_in(struct hid_device *hid)
L
Linus Torvalds 已提交
81 82
{
	unsigned long flags;
83 84
	int rc = 0;
	struct usbhid_device *usbhid = hid->driver_data;
L
Linus Torvalds 已提交
85

86 87
	spin_lock_irqsave(&usbhid->lock, flags);
	if (hid->open > 0 &&
88
			!test_bit(HID_DISCONNECTED, &usbhid->iofl) &&
89
			!test_bit(HID_REPORTED_IDLE, &usbhid->iofl) &&
90 91 92 93
			!test_and_set_bit(HID_IN_RUNNING, &usbhid->iofl)) {
		rc = usb_submit_urb(usbhid->urbin, GFP_ATOMIC);
		if (rc != 0)
			clear_bit(HID_IN_RUNNING, &usbhid->iofl);
L
Linus Torvalds 已提交
94
	}
95
	spin_unlock_irqrestore(&usbhid->lock, flags);
96
	return rc;
L
Linus Torvalds 已提交
97 98
}

99 100
/* I/O retry timer routine */
static void hid_retry_timeout(unsigned long _hid)
L
Linus Torvalds 已提交
101
{
102
	struct hid_device *hid = (struct hid_device *) _hid;
J
Jiri Kosina 已提交
103
	struct usbhid_device *usbhid = hid->driver_data;
L
Linus Torvalds 已提交
104

105 106 107
	dev_dbg(&usbhid->intf->dev, "retrying intr urb\n");
	if (hid_start_in(hid))
		hid_io_error(hid);
L
Linus Torvalds 已提交
108 109
}

110 111
/* Workqueue routine to reset the device or clear a halt */
static void hid_reset(struct work_struct *work)
L
Linus Torvalds 已提交
112
{
113 114 115
	struct usbhid_device *usbhid =
		container_of(work, struct usbhid_device, reset_work);
	struct hid_device *hid = usbhid->hid;
116
	int rc = 0;
L
Linus Torvalds 已提交
117

118 119 120 121 122 123
	if (test_bit(HID_CLEAR_HALT, &usbhid->iofl)) {
		dev_dbg(&usbhid->intf->dev, "clear halt\n");
		rc = usb_clear_halt(hid_to_usb_dev(hid), usbhid->urbin->pipe);
		clear_bit(HID_CLEAR_HALT, &usbhid->iofl);
		hid_start_in(hid);
	}
L
Linus Torvalds 已提交
124

125 126
	else if (test_bit(HID_RESET_PENDING, &usbhid->iofl)) {
		dev_dbg(&usbhid->intf->dev, "resetting device\n");
127 128
		rc = usb_lock_device_for_reset(hid_to_usb_dev(hid), usbhid->intf);
		if (rc == 0) {
129
			rc = usb_reset_device(hid_to_usb_dev(hid));
130
			usb_unlock_device(hid_to_usb_dev(hid));
L
Linus Torvalds 已提交
131
		}
132
		clear_bit(HID_RESET_PENDING, &usbhid->iofl);
L
Linus Torvalds 已提交
133 134
	}

135 136 137 138 139 140
	switch (rc) {
	case 0:
		if (!test_bit(HID_IN_RUNNING, &usbhid->iofl))
			hid_io_error(hid);
		break;
	default:
141
		err_hid("can't reset device, %s-%s/input%d, status %d",
142 143 144 145 146 147 148 149
				hid_to_usb_dev(hid)->bus->bus_name,
				hid_to_usb_dev(hid)->devpath,
				usbhid->ifnum, rc);
		/* FALLTHROUGH */
	case -EHOSTUNREACH:
	case -ENODEV:
	case -EINTR:
		break;
L
Linus Torvalds 已提交
150 151 152
	}
}

153 154
/* Main I/O error handler */
static void hid_io_error(struct hid_device *hid)
155
{
156 157
	unsigned long flags;
	struct usbhid_device *usbhid = hid->driver_data;
158

159
	spin_lock_irqsave(&usbhid->lock, flags);
160

161
	/* Stop when disconnected */
162
	if (test_bit(HID_DISCONNECTED, &usbhid->iofl))
163
		goto done;
164

A
Alan Stern 已提交
165 166 167 168 169
	/* If it has been a while since the last error, we'll assume
	 * this a brand new error and reset the retry timeout. */
	if (time_after(jiffies, usbhid->stop_retry + HZ/2))
		usbhid->retry_delay = 0;

170 171 172 173 174 175
	/* When an error occurs, retry at increasing intervals */
	if (usbhid->retry_delay == 0) {
		usbhid->retry_delay = 13;	/* Then 26, 52, 104, 104, ... */
		usbhid->stop_retry = jiffies + msecs_to_jiffies(1000);
	} else if (usbhid->retry_delay < 100)
		usbhid->retry_delay *= 2;
176

177
	if (time_after(jiffies, usbhid->stop_retry)) {
J
Jiri Kosina 已提交
178

179 180 181 182 183
		/* Retries failed, so do a port reset */
		if (!test_and_set_bit(HID_RESET_PENDING, &usbhid->iofl)) {
			schedule_work(&usbhid->reset_work);
			goto done;
		}
L
Linus Torvalds 已提交
184 185
	}

186 187 188
	mod_timer(&usbhid->io_retry,
			jiffies + msecs_to_jiffies(usbhid->retry_delay));
done:
189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233
	spin_unlock_irqrestore(&usbhid->lock, flags);
}

static void usbhid_mark_busy(struct usbhid_device *usbhid)
{
	struct usb_interface *intf = usbhid->intf;

	usb_mark_last_busy(interface_to_usbdev(intf));
}

static int usbhid_restart_out_queue(struct usbhid_device *usbhid)
{
	struct hid_device *hid = usb_get_intfdata(usbhid->intf);
	int kicked;

	if (!hid)
		return 0;

	if ((kicked = (usbhid->outhead != usbhid->outtail))) {
		dbg("Kicking head %d tail %d", usbhid->outhead, usbhid->outtail);
		if (hid_submit_out(hid)) {
			clear_bit(HID_OUT_RUNNING, &usbhid->iofl);
			wake_up(&usbhid->wait);
		}
	}
	return kicked;
}

static int usbhid_restart_ctrl_queue(struct usbhid_device *usbhid)
{
	struct hid_device *hid = usb_get_intfdata(usbhid->intf);
	int kicked;

	WARN_ON(hid == NULL);
	if (!hid)
		return 0;

	if ((kicked = (usbhid->ctrlhead != usbhid->ctrltail))) {
		dbg("Kicking head %d tail %d", usbhid->ctrlhead, usbhid->ctrltail);
		if (hid_submit_ctrl(hid)) {
			clear_bit(HID_CTRL_RUNNING, &usbhid->iofl);
			wake_up(&usbhid->wait);
		}
	}
	return kicked;
L
Linus Torvalds 已提交
234 235
}

236 237 238
/*
 * Input interrupt completion handler.
 */
239

240
static void hid_irq_in(struct urb *urb)
L
Linus Torvalds 已提交
241
{
242 243 244
	struct hid_device	*hid = urb->context;
	struct usbhid_device 	*usbhid = hid->driver_data;
	int			status;
L
Linus Torvalds 已提交
245

246
	switch (urb->status) {
J
Jiri Slaby 已提交
247
	case 0:			/* success */
248
		usbhid_mark_busy(usbhid);
J
Jiri Slaby 已提交
249 250 251 252
		usbhid->retry_delay = 0;
		hid_input_report(urb->context, HID_INPUT_REPORT,
				 urb->transfer_buffer,
				 urb->actual_length, 1);
253 254 255 256 257 258 259 260 261
		/*
		 * autosuspend refused while keys are pressed
		 * because most keyboards don't wake up when
		 * a key is released
		 */
		if (hid_check_keys_pressed(hid))
			set_bit(HID_KEYS_PRESSED, &usbhid->iofl);
		else
			clear_bit(HID_KEYS_PRESSED, &usbhid->iofl);
J
Jiri Slaby 已提交
262 263
		break;
	case -EPIPE:		/* stall */
264
		usbhid_mark_busy(usbhid);
J
Jiri Slaby 已提交
265 266 267 268 269 270 271 272 273 274 275 276 277
		clear_bit(HID_IN_RUNNING, &usbhid->iofl);
		set_bit(HID_CLEAR_HALT, &usbhid->iofl);
		schedule_work(&usbhid->reset_work);
		return;
	case -ECONNRESET:	/* unlink */
	case -ENOENT:
	case -ESHUTDOWN:	/* unplug */
		clear_bit(HID_IN_RUNNING, &usbhid->iofl);
		return;
	case -EILSEQ:		/* protocol error or unplug */
	case -EPROTO:		/* protocol error or unplug */
	case -ETIME:		/* protocol error or unplug */
	case -ETIMEDOUT:	/* Should never happen, but... */
278
		usbhid_mark_busy(usbhid);
J
Jiri Slaby 已提交
279 280 281 282
		clear_bit(HID_IN_RUNNING, &usbhid->iofl);
		hid_io_error(hid);
		return;
	default:		/* error */
283 284
		dev_warn(&urb->dev->dev, "input irq status %d  "
				"received\n", urb->status);
285
	}
L
Linus Torvalds 已提交
286

287 288 289 290
	status = usb_submit_urb(urb, GFP_ATOMIC);
	if (status) {
		clear_bit(HID_IN_RUNNING, &usbhid->iofl);
		if (status != -EPERM) {
291
			err_hid("can't resubmit intr, %s-%s/input%d, status %d",
292 293 294 295 296 297
					hid_to_usb_dev(hid)->bus->bus_name,
					hid_to_usb_dev(hid)->devpath,
					usbhid->ifnum, status);
			hid_io_error(hid);
		}
	}
L
Linus Torvalds 已提交
298 299
}

300
static int hid_submit_out(struct hid_device *hid)
L
Linus Torvalds 已提交
301
{
302
	struct hid_report *report;
303
	char *raw_report;
J
Jiri Kosina 已提交
304 305
	struct usbhid_device *usbhid = hid->driver_data;

306 307
	report = usbhid->out[usbhid->outtail].report;
	raw_report = usbhid->out[usbhid->outtail].raw_report;
L
Linus Torvalds 已提交
308

309 310 311 312 313
	if (!test_bit(HID_REPORTED_IDLE, &usbhid->iofl)) {
		usbhid->urbout->transfer_buffer_length = ((report->size - 1) >> 3) + 1 + (report->id > 0);
		usbhid->urbout->dev = hid_to_usb_dev(hid);
		memcpy(usbhid->outbuf, raw_report, usbhid->urbout->transfer_buffer_length);
		kfree(raw_report);
314

315
		dbg_hid("submitting out urb\n");
316

317 318 319 320 321 322 323 324 325 326 327
		if (usb_submit_urb(usbhid->urbout, GFP_ATOMIC)) {
			err_hid("usb_submit_urb(out) failed");
			return -1;
		}
	} else {
		/*
		 * queue work to wake up the device.
		 * as the work queue is freezeable, this is safe
		 * with respect to STD and STR
		 */
		queue_work(resumption_waker, &usbhid->restart_work);
328
	}
L
Linus Torvalds 已提交
329

330 331 332 333
	return 0;
}

static int hid_submit_ctrl(struct hid_device *hid)
L
Linus Torvalds 已提交
334 335
{
	struct hid_report *report;
336
	unsigned char dir;
337
	char *raw_report;
338
	int len;
J
Jiri Kosina 已提交
339
	struct usbhid_device *usbhid = hid->driver_data;
L
Linus Torvalds 已提交
340

341
	report = usbhid->ctrl[usbhid->ctrltail].report;
342
	raw_report = usbhid->ctrl[usbhid->ctrltail].raw_report;
343
	dir = usbhid->ctrl[usbhid->ctrltail].dir;
L
Linus Torvalds 已提交
344

345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366
	if (!test_bit(HID_REPORTED_IDLE, &usbhid->iofl)) {
		len = ((report->size - 1) >> 3) + 1 + (report->id > 0);
		if (dir == USB_DIR_OUT) {
			usbhid->urbctrl->pipe = usb_sndctrlpipe(hid_to_usb_dev(hid), 0);
			usbhid->urbctrl->transfer_buffer_length = len;
			memcpy(usbhid->ctrlbuf, raw_report, len);
			kfree(raw_report);
		} else {
			int maxpacket, padlen;

			usbhid->urbctrl->pipe = usb_rcvctrlpipe(hid_to_usb_dev(hid), 0);
			maxpacket = usb_maxpacket(hid_to_usb_dev(hid), usbhid->urbctrl->pipe, 0);
			if (maxpacket > 0) {
				padlen = DIV_ROUND_UP(len, maxpacket);
				padlen *= maxpacket;
				if (padlen > usbhid->bufsize)
					padlen = usbhid->bufsize;
			} else
				padlen = 0;
			usbhid->urbctrl->transfer_buffer_length = padlen;
		}
		usbhid->urbctrl->dev = hid_to_usb_dev(hid);
L
Linus Torvalds 已提交
367

368 369 370 371 372
		usbhid->cr->bRequestType = USB_TYPE_CLASS | USB_RECIP_INTERFACE | dir;
		usbhid->cr->bRequest = (dir == USB_DIR_OUT) ? HID_REQ_SET_REPORT : HID_REQ_GET_REPORT;
		usbhid->cr->wValue = cpu_to_le16(((report->type + 1) << 8) | report->id);
		usbhid->cr->wIndex = cpu_to_le16(usbhid->ifnum);
		usbhid->cr->wLength = cpu_to_le16(len);
L
Linus Torvalds 已提交
373

374 375 376
		dbg_hid("submitting ctrl urb: %s wValue=0x%04x wIndex=0x%04x wLength=%u\n",
			usbhid->cr->bRequest == HID_REQ_SET_REPORT ? "Set_Report" : "Get_Report",
			usbhid->cr->wValue, usbhid->cr->wIndex, usbhid->cr->wLength);
L
Linus Torvalds 已提交
377

378 379 380 381 382 383 384 385 386 387 388
		if (usb_submit_urb(usbhid->urbctrl, GFP_ATOMIC)) {
			err_hid("usb_submit_urb(ctrl) failed");
			return -1;
		}
	} else {
		/*
		 * queue work to wake up the device.
		 * as the work queue is freezeable, this is safe
		 * with respect to STD and STR
		 */
		queue_work(resumption_waker, &usbhid->restart_work);
389
	}
L
Linus Torvalds 已提交
390

391 392
	return 0;
}
L
Linus Torvalds 已提交
393

394 395 396
/*
 * Output interrupt completion handler.
 */
L
Linus Torvalds 已提交
397

398 399 400 401 402 403
static void hid_irq_out(struct urb *urb)
{
	struct hid_device *hid = urb->context;
	struct usbhid_device *usbhid = hid->driver_data;
	unsigned long flags;
	int unplug = 0;
L
Linus Torvalds 已提交
404

405
	switch (urb->status) {
J
Jiri Slaby 已提交
406 407 408 409 410 411 412 413 414 415
	case 0:			/* success */
		break;
	case -ESHUTDOWN:	/* unplug */
		unplug = 1;
	case -EILSEQ:		/* protocol error or unplug */
	case -EPROTO:		/* protocol error or unplug */
	case -ECONNRESET:	/* unlink */
	case -ENOENT:
		break;
	default:		/* error */
416 417
		dev_warn(&urb->dev->dev, "output irq status %d "
				"received\n", urb->status);
418
	}
L
Linus Torvalds 已提交
419

420
	spin_lock_irqsave(&usbhid->lock, flags);
L
Linus Torvalds 已提交
421

422 423 424 425
	if (unplug)
		usbhid->outtail = usbhid->outhead;
	else
		usbhid->outtail = (usbhid->outtail + 1) & (HID_OUTPUT_FIFO_SIZE - 1);
L
Linus Torvalds 已提交
426

427 428 429
	if (usbhid->outhead != usbhid->outtail) {
		if (hid_submit_out(hid)) {
			clear_bit(HID_OUT_RUNNING, &usbhid->iofl);
J
Jiri Slaby 已提交
430
			wake_up(&usbhid->wait);
431
		}
432
		spin_unlock_irqrestore(&usbhid->lock, flags);
433 434
		return;
	}
L
Linus Torvalds 已提交
435

436
	clear_bit(HID_OUT_RUNNING, &usbhid->iofl);
437
	spin_unlock_irqrestore(&usbhid->lock, flags);
J
Jiri Slaby 已提交
438
	wake_up(&usbhid->wait);
439
}
440

441 442 443
/*
 * Control pipe completion handler.
 */
L
Linus Torvalds 已提交
444

445 446 447 448
static void hid_ctrl(struct urb *urb)
{
	struct hid_device *hid = urb->context;
	struct usbhid_device *usbhid = hid->driver_data;
449
	int unplug = 0, status = urb->status;
L
Linus Torvalds 已提交
450

451
	spin_lock(&usbhid->lock);
L
Linus Torvalds 已提交
452

453
	switch (status) {
J
Jiri Slaby 已提交
454 455 456 457 458 459 460 461 462 463 464 465 466 467 468
	case 0:			/* success */
		if (usbhid->ctrl[usbhid->ctrltail].dir == USB_DIR_IN)
			hid_input_report(urb->context,
				usbhid->ctrl[usbhid->ctrltail].report->type,
				urb->transfer_buffer, urb->actual_length, 0);
		break;
	case -ESHUTDOWN:	/* unplug */
		unplug = 1;
	case -EILSEQ:		/* protocol error or unplug */
	case -EPROTO:		/* protocol error or unplug */
	case -ECONNRESET:	/* unlink */
	case -ENOENT:
	case -EPIPE:		/* report not available */
		break;
	default:		/* error */
469
		dev_warn(&urb->dev->dev, "ctrl urb status %d "
470
				"received\n", status);
471
	}
L
Linus Torvalds 已提交
472

473 474 475 476
	if (unplug)
		usbhid->ctrltail = usbhid->ctrlhead;
	else
		usbhid->ctrltail = (usbhid->ctrltail + 1) & (HID_CONTROL_FIFO_SIZE - 1);
L
Linus Torvalds 已提交
477

478 479 480
	if (usbhid->ctrlhead != usbhid->ctrltail) {
		if (hid_submit_ctrl(hid)) {
			clear_bit(HID_CTRL_RUNNING, &usbhid->iofl);
J
Jiri Slaby 已提交
481
			wake_up(&usbhid->wait);
482
		}
483
		spin_unlock(&usbhid->lock);
484 485
		return;
	}
L
Linus Torvalds 已提交
486

487
	clear_bit(HID_CTRL_RUNNING, &usbhid->iofl);
488
	spin_unlock(&usbhid->lock);
J
Jiri Slaby 已提交
489
	wake_up(&usbhid->wait);
490
}
L
Linus Torvalds 已提交
491

492
void __usbhid_submit_report(struct hid_device *hid, struct hid_report *report, unsigned char dir)
493 494 495
{
	int head;
	struct usbhid_device *usbhid = hid->driver_data;
496
	int len = ((report->size - 1) >> 3) + 1 + (report->id > 0);
L
Linus Torvalds 已提交
497

498 499
	if ((hid->quirks & HID_QUIRK_NOGET) && dir == USB_DIR_IN)
		return;
500

501 502
	if (usbhid->urbout && dir == USB_DIR_OUT && report->type == HID_OUTPUT_REPORT) {
		if ((head = (usbhid->outhead + 1) & (HID_OUTPUT_FIFO_SIZE - 1)) == usbhid->outtail) {
503
			dev_warn(&hid->dev, "output queue full\n");
504 505
			return;
		}
L
Linus Torvalds 已提交
506

507 508
		usbhid->out[usbhid->outhead].raw_report = kmalloc(len, GFP_ATOMIC);
		if (!usbhid->out[usbhid->outhead].raw_report) {
509
			dev_warn(&hid->dev, "output queueing failed\n");
510 511 512 513
			return;
		}
		hid_output_report(report, usbhid->out[usbhid->outhead].raw_report);
		usbhid->out[usbhid->outhead].report = report;
514
		usbhid->outhead = head;
515

516 517 518 519 520
		if (!test_and_set_bit(HID_OUT_RUNNING, &usbhid->iofl))
			if (hid_submit_out(hid))
				clear_bit(HID_OUT_RUNNING, &usbhid->iofl);
		return;
	}
L
Linus Torvalds 已提交
521

522
	if ((head = (usbhid->ctrlhead + 1) & (HID_CONTROL_FIFO_SIZE - 1)) == usbhid->ctrltail) {
523
		dev_warn(&hid->dev, "control queue full\n");
524 525
		return;
	}
526

527 528 529
	if (dir == USB_DIR_OUT) {
		usbhid->ctrl[usbhid->ctrlhead].raw_report = kmalloc(len, GFP_ATOMIC);
		if (!usbhid->ctrl[usbhid->ctrlhead].raw_report) {
530
			dev_warn(&hid->dev, "control queueing failed\n");
531 532 533 534
			return;
		}
		hid_output_report(report, usbhid->ctrl[usbhid->ctrlhead].raw_report);
	}
535 536 537
	usbhid->ctrl[usbhid->ctrlhead].report = report;
	usbhid->ctrl[usbhid->ctrlhead].dir = dir;
	usbhid->ctrlhead = head;
538

539 540 541
	if (!test_and_set_bit(HID_CTRL_RUNNING, &usbhid->iofl))
		if (hid_submit_ctrl(hid))
			clear_bit(HID_CTRL_RUNNING, &usbhid->iofl);
542
}
543

544 545 546 547
void usbhid_submit_report(struct hid_device *hid, struct hid_report *report, unsigned char dir)
{
	struct usbhid_device *usbhid = hid->driver_data;
	unsigned long flags;
548

549 550 551
	spin_lock_irqsave(&usbhid->lock, flags);
	__usbhid_submit_report(hid, report, dir);
	spin_unlock_irqrestore(&usbhid->lock, flags);
552
}
J
Jiri Slaby 已提交
553
EXPORT_SYMBOL_GPL(usbhid_submit_report);
554

555 556
static int usb_hidinput_input_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
{
557
	struct hid_device *hid = input_get_drvdata(dev);
558
	struct usbhid_device *usbhid = hid->driver_data;
559
	struct hid_field *field;
560
	unsigned long flags;
561
	int offset;
562

563 564
	if (type == EV_FF)
		return input_ff_event(dev, type, code, value);
565

566 567
	if (type != EV_LED)
		return -1;
568

569
	if ((offset = hidinput_find_field(hid, type, code, &field)) == -1) {
570
		dev_warn(&dev->dev, "event field not found\n");
571 572
		return -1;
	}
G
Geoff Levand 已提交
573

574
	hid_set_field(field, offset, value);
575 576 577 578 579 580 581 582 583
	if (value) {
		spin_lock_irqsave(&usbhid->lock, flags);
		usbhid->ledcount++;
		spin_unlock_irqrestore(&usbhid->lock, flags);
	} else {
		spin_lock_irqsave(&usbhid->lock, flags);
		usbhid->ledcount--;
		spin_unlock_irqrestore(&usbhid->lock, flags);
	}
584
	usbhid_submit_report(hid, field->report, USB_DIR_OUT);
L
Linus Torvalds 已提交
585

586 587
	return 0;
}
L
Linus Torvalds 已提交
588

589 590 591
int usbhid_wait_io(struct hid_device *hid)
{
	struct usbhid_device *usbhid = hid->driver_data;
592

J
Jiri Slaby 已提交
593 594 595
	if (!wait_event_timeout(usbhid->wait,
				(!test_bit(HID_CTRL_RUNNING, &usbhid->iofl) &&
				!test_bit(HID_OUT_RUNNING, &usbhid->iofl)),
596
					10*HZ)) {
597
		dbg_hid("timeout waiting for ctrl or out queue to clear\n");
598 599
		return -1;
	}
L
Linus Torvalds 已提交
600

601 602
	return 0;
}
603

604 605 606 607 608 609
static int hid_set_idle(struct usb_device *dev, int ifnum, int report, int idle)
{
	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
		HID_REQ_SET_IDLE, USB_TYPE_CLASS | USB_RECIP_INTERFACE, (idle << 8) | report,
		ifnum, NULL, 0, USB_CTRL_SET_TIMEOUT);
}
L
Linus Torvalds 已提交
610

611 612 613 614
static int hid_get_class_descriptor(struct usb_device *dev, int ifnum,
		unsigned char type, void *buf, int size)
{
	int result, retries = 4;
L
Linus Torvalds 已提交
615

616
	memset(buf, 0, size);
L
Linus Torvalds 已提交
617

618 619 620 621 622 623 624 625
	do {
		result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
				USB_REQ_GET_DESCRIPTOR, USB_RECIP_INTERFACE | USB_DIR_IN,
				(type << 8), ifnum, buf, size, USB_CTRL_GET_TIMEOUT);
		retries--;
	} while (result < size && retries);
	return result;
}
626

627 628
int usbhid_open(struct hid_device *hid)
{
629 630 631
	struct usbhid_device *usbhid = hid->driver_data;
	int res;

632
	mutex_lock(&hid_open_mut);
633 634
	if (!hid->open++) {
		res = usb_autopm_get_interface(usbhid->intf);
635
		/* the device must be awake to reliable request remote wakeup */
636 637
		if (res < 0) {
			hid->open--;
638
			mutex_unlock(&hid_open_mut);
639 640
			return -EIO;
		}
641 642 643 644 645
		usbhid->intf->needs_remote_wakeup = 1;
		if (hid_start_in(hid))
			hid_io_error(hid);
 
		usb_autopm_put_interface(usbhid->intf);
646
	}
647
	mutex_unlock(&hid_open_mut);
648 649
	return 0;
}
650

651 652 653
void usbhid_close(struct hid_device *hid)
{
	struct usbhid_device *usbhid = hid->driver_data;
654

655 656 657 658 659 660 661
	mutex_lock(&hid_open_mut);

	/* protecting hid->open to make sure we don't restart
	 * data acquistion due to a resumption we no longer
	 * care about
	 */
	spin_lock_irq(&usbhid->lock);
662
	if (!--hid->open) {
663
		spin_unlock_irq(&usbhid->lock);
664
		hid_cancel_delayed_stuff(usbhid);
665
		usb_kill_urb(usbhid->urbin);
666 667 668
		usbhid->intf->needs_remote_wakeup = 0;
	} else {
		spin_unlock_irq(&usbhid->lock);
669
	}
670
	mutex_unlock(&hid_open_mut);
671
}
672

673 674 675
/*
 * Initialize all reports
 */
676

677 678 679 680 681
void usbhid_init_reports(struct hid_device *hid)
{
	struct hid_report *report;
	struct usbhid_device *usbhid = hid->driver_data;
	int err, ret;
682

683 684
	list_for_each_entry(report, &hid->report_enum[HID_INPUT_REPORT].report_list, list)
		usbhid_submit_report(hid, report, USB_DIR_IN);
685

686 687
	list_for_each_entry(report, &hid->report_enum[HID_FEATURE_REPORT].report_list, list)
		usbhid_submit_report(hid, report, USB_DIR_IN);
G
Geoff Levand 已提交
688

689 690 691 692 693 694 695 696 697 698
	err = 0;
	ret = usbhid_wait_io(hid);
	while (ret) {
		err |= ret;
		if (test_bit(HID_CTRL_RUNNING, &usbhid->iofl))
			usb_kill_urb(usbhid->urbctrl);
		if (test_bit(HID_OUT_RUNNING, &usbhid->iofl))
			usb_kill_urb(usbhid->urbout);
		ret = usbhid_wait_io(hid);
	}
699

700
	if (err)
701
		dev_warn(&hid->dev, "timeout initializing reports\n");
702
}
L
Linus Torvalds 已提交
703

704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
/*
 * Reset LEDs which BIOS might have left on. For now, just NumLock (0x01).
 */
static int hid_find_field_early(struct hid_device *hid, unsigned int page,
    unsigned int hid_code, struct hid_field **pfield)
{
	struct hid_report *report;
	struct hid_field *field;
	struct hid_usage *usage;
	int i, j;

	list_for_each_entry(report, &hid->report_enum[HID_OUTPUT_REPORT].report_list, list) {
		for (i = 0; i < report->maxfield; i++) {
			field = report->field[i];
			for (j = 0; j < field->maxusage; j++) {
				usage = &field->usage[j];
				if ((usage->hid & HID_USAGE_PAGE) == page &&
				    (usage->hid & 0xFFFF) == hid_code) {
					*pfield = field;
					return j;
				}
			}
		}
	}
	return -1;
}

J
Jiri Slaby 已提交
731
void usbhid_set_leds(struct hid_device *hid)
732 733 734 735 736 737 738 739 740
{
	struct hid_field *field;
	int offset;

	if ((offset = hid_find_field_early(hid, HID_UP_LED, 0x01, &field)) != -1) {
		hid_set_field(field, offset, 0);
		usbhid_submit_report(hid, field->report, USB_DIR_OUT);
	}
}
J
Jiri Slaby 已提交
741
EXPORT_SYMBOL_GPL(usbhid_set_leds);
742

743 744 745
/*
 * Traverse the supplied list of reports and find the longest
 */
J
Jiri Slaby 已提交
746 747
static void hid_find_max_report(struct hid_device *hid, unsigned int type,
		unsigned int *max)
748 749
{
	struct hid_report *report;
J
Jiri Slaby 已提交
750
	unsigned int size;
751 752

	list_for_each_entry(report, &hid->report_enum[type].report_list, list) {
753
		size = ((report->size - 1) >> 3) + 1 + hid->report_enum[type].numbered;
754 755 756 757 758
		if (*max < size)
			*max = size;
	}
}

L
Linus Torvalds 已提交
759 760
static int hid_alloc_buffers(struct usb_device *dev, struct hid_device *hid)
{
J
Jiri Kosina 已提交
761 762
	struct usbhid_device *usbhid = hid->driver_data;

763 764 765 766 767 768 769 770 771 772
	usbhid->inbuf = usb_buffer_alloc(dev, usbhid->bufsize, GFP_KERNEL,
			&usbhid->inbuf_dma);
	usbhid->outbuf = usb_buffer_alloc(dev, usbhid->bufsize, GFP_KERNEL,
			&usbhid->outbuf_dma);
	usbhid->cr = usb_buffer_alloc(dev, sizeof(*usbhid->cr), GFP_KERNEL,
			&usbhid->cr_dma);
	usbhid->ctrlbuf = usb_buffer_alloc(dev, usbhid->bufsize, GFP_KERNEL,
			&usbhid->ctrlbuf_dma);
	if (!usbhid->inbuf || !usbhid->outbuf || !usbhid->cr ||
			!usbhid->ctrlbuf)
L
Linus Torvalds 已提交
773 774 775 776 777
		return -1;

	return 0;
}

778 779 780 781 782 783 784 785 786 787 788
static int usbhid_output_raw_report(struct hid_device *hid, __u8 *buf, size_t count)
{
	struct usbhid_device *usbhid = hid->driver_data;
	struct usb_device *dev = hid_to_usb_dev(hid);
	struct usb_interface *intf = usbhid->intf;
	struct usb_host_interface *interface = intf->cur_altsetting;
	int ret;

	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
		HID_REQ_SET_REPORT,
		USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
789
		((HID_OUTPUT_REPORT + 1) << 8) | *buf,
790 791 792 793 794 795 796 797 798 799
		interface->desc.bInterfaceNumber, buf + 1, count - 1,
		USB_CTRL_SET_TIMEOUT);

	/* count also the report id */
	if (ret > 0)
		ret++;

	return ret;
}

800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818
static void usbhid_restart_queues(struct usbhid_device *usbhid)
{
	if (usbhid->urbout)
		usbhid_restart_out_queue(usbhid);
	usbhid_restart_ctrl_queue(usbhid);
}

static void __usbhid_restart_queues(struct work_struct *work)
{
	struct usbhid_device *usbhid =
		container_of(work, struct usbhid_device, restart_work);
	int r;

	r = usb_autopm_get_interface(usbhid->intf);
	if (r < 0)
		return;
	usb_autopm_put_interface(usbhid->intf);
}

L
Linus Torvalds 已提交
819 820
static void hid_free_buffers(struct usb_device *dev, struct hid_device *hid)
{
J
Jiri Kosina 已提交
821 822
	struct usbhid_device *usbhid = hid->driver_data;

823 824 825 826
	usb_buffer_free(dev, usbhid->bufsize, usbhid->inbuf, usbhid->inbuf_dma);
	usb_buffer_free(dev, usbhid->bufsize, usbhid->outbuf, usbhid->outbuf_dma);
	usb_buffer_free(dev, sizeof(*(usbhid->cr)), usbhid->cr, usbhid->cr_dma);
	usb_buffer_free(dev, usbhid->bufsize, usbhid->ctrlbuf, usbhid->ctrlbuf_dma);
L
Linus Torvalds 已提交
827 828
}

J
Jiri Slaby 已提交
829 830 831
static int usbhid_parse(struct hid_device *hid)
{
	struct usb_interface *intf = to_usb_interface(hid->dev.parent);
L
Linus Torvalds 已提交
832 833 834
	struct usb_host_interface *interface = intf->cur_altsetting;
	struct usb_device *dev = interface_to_usbdev (intf);
	struct hid_descriptor *hdesc;
835
	u32 quirks = 0;
J
Jiri Slaby 已提交
836
	unsigned int rsize = 0;
837
	char *rdesc;
J
Jiri Slaby 已提交
838
	int ret, n;
L
Linus Torvalds 已提交
839

840 841
	quirks = usbhid_lookup_quirk(le16_to_cpu(dev->descriptor.idVendor),
			le16_to_cpu(dev->descriptor.idProduct));
L
Linus Torvalds 已提交
842

843 844 845
	if (quirks & HID_QUIRK_IGNORE)
		return -ENODEV;

846 847 848 849 850 851 852 853
	/* Many keyboards and mice don't like to be polled for reports,
	 * so we will always set the HID_QUIRK_NOGET flag for them. */
	if (interface->desc.bInterfaceSubClass == USB_INTERFACE_SUBCLASS_BOOT) {
		if (interface->desc.bInterfaceProtocol == USB_INTERFACE_PROTOCOL_KEYBOARD ||
			interface->desc.bInterfaceProtocol == USB_INTERFACE_PROTOCOL_MOUSE)
				quirks |= HID_QUIRK_NOGET;
	}

854 855 856
	if (usb_get_extra_descriptor(interface, HID_DT_HID, &hdesc) &&
	    (!interface->desc.bNumEndpoints ||
	     usb_get_extra_descriptor(&interface->endpoint[0], HID_DT_HID, &hdesc))) {
857
		dbg_hid("class descriptor not present\n");
J
Jiri Slaby 已提交
858
		return -ENODEV;
L
Linus Torvalds 已提交
859 860
	}

J
Jiri Slaby 已提交
861 862 863
	hid->version = le16_to_cpu(hdesc->bcdHID);
	hid->country = hdesc->bCountryCode;

L
Linus Torvalds 已提交
864 865 866 867 868
	for (n = 0; n < hdesc->bNumDescriptors; n++)
		if (hdesc->desc[n].bDescriptorType == HID_DT_REPORT)
			rsize = le16_to_cpu(hdesc->desc[n].wDescriptorLength);

	if (!rsize || rsize > HID_MAX_DESCRIPTOR_SIZE) {
869
		dbg_hid("weird size of report descriptor (%u)\n", rsize);
J
Jiri Slaby 已提交
870
		return -EINVAL;
L
Linus Torvalds 已提交
871 872 873
	}

	if (!(rdesc = kmalloc(rsize, GFP_KERNEL))) {
874
		dbg_hid("couldn't allocate rdesc memory\n");
J
Jiri Slaby 已提交
875
		return -ENOMEM;
L
Linus Torvalds 已提交
876 877
	}

878 879
	hid_set_idle(dev, interface->desc.bInterfaceNumber, 0, 0);

J
Jiri Slaby 已提交
880 881 882
	ret = hid_get_class_descriptor(dev, interface->desc.bInterfaceNumber,
			HID_DT_REPORT, rdesc, rsize);
	if (ret < 0) {
883
		dbg_hid("reading report descriptor failed\n");
L
Linus Torvalds 已提交
884
		kfree(rdesc);
J
Jiri Slaby 已提交
885
		goto err;
L
Linus Torvalds 已提交
886 887
	}

888
	dbg_hid("report descriptor (size %u, read %d) = ", rsize, n);
L
Linus Torvalds 已提交
889
	for (n = 0; n < rsize; n++)
890 891
		dbg_hid_line(" %02x", (unsigned char) rdesc[n]);
	dbg_hid_line("\n");
L
Linus Torvalds 已提交
892

J
Jiri Slaby 已提交
893 894 895
	ret = hid_parse_report(hid, rdesc, rsize);
	kfree(rdesc);
	if (ret) {
896
		dbg_hid("parsing report descriptor failed\n");
J
Jiri Slaby 已提交
897
		goto err;
L
Linus Torvalds 已提交
898 899
	}

900
	hid->quirks |= quirks;
L
Linus Torvalds 已提交
901

J
Jiri Slaby 已提交
902 903 904 905 906 907 908 909 910 911
	return 0;
err:
	return ret;
}

static int usbhid_start(struct hid_device *hid)
{
	struct usb_interface *intf = to_usb_interface(hid->dev.parent);
	struct usb_host_interface *interface = intf->cur_altsetting;
	struct usb_device *dev = interface_to_usbdev(intf);
912
	struct usbhid_device *usbhid = hid->driver_data;
J
Jiri Slaby 已提交
913 914 915
	unsigned int n, insize = 0;
	int ret;

916 917
	clear_bit(HID_DISCONNECTED, &usbhid->iofl);

J
Jiri Kosina 已提交
918 919 920 921
	usbhid->bufsize = HID_MIN_BUFFER_SIZE;
	hid_find_max_report(hid, HID_INPUT_REPORT, &usbhid->bufsize);
	hid_find_max_report(hid, HID_OUTPUT_REPORT, &usbhid->bufsize);
	hid_find_max_report(hid, HID_FEATURE_REPORT, &usbhid->bufsize);
922

J
Jiri Kosina 已提交
923 924
	if (usbhid->bufsize > HID_MAX_BUFFER_SIZE)
		usbhid->bufsize = HID_MAX_BUFFER_SIZE;
925 926 927 928 929 930

	hid_find_max_report(hid, HID_INPUT_REPORT, &insize);

	if (insize > HID_MAX_BUFFER_SIZE)
		insize = HID_MAX_BUFFER_SIZE;

J
Jiri Slaby 已提交
931 932
	if (hid_alloc_buffers(dev, hid)) {
		ret = -ENOMEM;
L
Linus Torvalds 已提交
933
		goto fail;
934 935
	}

L
Linus Torvalds 已提交
936 937 938 939 940 941
	for (n = 0; n < interface->desc.bNumEndpoints; n++) {
		struct usb_endpoint_descriptor *endpoint;
		int pipe;
		int interval;

		endpoint = &interface->endpoint[n].desc;
942
		if (!usb_endpoint_xfer_int(endpoint))
L
Linus Torvalds 已提交
943 944 945 946
			continue;

		interval = endpoint->bInterval;

947
		/* Some vendors give fullspeed interval on highspeed devides */
J
Jiri Slaby 已提交
948
		if (hid->quirks & HID_QUIRK_FULLSPEED_INTERVAL &&
949 950 951 952 953 954
		    dev->speed == USB_SPEED_HIGH) {
			interval = fls(endpoint->bInterval*8);
			printk(KERN_INFO "%s: Fixing fullspeed to highspeed interval: %d -> %d\n",
			       hid->name, endpoint->bInterval, interval);
		}

L
Linus Torvalds 已提交
955 956 957
		/* Change the polling interval of mice. */
		if (hid->collection->usage == HID_GD_MOUSE && hid_mousepoll_interval > 0)
			interval = hid_mousepoll_interval;
958

J
Jiri Slaby 已提交
959
		ret = -ENOMEM;
960
		if (usb_endpoint_dir_in(endpoint)) {
J
Jiri Kosina 已提交
961
			if (usbhid->urbin)
L
Linus Torvalds 已提交
962
				continue;
J
Jiri Kosina 已提交
963
			if (!(usbhid->urbin = usb_alloc_urb(0, GFP_KERNEL)))
L
Linus Torvalds 已提交
964 965
				goto fail;
			pipe = usb_rcvintpipe(dev, endpoint->bEndpointAddress);
J
Jiri Kosina 已提交
966
			usb_fill_int_urb(usbhid->urbin, dev, pipe, usbhid->inbuf, insize,
L
Linus Torvalds 已提交
967
					 hid_irq_in, hid, interval);
J
Jiri Kosina 已提交
968 969
			usbhid->urbin->transfer_dma = usbhid->inbuf_dma;
			usbhid->urbin->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
L
Linus Torvalds 已提交
970
		} else {
J
Jiri Kosina 已提交
971
			if (usbhid->urbout)
L
Linus Torvalds 已提交
972
				continue;
J
Jiri Kosina 已提交
973
			if (!(usbhid->urbout = usb_alloc_urb(0, GFP_KERNEL)))
L
Linus Torvalds 已提交
974 975
				goto fail;
			pipe = usb_sndintpipe(dev, endpoint->bEndpointAddress);
J
Jiri Kosina 已提交
976
			usb_fill_int_urb(usbhid->urbout, dev, pipe, usbhid->outbuf, 0,
L
Linus Torvalds 已提交
977
					 hid_irq_out, hid, interval);
J
Jiri Kosina 已提交
978 979
			usbhid->urbout->transfer_dma = usbhid->outbuf_dma;
			usbhid->urbout->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
L
Linus Torvalds 已提交
980 981 982
		}
	}

J
Jiri Slaby 已提交
983
	init_waitqueue_head(&usbhid->wait);
J
Jiri Kosina 已提交
984
	INIT_WORK(&usbhid->reset_work, hid_reset);
985
	INIT_WORK(&usbhid->restart_work, __usbhid_restart_queues);
J
Jiri Kosina 已提交
986
	setup_timer(&usbhid->io_retry, hid_retry_timeout, (unsigned long) hid);
A
Alan Stern 已提交
987

988
	spin_lock_init(&usbhid->lock);
L
Linus Torvalds 已提交
989

J
Jiri Kosina 已提交
990 991
	usbhid->intf = intf;
	usbhid->ifnum = interface->desc.bInterfaceNumber;
L
Linus Torvalds 已提交
992

J
Jiri Kosina 已提交
993
	usbhid->urbctrl = usb_alloc_urb(0, GFP_KERNEL);
J
Jiri Slaby 已提交
994 995
	if (!usbhid->urbctrl) {
		ret = -ENOMEM;
L
Linus Torvalds 已提交
996
		goto fail;
J
Jiri Slaby 已提交
997
	}
998

J
Jiri Kosina 已提交
999 1000 1001 1002 1003
	usb_fill_control_urb(usbhid->urbctrl, dev, 0, (void *) usbhid->cr,
			     usbhid->ctrlbuf, 1, hid_ctrl, hid);
	usbhid->urbctrl->setup_dma = usbhid->cr_dma;
	usbhid->urbctrl->transfer_dma = usbhid->ctrlbuf_dma;
	usbhid->urbctrl->transfer_flags |= (URB_NO_TRANSFER_DMA_MAP | URB_NO_SETUP_DMA_MAP);
J
Jiri Slaby 已提交
1004

J
Jiri Slaby 已提交
1005 1006 1007
	usbhid_init_reports(hid);
	hid_dump_device(hid);

1008 1009
	set_bit(HID_STARTED, &usbhid->iofl);

1010 1011 1012 1013 1014 1015 1016 1017 1018
	/* Some keyboards don't work until their LEDs have been set.
	 * Since BIOSes do set the LEDs, it must be safe for any device
	 * that supports the keyboard boot protocol.
	 */
	if (interface->desc.bInterfaceSubClass == USB_INTERFACE_SUBCLASS_BOOT &&
			interface->desc.bInterfaceProtocol ==
				USB_INTERFACE_PROTOCOL_KEYBOARD)
		usbhid_set_leds(hid);

J
Jiri Slaby 已提交
1019
	return 0;
L
Linus Torvalds 已提交
1020 1021

fail:
J
Jiri Kosina 已提交
1022 1023 1024
	usb_free_urb(usbhid->urbin);
	usb_free_urb(usbhid->urbout);
	usb_free_urb(usbhid->urbctrl);
1025 1026 1027
	usbhid->urbin = NULL;
	usbhid->urbout = NULL;
	usbhid->urbctrl = NULL;
1028
	hid_free_buffers(dev, hid);
J
Jiri Slaby 已提交
1029
	return ret;
L
Linus Torvalds 已提交
1030 1031
}

J
Jiri Slaby 已提交
1032
static void usbhid_stop(struct hid_device *hid)
L
Linus Torvalds 已提交
1033
{
J
Jiri Slaby 已提交
1034
	struct usbhid_device *usbhid = hid->driver_data;
L
Linus Torvalds 已提交
1035

J
Jiri Slaby 已提交
1036
	if (WARN_ON(!usbhid))
L
Linus Torvalds 已提交
1037 1038
		return;

1039
	clear_bit(HID_STARTED, &usbhid->iofl);
1040
	spin_lock_irq(&usbhid->lock);	/* Sync with error handler */
1041
	set_bit(HID_DISCONNECTED, &usbhid->iofl);
1042
	spin_unlock_irq(&usbhid->lock);
J
Jiri Kosina 已提交
1043 1044 1045
	usb_kill_urb(usbhid->urbin);
	usb_kill_urb(usbhid->urbout);
	usb_kill_urb(usbhid->urbctrl);
L
Linus Torvalds 已提交
1046

1047
	hid_cancel_delayed_stuff(usbhid);
A
Alan Stern 已提交
1048

L
Linus Torvalds 已提交
1049 1050 1051 1052
	if (hid->claimed & HID_CLAIMED_INPUT)
		hidinput_disconnect(hid);
	if (hid->claimed & HID_CLAIMED_HIDDEV)
		hiddev_disconnect(hid);
J
Jiri Kosina 已提交
1053 1054
	if (hid->claimed & HID_CLAIMED_HIDRAW)
		hidraw_disconnect(hid);
L
Linus Torvalds 已提交
1055

J
Jiri Slaby 已提交
1056 1057
	hid->claimed = 0;

J
Jiri Kosina 已提交
1058 1059 1060
	usb_free_urb(usbhid->urbin);
	usb_free_urb(usbhid->urbctrl);
	usb_free_urb(usbhid->urbout);
1061 1062 1063
	usbhid->urbin = NULL; /* don't mess up next start */
	usbhid->urbctrl = NULL;
	usbhid->urbout = NULL;
L
Linus Torvalds 已提交
1064

1065
	hid_free_buffers(hid_to_usb_dev(hid), hid);
L
Linus Torvalds 已提交
1066 1067
}

1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
static int usbhid_power(struct hid_device *hid, int lvl)
{
	int r = 0;

	switch (lvl) {
	case PM_HINT_FULLON:
		r = usbhid_get_power(hid);
		break;
	case PM_HINT_NORMAL:
		usbhid_put_power(hid);
		break;
	}
	return r;
}

J
Jiri Slaby 已提交
1083 1084 1085 1086 1087 1088
static struct hid_ll_driver usb_hid_driver = {
	.parse = usbhid_parse,
	.start = usbhid_start,
	.stop = usbhid_stop,
	.open = usbhid_open,
	.close = usbhid_close,
1089
	.power = usbhid_power,
J
Jiri Slaby 已提交
1090 1091 1092
	.hidinput_input_event = usb_hidinput_input_event,
};

L
Linus Torvalds 已提交
1093 1094
static int hid_probe(struct usb_interface *intf, const struct usb_device_id *id)
{
J
Jiri Slaby 已提交
1095
	struct usb_host_interface *interface = intf->cur_altsetting;
J
Jiri Slaby 已提交
1096
	struct usb_device *dev = interface_to_usbdev(intf);
1097
	struct usbhid_device *usbhid;
L
Linus Torvalds 已提交
1098
	struct hid_device *hid;
J
Jiri Slaby 已提交
1099
	unsigned int n, has_in = 0;
J
Jiri Slaby 已提交
1100 1101
	size_t len;
	int ret;
L
Linus Torvalds 已提交
1102

1103
	dbg_hid("HID probe called for ifnum %d\n",
L
Linus Torvalds 已提交
1104 1105
			intf->altsetting->desc.bInterfaceNumber);

J
Jiri Slaby 已提交
1106 1107 1108 1109 1110 1111 1112 1113 1114
	for (n = 0; n < interface->desc.bNumEndpoints; n++)
		if (usb_endpoint_is_int_in(&interface->endpoint[n].desc))
			has_in++;
	if (!has_in) {
		dev_err(&intf->dev, "couldn't find an input interrupt "
				"endpoint\n");
		return -ENODEV;
	}

J
Jiri Slaby 已提交
1115 1116 1117
	hid = hid_allocate_device();
	if (IS_ERR(hid))
		return PTR_ERR(hid);
L
Linus Torvalds 已提交
1118 1119

	usb_set_intfdata(intf, hid);
J
Jiri Slaby 已提交
1120 1121
	hid->ll_driver = &usb_hid_driver;
	hid->hid_output_raw_report = usbhid_output_raw_report;
J
Jiri Slaby 已提交
1122
	hid->ff_init = hid_pidff_init;
J
Jiri Slaby 已提交
1123
#ifdef CONFIG_USB_HIDDEV
J
Jiri Slaby 已提交
1124
	hid->hiddev_connect = hiddev_connect;
J
Jiri Slaby 已提交
1125 1126 1127 1128 1129 1130 1131 1132
	hid->hiddev_hid_event = hiddev_hid_event;
	hid->hiddev_report_event = hiddev_report_event;
#endif
	hid->dev.parent = &intf->dev;
	hid->bus = BUS_USB;
	hid->vendor = le16_to_cpu(dev->descriptor.idVendor);
	hid->product = le16_to_cpu(dev->descriptor.idProduct);
	hid->name[0] = 0;
1133 1134 1135
	if (intf->cur_altsetting->desc.bInterfaceProtocol ==
			USB_INTERFACE_PROTOCOL_MOUSE)
		hid->type = HID_TYPE_USBMOUSE;
L
Linus Torvalds 已提交
1136

J
Jiri Slaby 已提交
1137 1138
	if (dev->manufacturer)
		strlcpy(hid->name, dev->manufacturer, sizeof(hid->name));
L
Linus Torvalds 已提交
1139

J
Jiri Slaby 已提交
1140 1141 1142 1143
	if (dev->product) {
		if (dev->manufacturer)
			strlcat(hid->name, " ", sizeof(hid->name));
		strlcat(hid->name, dev->product, sizeof(hid->name));
L
Linus Torvalds 已提交
1144 1145
	}

J
Jiri Slaby 已提交
1146 1147 1148 1149
	if (!strlen(hid->name))
		snprintf(hid->name, sizeof(hid->name), "HID %04x:%04x",
			 le16_to_cpu(dev->descriptor.idVendor),
			 le16_to_cpu(dev->descriptor.idProduct));
L
Linus Torvalds 已提交
1150

J
Jiri Slaby 已提交
1151 1152 1153 1154 1155 1156 1157 1158 1159
	usb_make_path(dev, hid->phys, sizeof(hid->phys));
	strlcat(hid->phys, "/input", sizeof(hid->phys));
	len = strlen(hid->phys);
	if (len < sizeof(hid->phys) - 1)
		snprintf(hid->phys + len, sizeof(hid->phys) - len,
			 "%d", intf->altsetting[0].desc.bInterfaceNumber);

	if (usb_string(dev, dev->descriptor.iSerialNumber, hid->uniq, 64) <= 0)
		hid->uniq[0] = 0;
L
Linus Torvalds 已提交
1160

1161 1162 1163 1164 1165 1166 1167 1168 1169
	usbhid = kzalloc(sizeof(*usbhid), GFP_KERNEL);
	if (usbhid == NULL) {
		ret = -ENOMEM;
		goto err;
	}

	hid->driver_data = usbhid;
	usbhid->hid = hid;

J
Jiri Slaby 已提交
1170 1171
	ret = hid_add_device(hid);
	if (ret) {
J
Jiri Slaby 已提交
1172 1173
		if (ret != -ENODEV)
			dev_err(&intf->dev, "can't add hid device: %d\n", ret);
1174
		goto err_free;
J
Jiri Slaby 已提交
1175
	}
J
Jiri Slaby 已提交
1176 1177

	return 0;
1178 1179
err_free:
	kfree(usbhid);
J
Jiri Slaby 已提交
1180 1181
err:
	hid_destroy_device(hid);
J
Jiri Slaby 已提交
1182
	return ret;
L
Linus Torvalds 已提交
1183 1184
}

J
Jiri Slaby 已提交
1185 1186 1187
static void hid_disconnect(struct usb_interface *intf)
{
	struct hid_device *hid = usb_get_intfdata(intf);
1188
	struct usbhid_device *usbhid;
J
Jiri Slaby 已提交
1189 1190 1191 1192

	if (WARN_ON(!hid))
		return;

1193
	usbhid = hid->driver_data;
J
Jiri Slaby 已提交
1194
	hid_destroy_device(hid);
1195
	kfree(usbhid);
J
Jiri Slaby 已提交
1196 1197
}

1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212
static void hid_cancel_delayed_stuff(struct usbhid_device *usbhid)
{
	del_timer_sync(&usbhid->io_retry);
	cancel_work_sync(&usbhid->restart_work);
	cancel_work_sync(&usbhid->reset_work);
}

static void hid_cease_io(struct usbhid_device *usbhid)
{
	del_timer(&usbhid->io_retry);
	usb_kill_urb(usbhid->urbin);
	usb_kill_urb(usbhid->urbctrl);
	usb_kill_urb(usbhid->urbout);
}

1213 1214 1215 1216 1217 1218 1219 1220 1221
/* Treat USB reset pretty much the same as suspend/resume */
static int hid_pre_reset(struct usb_interface *intf)
{
	struct hid_device *hid = usb_get_intfdata(intf);
	struct usbhid_device *usbhid = hid->driver_data;

	spin_lock_irq(&usbhid->lock);
	set_bit(HID_RESET_PENDING, &usbhid->iofl);
	spin_unlock_irq(&usbhid->lock);
1222
	cancel_work_sync(&usbhid->restart_work);
1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234
	hid_cease_io(usbhid);

	return 0;
}

/* Same routine used for post_reset and reset_resume */
static int hid_post_reset(struct usb_interface *intf)
{
	struct usb_device *dev = interface_to_usbdev (intf);
	struct hid_device *hid = usb_get_intfdata(intf);
	struct usbhid_device *usbhid = hid->driver_data;
	int status;
1235

1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250
	spin_lock_irq(&usbhid->lock);
	clear_bit(HID_RESET_PENDING, &usbhid->iofl);
	spin_unlock_irq(&usbhid->lock);
	hid_set_idle(dev, intf->cur_altsetting->desc.bInterfaceNumber, 0, 0);
	status = hid_start_in(hid);
	if (status < 0)
		hid_io_error(hid);
	usbhid_restart_queues(usbhid);

	return 0;
}

int usbhid_get_power(struct hid_device *hid)
{
	struct usbhid_device *usbhid = hid->driver_data;
1251

1252 1253 1254 1255 1256 1257
	return usb_autopm_get_interface(usbhid->intf);
}

void usbhid_put_power(struct hid_device *hid)
{
	struct usbhid_device *usbhid = hid->driver_data;
1258

1259 1260 1261 1262
	usb_autopm_put_interface(usbhid->intf);
}


1263
#ifdef CONFIG_PM
1264
static int hid_suspend(struct usb_interface *intf, pm_message_t message)
L
Linus Torvalds 已提交
1265
{
1266
	struct hid_device *hid = usb_get_intfdata(intf);
J
Jiri Kosina 已提交
1267
	struct usbhid_device *usbhid = hid->driver_data;
1268 1269
	struct usb_device *udev = interface_to_usbdev(intf);
	int status;
L
Linus Torvalds 已提交
1270

1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286
	if (udev->auto_pm) {
		spin_lock_irq(&usbhid->lock);	/* Sync with error handler */
		if (!test_bit(HID_RESET_PENDING, &usbhid->iofl)
		    && !test_bit(HID_CLEAR_HALT, &usbhid->iofl)
		    && !test_bit(HID_OUT_RUNNING, &usbhid->iofl)
		    && !test_bit(HID_CTRL_RUNNING, &usbhid->iofl)
		    && !test_bit(HID_KEYS_PRESSED, &usbhid->iofl)
		    && (!usbhid->ledcount || ignoreled))
		{
			set_bit(HID_REPORTED_IDLE, &usbhid->iofl);
			spin_unlock_irq(&usbhid->lock);
		} else {
			usbhid_mark_busy(usbhid);
			spin_unlock_irq(&usbhid->lock);
			return -EBUSY;
		}
1287

1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
	} else {
		spin_lock_irq(&usbhid->lock);
		set_bit(HID_REPORTED_IDLE, &usbhid->iofl);
		spin_unlock_irq(&usbhid->lock);
		if (usbhid_wait_io(hid) < 0)
			return -EIO;
	}

	if (!ignoreled && udev->auto_pm) {
		spin_lock_irq(&usbhid->lock);
		if (test_bit(HID_LED_ON, &usbhid->iofl)) {
			spin_unlock_irq(&usbhid->lock);
			usbhid_mark_busy(usbhid);
			return -EBUSY;
		}
		spin_unlock_irq(&usbhid->lock);
	}

	hid_cancel_delayed_stuff(usbhid);
	hid_cease_io(usbhid);

	if (udev->auto_pm && test_bit(HID_KEYS_PRESSED, &usbhid->iofl)) {
		/* lost race against keypresses */
		status = hid_start_in(hid);
		if (status < 0)
			hid_io_error(hid);
		usbhid_mark_busy(usbhid);
		return -EBUSY;
	}
L
Linus Torvalds 已提交
1317 1318 1319 1320 1321 1322 1323
	dev_dbg(&intf->dev, "suspend\n");
	return 0;
}

static int hid_resume(struct usb_interface *intf)
{
	struct hid_device *hid = usb_get_intfdata (intf);
J
Jiri Kosina 已提交
1324
	struct usbhid_device *usbhid = hid->driver_data;
L
Linus Torvalds 已提交
1325 1326
	int status;

1327
	if (!test_bit(HID_STARTED, &usbhid->iofl))
1328 1329
		return 0;

1330 1331 1332 1333 1334 1335
	clear_bit(HID_REPORTED_IDLE, &usbhid->iofl);
	usbhid_mark_busy(usbhid);

	if (test_bit(HID_CLEAR_HALT, &usbhid->iofl) ||
	    test_bit(HID_RESET_PENDING, &usbhid->iofl))
		schedule_work(&usbhid->reset_work);
J
Jiri Kosina 已提交
1336
	usbhid->retry_delay = 0;
A
Alan Stern 已提交
1337
	status = hid_start_in(hid);
1338 1339 1340
	if (status < 0)
		hid_io_error(hid);
	usbhid_restart_queues(usbhid);
L
Linus Torvalds 已提交
1341 1342

	dev_dbg(&intf->dev, "resume status %d\n", status);
A
Alan Stern 已提交
1343
	return 0;
1344 1345
}

1346
static int hid_reset_resume(struct usb_interface *intf)
1347
{
1348 1349
	struct hid_device *hid = usb_get_intfdata(intf);
	struct usbhid_device *usbhid = hid->driver_data;
1350

1351 1352
	clear_bit(HID_REPORTED_IDLE, &usbhid->iofl);
	return hid_post_reset(intf);
1353 1354
}

1355
#endif /* CONFIG_PM */
1356

L
Linus Torvalds 已提交
1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368
static struct usb_device_id hid_usb_ids [] = {
	{ .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS,
		.bInterfaceClass = USB_INTERFACE_CLASS_HID },
	{ }						/* Terminating entry */
};

MODULE_DEVICE_TABLE (usb, hid_usb_ids);

static struct usb_driver hid_driver = {
	.name =		"usbhid",
	.probe =	hid_probe,
	.disconnect =	hid_disconnect,
1369
#ifdef CONFIG_PM
L
Linus Torvalds 已提交
1370 1371
	.suspend =	hid_suspend,
	.resume =	hid_resume,
1372
	.reset_resume =	hid_reset_resume,
1373
#endif
1374 1375
	.pre_reset =	hid_pre_reset,
	.post_reset =	hid_post_reset,
L
Linus Torvalds 已提交
1376
	.id_table =	hid_usb_ids,
1377
	.supports_autosuspend = 1,
L
Linus Torvalds 已提交
1378 1379
};

J
Jiri Slaby 已提交
1380 1381 1382 1383 1384 1385 1386 1387 1388 1389
static const struct hid_device_id hid_usb_table[] = {
	{ HID_USB_DEVICE(HID_ANY_ID, HID_ANY_ID) },
	{ }
};

static struct hid_driver hid_usb_driver = {
	.name = "generic-usb",
	.id_table = hid_usb_table,
};

L
Linus Torvalds 已提交
1390 1391
static int __init hid_init(void)
{
1392 1393 1394 1395 1396
	int retval = -ENOMEM;

	resumption_waker = create_freezeable_workqueue("usbhid_resumer");
	if (!resumption_waker)
		goto no_queue;
J
Jiri Slaby 已提交
1397 1398 1399
	retval = hid_register_driver(&hid_usb_driver);
	if (retval)
		goto hid_register_fail;
1400 1401 1402
	retval = usbhid_quirks_init(quirks_param);
	if (retval)
		goto usbhid_quirks_init_fail;
L
Linus Torvalds 已提交
1403 1404 1405 1406 1407 1408
	retval = hiddev_init();
	if (retval)
		goto hiddev_init_fail;
	retval = usb_register(&hid_driver);
	if (retval)
		goto usb_register_fail;
1409 1410
	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
			DRIVER_DESC "\n");
L
Linus Torvalds 已提交
1411 1412 1413 1414 1415

	return 0;
usb_register_fail:
	hiddev_exit();
hiddev_init_fail:
1416 1417
	usbhid_quirks_exit();
usbhid_quirks_init_fail:
J
Jiri Slaby 已提交
1418 1419
	hid_unregister_driver(&hid_usb_driver);
hid_register_fail:
1420 1421
	destroy_workqueue(resumption_waker);
no_queue:
L
Linus Torvalds 已提交
1422 1423 1424 1425 1426 1427 1428
	return retval;
}

static void __exit hid_exit(void)
{
	usb_deregister(&hid_driver);
	hiddev_exit();
1429
	usbhid_quirks_exit();
J
Jiri Slaby 已提交
1430
	hid_unregister_driver(&hid_usb_driver);
1431
	destroy_workqueue(resumption_waker);
L
Linus Torvalds 已提交
1432 1433 1434 1435 1436 1437 1438 1439
}

module_init(hid_init);
module_exit(hid_exit);

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE(DRIVER_LICENSE);