?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Staging: strip: delete the driver
[linux/fpc-iii.git] / drivers / usb / core / devio.c
blob3466fdc5bb11e7cdc42871982c5e85cde38ae0bc
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 mutex_lock(&file->f_dentry->d_inode->i_mutex);
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 mutex_unlock(&file->f_dentry->d_inode->i_mutex);
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 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 uid_t uid = 0;
399 uid_t euid = 0;
400 u32 secid = 0;
401 int signr;
402
403 spin_lock(&ps->lock);
404 list_move_tail(&as->asynclist, &ps->async_completed);
405 as->status = urb->status;
406 signr = as->signr;
407 if (signr) {
408 sinfo.si_signo = as->signr;
409 sinfo.si_errno = as->status;
410 sinfo.si_code = SI_ASYNCIO;
411 sinfo.si_addr = as->userurb;
412 pid = as->pid;
413 uid = as->uid;
414 euid = as->euid;
415 secid = as->secid;
416 }
417 snoop(&urb->dev->dev, "urb complete\n");
418 snoop_urb(urb->dev, as->userurb, urb->pipe, urb->actual_length,
419 as->status, COMPLETE,
420 ((urb->transfer_flags & URB_DIR_MASK) == USB_DIR_OUT) ?
421 NULL : urb->transfer_buffer, urb->actual_length);
422 if (as->status < 0 && as->bulk_addr && as->status != -ECONNRESET &&
423 as->status != -ENOENT)
424 cancel_bulk_urbs(ps, as->bulk_addr);
425 spin_unlock(&ps->lock);
426
427 if (signr)
428 kill_pid_info_as_uid(sinfo.si_signo, &sinfo, pid, uid,
429 euid, secid);
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 index)
613 {
614 int ret = 0;
615
616 if (ps->dev->state != USB_STATE_UNAUTHENTICATED
617 && ps->dev->state != USB_STATE_ADDRESS
618 && ps->dev->state != USB_STATE_CONFIGURED)
619 return -EHOSTUNREACH;
620 if (USB_TYPE_VENDOR == (USB_TYPE_MASK & requesttype))
621 return 0;
622
623 index &= 0xff;
624 switch (requesttype & USB_RECIP_MASK) {
625 case USB_RECIP_ENDPOINT:
626 ret = findintfep(ps->dev, index);
627 if (ret >= 0)
628 ret = checkintf(ps, ret);
629 break;
630
631 case USB_RECIP_INTERFACE:
632 ret = checkintf(ps, index);
633 break;
634 }
635 return ret;
636 }
637
638 static int match_devt(struct device *dev, void *data)
639 {
640 return dev->devt == (dev_t) (unsigned long) data;
641 }
642
643 static struct usb_device *usbdev_lookup_by_devt(dev_t devt)
644 {
645 struct device *dev;
646
647 dev = bus_find_device(&usb_bus_type, NULL,
648 (void *) (unsigned long) devt, match_devt);
649 if (!dev)
650 return NULL;
651 return container_of(dev, struct usb_device, dev);
652 }
653
654 /*
655 * file operations
656 */
657 static int usbdev_open(struct inode *inode, struct file *file)
658 {
659 struct usb_device *dev = NULL;
660 struct dev_state *ps;
661 const struct cred *cred = current_cred();
662 int ret;
663
664 ret = -ENOMEM;
665 ps = kmalloc(sizeof(struct dev_state), GFP_KERNEL);
666 if (!ps)
667 goto out_free_ps;
668
669 ret = -ENODEV;
670
671 /* Protect against simultaneous removal or release */
672 mutex_lock(&usbfs_mutex);
673
674 /* usbdev device-node */
675 if (imajor(inode) == USB_DEVICE_MAJOR)
676 dev = usbdev_lookup_by_devt(inode->i_rdev);
677
678 #ifdef CONFIG_USB_DEVICEFS
679 /* procfs file */
680 if (!dev) {
681 dev = inode->i_private;
682 if (dev && dev->usbfs_dentry &&
683 dev->usbfs_dentry->d_inode == inode)
684 usb_get_dev(dev);
685 else
686 dev = NULL;
687 }
688 #endif
689 mutex_unlock(&usbfs_mutex);
690
691 if (!dev)
692 goto out_free_ps;
693
694 usb_lock_device(dev);
695 if (dev->state == USB_STATE_NOTATTACHED)
696 goto out_unlock_device;
697
698 ret = usb_autoresume_device(dev);
699 if (ret)
700 goto out_unlock_device;
701
702 ps->dev = dev;
703 ps->file = file;
704 spin_lock_init(&ps->lock);
705 INIT_LIST_HEAD(&ps->list);
706 INIT_LIST_HEAD(&ps->async_pending);
707 INIT_LIST_HEAD(&ps->async_completed);
708 init_waitqueue_head(&ps->wait);
709 ps->discsignr = 0;
710 ps->disc_pid = get_pid(task_pid(current));
711 ps->disc_uid = cred->uid;
712 ps->disc_euid = cred->euid;
713 ps->disccontext = NULL;
714 ps->ifclaimed = 0;
715 security_task_getsecid(current, &ps->secid);
716 smp_wmb();
717 list_add_tail(&ps->list, &dev->filelist);
718 file->private_data = ps;
719 usb_unlock_device(dev);
720 snoop(&dev->dev, "opened by process %d: %s\n", task_pid_nr(current),
721 current->comm);
722 return ret;
723
724 out_unlock_device:
725 usb_unlock_device(dev);
726 usb_put_dev(dev);
727 out_free_ps:
728 kfree(ps);
729 return ret;
730 }
731
732 static int usbdev_release(struct inode *inode, struct file *file)
733 {
734 struct dev_state *ps = file->private_data;
735 struct usb_device *dev = ps->dev;
736 unsigned int ifnum;
737 struct async *as;
738
739 usb_lock_device(dev);
740 usb_hub_release_all_ports(dev, ps);
741
742 list_del_init(&ps->list);
743
744 for (ifnum = 0; ps->ifclaimed && ifnum < 8*sizeof(ps->ifclaimed);
745 ifnum++) {
746 if (test_bit(ifnum, &ps->ifclaimed))
747 releaseintf(ps, ifnum);
748 }
749 destroy_all_async(ps);
750 usb_autosuspend_device(dev);
751 usb_unlock_device(dev);
752 usb_put_dev(dev);
753 put_pid(ps->disc_pid);
754
755 as = async_getcompleted(ps);
756 while (as) {
757 free_async(as);
758 as = async_getcompleted(ps);
759 }
760 kfree(ps);
761 return 0;
762 }
763
764 static int proc_control(struct dev_state *ps, void __user *arg)
765 {
766 struct usb_device *dev = ps->dev;
767 struct usbdevfs_ctrltransfer ctrl;
768 unsigned int tmo;
769 unsigned char *tbuf;
770 unsigned wLength;
771 int i, pipe, ret;
772
773 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
774 return -EFAULT;
775 ret = check_ctrlrecip(ps, ctrl.bRequestType, ctrl.wIndex);
776 if (ret)
777 return ret;
778 wLength = ctrl.wLength; /* To suppress 64k PAGE_SIZE warning */
779 if (wLength > PAGE_SIZE)
780 return -EINVAL;
781 tbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
782 if (!tbuf)
783 return -ENOMEM;
784 tmo = ctrl.timeout;
785 snoop(&dev->dev, "control urb: bRequestType=%02x "
786 "bRequest=%02x wValue=%04x "
787 "wIndex=%04x wLength=%04x\n",
788 ctrl.bRequestType, ctrl.bRequest,
789 __le16_to_cpup(&ctrl.wValue),
790 __le16_to_cpup(&ctrl.wIndex),
791 __le16_to_cpup(&ctrl.wLength));
792 if (ctrl.bRequestType & 0x80) {
793 if (ctrl.wLength && !access_ok(VERIFY_WRITE, ctrl.data,
794 ctrl.wLength)) {
795 free_page((unsigned long)tbuf);
796 return -EINVAL;
797 }
798 pipe = usb_rcvctrlpipe(dev, 0);
799 snoop_urb(dev, NULL, pipe, ctrl.wLength, tmo, SUBMIT, NULL, 0);
800
801 usb_unlock_device(dev);
802 i = usb_control_msg(dev, pipe, ctrl.bRequest,
803 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
804 tbuf, ctrl.wLength, tmo);
805 usb_lock_device(dev);
806 snoop_urb(dev, NULL, pipe, max(i, 0), min(i, 0), COMPLETE,
807 tbuf, i);
808 if ((i > 0) && ctrl.wLength) {
809 if (copy_to_user(ctrl.data, tbuf, i)) {
810 free_page((unsigned long)tbuf);
811 return -EFAULT;
812 }
813 }
814 } else {
815 if (ctrl.wLength) {
816 if (copy_from_user(tbuf, ctrl.data, ctrl.wLength)) {
817 free_page((unsigned long)tbuf);
818 return -EFAULT;
819 }
820 }
821 pipe = usb_sndctrlpipe(dev, 0);
822 snoop_urb(dev, NULL, pipe, ctrl.wLength, tmo, SUBMIT,
823 tbuf, ctrl.wLength);
824
825 usb_unlock_device(dev);
826 i = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ctrl.bRequest,
827 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
828 tbuf, ctrl.wLength, tmo);
829 usb_lock_device(dev);
830 snoop_urb(dev, NULL, pipe, max(i, 0), min(i, 0), COMPLETE, NULL, 0);
831 }
832 free_page((unsigned long)tbuf);
833 if (i < 0 && i != -EPIPE) {
834 dev_printk(KERN_DEBUG, &dev->dev, "usbfs: USBDEVFS_CONTROL "
835 "failed cmd %s rqt %u rq %u len %u ret %d\n",
836 current->comm, ctrl.bRequestType, ctrl.bRequest,
837 ctrl.wLength, i);
838 }
839 return i;
840 }
841
842 static int proc_bulk(struct dev_state *ps, void __user *arg)
843 {
844 struct usb_device *dev = ps->dev;
845 struct usbdevfs_bulktransfer bulk;
846 unsigned int tmo, len1, pipe;
847 int len2;
848 unsigned char *tbuf;
849 int i, ret;
850
851 if (copy_from_user(&bulk, arg, sizeof(bulk)))
852 return -EFAULT;
853 ret = findintfep(ps->dev, bulk.ep);
854 if (ret < 0)
855 return ret;
856 ret = checkintf(ps, ret);
857 if (ret)
858 return ret;
859 if (bulk.ep & USB_DIR_IN)
860 pipe = usb_rcvbulkpipe(dev, bulk.ep & 0x7f);
861 else
862 pipe = usb_sndbulkpipe(dev, bulk.ep & 0x7f);
863 if (!usb_maxpacket(dev, pipe, !(bulk.ep & USB_DIR_IN)))
864 return -EINVAL;
865 len1 = bulk.len;
866 if (len1 > MAX_USBFS_BUFFER_SIZE)
867 return -EINVAL;
868 if (!(tbuf = kmalloc(len1, GFP_KERNEL)))
869 return -ENOMEM;
870 tmo = bulk.timeout;
871 if (bulk.ep & 0x80) {
872 if (len1 && !access_ok(VERIFY_WRITE, bulk.data, len1)) {
873 kfree(tbuf);
874 return -EINVAL;
875 }
876 snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, NULL, 0);
877
878 usb_unlock_device(dev);
879 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
880 usb_lock_device(dev);
881 snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, tbuf, len2);
882
883 if (!i && len2) {
884 if (copy_to_user(bulk.data, tbuf, len2)) {
885 kfree(tbuf);
886 return -EFAULT;
887 }
888 }
889 } else {
890 if (len1) {
891 if (copy_from_user(tbuf, bulk.data, len1)) {
892 kfree(tbuf);
893 return -EFAULT;
894 }
895 }
896 snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, tbuf, len1);
897
898 usb_unlock_device(dev);
899 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
900 usb_lock_device(dev);
901 snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, NULL, 0);
902 }
903 kfree(tbuf);
904 if (i < 0)
905 return i;
906 return len2;
907 }
908
909 static int proc_resetep(struct dev_state *ps, void __user *arg)
910 {
911 unsigned int ep;
912 int ret;
913
914 if (get_user(ep, (unsigned int __user *)arg))
915 return -EFAULT;
916 ret = findintfep(ps->dev, ep);
917 if (ret < 0)
918 return ret;
919 ret = checkintf(ps, ret);
920 if (ret)
921 return ret;
922 usb_reset_endpoint(ps->dev, ep);
923 return 0;
924 }
925
926 static int proc_clearhalt(struct dev_state *ps, void __user *arg)
927 {
928 unsigned int ep;
929 int pipe;
930 int ret;
931
932 if (get_user(ep, (unsigned int __user *)arg))
933 return -EFAULT;
934 ret = findintfep(ps->dev, ep);
935 if (ret < 0)
936 return ret;
937 ret = checkintf(ps, ret);
938 if (ret)
939 return ret;
940 if (ep & USB_DIR_IN)
941 pipe = usb_rcvbulkpipe(ps->dev, ep & 0x7f);
942 else
943 pipe = usb_sndbulkpipe(ps->dev, ep & 0x7f);
944
945 return usb_clear_halt(ps->dev, pipe);
946 }
947
948 static int proc_getdriver(struct dev_state *ps, void __user *arg)
949 {
950 struct usbdevfs_getdriver gd;
951 struct usb_interface *intf;
952 int ret;
953
954 if (copy_from_user(&gd, arg, sizeof(gd)))
955 return -EFAULT;
956 intf = usb_ifnum_to_if(ps->dev, gd.interface);
957 if (!intf || !intf->dev.driver)
958 ret = -ENODATA;
959 else {
960 strncpy(gd.driver, intf->dev.driver->name,
961 sizeof(gd.driver));
962 ret = (copy_to_user(arg, &gd, sizeof(gd)) ? -EFAULT : 0);
963 }
964 return ret;
965 }
966
967 static int proc_connectinfo(struct dev_state *ps, void __user *arg)
968 {
969 struct usbdevfs_connectinfo ci;
970
971 ci.devnum = ps->dev->devnum;
972 ci.slow = ps->dev->speed == USB_SPEED_LOW;
973 if (copy_to_user(arg, &ci, sizeof(ci)))
974 return -EFAULT;
975 return 0;
976 }
977
978 static int proc_resetdevice(struct dev_state *ps)
979 {
980 return usb_reset_device(ps->dev);
981 }
982
983 static int proc_setintf(struct dev_state *ps, void __user *arg)
984 {
985 struct usbdevfs_setinterface setintf;
986 int ret;
987
988 if (copy_from_user(&setintf, arg, sizeof(setintf)))
989 return -EFAULT;
990 if ((ret = checkintf(ps, setintf.interface)))
991 return ret;
992 return usb_set_interface(ps->dev, setintf.interface,
993 setintf.altsetting);
994 }
995
996 static int proc_setconfig(struct dev_state *ps, void __user *arg)
997 {
998 int u;
999 int status = 0;
1000 struct usb_host_config *actconfig;
1001
1002 if (get_user(u, (int __user *)arg))
1003 return -EFAULT;
1004
1005 actconfig = ps->dev->actconfig;
1006
1007 /* Don't touch the device if any interfaces are claimed.
1008 * It could interfere with other drivers' operations, and if
1009 * an interface is claimed by usbfs it could easily deadlock.
1010 */
1011 if (actconfig) {
1012 int i;
1013
1014 for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
1015 if (usb_interface_claimed(actconfig->interface[i])) {
1016 dev_warn(&ps->dev->dev,
1017 "usbfs: interface %d claimed by %s "
1018 "while '%s' sets config #%d\n",
1019 actconfig->interface[i]
1020 ->cur_altsetting
1021 ->desc.bInterfaceNumber,
1022 actconfig->interface[i]
1023 ->dev.driver->name,
1024 current->comm, u);
1025 status = -EBUSY;
1026 break;
1027 }
1028 }
1029 }
1030
1031 /* SET_CONFIGURATION is often abused as a "cheap" driver reset,
1032 * so avoid usb_set_configuration()'s kick to sysfs
1033 */
1034 if (status == 0) {
1035 if (actconfig && actconfig->desc.bConfigurationValue == u)
1036 status = usb_reset_configuration(ps->dev);
1037 else
1038 status = usb_set_configuration(ps->dev, u);
1039 }
1040
1041 return status;
1042 }
1043
1044 static int proc_do_submiturb(struct dev_state *ps, struct usbdevfs_urb *uurb,
1045 struct usbdevfs_iso_packet_desc __user *iso_frame_desc,
1046 void __user *arg)
1047 {
1048 struct usbdevfs_iso_packet_desc *isopkt = NULL;
1049 struct usb_host_endpoint *ep;
1050 struct async *as;
1051 struct usb_ctrlrequest *dr = NULL;
1052 const struct cred *cred = current_cred();
1053 unsigned int u, totlen, isofrmlen;
1054 int ret, ifnum = -1;
1055 int is_in;
1056
1057 if (uurb->flags & ~(USBDEVFS_URB_ISO_ASAP |
1058 USBDEVFS_URB_SHORT_NOT_OK |
1059 USBDEVFS_URB_BULK_CONTINUATION |
1060 USBDEVFS_URB_NO_FSBR |
1061 USBDEVFS_URB_ZERO_PACKET |
1062 USBDEVFS_URB_NO_INTERRUPT))
1063 return -EINVAL;
1064 if (uurb->buffer_length > 0 && !uurb->buffer)
1065 return -EINVAL;
1066 if (!(uurb->type == USBDEVFS_URB_TYPE_CONTROL &&
1067 (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) == 0)) {
1068 ifnum = findintfep(ps->dev, uurb->endpoint);
1069 if (ifnum < 0)
1070 return ifnum;
1071 ret = checkintf(ps, ifnum);
1072 if (ret)
1073 return ret;
1074 }
1075 if ((uurb->endpoint & USB_ENDPOINT_DIR_MASK) != 0) {
1076 is_in = 1;
1077 ep = ps->dev->ep_in[uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
1078 } else {
1079 is_in = 0;
1080 ep = ps->dev->ep_out[uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
1081 }
1082 if (!ep)
1083 return -ENOENT;
1084 switch(uurb->type) {
1085 case USBDEVFS_URB_TYPE_CONTROL:
1086 if (!usb_endpoint_xfer_control(&ep->desc))
1087 return -EINVAL;
1088 /* min 8 byte setup packet,
1089 * max 8 byte setup plus an arbitrary data stage */
1090 if (uurb->buffer_length < 8 ||
1091 uurb->buffer_length > (8 + MAX_USBFS_BUFFER_SIZE))
1092 return -EINVAL;
1093 dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL);
1094 if (!dr)
1095 return -ENOMEM;
1096 if (copy_from_user(dr, uurb->buffer, 8)) {
1097 kfree(dr);
1098 return -EFAULT;
1099 }
1100 if (uurb->buffer_length < (le16_to_cpup(&dr->wLength) + 8)) {
1101 kfree(dr);
1102 return -EINVAL;
1103 }
1104 ret = check_ctrlrecip(ps, dr->bRequestType,
1105 le16_to_cpup(&dr->wIndex));
1106 if (ret) {
1107 kfree(dr);
1108 return ret;
1109 }
1110 uurb->number_of_packets = 0;
1111 uurb->buffer_length = le16_to_cpup(&dr->wLength);
1112 uurb->buffer += 8;
1113 if ((dr->bRequestType & USB_DIR_IN) && uurb->buffer_length) {
1114 is_in = 1;
1115 uurb->endpoint |= USB_DIR_IN;
1116 } else {
1117 is_in = 0;
1118 uurb->endpoint &= ~USB_DIR_IN;
1119 }
1120 snoop(&ps->dev->dev, "control urb: bRequestType=%02x "
1121 "bRequest=%02x wValue=%04x "
1122 "wIndex=%04x wLength=%04x\n",
1123 dr->bRequestType, dr->bRequest,
1124 __le16_to_cpup(&dr->wValue),
1125 __le16_to_cpup(&dr->wIndex),
1126 __le16_to_cpup(&dr->wLength));
1127 break;
1128
1129 case USBDEVFS_URB_TYPE_BULK:
1130 switch (usb_endpoint_type(&ep->desc)) {
1131 case USB_ENDPOINT_XFER_CONTROL:
1132 case USB_ENDPOINT_XFER_ISOC:
1133 return -EINVAL;
1134 case USB_ENDPOINT_XFER_INT:
1135 /* allow single-shot interrupt transfers */
1136 uurb->type = USBDEVFS_URB_TYPE_INTERRUPT;
1137 goto interrupt_urb;
1138 }
1139 uurb->number_of_packets = 0;
1140 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
1141 return -EINVAL;
1142 break;
1143
1144 case USBDEVFS_URB_TYPE_INTERRUPT:
1145 if (!usb_endpoint_xfer_int(&ep->desc))
1146 return -EINVAL;
1147 interrupt_urb:
1148 uurb->number_of_packets = 0;
1149 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
1150 return -EINVAL;
1151 break;
1152
1153 case USBDEVFS_URB_TYPE_ISO:
1154 /* arbitrary limit */
1155 if (uurb->number_of_packets < 1 ||
1156 uurb->number_of_packets > 128)
1157 return -EINVAL;
1158 if (!usb_endpoint_xfer_isoc(&ep->desc))
1159 return -EINVAL;
1160 isofrmlen = sizeof(struct usbdevfs_iso_packet_desc) *
1161 uurb->number_of_packets;
1162 if (!(isopkt = kmalloc(isofrmlen, GFP_KERNEL)))
1163 return -ENOMEM;
1164 if (copy_from_user(isopkt, iso_frame_desc, isofrmlen)) {
1165 kfree(isopkt);
1166 return -EFAULT;
1167 }
1168 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
1169 /* arbitrary limit,
1170 * sufficient for USB 2.0 high-bandwidth iso */
1171 if (isopkt[u].length > 8192) {
1172 kfree(isopkt);
1173 return -EINVAL;
1174 }
1175 totlen += isopkt[u].length;
1176 }
1177 /* 3072 * 64 microframes */
1178 if (totlen > 196608) {
1179 kfree(isopkt);
1180 return -EINVAL;
1181 }
1182 uurb->buffer_length = totlen;
1183 break;
1184
1185 default:
1186 return -EINVAL;
1187 }
1188 if (uurb->buffer_length > 0 &&
1189 !access_ok(is_in ? VERIFY_WRITE : VERIFY_READ,
1190 uurb->buffer, uurb->buffer_length)) {
1191 kfree(isopkt);
1192 kfree(dr);
1193 return -EFAULT;
1194 }
1195 as = alloc_async(uurb->number_of_packets);
1196 if (!as) {
1197 kfree(isopkt);
1198 kfree(dr);
1199 return -ENOMEM;
1200 }
1201 if (uurb->buffer_length > 0) {
1202 as->urb->transfer_buffer = kmalloc(uurb->buffer_length,
1203 GFP_KERNEL);
1204 if (!as->urb->transfer_buffer) {
1205 kfree(isopkt);
1206 kfree(dr);
1207 free_async(as);
1208 return -ENOMEM;
1209 }
1210 /* Isochronous input data may end up being discontiguous
1211 * if some of the packets are short. Clear the buffer so
1212 * that the gaps don't leak kernel data to userspace.
1213 */
1214 if (is_in && uurb->type == USBDEVFS_URB_TYPE_ISO)
1215 memset(as->urb->transfer_buffer, 0,
1216 uurb->buffer_length);
1217 }
1218 as->urb->dev = ps->dev;
1219 as->urb->pipe = (uurb->type << 30) |
1220 __create_pipe(ps->dev, uurb->endpoint & 0xf) |
1221 (uurb->endpoint & USB_DIR_IN);
1222
1223 /* This tedious sequence is necessary because the URB_* flags
1224 * are internal to the kernel and subject to change, whereas
1225 * the USBDEVFS_URB_* flags are a user API and must not be changed.
1226 */
1227 u = (is_in ? URB_DIR_IN : URB_DIR_OUT);
1228 if (uurb->flags & USBDEVFS_URB_ISO_ASAP)
1229 u |= URB_ISO_ASAP;
1230 if (uurb->flags & USBDEVFS_URB_SHORT_NOT_OK)
1231 u |= URB_SHORT_NOT_OK;
1232 if (uurb->flags & USBDEVFS_URB_NO_FSBR)
1233 u |= URB_NO_FSBR;
1234 if (uurb->flags & USBDEVFS_URB_ZERO_PACKET)
1235 u |= URB_ZERO_PACKET;
1236 if (uurb->flags & USBDEVFS_URB_NO_INTERRUPT)
1237 u |= URB_NO_INTERRUPT;
1238 as->urb->transfer_flags = u;
1239
1240 as->urb->transfer_buffer_length = uurb->buffer_length;
1241 as->urb->setup_packet = (unsigned char *)dr;
1242 as->urb->start_frame = uurb->start_frame;
1243 as->urb->number_of_packets = uurb->number_of_packets;
1244 if (uurb->type == USBDEVFS_URB_TYPE_ISO ||
1245 ps->dev->speed == USB_SPEED_HIGH)
1246 as->urb->interval = 1 << min(15, ep->desc.bInterval - 1);
1247 else
1248 as->urb->interval = ep->desc.bInterval;
1249 as->urb->context = as;
1250 as->urb->complete = async_completed;
1251 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
1252 as->urb->iso_frame_desc[u].offset = totlen;
1253 as->urb->iso_frame_desc[u].length = isopkt[u].length;
1254 totlen += isopkt[u].length;
1255 }
1256 kfree(isopkt);
1257 as->ps = ps;
1258 as->userurb = arg;
1259 if (is_in && uurb->buffer_length > 0)
1260 as->userbuffer = uurb->buffer;
1261 else
1262 as->userbuffer = NULL;
1263 as->signr = uurb->signr;
1264 as->ifnum = ifnum;
1265 as->pid = get_pid(task_pid(current));
1266 as->uid = cred->uid;
1267 as->euid = cred->euid;
1268 security_task_getsecid(current, &as->secid);
1269 if (!is_in && uurb->buffer_length > 0) {
1270 if (copy_from_user(as->urb->transfer_buffer, uurb->buffer,
1271 uurb->buffer_length)) {
1272 free_async(as);
1273 return -EFAULT;
1274 }
1275 }
1276 snoop_urb(ps->dev, as->userurb, as->urb->pipe,
1277 as->urb->transfer_buffer_length, 0, SUBMIT,
1278 is_in ? NULL : as->urb->transfer_buffer,
1279 uurb->buffer_length);
1280 async_newpending(as);
1281
1282 if (usb_endpoint_xfer_bulk(&ep->desc)) {
1283 spin_lock_irq(&ps->lock);
1284
1285 /* Not exactly the endpoint address; the direction bit is
1286 * shifted to the 0x10 position so that the value will be
1287 * between 0 and 31.
1288 */
1289 as->bulk_addr = usb_endpoint_num(&ep->desc) |
1290 ((ep->desc.bEndpointAddress & USB_ENDPOINT_DIR_MASK)
1291 >> 3);
1292
1293 /* If this bulk URB is the start of a new transfer, re-enable
1294 * the endpoint. Otherwise mark it as a continuation URB.
1295 */
1296 if (uurb->flags & USBDEVFS_URB_BULK_CONTINUATION)
1297 as->bulk_status = AS_CONTINUATION;
1298 else
1299 ps->disabled_bulk_eps &= ~(1 << as->bulk_addr);
1300
1301 /* Don't accept continuation URBs if the endpoint is
1302 * disabled because of an earlier error.
1303 */
1304 if (ps->disabled_bulk_eps & (1 << as->bulk_addr))
1305 ret = -EREMOTEIO;
1306 else
1307 ret = usb_submit_urb(as->urb, GFP_ATOMIC);
1308 spin_unlock_irq(&ps->lock);
1309 } else {
1310 ret = usb_submit_urb(as->urb, GFP_KERNEL);
1311 }
1312
1313 if (ret) {
1314 dev_printk(KERN_DEBUG, &ps->dev->dev,
1315 "usbfs: usb_submit_urb returned %d\n", ret);
1316 snoop_urb(ps->dev, as->userurb, as->urb->pipe,
1317 0, ret, COMPLETE, NULL, 0);
1318 async_removepending(as);
1319 free_async(as);
1320 return ret;
1321 }
1322 return 0;
1323 }
1324
1325 static int proc_submiturb(struct dev_state *ps, void __user *arg)
1326 {
1327 struct usbdevfs_urb uurb;
1328
1329 if (copy_from_user(&uurb, arg, sizeof(uurb)))
1330 return -EFAULT;
1331
1332 return proc_do_submiturb(ps, &uurb,
1333 (((struct usbdevfs_urb __user *)arg)->iso_frame_desc),
1334 arg);
1335 }
1336
1337 static int proc_unlinkurb(struct dev_state *ps, void __user *arg)
1338 {
1339 struct async *as;
1340
1341 as = async_getpending(ps, arg);
1342 if (!as)
1343 return -EINVAL;
1344 usb_kill_urb(as->urb);
1345 return 0;
1346 }
1347
1348 static int processcompl(struct async *as, void __user * __user *arg)
1349 {
1350 struct urb *urb = as->urb;
1351 struct usbdevfs_urb __user *userurb = as->userurb;
1352 void __user *addr = as->userurb;
1353 unsigned int i;
1354
1355 if (as->userbuffer && urb->actual_length) {
1356 if (urb->number_of_packets > 0) /* Isochronous */
1357 i = urb->transfer_buffer_length;
1358 else /* Non-Isoc */
1359 i = urb->actual_length;
1360 if (copy_to_user(as->userbuffer, urb->transfer_buffer, i))
1361 goto err_out;
1362 }
1363 if (put_user(as->status, &userurb->status))
1364 goto err_out;
1365 if (put_user(urb->actual_length, &userurb->actual_length))
1366 goto err_out;
1367 if (put_user(urb->error_count, &userurb->error_count))
1368 goto err_out;
1369
1370 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
1371 for (i = 0; i < urb->number_of_packets; i++) {
1372 if (put_user(urb->iso_frame_desc[i].actual_length,
1373 &userurb->iso_frame_desc[i].actual_length))
1374 goto err_out;
1375 if (put_user(urb->iso_frame_desc[i].status,
1376 &userurb->iso_frame_desc[i].status))
1377 goto err_out;
1378 }
1379 }
1380
1381 if (put_user(addr, (void __user * __user *)arg))
1382 return -EFAULT;
1383 return 0;
1384
1385 err_out:
1386 return -EFAULT;
1387 }
1388
1389 static struct async *reap_as(struct dev_state *ps)
1390 {
1391 DECLARE_WAITQUEUE(wait, current);
1392 struct async *as = NULL;
1393 struct usb_device *dev = ps->dev;
1394
1395 add_wait_queue(&ps->wait, &wait);
1396 for (;;) {
1397 __set_current_state(TASK_INTERRUPTIBLE);
1398 as = async_getcompleted(ps);
1399 if (as)
1400 break;
1401 if (signal_pending(current))
1402 break;
1403 usb_unlock_device(dev);
1404 schedule();
1405 usb_lock_device(dev);
1406 }
1407 remove_wait_queue(&ps->wait, &wait);
1408 set_current_state(TASK_RUNNING);
1409 return as;
1410 }
1411
1412 static int proc_reapurb(struct dev_state *ps, void __user *arg)
1413 {
1414 struct async *as = reap_as(ps);
1415 if (as) {
1416 int retval = processcompl(as, (void __user * __user *)arg);
1417 free_async(as);
1418 return retval;
1419 }
1420 if (signal_pending(current))
1421 return -EINTR;
1422 return -EIO;
1423 }
1424
1425 static int proc_reapurbnonblock(struct dev_state *ps, void __user *arg)
1426 {
1427 int retval;
1428 struct async *as;
1429
1430 as = async_getcompleted(ps);
1431 retval = -EAGAIN;
1432 if (as) {
1433 retval = processcompl(as, (void __user * __user *)arg);
1434 free_async(as);
1435 }
1436 return retval;
1437 }
1438
1439 #ifdef CONFIG_COMPAT
1440 static int proc_control_compat(struct dev_state *ps,
1441 struct usbdevfs_ctrltransfer32 __user *p32)
1442 {
1443 struct usbdevfs_ctrltransfer __user *p;
1444 __u32 udata;
1445 p = compat_alloc_user_space(sizeof(*p));
1446 if (copy_in_user(p, p32, (sizeof(*p32) - sizeof(compat_caddr_t))) ||
1447 get_user(udata, &p32->data) ||
1448 put_user(compat_ptr(udata), &p->data))
1449 return -EFAULT;
1450 return proc_control(ps, p);
1451 }
1452
1453 static int proc_bulk_compat(struct dev_state *ps,
1454 struct usbdevfs_bulktransfer32 __user *p32)
1455 {
1456 struct usbdevfs_bulktransfer __user *p;
1457 compat_uint_t n;
1458 compat_caddr_t addr;
1459
1460 p = compat_alloc_user_space(sizeof(*p));
1461
1462 if (get_user(n, &p32->ep) || put_user(n, &p->ep) ||
1463 get_user(n, &p32->len) || put_user(n, &p->len) ||
1464 get_user(n, &p32->timeout) || put_user(n, &p->timeout) ||
1465 get_user(addr, &p32->data) || put_user(compat_ptr(addr), &p->data))
1466 return -EFAULT;
1467
1468 return proc_bulk(ps, p);
1469 }
1470 static int proc_disconnectsignal_compat(struct dev_state *ps, void __user *arg)
1471 {
1472 struct usbdevfs_disconnectsignal32 ds;
1473
1474 if (copy_from_user(&ds, arg, sizeof(ds)))
1475 return -EFAULT;
1476 ps->discsignr = ds.signr;
1477 ps->disccontext = compat_ptr(ds.context);
1478 return 0;
1479 }
1480
1481 static int get_urb32(struct usbdevfs_urb *kurb,
1482 struct usbdevfs_urb32 __user *uurb)
1483 {
1484 __u32 uptr;
1485 if (!access_ok(VERIFY_READ, uurb, sizeof(*uurb)) ||
1486 __get_user(kurb->type, &uurb->type) ||
1487 __get_user(kurb->endpoint, &uurb->endpoint) ||
1488 __get_user(kurb->status, &uurb->status) ||
1489 __get_user(kurb->flags, &uurb->flags) ||
1490 __get_user(kurb->buffer_length, &uurb->buffer_length) ||
1491 __get_user(kurb->actual_length, &uurb->actual_length) ||
1492 __get_user(kurb->start_frame, &uurb->start_frame) ||
1493 __get_user(kurb->number_of_packets, &uurb->number_of_packets) ||
1494 __get_user(kurb->error_count, &uurb->error_count) ||
1495 __get_user(kurb->signr, &uurb->signr))
1496 return -EFAULT;
1497
1498 if (__get_user(uptr, &uurb->buffer))
1499 return -EFAULT;
1500 kurb->buffer = compat_ptr(uptr);
1501 if (__get_user(uptr, &uurb->usercontext))
1502 return -EFAULT;
1503 kurb->usercontext = compat_ptr(uptr);
1504
1505 return 0;
1506 }
1507
1508 static int proc_submiturb_compat(struct dev_state *ps, void __user *arg)
1509 {
1510 struct usbdevfs_urb uurb;
1511
1512 if (get_urb32(&uurb, (struct usbdevfs_urb32 __user *)arg))
1513 return -EFAULT;
1514
1515 return proc_do_submiturb(ps, &uurb,
1516 ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc,
1517 arg);
1518 }
1519
1520 static int processcompl_compat(struct async *as, void __user * __user *arg)
1521 {
1522 struct urb *urb = as->urb;
1523 struct usbdevfs_urb32 __user *userurb = as->userurb;
1524 void __user *addr = as->userurb;
1525 unsigned int i;
1526
1527 if (as->userbuffer && urb->actual_length)
1528 if (copy_to_user(as->userbuffer, urb->transfer_buffer,
1529 urb->actual_length))
1530 return -EFAULT;
1531 if (put_user(as->status, &userurb->status))
1532 return -EFAULT;
1533 if (put_user(urb->actual_length, &userurb->actual_length))
1534 return -EFAULT;
1535 if (put_user(urb->error_count, &userurb->error_count))
1536 return -EFAULT;
1537
1538 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
1539 for (i = 0; i < urb->number_of_packets; i++) {
1540 if (put_user(urb->iso_frame_desc[i].actual_length,
1541 &userurb->iso_frame_desc[i].actual_length))
1542 return -EFAULT;
1543 if (put_user(urb->iso_frame_desc[i].status,
1544 &userurb->iso_frame_desc[i].status))
1545 return -EFAULT;
1546 }
1547 }
1548
1549 if (put_user(ptr_to_compat(addr), (u32 __user *)arg))
1550 return -EFAULT;
1551 return 0;
1552 }
1553
1554 static int proc_reapurb_compat(struct dev_state *ps, void __user *arg)
1555 {
1556 struct async *as = reap_as(ps);
1557 if (as) {
1558 int retval = processcompl_compat(as, (void __user * __user *)arg);
1559 free_async(as);
1560 return retval;
1561 }
1562 if (signal_pending(current))
1563 return -EINTR;
1564 return -EIO;
1565 }
1566
1567 static int proc_reapurbnonblock_compat(struct dev_state *ps, void __user *arg)
1568 {
1569 int retval;
1570 struct async *as;
1571
1572 retval = -EAGAIN;
1573 as = async_getcompleted(ps);
1574 if (as) {
1575 retval = processcompl_compat(as, (void __user * __user *)arg);
1576 free_async(as);
1577 }
1578 return retval;
1579 }
1580
1581
1582 #endif
1583
1584 static int proc_disconnectsignal(struct dev_state *ps, void __user *arg)
1585 {
1586 struct usbdevfs_disconnectsignal ds;
1587
1588 if (copy_from_user(&ds, arg, sizeof(ds)))
1589 return -EFAULT;
1590 ps->discsignr = ds.signr;
1591 ps->disccontext = ds.context;
1592 return 0;
1593 }
1594
1595 static int proc_claiminterface(struct dev_state *ps, void __user *arg)
1596 {
1597 unsigned int ifnum;
1598
1599 if (get_user(ifnum, (unsigned int __user *)arg))
1600 return -EFAULT;
1601 return claimintf(ps, ifnum);
1602 }
1603
1604 static int proc_releaseinterface(struct dev_state *ps, void __user *arg)
1605 {
1606 unsigned int ifnum;
1607 int ret;
1608
1609 if (get_user(ifnum, (unsigned int __user *)arg))
1610 return -EFAULT;
1611 if ((ret = releaseintf(ps, ifnum)) < 0)
1612 return ret;
1613 destroy_async_on_interface (ps, ifnum);
1614 return 0;
1615 }
1616
1617 static int proc_ioctl(struct dev_state *ps, struct usbdevfs_ioctl *ctl)
1618 {
1619 int size;
1620 void *buf = NULL;
1621 int retval = 0;
1622 struct usb_interface *intf = NULL;
1623 struct usb_driver *driver = NULL;
1624
1625 /* alloc buffer */
1626 if ((size = _IOC_SIZE(ctl->ioctl_code)) > 0) {
1627 if ((buf = kmalloc(size, GFP_KERNEL)) == NULL)
1628 return -ENOMEM;
1629 if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) {
1630 if (copy_from_user(buf, ctl->data, size)) {
1631 kfree(buf);
1632 return -EFAULT;
1633 }
1634 } else {
1635 memset(buf, 0, size);
1636 }
1637 }
1638
1639 if (!connected(ps)) {
1640 kfree(buf);
1641 return -ENODEV;
1642 }
1643
1644 if (ps->dev->state != USB_STATE_CONFIGURED)
1645 retval = -EHOSTUNREACH;
1646 else if (!(intf = usb_ifnum_to_if(ps->dev, ctl->ifno)))
1647 retval = -EINVAL;
1648 else switch (ctl->ioctl_code) {
1649
1650 /* disconnect kernel driver from interface */
1651 case USBDEVFS_DISCONNECT:
1652 if (intf->dev.driver) {
1653 driver = to_usb_driver(intf->dev.driver);
1654 dev_dbg(&intf->dev, "disconnect by usbfs\n");
1655 usb_driver_release_interface(driver, intf);
1656 } else
1657 retval = -ENODATA;
1658 break;
1659
1660 /* let kernel drivers try to (re)bind to the interface */
1661 case USBDEVFS_CONNECT:
1662 if (!intf->dev.driver)
1663 retval = device_attach(&intf->dev);
1664 else
1665 retval = -EBUSY;
1666 break;
1667
1668 /* talk directly to the interface's driver */
1669 default:
1670 if (intf->dev.driver)
1671 driver = to_usb_driver(intf->dev.driver);
1672 if (driver == NULL || driver->ioctl == NULL) {
1673 retval = -ENOTTY;
1674 } else {
1675 /* keep API that guarantees BKL */
1676 lock_kernel();
1677 retval = driver->ioctl(intf, ctl->ioctl_code, buf);
1678 unlock_kernel();
1679 if (retval == -ENOIOCTLCMD)
1680 retval = -ENOTTY;
1681 }
1682 }
1683
1684 /* cleanup and return */
1685 if (retval >= 0
1686 && (_IOC_DIR(ctl->ioctl_code) & _IOC_READ) != 0
1687 && size > 0
1688 && copy_to_user(ctl->data, buf, size) != 0)
1689 retval = -EFAULT;
1690
1691 kfree(buf);
1692 return retval;
1693 }
1694
1695 static int proc_ioctl_default(struct dev_state *ps, void __user *arg)
1696 {
1697 struct usbdevfs_ioctl ctrl;
1698
1699 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
1700 return -EFAULT;
1701 return proc_ioctl(ps, &ctrl);
1702 }
1703
1704 #ifdef CONFIG_COMPAT
1705 static int proc_ioctl_compat(struct dev_state *ps, compat_uptr_t arg)
1706 {
1707 struct usbdevfs_ioctl32 __user *uioc;
1708 struct usbdevfs_ioctl ctrl;
1709 u32 udata;
1710
1711 uioc = compat_ptr((long)arg);
1712 if (!access_ok(VERIFY_READ, uioc, sizeof(*uioc)) ||
1713 __get_user(ctrl.ifno, &uioc->ifno) ||
1714 __get_user(ctrl.ioctl_code, &uioc->ioctl_code) ||
1715 __get_user(udata, &uioc->data))
1716 return -EFAULT;
1717 ctrl.data = compat_ptr(udata);
1718
1719 return proc_ioctl(ps, &ctrl);
1720 }
1721 #endif
1722
1723 static int proc_claim_port(struct dev_state *ps, void __user *arg)
1724 {
1725 unsigned portnum;
1726 int rc;
1727
1728 if (get_user(portnum, (unsigned __user *) arg))
1729 return -EFAULT;
1730 rc = usb_hub_claim_port(ps->dev, portnum, ps);
1731 if (rc == 0)
1732 snoop(&ps->dev->dev, "port %d claimed by process %d: %s\n",
1733 portnum, task_pid_nr(current), current->comm);
1734 return rc;
1735 }
1736
1737 static int proc_release_port(struct dev_state *ps, void __user *arg)
1738 {
1739 unsigned portnum;
1740
1741 if (get_user(portnum, (unsigned __user *) arg))
1742 return -EFAULT;
1743 return usb_hub_release_port(ps->dev, portnum, ps);
1744 }
1745
1746 /*
1747 * NOTE: All requests here that have interface numbers as parameters
1748 * are assuming that somehow the configuration has been prevented from
1749 * changing. But there's no mechanism to ensure that...
1750 */
1751 static long usbdev_do_ioctl(struct file *file, unsigned int cmd,
1752 void __user *p)
1753 {
1754 struct dev_state *ps = file->private_data;
1755 struct inode *inode = file->f_path.dentry->d_inode;
1756 struct usb_device *dev = ps->dev;
1757 int ret = -ENOTTY;
1758
1759 if (!(file->f_mode & FMODE_WRITE))
1760 return -EPERM;
1761
1762 usb_lock_device(dev);
1763 if (!connected(ps)) {
1764 usb_unlock_device(dev);
1765 return -ENODEV;
1766 }
1767
1768 switch (cmd) {
1769 case USBDEVFS_CONTROL:
1770 snoop(&dev->dev, "%s: CONTROL\n", __func__);
1771 ret = proc_control(ps, p);
1772 if (ret >= 0)
1773 inode->i_mtime = CURRENT_TIME;
1774 break;
1775
1776 case USBDEVFS_BULK:
1777 snoop(&dev->dev, "%s: BULK\n", __func__);
1778 ret = proc_bulk(ps, p);
1779 if (ret >= 0)
1780 inode->i_mtime = CURRENT_TIME;
1781 break;
1782
1783 case USBDEVFS_RESETEP:
1784 snoop(&dev->dev, "%s: RESETEP\n", __func__);
1785 ret = proc_resetep(ps, p);
1786 if (ret >= 0)
1787 inode->i_mtime = CURRENT_TIME;
1788 break;
1789
1790 case USBDEVFS_RESET:
1791 snoop(&dev->dev, "%s: RESET\n", __func__);
1792 ret = proc_resetdevice(ps);
1793 break;
1794
1795 case USBDEVFS_CLEAR_HALT:
1796 snoop(&dev->dev, "%s: CLEAR_HALT\n", __func__);
1797 ret = proc_clearhalt(ps, p);
1798 if (ret >= 0)
1799 inode->i_mtime = CURRENT_TIME;
1800 break;
1801
1802 case USBDEVFS_GETDRIVER:
1803 snoop(&dev->dev, "%s: GETDRIVER\n", __func__);
1804 ret = proc_getdriver(ps, p);
1805 break;
1806
1807 case USBDEVFS_CONNECTINFO:
1808 snoop(&dev->dev, "%s: CONNECTINFO\n", __func__);
1809 ret = proc_connectinfo(ps, p);
1810 break;
1811
1812 case USBDEVFS_SETINTERFACE:
1813 snoop(&dev->dev, "%s: SETINTERFACE\n", __func__);
1814 ret = proc_setintf(ps, p);
1815 break;
1816
1817 case USBDEVFS_SETCONFIGURATION:
1818 snoop(&dev->dev, "%s: SETCONFIGURATION\n", __func__);
1819 ret = proc_setconfig(ps, p);
1820 break;
1821
1822 case USBDEVFS_SUBMITURB:
1823 snoop(&dev->dev, "%s: SUBMITURB\n", __func__);
1824 ret = proc_submiturb(ps, p);
1825 if (ret >= 0)
1826 inode->i_mtime = CURRENT_TIME;
1827 break;
1828
1829 #ifdef CONFIG_COMPAT
1830 case USBDEVFS_CONTROL32:
1831 snoop(&dev->dev, "%s: CONTROL32\n", __func__);
1832 ret = proc_control_compat(ps, p);
1833 if (ret >= 0)
1834 inode->i_mtime = CURRENT_TIME;
1835 break;
1836
1837 case USBDEVFS_BULK32:
1838 snoop(&dev->dev, "%s: BULK32\n", __func__);
1839 ret = proc_bulk_compat(ps, p);
1840 if (ret >= 0)
1841 inode->i_mtime = CURRENT_TIME;
1842 break;
1843
1844 case USBDEVFS_DISCSIGNAL32:
1845 snoop(&dev->dev, "%s: DISCSIGNAL32\n", __func__);
1846 ret = proc_disconnectsignal_compat(ps, p);
1847 break;
1848
1849 case USBDEVFS_SUBMITURB32:
1850 snoop(&dev->dev, "%s: SUBMITURB32\n", __func__);
1851 ret = proc_submiturb_compat(ps, p);
1852 if (ret >= 0)
1853 inode->i_mtime = CURRENT_TIME;
1854 break;
1855
1856 case USBDEVFS_REAPURB32:
1857 snoop(&dev->dev, "%s: REAPURB32\n", __func__);
1858 ret = proc_reapurb_compat(ps, p);
1859 break;
1860
1861 case USBDEVFS_REAPURBNDELAY32:
1862 snoop(&dev->dev, "%s: REAPURBNDELAY32\n", __func__);
1863 ret = proc_reapurbnonblock_compat(ps, p);
1864 break;
1865
1866 case USBDEVFS_IOCTL32:
1867 snoop(&dev->dev, "%s: IOCTL32\n", __func__);
1868 ret = proc_ioctl_compat(ps, ptr_to_compat(p));
1869 break;
1870 #endif
1871
1872 case USBDEVFS_DISCARDURB:
1873 snoop(&dev->dev, "%s: DISCARDURB\n", __func__);
1874 ret = proc_unlinkurb(ps, p);
1875 break;
1876
1877 case USBDEVFS_REAPURB:
1878 snoop(&dev->dev, "%s: REAPURB\n", __func__);
1879 ret = proc_reapurb(ps, p);
1880 break;
1881
1882 case USBDEVFS_REAPURBNDELAY:
1883 snoop(&dev->dev, "%s: REAPURBNDELAY\n", __func__);
1884 ret = proc_reapurbnonblock(ps, p);
1885 break;
1886
1887 case USBDEVFS_DISCSIGNAL:
1888 snoop(&dev->dev, "%s: DISCSIGNAL\n", __func__);
1889 ret = proc_disconnectsignal(ps, p);
1890 break;
1891
1892 case USBDEVFS_CLAIMINTERFACE:
1893 snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __func__);
1894 ret = proc_claiminterface(ps, p);
1895 break;
1896
1897 case USBDEVFS_RELEASEINTERFACE:
1898 snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __func__);
1899 ret = proc_releaseinterface(ps, p);
1900 break;
1901
1902 case USBDEVFS_IOCTL:
1903 snoop(&dev->dev, "%s: IOCTL\n", __func__);
1904 ret = proc_ioctl_default(ps, p);
1905 break;
1906
1907 case USBDEVFS_CLAIM_PORT:
1908 snoop(&dev->dev, "%s: CLAIM_PORT\n", __func__);
1909 ret = proc_claim_port(ps, p);
1910 break;
1911
1912 case USBDEVFS_RELEASE_PORT:
1913 snoop(&dev->dev, "%s: RELEASE_PORT\n", __func__);
1914 ret = proc_release_port(ps, p);
1915 break;
1916 }
1917 usb_unlock_device(dev);
1918 if (ret >= 0)
1919 inode->i_atime = CURRENT_TIME;
1920 return ret;
1921 }
1922
1923 static long usbdev_ioctl(struct file *file, unsigned int cmd,
1924 unsigned long arg)
1925 {
1926 int ret;
1927
1928 ret = usbdev_do_ioctl(file, cmd, (void __user *)arg);
1929
1930 return ret;
1931 }
1932
1933 #ifdef CONFIG_COMPAT
1934 static long usbdev_compat_ioctl(struct file *file, unsigned int cmd,
1935 unsigned long arg)
1936 {
1937 int ret;
1938
1939 ret = usbdev_do_ioctl(file, cmd, compat_ptr(arg));
1940
1941 return ret;
1942 }
1943 #endif
1944
1945 /* No kernel lock - fine */
1946 static unsigned int usbdev_poll(struct file *file,
1947 struct poll_table_struct *wait)
1948 {
1949 struct dev_state *ps = file->private_data;
1950 unsigned int mask = 0;
1951
1952 poll_wait(file, &ps->wait, wait);
1953 if (file->f_mode & FMODE_WRITE && !list_empty(&ps->async_completed))
1954 mask |= POLLOUT | POLLWRNORM;
1955 if (!connected(ps))
1956 mask |= POLLERR | POLLHUP;
1957 return mask;
1958 }
1959
1960 const struct file_operations usbdev_file_operations = {
1961 .owner = THIS_MODULE,
1962 .llseek = usbdev_lseek,
1963 .read = usbdev_read,
1964 .poll = usbdev_poll,
1965 .unlocked_ioctl = usbdev_ioctl,
1966 #ifdef CONFIG_COMPAT
1967 .compat_ioctl = usbdev_compat_ioctl,
1968 #endif
1969 .open = usbdev_open,
1970 .release = usbdev_release,
1971 };
1972
1973 static void usbdev_remove(struct usb_device *udev)
1974 {
1975 struct dev_state *ps;
1976 struct siginfo sinfo;
1977
1978 while (!list_empty(&udev->filelist)) {
1979 ps = list_entry(udev->filelist.next, struct dev_state, list);
1980 destroy_all_async(ps);
1981 wake_up_all(&ps->wait);
1982 list_del_init(&ps->list);
1983 if (ps->discsignr) {
1984 sinfo.si_signo = ps->discsignr;
1985 sinfo.si_errno = EPIPE;
1986 sinfo.si_code = SI_ASYNCIO;
1987 sinfo.si_addr = ps->disccontext;
1988 kill_pid_info_as_uid(ps->discsignr, &sinfo,
1989 ps->disc_pid, ps->disc_uid,
1990 ps->disc_euid, ps->secid);
1991 }
1992 }
1993 }
1994
1995 #ifdef CONFIG_USB_DEVICE_CLASS
1996 static struct class *usb_classdev_class;
1997
1998 static int usb_classdev_add(struct usb_device *dev)
1999 {
2000 struct device *cldev;
2001
2002 cldev = device_create(usb_classdev_class, &dev->dev, dev->dev.devt,
2003 NULL, "usbdev%d.%d", dev->bus->busnum,
2004 dev->devnum);
2005 if (IS_ERR(cldev))
2006 return PTR_ERR(cldev);
2007 dev->usb_classdev = cldev;
2008 return 0;
2009 }
2010
2011 static void usb_classdev_remove(struct usb_device *dev)
2012 {
2013 if (dev->usb_classdev)
2014 device_unregister(dev->usb_classdev);
2015 }
2016
2017 #else
2018 #define usb_classdev_add(dev) 0
2019 #define usb_classdev_remove(dev) do {} while (0)
2020
2021 #endif
2022
2023 static int usbdev_notify(struct notifier_block *self,
2024 unsigned long action, void *dev)
2025 {
2026 switch (action) {
2027 case USB_DEVICE_ADD:
2028 if (usb_classdev_add(dev))
2029 return NOTIFY_BAD;
2030 break;
2031 case USB_DEVICE_REMOVE:
2032 usb_classdev_remove(dev);
2033 usbdev_remove(dev);
2034 break;
2035 }
2036 return NOTIFY_OK;
2037 }
2038
2039 static struct notifier_block usbdev_nb = {
2040 .notifier_call = usbdev_notify,
2041 };
2042
2043 static struct cdev usb_device_cdev;
2044
2045 int __init usb_devio_init(void)
2046 {
2047 int retval;
2048
2049 retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX,
2050 "usb_device");
2051 if (retval) {
2052 printk(KERN_ERR "Unable to register minors for usb_device\n");
2053 goto out;
2054 }
2055 cdev_init(&usb_device_cdev, &usbdev_file_operations);
2056 retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX);
2057 if (retval) {
2058 printk(KERN_ERR "Unable to get usb_device major %d\n",
2059 USB_DEVICE_MAJOR);
2060 goto error_cdev;
2061 }
2062 #ifdef CONFIG_USB_DEVICE_CLASS
2063 usb_classdev_class = class_create(THIS_MODULE, "usb_device");
2064 if (IS_ERR(usb_classdev_class)) {
2065 printk(KERN_ERR "Unable to register usb_device class\n");
2066 retval = PTR_ERR(usb_classdev_class);
2067 cdev_del(&usb_device_cdev);
2068 usb_classdev_class = NULL;
2069 goto out;
2070 }
2071 /* devices of this class shadow the major:minor of their parent
2072 * device, so clear ->dev_kobj to prevent adding duplicate entries
2073 * to /sys/dev
2074 */
2075 usb_classdev_class->dev_kobj = NULL;
2076 #endif
2077 usb_register_notify(&usbdev_nb);
2078 out:
2079 return retval;
2080
2081 error_cdev:
2082 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
2083 goto out;
2084 }
2085
2086 void usb_devio_cleanup(void)
2087 {
2088 usb_unregister_notify(&usbdev_nb);
2089 #ifdef CONFIG_USB_DEVICE_CLASS
2090 class_destroy(usb_classdev_class);
2091 #endif
2092 cdev_del(&usb_device_cdev);
2093 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
2094 }
Linux with added FPC-III support