]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/usb/core/devio.c
USB: fix memleak in usbfs
[net-next-2.6.git] / drivers / usb / core / devio.c
CommitLineData
1da177e4
LT
1/*****************************************************************************/
2
3/*
4 * devio.c -- User space communication with USB devices.
5 *
6 * Copyright (C) 1999-2000 Thomas Sailer (sailer@ife.ee.ethz.ch)
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 *
1da177e4
LT
22 * This file implements the usbfs/x/y files, where
23 * x is the bus number and y the device number.
24 *
25 * It allows user space programs/"drivers" to communicate directly
26 * with USB devices without intervening kernel driver.
27 *
28 * Revision history
29 * 22.12.1999 0.1 Initial release (split from proc_usb.c)
30 * 04.01.2000 0.2 Turned into its own filesystem
46113830
HW
31 * 30.09.2005 0.3 Fix user-triggerable oops in async URB delivery
32 * (CAN-2005-3055)
1da177e4
LT
33 */
34
35/*****************************************************************************/
36
37#include <linux/fs.h>
38#include <linux/mm.h>
39#include <linux/slab.h>
40#include <linux/smp_lock.h>
41#include <linux/signal.h>
42#include <linux/poll.h>
43#include <linux/module.h>
44#include <linux/usb.h>
45#include <linux/usbdevice_fs.h>
fbf82fd2 46#include <linux/cdev.h>
a7b986b3 47#include <linux/notifier.h>
7a01955f 48#include <linux/security.h>
1da177e4
LT
49#include <asm/uaccess.h>
50#include <asm/byteorder.h>
51#include <linux/moduleparam.h>
52
53#include "hcd.h" /* for usbcore internals */
54#include "usb.h"
55
fbf82fd2
KS
56#define USB_MAXBUS 64
57#define USB_DEVICE_MAX USB_MAXBUS * 128
fbf82fd2 58
4a2a8a2c
AS
59/* Mutual exclusion for removal, open, and release */
60DEFINE_MUTEX(usbfs_mutex);
61
cd9f0375
AS
62struct dev_state {
63 struct list_head list; /* state list */
64 struct usb_device *dev;
65 struct file *file;
66 spinlock_t lock; /* protects the async urb lists */
67 struct list_head async_pending;
68 struct list_head async_completed;
69 wait_queue_head_t wait; /* wake up if a request completed */
70 unsigned int discsignr;
71 struct pid *disc_pid;
72 uid_t disc_uid, disc_euid;
73 void __user *disccontext;
74 unsigned long ifclaimed;
75 u32 secid;
76};
77
1da177e4
LT
78struct async {
79 struct list_head asynclist;
80 struct dev_state *ps;
2425c08b 81 struct pid *pid;
46113830 82 uid_t uid, euid;
1da177e4
LT
83 unsigned int signr;
84 unsigned int ifnum;
85 void __user *userbuffer;
86 void __user *userurb;
87 struct urb *urb;
e015268d 88 int status;
7a01955f 89 u32 secid;
1da177e4
LT
90};
91
04e482ff
GKH
92static int usbfs_snoop;
93module_param(usbfs_snoop, bool, S_IRUGO | S_IWUSR);
94MODULE_PARM_DESC(usbfs_snoop, "true to log all usbfs traffic");
1da177e4
LT
95
96#define snoop(dev, format, arg...) \
97 do { \
98 if (usbfs_snoop) \
04e482ff 99 dev_info(dev , format , ## arg); \
1da177e4
LT
100 } while (0)
101
fad21bdf
AS
102#define USB_DEVICE_DEV MKDEV(USB_DEVICE_MAJOR, 0)
103
1da177e4
LT
104
105#define MAX_USBFS_BUFFER_SIZE 16384
106
d34d9721 107static int connected(struct dev_state *ps)
1da177e4 108{
349710c3
AS
109 return (!list_empty(&ps->list) &&
110 ps->dev->state != USB_STATE_NOTATTACHED);
1da177e4
LT
111}
112
113static loff_t usbdev_lseek(struct file *file, loff_t offset, int orig)
114{
115 loff_t ret;
116
117 lock_kernel();
118
119 switch (orig) {
120 case 0:
121 file->f_pos = offset;
122 ret = file->f_pos;
123 break;
124 case 1:
125 file->f_pos += offset;
126 ret = file->f_pos;
127 break;
128 case 2:
129 default:
130 ret = -EINVAL;
131 }
132
133 unlock_kernel();
134 return ret;
135}
136
04e482ff
GKH
137static ssize_t usbdev_read(struct file *file, char __user *buf, size_t nbytes,
138 loff_t *ppos)
1da177e4 139{
ec17cf1c 140 struct dev_state *ps = file->private_data;
1da177e4
LT
141 struct usb_device *dev = ps->dev;
142 ssize_t ret = 0;
143 unsigned len;
144 loff_t pos;
145 int i;
146
147 pos = *ppos;
148 usb_lock_device(dev);
349710c3 149 if (!connected(ps)) {
1da177e4
LT
150 ret = -ENODEV;
151 goto err;
152 } else if (pos < 0) {
153 ret = -EINVAL;
154 goto err;
155 }
156
157 if (pos < sizeof(struct usb_device_descriptor)) {
04e482ff
GKH
158 /* 18 bytes - fits on the stack */
159 struct usb_device_descriptor temp_desc;
8781ba0a
ON
160
161 memcpy(&temp_desc, &dev->descriptor, sizeof(dev->descriptor));
9fcd5c32
AM
162 le16_to_cpus(&temp_desc.bcdUSB);
163 le16_to_cpus(&temp_desc.idVendor);
164 le16_to_cpus(&temp_desc.idProduct);
165 le16_to_cpus(&temp_desc.bcdDevice);
1da177e4
LT
166
167 len = sizeof(struct usb_device_descriptor) - pos;
168 if (len > nbytes)
169 len = nbytes;
8781ba0a 170 if (copy_to_user(buf, ((char *)&temp_desc) + pos, len)) {
1da177e4
LT
171 ret = -EFAULT;
172 goto err;
173 }
1da177e4
LT
174
175 *ppos += len;
176 buf += len;
177 nbytes -= len;
178 ret += len;
179 }
180
181 pos = sizeof(struct usb_device_descriptor);
182 for (i = 0; nbytes && i < dev->descriptor.bNumConfigurations; i++) {
183 struct usb_config_descriptor *config =
184 (struct usb_config_descriptor *)dev->rawdescriptors[i];
185 unsigned int length = le16_to_cpu(config->wTotalLength);
186
187 if (*ppos < pos + length) {
188
189 /* The descriptor may claim to be longer than it
190 * really is. Here is the actual allocated length. */
191 unsigned alloclen =
192 le16_to_cpu(dev->config[i].desc.wTotalLength);
193
194 len = length - (*ppos - pos);
195 if (len > nbytes)
196 len = nbytes;
197
198 /* Simply don't write (skip over) unallocated parts */
199 if (alloclen > (*ppos - pos)) {
200 alloclen -= (*ppos - pos);
201 if (copy_to_user(buf,
202 dev->rawdescriptors[i] + (*ppos - pos),
203 min(len, alloclen))) {
204 ret = -EFAULT;
205 goto err;
206 }
207 }
208
209 *ppos += len;
210 buf += len;
211 nbytes -= len;
212 ret += len;
213 }
214
215 pos += length;
216 }
217
218err:
219 usb_unlock_device(dev);
220 return ret;
221}
222
223/*
224 * async list handling
225 */
226
227static struct async *alloc_async(unsigned int numisoframes)
228{
dd95b814 229 struct async *as;
0a1ef3b5 230
dd95b814 231 as = kzalloc(sizeof(struct async), GFP_KERNEL);
04e482ff
GKH
232 if (!as)
233 return NULL;
1da177e4
LT
234 as->urb = usb_alloc_urb(numisoframes, GFP_KERNEL);
235 if (!as->urb) {
236 kfree(as);
237 return NULL;
238 }
04e482ff 239 return as;
1da177e4
LT
240}
241
242static void free_async(struct async *as)
243{
2425c08b 244 put_pid(as->pid);
6fd19f4b
JJ
245 kfree(as->urb->transfer_buffer);
246 kfree(as->urb->setup_packet);
1da177e4 247 usb_free_urb(as->urb);
6fd19f4b 248 kfree(as);
1da177e4
LT
249}
250
d34d9721 251static void async_newpending(struct async *as)
1da177e4 252{
04e482ff
GKH
253 struct dev_state *ps = as->ps;
254 unsigned long flags;
255
256 spin_lock_irqsave(&ps->lock, flags);
257 list_add_tail(&as->asynclist, &ps->async_pending);
258 spin_unlock_irqrestore(&ps->lock, flags);
1da177e4
LT
259}
260
d34d9721 261static void async_removepending(struct async *as)
1da177e4 262{
04e482ff
GKH
263 struct dev_state *ps = as->ps;
264 unsigned long flags;
265
266 spin_lock_irqsave(&ps->lock, flags);
267 list_del_init(&as->asynclist);
268 spin_unlock_irqrestore(&ps->lock, flags);
1da177e4
LT
269}
270
d34d9721 271static struct async *async_getcompleted(struct dev_state *ps)
1da177e4 272{
04e482ff
GKH
273 unsigned long flags;
274 struct async *as = NULL;
275
276 spin_lock_irqsave(&ps->lock, flags);
277 if (!list_empty(&ps->async_completed)) {
278 as = list_entry(ps->async_completed.next, struct async,
279 asynclist);
280 list_del_init(&as->asynclist);
281 }
282 spin_unlock_irqrestore(&ps->lock, flags);
283 return as;
1da177e4
LT
284}
285
d34d9721 286static struct async *async_getpending(struct dev_state *ps,
04e482ff 287 void __user *userurb)
1da177e4 288{
04e482ff
GKH
289 unsigned long flags;
290 struct async *as;
1da177e4 291
04e482ff 292 spin_lock_irqsave(&ps->lock, flags);
1da177e4
LT
293 list_for_each_entry(as, &ps->async_pending, asynclist)
294 if (as->userurb == userurb) {
295 list_del_init(&as->asynclist);
296 spin_unlock_irqrestore(&ps->lock, flags);
297 return as;
298 }
04e482ff
GKH
299 spin_unlock_irqrestore(&ps->lock, flags);
300 return NULL;
1da177e4
LT
301}
302
e639dd3f
GKH
303static void snoop_urb(struct urb *urb, void __user *userurb)
304{
71d2718f 305 unsigned j;
e639dd3f
GKH
306 unsigned char *data = urb->transfer_buffer;
307
308 if (!usbfs_snoop)
309 return;
310
93cf9b90
AS
311 dev_info(&urb->dev->dev, "direction=%s\n",
312 usb_urb_dir_in(urb) ? "IN" : "OUT");
e639dd3f 313 dev_info(&urb->dev->dev, "userurb=%p\n", userurb);
71d2718f 314 dev_info(&urb->dev->dev, "transfer_buffer_length=%u\n",
e639dd3f 315 urb->transfer_buffer_length);
71d2718f 316 dev_info(&urb->dev->dev, "actual_length=%u\n", urb->actual_length);
e639dd3f
GKH
317 dev_info(&urb->dev->dev, "data: ");
318 for (j = 0; j < urb->transfer_buffer_length; ++j)
04e482ff 319 printk("%02x ", data[j]);
e639dd3f
GKH
320 printk("\n");
321}
322
7d12e780 323static void async_completed(struct urb *urb)
1da177e4 324{
04e482ff
GKH
325 struct async *as = urb->context;
326 struct dev_state *ps = as->ps;
1da177e4
LT
327 struct siginfo sinfo;
328
04e482ff
GKH
329 spin_lock(&ps->lock);
330 list_move_tail(&as->asynclist, &ps->async_completed);
331 spin_unlock(&ps->lock);
e015268d 332 as->status = urb->status;
1da177e4
LT
333 if (as->signr) {
334 sinfo.si_signo = as->signr;
e015268d 335 sinfo.si_errno = as->status;
1da177e4
LT
336 sinfo.si_code = SI_ASYNCIO;
337 sinfo.si_addr = as->userurb;
2425c08b 338 kill_pid_info_as_uid(as->signr, &sinfo, as->pid, as->uid,
7a01955f 339 as->euid, as->secid);
1da177e4 340 }
e639dd3f
GKH
341 snoop(&urb->dev->dev, "urb complete\n");
342 snoop_urb(urb, as->userurb);
343 wake_up(&ps->wait);
1da177e4
LT
344}
345
04e482ff 346static void destroy_async(struct dev_state *ps, struct list_head *list)
1da177e4
LT
347{
348 struct async *as;
349 unsigned long flags;
350
351 spin_lock_irqsave(&ps->lock, flags);
352 while (!list_empty(list)) {
353 as = list_entry(list->next, struct async, asynclist);
354 list_del_init(&as->asynclist);
355
356 /* drop the spinlock so the completion handler can run */
357 spin_unlock_irqrestore(&ps->lock, flags);
358 usb_kill_urb(as->urb);
359 spin_lock_irqsave(&ps->lock, flags);
360 }
361 spin_unlock_irqrestore(&ps->lock, flags);
1da177e4
LT
362}
363
04e482ff
GKH
364static void destroy_async_on_interface(struct dev_state *ps,
365 unsigned int ifnum)
1da177e4
LT
366{
367 struct list_head *p, *q, hitlist;
368 unsigned long flags;
369
370 INIT_LIST_HEAD(&hitlist);
371 spin_lock_irqsave(&ps->lock, flags);
372 list_for_each_safe(p, q, &ps->async_pending)
373 if (ifnum == list_entry(p, struct async, asynclist)->ifnum)
374 list_move_tail(p, &hitlist);
375 spin_unlock_irqrestore(&ps->lock, flags);
376 destroy_async(ps, &hitlist);
377}
378
d34d9721 379static void destroy_all_async(struct dev_state *ps)
1da177e4 380{
04e482ff 381 destroy_async(ps, &ps->async_pending);
1da177e4
LT
382}
383
384/*
385 * interface claims are made only at the request of user level code,
386 * which can also release them (explicitly or by closing files).
387 * they're also undone when devices disconnect.
388 */
389
04e482ff
GKH
390static int driver_probe(struct usb_interface *intf,
391 const struct usb_device_id *id)
1da177e4
LT
392{
393 return -ENODEV;
394}
395
396static void driver_disconnect(struct usb_interface *intf)
397{
04e482ff 398 struct dev_state *ps = usb_get_intfdata(intf);
1da177e4
LT
399 unsigned int ifnum = intf->altsetting->desc.bInterfaceNumber;
400
401 if (!ps)
402 return;
403
404 /* NOTE: this relies on usbcore having canceled and completed
405 * all pending I/O requests; 2.6 does that.
406 */
407
408 if (likely(ifnum < 8*sizeof(ps->ifclaimed)))
409 clear_bit(ifnum, &ps->ifclaimed);
410 else
3b6004f3
GKH
411 dev_warn(&intf->dev, "interface number %u out of range\n",
412 ifnum);
1da177e4 413
04e482ff 414 usb_set_intfdata(intf, NULL);
1da177e4
LT
415
416 /* force async requests to complete */
417 destroy_async_on_interface(ps, ifnum);
418}
419
2e2eb83f
AS
420/* The following routines are merely placeholders. There is no way
421 * to inform a user task about suspend or resumes.
422 */
423static int driver_suspend(struct usb_interface *intf, pm_message_t msg)
424{
425 return 0;
426}
427
428static int driver_resume(struct usb_interface *intf)
429{
430 return 0;
431}
432
1da177e4 433struct usb_driver usbfs_driver = {
1da177e4
LT
434 .name = "usbfs",
435 .probe = driver_probe,
436 .disconnect = driver_disconnect,
2e2eb83f
AS
437 .suspend = driver_suspend,
438 .resume = driver_resume,
1da177e4
LT
439};
440
441static int claimintf(struct dev_state *ps, unsigned int ifnum)
442{
443 struct usb_device *dev = ps->dev;
444 struct usb_interface *intf;
445 int err;
446
447 if (ifnum >= 8*sizeof(ps->ifclaimed))
448 return -EINVAL;
449 /* already claimed */
450 if (test_bit(ifnum, &ps->ifclaimed))
451 return 0;
452
1da177e4
LT
453 intf = usb_ifnum_to_if(dev, ifnum);
454 if (!intf)
455 err = -ENOENT;
456 else
457 err = usb_driver_claim_interface(&usbfs_driver, intf, ps);
1da177e4
LT
458 if (err == 0)
459 set_bit(ifnum, &ps->ifclaimed);
460 return err;
461}
462
463static int releaseintf(struct dev_state *ps, unsigned int ifnum)
464{
465 struct usb_device *dev;
466 struct usb_interface *intf;
467 int err;
468
469 err = -EINVAL;
470 if (ifnum >= 8*sizeof(ps->ifclaimed))
471 return err;
472 dev = ps->dev;
1da177e4
LT
473 intf = usb_ifnum_to_if(dev, ifnum);
474 if (!intf)
475 err = -ENOENT;
476 else if (test_and_clear_bit(ifnum, &ps->ifclaimed)) {
477 usb_driver_release_interface(&usbfs_driver, intf);
478 err = 0;
479 }
1da177e4
LT
480 return err;
481}
482
483static int checkintf(struct dev_state *ps, unsigned int ifnum)
484{
485 if (ps->dev->state != USB_STATE_CONFIGURED)
486 return -EHOSTUNREACH;
487 if (ifnum >= 8*sizeof(ps->ifclaimed))
488 return -EINVAL;
489 if (test_bit(ifnum, &ps->ifclaimed))
490 return 0;
491 /* if not yet claimed, claim it for the driver */
04e482ff
GKH
492 dev_warn(&ps->dev->dev, "usbfs: process %d (%s) did not claim "
493 "interface %u before use\n", task_pid_nr(current),
494 current->comm, ifnum);
1da177e4
LT
495 return claimintf(ps, ifnum);
496}
497
498static int findintfep(struct usb_device *dev, unsigned int ep)
499{
500 unsigned int i, j, e;
04e482ff 501 struct usb_interface *intf;
1da177e4
LT
502 struct usb_host_interface *alts;
503 struct usb_endpoint_descriptor *endpt;
504
505 if (ep & ~(USB_DIR_IN|0xf))
506 return -EINVAL;
507 if (!dev->actconfig)
508 return -ESRCH;
509 for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
510 intf = dev->actconfig->interface[i];
511 for (j = 0; j < intf->num_altsetting; j++) {
04e482ff 512 alts = &intf->altsetting[j];
1da177e4
LT
513 for (e = 0; e < alts->desc.bNumEndpoints; e++) {
514 endpt = &alts->endpoint[e].desc;
515 if (endpt->bEndpointAddress == ep)
516 return alts->desc.bInterfaceNumber;
517 }
518 }
519 }
04e482ff 520 return -ENOENT;
1da177e4
LT
521}
522
04e482ff
GKH
523static int check_ctrlrecip(struct dev_state *ps, unsigned int requesttype,
524 unsigned int index)
1da177e4
LT
525{
526 int ret = 0;
527
6da9c990
DV
528 if (ps->dev->state != USB_STATE_UNAUTHENTICATED
529 && ps->dev->state != USB_STATE_ADDRESS
24f8b116 530 && ps->dev->state != USB_STATE_CONFIGURED)
1da177e4
LT
531 return -EHOSTUNREACH;
532 if (USB_TYPE_VENDOR == (USB_TYPE_MASK & requesttype))
533 return 0;
534
535 index &= 0xff;
536 switch (requesttype & USB_RECIP_MASK) {
537 case USB_RECIP_ENDPOINT:
04e482ff
GKH
538 ret = findintfep(ps->dev, index);
539 if (ret >= 0)
1da177e4
LT
540 ret = checkintf(ps, ret);
541 break;
542
543 case USB_RECIP_INTERFACE:
544 ret = checkintf(ps, index);
545 break;
546 }
547 return ret;
548}
549
61ad04a8 550static int match_devt(struct device *dev, void *data)
4592bf5a 551{
a80d5ff0 552 return dev->devt == (dev_t) (unsigned long) data;
9f8b17e6 553}
4592bf5a 554
61ad04a8 555static struct usb_device *usbdev_lookup_by_devt(dev_t devt)
9f8b17e6
KS
556{
557 struct device *dev;
558
a80d5ff0
DH
559 dev = bus_find_device(&usb_bus_type, NULL,
560 (void *) (unsigned long) devt, match_devt);
9f8b17e6
KS
561 if (!dev)
562 return NULL;
9f8b17e6
KS
563 return container_of(dev, struct usb_device, dev);
564}
4592bf5a 565
1da177e4
LT
566/*
567 * file operations
568 */
569static int usbdev_open(struct inode *inode, struct file *file)
570{
fbf82fd2 571 struct usb_device *dev = NULL;
1da177e4 572 struct dev_state *ps;
86a264ab 573 const struct cred *cred = current_cred();
1da177e4
LT
574 int ret;
575
b5b4aa67 576 lock_kernel();
4a2a8a2c
AS
577 /* Protect against simultaneous removal or release */
578 mutex_lock(&usbfs_mutex);
579
1da177e4 580 ret = -ENOMEM;
04e482ff
GKH
581 ps = kmalloc(sizeof(struct dev_state), GFP_KERNEL);
582 if (!ps)
4a2a8a2c 583 goto out;
1da177e4 584
1da177e4 585 ret = -ENOENT;
61ad04a8 586
9f8b17e6 587 /* usbdev device-node */
fbf82fd2 588 if (imajor(inode) == USB_DEVICE_MAJOR)
61ad04a8 589 dev = usbdev_lookup_by_devt(inode->i_rdev);
9f8b17e6
KS
590#ifdef CONFIG_USB_DEVICEFS
591 /* procfs file */
d64aac36 592 if (!dev) {
8e18e294 593 dev = inode->i_private;
d64aac36
AS
594 if (dev && dev->usbfs_dentry &&
595 dev->usbfs_dentry->d_inode == inode)
596 usb_get_dev(dev);
597 else
598 dev = NULL;
599 }
9f8b17e6 600#endif
d64aac36 601 if (!dev || dev->state == USB_STATE_NOTATTACHED)
1da177e4 602 goto out;
94fcda1f 603 ret = usb_autoresume_device(dev);
01d883d4
AS
604 if (ret)
605 goto out;
606
1da177e4
LT
607 ret = 0;
608 ps->dev = dev;
609 ps->file = file;
610 spin_lock_init(&ps->lock);
316547fd 611 INIT_LIST_HEAD(&ps->list);
1da177e4
LT
612 INIT_LIST_HEAD(&ps->async_pending);
613 INIT_LIST_HEAD(&ps->async_completed);
614 init_waitqueue_head(&ps->wait);
615 ps->discsignr = 0;
2425c08b 616 ps->disc_pid = get_pid(task_pid(current));
86a264ab
DH
617 ps->disc_uid = cred->uid;
618 ps->disc_euid = cred->euid;
1da177e4
LT
619 ps->disccontext = NULL;
620 ps->ifclaimed = 0;
7a01955f 621 security_task_getsecid(current, &ps->secid);
527660a8 622 smp_wmb();
1da177e4
LT
623 list_add_tail(&ps->list, &dev->filelist);
624 file->private_data = ps;
2da41d5f
AS
625 snoop(&dev->dev, "opened by process %d: %s\n", task_pid_nr(current),
626 current->comm);
1da177e4 627 out:
d64aac36 628 if (ret) {
01d883d4 629 kfree(ps);
d64aac36
AS
630 usb_put_dev(dev);
631 }
4a2a8a2c 632 mutex_unlock(&usbfs_mutex);
b5b4aa67 633 unlock_kernel();
4a2a8a2c 634 return ret;
1da177e4
LT
635}
636
637static int usbdev_release(struct inode *inode, struct file *file)
638{
ec17cf1c 639 struct dev_state *ps = file->private_data;
1da177e4
LT
640 struct usb_device *dev = ps->dev;
641 unsigned int ifnum;
6ff10464 642 struct async *as;
1da177e4
LT
643
644 usb_lock_device(dev);
4a2a8a2c
AS
645
646 /* Protect against simultaneous open */
647 mutex_lock(&usbfs_mutex);
1da177e4 648 list_del_init(&ps->list);
4a2a8a2c
AS
649 mutex_unlock(&usbfs_mutex);
650
1da177e4
LT
651 for (ifnum = 0; ps->ifclaimed && ifnum < 8*sizeof(ps->ifclaimed);
652 ifnum++) {
653 if (test_bit(ifnum, &ps->ifclaimed))
654 releaseintf(ps, ifnum);
655 }
656 destroy_all_async(ps);
94fcda1f 657 usb_autosuspend_device(dev);
1da177e4
LT
658 usb_unlock_device(dev);
659 usb_put_dev(dev);
2425c08b 660 put_pid(ps->disc_pid);
6ff10464
AS
661
662 as = async_getcompleted(ps);
663 while (as) {
664 free_async(as);
665 as = async_getcompleted(ps);
666 }
1da177e4 667 kfree(ps);
4a2a8a2c 668 return 0;
1da177e4
LT
669}
670
671static int proc_control(struct dev_state *ps, void __user *arg)
672{
673 struct usb_device *dev = ps->dev;
674 struct usbdevfs_ctrltransfer ctrl;
675 unsigned int tmo;
676 unsigned char *tbuf;
ff66e3ce 677 unsigned wLength;
1da177e4
LT
678 int i, j, ret;
679
680 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
681 return -EFAULT;
04e482ff
GKH
682 ret = check_ctrlrecip(ps, ctrl.bRequestType, ctrl.wIndex);
683 if (ret)
1da177e4 684 return ret;
ff66e3ce
AM
685 wLength = ctrl.wLength; /* To suppress 64k PAGE_SIZE warning */
686 if (wLength > PAGE_SIZE)
1da177e4 687 return -EINVAL;
04e482ff
GKH
688 tbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
689 if (!tbuf)
1da177e4
LT
690 return -ENOMEM;
691 tmo = ctrl.timeout;
692 if (ctrl.bRequestType & 0x80) {
04e482ff
GKH
693 if (ctrl.wLength && !access_ok(VERIFY_WRITE, ctrl.data,
694 ctrl.wLength)) {
1da177e4
LT
695 free_page((unsigned long)tbuf);
696 return -EINVAL;
697 }
fe0410c7
AS
698 snoop(&dev->dev, "control read: bRequest=%02x "
699 "bRrequestType=%02x wValue=%04x "
700 "wIndex=%04x wLength=%04x\n",
701 ctrl.bRequest, ctrl.bRequestType, ctrl.wValue,
702 ctrl.wIndex, ctrl.wLength);
1da177e4
LT
703
704 usb_unlock_device(dev);
04e482ff
GKH
705 i = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), ctrl.bRequest,
706 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
707 tbuf, ctrl.wLength, tmo);
1da177e4
LT
708 usb_lock_device(dev);
709 if ((i > 0) && ctrl.wLength) {
710 if (usbfs_snoop) {
711 dev_info(&dev->dev, "control read: data ");
fe0410c7 712 for (j = 0; j < i; ++j)
04e482ff 713 printk("%02x ", (u8)(tbuf)[j]);
1da177e4
LT
714 printk("\n");
715 }
fe0410c7 716 if (copy_to_user(ctrl.data, tbuf, i)) {
1da177e4
LT
717 free_page((unsigned long)tbuf);
718 return -EFAULT;
719 }
720 }
721 } else {
722 if (ctrl.wLength) {
723 if (copy_from_user(tbuf, ctrl.data, ctrl.wLength)) {
724 free_page((unsigned long)tbuf);
725 return -EFAULT;
726 }
727 }
fe0410c7
AS
728 snoop(&dev->dev, "control write: bRequest=%02x "
729 "bRrequestType=%02x wValue=%04x "
730 "wIndex=%04x wLength=%04x\n",
731 ctrl.bRequest, ctrl.bRequestType, ctrl.wValue,
732 ctrl.wIndex, ctrl.wLength);
1da177e4
LT
733 if (usbfs_snoop) {
734 dev_info(&dev->dev, "control write: data: ");
735 for (j = 0; j < ctrl.wLength; ++j)
e639dd3f 736 printk("%02x ", (unsigned char)(tbuf)[j]);
1da177e4
LT
737 printk("\n");
738 }
739 usb_unlock_device(dev);
04e482ff
GKH
740 i = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ctrl.bRequest,
741 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
742 tbuf, ctrl.wLength, tmo);
1da177e4
LT
743 usb_lock_device(dev);
744 }
745 free_page((unsigned long)tbuf);
04e482ff 746 if (i < 0 && i != -EPIPE) {
1da177e4
LT
747 dev_printk(KERN_DEBUG, &dev->dev, "usbfs: USBDEVFS_CONTROL "
748 "failed cmd %s rqt %u rq %u len %u ret %d\n",
749 current->comm, ctrl.bRequestType, ctrl.bRequest,
750 ctrl.wLength, i);
751 }
752 return i;
753}
754
755static int proc_bulk(struct dev_state *ps, void __user *arg)
756{
757 struct usb_device *dev = ps->dev;
758 struct usbdevfs_bulktransfer bulk;
759 unsigned int tmo, len1, pipe;
760 int len2;
761 unsigned char *tbuf;
e639dd3f 762 int i, j, ret;
1da177e4
LT
763
764 if (copy_from_user(&bulk, arg, sizeof(bulk)))
765 return -EFAULT;
04e482ff
GKH
766 ret = findintfep(ps->dev, bulk.ep);
767 if (ret < 0)
1da177e4 768 return ret;
04e482ff
GKH
769 ret = checkintf(ps, ret);
770 if (ret)
1da177e4
LT
771 return ret;
772 if (bulk.ep & USB_DIR_IN)
773 pipe = usb_rcvbulkpipe(dev, bulk.ep & 0x7f);
774 else
775 pipe = usb_sndbulkpipe(dev, bulk.ep & 0x7f);
776 if (!usb_maxpacket(dev, pipe, !(bulk.ep & USB_DIR_IN)))
777 return -EINVAL;
778 len1 = bulk.len;
779 if (len1 > MAX_USBFS_BUFFER_SIZE)
780 return -EINVAL;
781 if (!(tbuf = kmalloc(len1, GFP_KERNEL)))
782 return -ENOMEM;
783 tmo = bulk.timeout;
784 if (bulk.ep & 0x80) {
785 if (len1 && !access_ok(VERIFY_WRITE, bulk.data, len1)) {
786 kfree(tbuf);
787 return -EINVAL;
788 }
e639dd3f
GKH
789 snoop(&dev->dev, "bulk read: len=0x%02x timeout=%04d\n",
790 bulk.len, bulk.timeout);
1da177e4
LT
791 usb_unlock_device(dev);
792 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
793 usb_lock_device(dev);
794 if (!i && len2) {
e639dd3f
GKH
795 if (usbfs_snoop) {
796 dev_info(&dev->dev, "bulk read: data ");
797 for (j = 0; j < len2; ++j)
04e482ff 798 printk("%02x ", (u8)(tbuf)[j]);
e639dd3f
GKH
799 printk("\n");
800 }
1da177e4
LT
801 if (copy_to_user(bulk.data, tbuf, len2)) {
802 kfree(tbuf);
803 return -EFAULT;
804 }
805 }
806 } else {
807 if (len1) {
808 if (copy_from_user(tbuf, bulk.data, len1)) {
809 kfree(tbuf);
810 return -EFAULT;
811 }
812 }
e639dd3f
GKH
813 snoop(&dev->dev, "bulk write: len=0x%02x timeout=%04d\n",
814 bulk.len, bulk.timeout);
815 if (usbfs_snoop) {
816 dev_info(&dev->dev, "bulk write: data: ");
817 for (j = 0; j < len1; ++j)
818 printk("%02x ", (unsigned char)(tbuf)[j]);
819 printk("\n");
820 }
1da177e4
LT
821 usb_unlock_device(dev);
822 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
823 usb_lock_device(dev);
824 }
825 kfree(tbuf);
826 if (i < 0)
827 return i;
828 return len2;
829}
830
831static int proc_resetep(struct dev_state *ps, void __user *arg)
832{
833 unsigned int ep;
834 int ret;
835
836 if (get_user(ep, (unsigned int __user *)arg))
837 return -EFAULT;
04e482ff
GKH
838 ret = findintfep(ps->dev, ep);
839 if (ret < 0)
1da177e4 840 return ret;
04e482ff
GKH
841 ret = checkintf(ps, ret);
842 if (ret)
1da177e4 843 return ret;
3444b26a 844 usb_reset_endpoint(ps->dev, ep);
1da177e4
LT
845 return 0;
846}
847
848static int proc_clearhalt(struct dev_state *ps, void __user *arg)
849{
850 unsigned int ep;
851 int pipe;
852 int ret;
853
854 if (get_user(ep, (unsigned int __user *)arg))
855 return -EFAULT;
04e482ff
GKH
856 ret = findintfep(ps->dev, ep);
857 if (ret < 0)
1da177e4 858 return ret;
04e482ff
GKH
859 ret = checkintf(ps, ret);
860 if (ret)
1da177e4
LT
861 return ret;
862 if (ep & USB_DIR_IN)
04e482ff
GKH
863 pipe = usb_rcvbulkpipe(ps->dev, ep & 0x7f);
864 else
865 pipe = usb_sndbulkpipe(ps->dev, ep & 0x7f);
1da177e4
LT
866
867 return usb_clear_halt(ps->dev, pipe);
868}
1da177e4
LT
869
870static int proc_getdriver(struct dev_state *ps, void __user *arg)
871{
872 struct usbdevfs_getdriver gd;
873 struct usb_interface *intf;
874 int ret;
875
876 if (copy_from_user(&gd, arg, sizeof(gd)))
877 return -EFAULT;
1da177e4
LT
878 intf = usb_ifnum_to_if(ps->dev, gd.interface);
879 if (!intf || !intf->dev.driver)
880 ret = -ENODATA;
881 else {
882 strncpy(gd.driver, intf->dev.driver->name,
883 sizeof(gd.driver));
884 ret = (copy_to_user(arg, &gd, sizeof(gd)) ? -EFAULT : 0);
885 }
1da177e4
LT
886 return ret;
887}
888
889static int proc_connectinfo(struct dev_state *ps, void __user *arg)
890{
891 struct usbdevfs_connectinfo ci;
892
893 ci.devnum = ps->dev->devnum;
894 ci.slow = ps->dev->speed == USB_SPEED_LOW;
895 if (copy_to_user(arg, &ci, sizeof(ci)))
896 return -EFAULT;
897 return 0;
898}
899
900static int proc_resetdevice(struct dev_state *ps)
901{
742120c6 902 return usb_reset_device(ps->dev);
1da177e4
LT
903}
904
905static int proc_setintf(struct dev_state *ps, void __user *arg)
906{
907 struct usbdevfs_setinterface setintf;
908 int ret;
909
910 if (copy_from_user(&setintf, arg, sizeof(setintf)))
911 return -EFAULT;
912 if ((ret = checkintf(ps, setintf.interface)))
913 return ret;
914 return usb_set_interface(ps->dev, setintf.interface,
915 setintf.altsetting);
916}
917
918static int proc_setconfig(struct dev_state *ps, void __user *arg)
919{
3f141e2a 920 int u;
1da177e4 921 int status = 0;
04e482ff 922 struct usb_host_config *actconfig;
1da177e4 923
3f141e2a 924 if (get_user(u, (int __user *)arg))
1da177e4
LT
925 return -EFAULT;
926
04e482ff
GKH
927 actconfig = ps->dev->actconfig;
928
929 /* Don't touch the device if any interfaces are claimed.
930 * It could interfere with other drivers' operations, and if
1da177e4
LT
931 * an interface is claimed by usbfs it could easily deadlock.
932 */
04e482ff
GKH
933 if (actconfig) {
934 int i;
935
936 for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
937 if (usb_interface_claimed(actconfig->interface[i])) {
938 dev_warn(&ps->dev->dev,
72ebddb5 939 "usbfs: interface %d claimed by %s "
1da177e4
LT
940 "while '%s' sets config #%d\n",
941 actconfig->interface[i]
942 ->cur_altsetting
943 ->desc.bInterfaceNumber,
72ebddb5
DB
944 actconfig->interface[i]
945 ->dev.driver->name,
1da177e4 946 current->comm, u);
04e482ff 947 status = -EBUSY;
1da177e4 948 break;
1da177e4 949 }
04e482ff
GKH
950 }
951 }
1da177e4
LT
952
953 /* SET_CONFIGURATION is often abused as a "cheap" driver reset,
954 * so avoid usb_set_configuration()'s kick to sysfs
955 */
956 if (status == 0) {
957 if (actconfig && actconfig->desc.bConfigurationValue == u)
958 status = usb_reset_configuration(ps->dev);
959 else
960 status = usb_set_configuration(ps->dev, u);
961 }
962
963 return status;
964}
965
1da177e4 966static int proc_do_submiturb(struct dev_state *ps, struct usbdevfs_urb *uurb,
04e482ff
GKH
967 struct usbdevfs_iso_packet_desc __user *iso_frame_desc,
968 void __user *arg)
1da177e4
LT
969{
970 struct usbdevfs_iso_packet_desc *isopkt = NULL;
971 struct usb_host_endpoint *ep;
972 struct async *as;
973 struct usb_ctrlrequest *dr = NULL;
86a264ab 974 const struct cred *cred = current_cred();
1da177e4 975 unsigned int u, totlen, isofrmlen;
97b9eb91 976 int ret, ifnum = -1;
93cf9b90 977 int is_in;
1da177e4 978
14722ef4
AS
979 if (uurb->flags & ~(USBDEVFS_URB_ISO_ASAP |
980 USBDEVFS_URB_SHORT_NOT_OK |
981 USBDEVFS_URB_NO_FSBR |
982 USBDEVFS_URB_ZERO_PACKET |
983 USBDEVFS_URB_NO_INTERRUPT))
1da177e4
LT
984 return -EINVAL;
985 if (!uurb->buffer)
986 return -EINVAL;
04e482ff
GKH
987 if (!(uurb->type == USBDEVFS_URB_TYPE_CONTROL &&
988 (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) == 0)) {
989 ifnum = findintfep(ps->dev, uurb->endpoint);
990 if (ifnum < 0)
1da177e4 991 return ifnum;
04e482ff
GKH
992 ret = checkintf(ps, ifnum);
993 if (ret)
1da177e4
LT
994 return ret;
995 }
93cf9b90
AS
996 if ((uurb->endpoint & USB_ENDPOINT_DIR_MASK) != 0) {
997 is_in = 1;
998 ep = ps->dev->ep_in[uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
999 } else {
1000 is_in = 0;
1001 ep = ps->dev->ep_out[uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
1002 }
1da177e4
LT
1003 if (!ep)
1004 return -ENOENT;
1005 switch(uurb->type) {
1006 case USBDEVFS_URB_TYPE_CONTROL:
93cf9b90 1007 if (!usb_endpoint_xfer_control(&ep->desc))
1da177e4 1008 return -EINVAL;
04e482ff
GKH
1009 /* min 8 byte setup packet,
1010 * max 8 byte setup plus an arbitrary data stage */
1011 if (uurb->buffer_length < 8 ||
1012 uurb->buffer_length > (8 + MAX_USBFS_BUFFER_SIZE))
1da177e4 1013 return -EINVAL;
04e482ff
GKH
1014 dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL);
1015 if (!dr)
1da177e4
LT
1016 return -ENOMEM;
1017 if (copy_from_user(dr, uurb->buffer, 8)) {
1018 kfree(dr);
1019 return -EFAULT;
1020 }
1021 if (uurb->buffer_length < (le16_to_cpup(&dr->wLength) + 8)) {
1022 kfree(dr);
1023 return -EINVAL;
1024 }
04e482ff
GKH
1025 ret = check_ctrlrecip(ps, dr->bRequestType,
1026 le16_to_cpup(&dr->wIndex));
1027 if (ret) {
1da177e4
LT
1028 kfree(dr);
1029 return ret;
1030 }
1da177e4
LT
1031 uurb->number_of_packets = 0;
1032 uurb->buffer_length = le16_to_cpup(&dr->wLength);
1033 uurb->buffer += 8;
93cf9b90
AS
1034 if ((dr->bRequestType & USB_DIR_IN) && uurb->buffer_length) {
1035 is_in = 1;
1036 uurb->endpoint |= USB_DIR_IN;
1037 } else {
1038 is_in = 0;
1039 uurb->endpoint &= ~USB_DIR_IN;
1040 }
1041 if (!access_ok(is_in ? VERIFY_WRITE : VERIFY_READ,
1042 uurb->buffer, uurb->buffer_length)) {
1da177e4
LT
1043 kfree(dr);
1044 return -EFAULT;
1045 }
df251b8b
CF
1046 snoop(&ps->dev->dev, "control urb: bRequest=%02x "
1047 "bRrequestType=%02x wValue=%04x "
1048 "wIndex=%04x wLength=%04x\n",
93cf9b90
AS
1049 dr->bRequest, dr->bRequestType,
1050 __le16_to_cpup(&dr->wValue),
1051 __le16_to_cpup(&dr->wIndex),
1052 __le16_to_cpup(&dr->wLength));
1da177e4
LT
1053 break;
1054
1055 case USBDEVFS_URB_TYPE_BULK:
93cf9b90 1056 switch (usb_endpoint_type(&ep->desc)) {
1da177e4
LT
1057 case USB_ENDPOINT_XFER_CONTROL:
1058 case USB_ENDPOINT_XFER_ISOC:
1059 return -EINVAL;
1060 /* allow single-shot interrupt transfers, at bogus rates */
1061 }
1062 uurb->number_of_packets = 0;
1063 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
1064 return -EINVAL;
93cf9b90
AS
1065 if (!access_ok(is_in ? VERIFY_WRITE : VERIFY_READ,
1066 uurb->buffer, uurb->buffer_length))
1da177e4 1067 return -EFAULT;
e639dd3f 1068 snoop(&ps->dev->dev, "bulk urb\n");
1da177e4
LT
1069 break;
1070
1071 case USBDEVFS_URB_TYPE_ISO:
1072 /* arbitrary limit */
04e482ff
GKH
1073 if (uurb->number_of_packets < 1 ||
1074 uurb->number_of_packets > 128)
1da177e4 1075 return -EINVAL;
93cf9b90 1076 if (!usb_endpoint_xfer_isoc(&ep->desc))
1da177e4 1077 return -EINVAL;
04e482ff
GKH
1078 isofrmlen = sizeof(struct usbdevfs_iso_packet_desc) *
1079 uurb->number_of_packets;
1da177e4
LT
1080 if (!(isopkt = kmalloc(isofrmlen, GFP_KERNEL)))
1081 return -ENOMEM;
1082 if (copy_from_user(isopkt, iso_frame_desc, isofrmlen)) {
1083 kfree(isopkt);
1084 return -EFAULT;
1085 }
1086 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
04e482ff
GKH
1087 /* arbitrary limit,
1088 * sufficient for USB 2.0 high-bandwidth iso */
3612242e 1089 if (isopkt[u].length > 8192) {
1da177e4
LT
1090 kfree(isopkt);
1091 return -EINVAL;
1092 }
1093 totlen += isopkt[u].length;
1094 }
1095 if (totlen > 32768) {
1096 kfree(isopkt);
1097 return -EINVAL;
1098 }
1099 uurb->buffer_length = totlen;
e639dd3f 1100 snoop(&ps->dev->dev, "iso urb\n");
1da177e4
LT
1101 break;
1102
1103 case USBDEVFS_URB_TYPE_INTERRUPT:
1104 uurb->number_of_packets = 0;
93cf9b90 1105 if (!usb_endpoint_xfer_int(&ep->desc))
1da177e4 1106 return -EINVAL;
1da177e4
LT
1107 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
1108 return -EINVAL;
93cf9b90
AS
1109 if (!access_ok(is_in ? VERIFY_WRITE : VERIFY_READ,
1110 uurb->buffer, uurb->buffer_length))
1da177e4 1111 return -EFAULT;
e639dd3f 1112 snoop(&ps->dev->dev, "interrupt urb\n");
1da177e4
LT
1113 break;
1114
1115 default:
1116 return -EINVAL;
1117 }
04e482ff
GKH
1118 as = alloc_async(uurb->number_of_packets);
1119 if (!as) {
6fd19f4b
JJ
1120 kfree(isopkt);
1121 kfree(dr);
1da177e4
LT
1122 return -ENOMEM;
1123 }
04e482ff
GKH
1124 as->urb->transfer_buffer = kmalloc(uurb->buffer_length, GFP_KERNEL);
1125 if (!as->urb->transfer_buffer) {
6fd19f4b
JJ
1126 kfree(isopkt);
1127 kfree(dr);
1da177e4
LT
1128 free_async(as);
1129 return -ENOMEM;
1130 }
04e482ff
GKH
1131 as->urb->dev = ps->dev;
1132 as->urb->pipe = (uurb->type << 30) |
93cf9b90
AS
1133 __create_pipe(ps->dev, uurb->endpoint & 0xf) |
1134 (uurb->endpoint & USB_DIR_IN);
14722ef4
AS
1135
1136 /* This tedious sequence is necessary because the URB_* flags
1137 * are internal to the kernel and subject to change, whereas
1138 * the USBDEVFS_URB_* flags are a user API and must not be changed.
1139 */
1140 u = (is_in ? URB_DIR_IN : URB_DIR_OUT);
1141 if (uurb->flags & USBDEVFS_URB_ISO_ASAP)
1142 u |= URB_ISO_ASAP;
1143 if (uurb->flags & USBDEVFS_URB_SHORT_NOT_OK)
1144 u |= URB_SHORT_NOT_OK;
1145 if (uurb->flags & USBDEVFS_URB_NO_FSBR)
1146 u |= URB_NO_FSBR;
1147 if (uurb->flags & USBDEVFS_URB_ZERO_PACKET)
1148 u |= URB_ZERO_PACKET;
1149 if (uurb->flags & USBDEVFS_URB_NO_INTERRUPT)
1150 u |= URB_NO_INTERRUPT;
1151 as->urb->transfer_flags = u;
1152
1da177e4 1153 as->urb->transfer_buffer_length = uurb->buffer_length;
04e482ff 1154 as->urb->setup_packet = (unsigned char *)dr;
1da177e4
LT
1155 as->urb->start_frame = uurb->start_frame;
1156 as->urb->number_of_packets = uurb->number_of_packets;
97b9eb91
AS
1157 if (uurb->type == USBDEVFS_URB_TYPE_ISO ||
1158 ps->dev->speed == USB_SPEED_HIGH)
1159 as->urb->interval = 1 << min(15, ep->desc.bInterval - 1);
1160 else
1161 as->urb->interval = ep->desc.bInterval;
04e482ff
GKH
1162 as->urb->context = as;
1163 as->urb->complete = async_completed;
1da177e4
LT
1164 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
1165 as->urb->iso_frame_desc[u].offset = totlen;
1166 as->urb->iso_frame_desc[u].length = isopkt[u].length;
1167 totlen += isopkt[u].length;
1168 }
6fd19f4b 1169 kfree(isopkt);
1da177e4 1170 as->ps = ps;
04e482ff 1171 as->userurb = arg;
1da177e4
LT
1172 if (uurb->endpoint & USB_DIR_IN)
1173 as->userbuffer = uurb->buffer;
1174 else
1175 as->userbuffer = NULL;
1176 as->signr = uurb->signr;
1177 as->ifnum = ifnum;
2425c08b 1178 as->pid = get_pid(task_pid(current));
86a264ab
DH
1179 as->uid = cred->uid;
1180 as->euid = cred->euid;
7a01955f 1181 security_task_getsecid(current, &as->secid);
93cf9b90
AS
1182 if (!is_in) {
1183 if (copy_from_user(as->urb->transfer_buffer, uurb->buffer,
1184 as->urb->transfer_buffer_length)) {
1da177e4
LT
1185 free_async(as);
1186 return -EFAULT;
1187 }
1188 }
e639dd3f 1189 snoop_urb(as->urb, as->userurb);
04e482ff
GKH
1190 async_newpending(as);
1191 if ((ret = usb_submit_urb(as->urb, GFP_KERNEL))) {
1192 dev_printk(KERN_DEBUG, &ps->dev->dev,
1193 "usbfs: usb_submit_urb returned %d\n", ret);
1194 async_removepending(as);
1195 free_async(as);
1196 return ret;
1197 }
1198 return 0;
1da177e4
LT
1199}
1200
1201static int proc_submiturb(struct dev_state *ps, void __user *arg)
1202{
1203 struct usbdevfs_urb uurb;
1204
1205 if (copy_from_user(&uurb, arg, sizeof(uurb)))
1206 return -EFAULT;
1207
04e482ff
GKH
1208 return proc_do_submiturb(ps, &uurb,
1209 (((struct usbdevfs_urb __user *)arg)->iso_frame_desc),
1210 arg);
1da177e4
LT
1211}
1212
1213static int proc_unlinkurb(struct dev_state *ps, void __user *arg)
1214{
1215 struct async *as;
1216
1217 as = async_getpending(ps, arg);
1218 if (!as)
1219 return -EINVAL;
1220 usb_kill_urb(as->urb);
1221 return 0;
1222}
1223
1224static int processcompl(struct async *as, void __user * __user *arg)
1225{
1226 struct urb *urb = as->urb;
1227 struct usbdevfs_urb __user *userurb = as->userurb;
1228 void __user *addr = as->userurb;
1229 unsigned int i;
1230
1231 if (as->userbuffer)
04e482ff
GKH
1232 if (copy_to_user(as->userbuffer, urb->transfer_buffer,
1233 urb->transfer_buffer_length))
d794a021 1234 goto err_out;
e015268d 1235 if (put_user(as->status, &userurb->status))
d794a021 1236 goto err_out;
1da177e4 1237 if (put_user(urb->actual_length, &userurb->actual_length))
d794a021 1238 goto err_out;
1da177e4 1239 if (put_user(urb->error_count, &userurb->error_count))
d794a021 1240 goto err_out;
1da177e4 1241
93cf9b90 1242 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
668a9541
CL
1243 for (i = 0; i < urb->number_of_packets; i++) {
1244 if (put_user(urb->iso_frame_desc[i].actual_length,
1245 &userurb->iso_frame_desc[i].actual_length))
d794a021 1246 goto err_out;
668a9541
CL
1247 if (put_user(urb->iso_frame_desc[i].status,
1248 &userurb->iso_frame_desc[i].status))
d794a021 1249 goto err_out;
668a9541 1250 }
1da177e4
LT
1251 }
1252
1253 free_async(as);
1254
1255 if (put_user(addr, (void __user * __user *)arg))
1256 return -EFAULT;
1257 return 0;
d794a021
ON
1258
1259err_out:
1260 free_async(as);
1261 return -EFAULT;
1da177e4
LT
1262}
1263
04e482ff 1264static struct async *reap_as(struct dev_state *ps)
1da177e4 1265{
04e482ff 1266 DECLARE_WAITQUEUE(wait, current);
1da177e4
LT
1267 struct async *as = NULL;
1268 struct usb_device *dev = ps->dev;
1269
1270 add_wait_queue(&ps->wait, &wait);
1271 for (;;) {
1272 __set_current_state(TASK_INTERRUPTIBLE);
04e482ff
GKH
1273 as = async_getcompleted(ps);
1274 if (as)
1da177e4
LT
1275 break;
1276 if (signal_pending(current))
1277 break;
1278 usb_unlock_device(dev);
1279 schedule();
1280 usb_lock_device(dev);
1281 }
1282 remove_wait_queue(&ps->wait, &wait);
1283 set_current_state(TASK_RUNNING);
1284 return as;
1285}
1286
1287static int proc_reapurb(struct dev_state *ps, void __user *arg)
1288{
1289 struct async *as = reap_as(ps);
1290 if (as)
1291 return processcompl(as, (void __user * __user *)arg);
1292 if (signal_pending(current))
1293 return -EINTR;
1294 return -EIO;
1295}
1296
1297static int proc_reapurbnonblock(struct dev_state *ps, void __user *arg)
1298{
1299 struct async *as;
1300
1301 if (!(as = async_getcompleted(ps)))
1302 return -EAGAIN;
1303 return processcompl(as, (void __user * __user *)arg);
1304}
1305
1306#ifdef CONFIG_COMPAT
1307
1308static int get_urb32(struct usbdevfs_urb *kurb,
1309 struct usbdevfs_urb32 __user *uurb)
1310{
1311 __u32 uptr;
1312 if (get_user(kurb->type, &uurb->type) ||
1313 __get_user(kurb->endpoint, &uurb->endpoint) ||
1314 __get_user(kurb->status, &uurb->status) ||
1315 __get_user(kurb->flags, &uurb->flags) ||
1316 __get_user(kurb->buffer_length, &uurb->buffer_length) ||
1317 __get_user(kurb->actual_length, &uurb->actual_length) ||
1318 __get_user(kurb->start_frame, &uurb->start_frame) ||
1319 __get_user(kurb->number_of_packets, &uurb->number_of_packets) ||
1320 __get_user(kurb->error_count, &uurb->error_count) ||
1321 __get_user(kurb->signr, &uurb->signr))
1322 return -EFAULT;
1323
1324 if (__get_user(uptr, &uurb->buffer))
1325 return -EFAULT;
1326 kurb->buffer = compat_ptr(uptr);
ed0c7720 1327 if (__get_user(uptr, &uurb->usercontext))
1da177e4
LT
1328 return -EFAULT;
1329 kurb->usercontext = compat_ptr(uptr);
1330
1331 return 0;
1332}
1333
1334static int proc_submiturb_compat(struct dev_state *ps, void __user *arg)
1335{
1336 struct usbdevfs_urb uurb;
1337
04e482ff 1338 if (get_urb32(&uurb, (struct usbdevfs_urb32 __user *)arg))
1da177e4
LT
1339 return -EFAULT;
1340
04e482ff
GKH
1341 return proc_do_submiturb(ps, &uurb,
1342 ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc,
1343 arg);
1da177e4
LT
1344}
1345
1346static int processcompl_compat(struct async *as, void __user * __user *arg)
1347{
1348 struct urb *urb = as->urb;
1349 struct usbdevfs_urb32 __user *userurb = as->userurb;
1350 void __user *addr = as->userurb;
1351 unsigned int i;
1352
1353 if (as->userbuffer)
04e482ff
GKH
1354 if (copy_to_user(as->userbuffer, urb->transfer_buffer,
1355 urb->transfer_buffer_length))
1da177e4 1356 return -EFAULT;
e015268d 1357 if (put_user(as->status, &userurb->status))
1da177e4
LT
1358 return -EFAULT;
1359 if (put_user(urb->actual_length, &userurb->actual_length))
1360 return -EFAULT;
1361 if (put_user(urb->error_count, &userurb->error_count))
1362 return -EFAULT;
1363
93cf9b90 1364 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
668a9541
CL
1365 for (i = 0; i < urb->number_of_packets; i++) {
1366 if (put_user(urb->iso_frame_desc[i].actual_length,
1367 &userurb->iso_frame_desc[i].actual_length))
1368 return -EFAULT;
1369 if (put_user(urb->iso_frame_desc[i].status,
1370 &userurb->iso_frame_desc[i].status))
1371 return -EFAULT;
1372 }
1da177e4
LT
1373 }
1374
1375 free_async(as);
c714de5d 1376 if (put_user(ptr_to_compat(addr), (u32 __user *)arg))
1da177e4
LT
1377 return -EFAULT;
1378 return 0;
1379}
1380
1381static int proc_reapurb_compat(struct dev_state *ps, void __user *arg)
1382{
1383 struct async *as = reap_as(ps);
1384 if (as)
1385 return processcompl_compat(as, (void __user * __user *)arg);
1386 if (signal_pending(current))
1387 return -EINTR;
1388 return -EIO;
1389}
1390
1391static int proc_reapurbnonblock_compat(struct dev_state *ps, void __user *arg)
1392{
1393 struct async *as;
1394
1da177e4
LT
1395 if (!(as = async_getcompleted(ps)))
1396 return -EAGAIN;
1da177e4
LT
1397 return processcompl_compat(as, (void __user * __user *)arg);
1398}
1399
1400#endif
1401
1402static int proc_disconnectsignal(struct dev_state *ps, void __user *arg)
1403{
1404 struct usbdevfs_disconnectsignal ds;
1405
1406 if (copy_from_user(&ds, arg, sizeof(ds)))
1407 return -EFAULT;
1da177e4
LT
1408 ps->discsignr = ds.signr;
1409 ps->disccontext = ds.context;
1410 return 0;
1411}
1412
1413static int proc_claiminterface(struct dev_state *ps, void __user *arg)
1414{
1415 unsigned int ifnum;
1416
1417 if (get_user(ifnum, (unsigned int __user *)arg))
1418 return -EFAULT;
1419 return claimintf(ps, ifnum);
1420}
1421
1422static int proc_releaseinterface(struct dev_state *ps, void __user *arg)
1423{
1424 unsigned int ifnum;
1425 int ret;
1426
1427 if (get_user(ifnum, (unsigned int __user *)arg))
1428 return -EFAULT;
1429 if ((ret = releaseintf(ps, ifnum)) < 0)
1430 return ret;
1431 destroy_async_on_interface (ps, ifnum);
1432 return 0;
1433}
1434
c36fc889 1435static int proc_ioctl(struct dev_state *ps, struct usbdevfs_ioctl *ctl)
1da177e4 1436{
1da177e4
LT
1437 int size;
1438 void *buf = NULL;
1439 int retval = 0;
1440 struct usb_interface *intf = NULL;
1441 struct usb_driver *driver = NULL;
1da177e4 1442
c36fc889 1443 /* alloc buffer */
04e482ff
GKH
1444 if ((size = _IOC_SIZE(ctl->ioctl_code)) > 0) {
1445 if ((buf = kmalloc(size, GFP_KERNEL)) == NULL)
1da177e4 1446 return -ENOMEM;
c36fc889 1447 if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) {
04e482ff 1448 if (copy_from_user(buf, ctl->data, size)) {
6fd19f4b 1449 kfree(buf);
1da177e4
LT
1450 return -EFAULT;
1451 }
1452 } else {
04e482ff 1453 memset(buf, 0, size);
1da177e4
LT
1454 }
1455 }
1456
349710c3 1457 if (!connected(ps)) {
6fd19f4b 1458 kfree(buf);
1da177e4
LT
1459 return -ENODEV;
1460 }
1461
1462 if (ps->dev->state != USB_STATE_CONFIGURED)
1463 retval = -EHOSTUNREACH;
04e482ff
GKH
1464 else if (!(intf = usb_ifnum_to_if(ps->dev, ctl->ifno)))
1465 retval = -EINVAL;
c36fc889 1466 else switch (ctl->ioctl_code) {
1da177e4
LT
1467
1468 /* disconnect kernel driver from interface */
1469 case USBDEVFS_DISCONNECT:
1da177e4
LT
1470 if (intf->dev.driver) {
1471 driver = to_usb_driver(intf->dev.driver);
04e482ff 1472 dev_dbg(&intf->dev, "disconnect by usbfs\n");
1da177e4
LT
1473 usb_driver_release_interface(driver, intf);
1474 } else
1475 retval = -ENODATA;
1da177e4
LT
1476 break;
1477
1478 /* let kernel drivers try to (re)bind to the interface */
1479 case USBDEVFS_CONNECT:
885e9747
AS
1480 if (!intf->dev.driver)
1481 retval = device_attach(&intf->dev);
1482 else
1483 retval = -EBUSY;
1da177e4
LT
1484 break;
1485
1486 /* talk directly to the interface's driver */
1487 default:
1da177e4
LT
1488 if (intf->dev.driver)
1489 driver = to_usb_driver(intf->dev.driver);
1490 if (driver == NULL || driver->ioctl == NULL) {
1491 retval = -ENOTTY;
1492 } else {
04e482ff 1493 retval = driver->ioctl(intf, ctl->ioctl_code, buf);
1da177e4
LT
1494 if (retval == -ENOIOCTLCMD)
1495 retval = -ENOTTY;
1496 }
1da177e4
LT
1497 }
1498
1499 /* cleanup and return */
1500 if (retval >= 0
04e482ff 1501 && (_IOC_DIR(ctl->ioctl_code) & _IOC_READ) != 0
1da177e4 1502 && size > 0
04e482ff 1503 && copy_to_user(ctl->data, buf, size) != 0)
1da177e4 1504 retval = -EFAULT;
6fd19f4b
JJ
1505
1506 kfree(buf);
1da177e4
LT
1507 return retval;
1508}
1509
c36fc889
PZ
1510static int proc_ioctl_default(struct dev_state *ps, void __user *arg)
1511{
1512 struct usbdevfs_ioctl ctrl;
1513
04e482ff 1514 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
c36fc889
PZ
1515 return -EFAULT;
1516 return proc_ioctl(ps, &ctrl);
1517}
1518
1519#ifdef CONFIG_COMPAT
777da590 1520static int proc_ioctl_compat(struct dev_state *ps, compat_uptr_t arg)
c36fc889
PZ
1521{
1522 struct usbdevfs_ioctl32 __user *uioc;
1523 struct usbdevfs_ioctl ctrl;
1524 u32 udata;
1525
058120d7 1526 uioc = compat_ptr((long)arg);
c36fc889
PZ
1527 if (get_user(ctrl.ifno, &uioc->ifno) ||
1528 get_user(ctrl.ioctl_code, &uioc->ioctl_code) ||
1529 __get_user(udata, &uioc->data))
1530 return -EFAULT;
1531 ctrl.data = compat_ptr(udata);
1532
1533 return proc_ioctl(ps, &ctrl);
1534}
1535#endif
1536
1da177e4
LT
1537/*
1538 * NOTE: All requests here that have interface numbers as parameters
1539 * are assuming that somehow the configuration has been prevented from
1540 * changing. But there's no mechanism to ensure that...
1541 */
04e482ff
GKH
1542static int usbdev_ioctl(struct inode *inode, struct file *file,
1543 unsigned int cmd, unsigned long arg)
1da177e4 1544{
ec17cf1c 1545 struct dev_state *ps = file->private_data;
1da177e4
LT
1546 struct usb_device *dev = ps->dev;
1547 void __user *p = (void __user *)arg;
1548 int ret = -ENOTTY;
1549
1550 if (!(file->f_mode & FMODE_WRITE))
1551 return -EPERM;
1552 usb_lock_device(dev);
349710c3 1553 if (!connected(ps)) {
1da177e4
LT
1554 usb_unlock_device(dev);
1555 return -ENODEV;
1556 }
1557
1558 switch (cmd) {
1559 case USBDEVFS_CONTROL:
441b62c1 1560 snoop(&dev->dev, "%s: CONTROL\n", __func__);
1da177e4
LT
1561 ret = proc_control(ps, p);
1562 if (ret >= 0)
1563 inode->i_mtime = CURRENT_TIME;
1564 break;
1565
1566 case USBDEVFS_BULK:
441b62c1 1567 snoop(&dev->dev, "%s: BULK\n", __func__);
1da177e4
LT
1568 ret = proc_bulk(ps, p);
1569 if (ret >= 0)
1570 inode->i_mtime = CURRENT_TIME;
1571 break;
1572
1573 case USBDEVFS_RESETEP:
441b62c1 1574 snoop(&dev->dev, "%s: RESETEP\n", __func__);
1da177e4
LT
1575 ret = proc_resetep(ps, p);
1576 if (ret >= 0)
1577 inode->i_mtime = CURRENT_TIME;
1578 break;
1579
1580 case USBDEVFS_RESET:
441b62c1 1581 snoop(&dev->dev, "%s: RESET\n", __func__);
1da177e4
LT
1582 ret = proc_resetdevice(ps);
1583 break;
1584
1585 case USBDEVFS_CLEAR_HALT:
441b62c1 1586 snoop(&dev->dev, "%s: CLEAR_HALT\n", __func__);
1da177e4
LT
1587 ret = proc_clearhalt(ps, p);
1588 if (ret >= 0)
1589 inode->i_mtime = CURRENT_TIME;
1590 break;
1591
1592 case USBDEVFS_GETDRIVER:
441b62c1 1593 snoop(&dev->dev, "%s: GETDRIVER\n", __func__);
1da177e4
LT
1594 ret = proc_getdriver(ps, p);
1595 break;
1596
1597 case USBDEVFS_CONNECTINFO:
441b62c1 1598 snoop(&dev->dev, "%s: CONNECTINFO\n", __func__);
1da177e4
LT
1599 ret = proc_connectinfo(ps, p);
1600 break;
1601
1602 case USBDEVFS_SETINTERFACE:
441b62c1 1603 snoop(&dev->dev, "%s: SETINTERFACE\n", __func__);
1da177e4
LT
1604 ret = proc_setintf(ps, p);
1605 break;
1606
1607 case USBDEVFS_SETCONFIGURATION:
441b62c1 1608 snoop(&dev->dev, "%s: SETCONFIGURATION\n", __func__);
1da177e4
LT
1609 ret = proc_setconfig(ps, p);
1610 break;
1611
1612 case USBDEVFS_SUBMITURB:
441b62c1 1613 snoop(&dev->dev, "%s: SUBMITURB\n", __func__);
1da177e4
LT
1614 ret = proc_submiturb(ps, p);
1615 if (ret >= 0)
1616 inode->i_mtime = CURRENT_TIME;
1617 break;
1618
1619#ifdef CONFIG_COMPAT
1620
1621 case USBDEVFS_SUBMITURB32:
441b62c1 1622 snoop(&dev->dev, "%s: SUBMITURB32\n", __func__);
1da177e4
LT
1623 ret = proc_submiturb_compat(ps, p);
1624 if (ret >= 0)
1625 inode->i_mtime = CURRENT_TIME;
1626 break;
1627
1628 case USBDEVFS_REAPURB32:
441b62c1 1629 snoop(&dev->dev, "%s: REAPURB32\n", __func__);
1da177e4
LT
1630 ret = proc_reapurb_compat(ps, p);
1631 break;
1632
1633 case USBDEVFS_REAPURBNDELAY32:
441b62c1 1634 snoop(&dev->dev, "%s: REAPURBDELAY32\n", __func__);
1da177e4
LT
1635 ret = proc_reapurbnonblock_compat(ps, p);
1636 break;
1637
c36fc889 1638 case USBDEVFS_IOCTL32:
441b62c1 1639 snoop(&dev->dev, "%s: IOCTL\n", __func__);
c714de5d 1640 ret = proc_ioctl_compat(ps, ptr_to_compat(p));
c36fc889 1641 break;
1da177e4
LT
1642#endif
1643
1644 case USBDEVFS_DISCARDURB:
441b62c1 1645 snoop(&dev->dev, "%s: DISCARDURB\n", __func__);
1da177e4
LT
1646 ret = proc_unlinkurb(ps, p);
1647 break;
1648
1649 case USBDEVFS_REAPURB:
441b62c1 1650 snoop(&dev->dev, "%s: REAPURB\n", __func__);
1da177e4
LT
1651 ret = proc_reapurb(ps, p);
1652 break;
1653
1654 case USBDEVFS_REAPURBNDELAY:
441b62c1 1655 snoop(&dev->dev, "%s: REAPURBDELAY\n", __func__);
1da177e4
LT
1656 ret = proc_reapurbnonblock(ps, p);
1657 break;
1658
1659 case USBDEVFS_DISCSIGNAL:
441b62c1 1660 snoop(&dev->dev, "%s: DISCSIGNAL\n", __func__);
1da177e4
LT
1661 ret = proc_disconnectsignal(ps, p);
1662 break;
1663
1664 case USBDEVFS_CLAIMINTERFACE:
441b62c1 1665 snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __func__);
1da177e4
LT
1666 ret = proc_claiminterface(ps, p);
1667 break;
1668
1669 case USBDEVFS_RELEASEINTERFACE:
441b62c1 1670 snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __func__);
1da177e4
LT
1671 ret = proc_releaseinterface(ps, p);
1672 break;
1673
1674 case USBDEVFS_IOCTL:
441b62c1 1675 snoop(&dev->dev, "%s: IOCTL\n", __func__);
c36fc889 1676 ret = proc_ioctl_default(ps, p);
1da177e4
LT
1677 break;
1678 }
1679 usb_unlock_device(dev);
1680 if (ret >= 0)
1681 inode->i_atime = CURRENT_TIME;
1682 return ret;
1683}
1684
1685/* No kernel lock - fine */
04e482ff
GKH
1686static unsigned int usbdev_poll(struct file *file,
1687 struct poll_table_struct *wait)
1da177e4 1688{
ec17cf1c
TK
1689 struct dev_state *ps = file->private_data;
1690 unsigned int mask = 0;
1da177e4
LT
1691
1692 poll_wait(file, &ps->wait, wait);
1693 if (file->f_mode & FMODE_WRITE && !list_empty(&ps->async_completed))
1694 mask |= POLLOUT | POLLWRNORM;
349710c3 1695 if (!connected(ps))
1da177e4
LT
1696 mask |= POLLERR | POLLHUP;
1697 return mask;
1698}
1699
9f8b17e6 1700const struct file_operations usbdev_file_operations = {
7e7654a9 1701 .owner = THIS_MODULE,
1da177e4
LT
1702 .llseek = usbdev_lseek,
1703 .read = usbdev_read,
1704 .poll = usbdev_poll,
1705 .ioctl = usbdev_ioctl,
1706 .open = usbdev_open,
1707 .release = usbdev_release,
1708};
fbf82fd2 1709
501950d8 1710static void usbdev_remove(struct usb_device *udev)
cd9f0375
AS
1711{
1712 struct dev_state *ps;
1713 struct siginfo sinfo;
1714
1715 while (!list_empty(&udev->filelist)) {
1716 ps = list_entry(udev->filelist.next, struct dev_state, list);
1717 destroy_all_async(ps);
1718 wake_up_all(&ps->wait);
1719 list_del_init(&ps->list);
1720 if (ps->discsignr) {
1721 sinfo.si_signo = ps->discsignr;
1722 sinfo.si_errno = EPIPE;
1723 sinfo.si_code = SI_ASYNCIO;
1724 sinfo.si_addr = ps->disccontext;
1725 kill_pid_info_as_uid(ps->discsignr, &sinfo,
1726 ps->disc_pid, ps->disc_uid,
1727 ps->disc_euid, ps->secid);
1728 }
1729 }
1730}
1731
9f8b17e6
KS
1732#ifdef CONFIG_USB_DEVICE_CLASS
1733static struct class *usb_classdev_class;
1734
1735static int usb_classdev_add(struct usb_device *dev)
fbf82fd2 1736{
e04199b2
AS
1737 struct device *cldev;
1738
b0b090e5
GKH
1739 cldev = device_create(usb_classdev_class, &dev->dev, dev->dev.devt,
1740 NULL, "usbdev%d.%d", dev->bus->busnum,
1741 dev->devnum);
e04199b2
AS
1742 if (IS_ERR(cldev))
1743 return PTR_ERR(cldev);
1744 dev->usb_classdev = cldev;
27d39e26 1745 return 0;
fbf82fd2
KS
1746}
1747
9f8b17e6 1748static void usb_classdev_remove(struct usb_device *dev)
fbf82fd2 1749{
e04199b2
AS
1750 if (dev->usb_classdev)
1751 device_unregister(dev->usb_classdev);
fbf82fd2
KS
1752}
1753
501950d8
AS
1754#else
1755#define usb_classdev_add(dev) 0
1756#define usb_classdev_remove(dev) do {} while (0)
1757
1758#endif
1759
1760static int usbdev_notify(struct notifier_block *self,
9f8b17e6 1761 unsigned long action, void *dev)
a7b986b3
GKH
1762{
1763 switch (action) {
1764 case USB_DEVICE_ADD:
9f8b17e6 1765 if (usb_classdev_add(dev))
27d39e26 1766 return NOTIFY_BAD;
a7b986b3
GKH
1767 break;
1768 case USB_DEVICE_REMOVE:
9f8b17e6 1769 usb_classdev_remove(dev);
501950d8 1770 usbdev_remove(dev);
a7b986b3
GKH
1771 break;
1772 }
1773 return NOTIFY_OK;
1774}
1775
1776static struct notifier_block usbdev_nb = {
501950d8 1777 .notifier_call = usbdev_notify,
a7b986b3
GKH
1778};
1779
7e7654a9 1780static struct cdev usb_device_cdev;
fbf82fd2 1781
9f8b17e6 1782int __init usb_devio_init(void)
fbf82fd2
KS
1783{
1784 int retval;
1785
fad21bdf 1786 retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX,
04e482ff 1787 "usb_device");
fbf82fd2 1788 if (retval) {
69a85942 1789 printk(KERN_ERR "Unable to register minors for usb_device\n");
fbf82fd2
KS
1790 goto out;
1791 }
9f8b17e6 1792 cdev_init(&usb_device_cdev, &usbdev_file_operations);
fad21bdf 1793 retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX);
fbf82fd2 1794 if (retval) {
69a85942
GKH
1795 printk(KERN_ERR "Unable to get usb_device major %d\n",
1796 USB_DEVICE_MAJOR);
a7b986b3 1797 goto error_cdev;
fbf82fd2 1798 }
9f8b17e6
KS
1799#ifdef CONFIG_USB_DEVICE_CLASS
1800 usb_classdev_class = class_create(THIS_MODULE, "usb_device");
1801 if (IS_ERR(usb_classdev_class)) {
69a85942 1802 printk(KERN_ERR "Unable to register usb_device class\n");
9f8b17e6
KS
1803 retval = PTR_ERR(usb_classdev_class);
1804 cdev_del(&usb_device_cdev);
1805 usb_classdev_class = NULL;
1806 goto out;
fbf82fd2 1807 }
e105b8bf
DW
1808 /* devices of this class shadow the major:minor of their parent
1809 * device, so clear ->dev_kobj to prevent adding duplicate entries
1810 * to /sys/dev
1811 */
1812 usb_classdev_class->dev_kobj = NULL;
9f8b17e6 1813#endif
501950d8 1814 usb_register_notify(&usbdev_nb);
fbf82fd2
KS
1815out:
1816 return retval;
a7b986b3 1817
a7b986b3
GKH
1818error_cdev:
1819 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
1820 goto out;
fbf82fd2
KS
1821}
1822
9f8b17e6 1823void usb_devio_cleanup(void)
fbf82fd2 1824{
a7b986b3 1825 usb_unregister_notify(&usbdev_nb);
501950d8 1826#ifdef CONFIG_USB_DEVICE_CLASS
9f8b17e6
KS
1827 class_destroy(usb_classdev_class);
1828#endif
fbf82fd2 1829 cdev_del(&usb_device_cdev);
fad21bdf 1830 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
fbf82fd2 1831}