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