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