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