?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
inet: frag: enforce memory limits earlier
[linux/fpc-iii.git] / drivers / usb / core / devio.c
blob893ebae5102924ef778f381d76286a947fedc77b
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/string.h>
44 #include <linux/usb.h>
45 #include <linux/usbdevice_fs.h>
46 #include <linux/usb/hcd.h> /* for usbcore internals */
47 #include <linux/cdev.h>
48 #include <linux/notifier.h>
49 #include <linux/security.h>
50 #include <linux/user_namespace.h>
51 #include <linux/scatterlist.h>
52 #include <linux/uaccess.h>
53 #include <linux/dma-mapping.h>
54 #include <asm/byteorder.h>
55 #include <linux/moduleparam.h>
56
57 #include "usb.h"
58
59 #define USB_MAXBUS 64
60 #define USB_DEVICE_MAX (USB_MAXBUS * 128)
61 #define USB_SG_SIZE 16384 /* split-size for large txs */
62
63 /* Mutual exclusion for removal, open, and release */
64 DEFINE_MUTEX(usbfs_mutex);
65
66 struct usb_dev_state {
67 struct list_head list; /* state list */
68 struct usb_device *dev;
69 struct file *file;
70 spinlock_t lock; /* protects the async urb lists */
71 struct list_head async_pending;
72 struct list_head async_completed;
73 struct list_head memory_list;
74 wait_queue_head_t wait; /* wake up if a request completed */
75 unsigned int discsignr;
76 struct pid *disc_pid;
77 const struct cred *cred;
78 void __user *disccontext;
79 unsigned long ifclaimed;
80 u32 secid;
81 u32 disabled_bulk_eps;
82 bool privileges_dropped;
83 unsigned long interface_allowed_mask;
84 };
85
86 struct usb_memory {
87 struct list_head memlist;
88 int vma_use_count;
89 int urb_use_count;
90 u32 size;
91 void *mem;
92 dma_addr_t dma_handle;
93 unsigned long vm_start;
94 struct usb_dev_state *ps;
95 };
96
97 struct async {
98 struct list_head asynclist;
99 struct usb_dev_state *ps;
100 struct pid *pid;
101 const struct cred *cred;
102 unsigned int signr;
103 unsigned int ifnum;
104 void __user *userbuffer;
105 void __user *userurb;
106 struct urb *urb;
107 struct usb_memory *usbm;
108 unsigned int mem_usage;
109 int status;
110 u32 secid;
111 u8 bulk_addr;
112 u8 bulk_status;
113 };
114
115 static bool usbfs_snoop;
116 module_param(usbfs_snoop, bool, S_IRUGO | S_IWUSR);
117 MODULE_PARM_DESC(usbfs_snoop, "true to log all usbfs traffic");
118
119 static unsigned usbfs_snoop_max = 65536;
120 module_param(usbfs_snoop_max, uint, S_IRUGO | S_IWUSR);
121 MODULE_PARM_DESC(usbfs_snoop_max,
122 "maximum number of bytes to print while snooping");
123
124 #define snoop(dev, format, arg...) \
125 do { \
126 if (usbfs_snoop) \
127 dev_info(dev, format, ## arg); \
128 } while (0)
129
130 enum snoop_when {
131 SUBMIT, COMPLETE
132 };
133
134 #define USB_DEVICE_DEV MKDEV(USB_DEVICE_MAJOR, 0)
135
136 /* Limit on the total amount of memory we can allocate for transfers */
137 static u32 usbfs_memory_mb = 16;
138 module_param(usbfs_memory_mb, uint, 0644);
139 MODULE_PARM_DESC(usbfs_memory_mb,
140 "maximum MB allowed for usbfs buffers (0 = no limit)");
141
142 /* Hard limit, necessary to avoid arithmetic overflow */
143 #define USBFS_XFER_MAX (UINT_MAX / 2 - 1000000)
144
145 static atomic64_t usbfs_memory_usage; /* Total memory currently allocated */
146
147 /* Check whether it's okay to allocate more memory for a transfer */
148 static int usbfs_increase_memory_usage(u64 amount)
149 {
150 u64 lim;
151
152 lim = ACCESS_ONCE(usbfs_memory_mb);
153 lim <<= 20;
154
155 atomic64_add(amount, &usbfs_memory_usage);
156
157 if (lim > 0 && atomic64_read(&usbfs_memory_usage) > lim) {
158 atomic64_sub(amount, &usbfs_memory_usage);
159 return -ENOMEM;
160 }
161
162 return 0;
163 }
164
165 /* Memory for a transfer is being deallocated */
166 static void usbfs_decrease_memory_usage(u64 amount)
167 {
168 atomic64_sub(amount, &usbfs_memory_usage);
169 }
170
171 static int connected(struct usb_dev_state *ps)
172 {
173 return (!list_empty(&ps->list) &&
174 ps->dev->state != USB_STATE_NOTATTACHED);
175 }
176
177 static void dec_usb_memory_use_count(struct usb_memory *usbm, int *count)
178 {
179 struct usb_dev_state *ps = usbm->ps;
180 unsigned long flags;
181
182 spin_lock_irqsave(&ps->lock, flags);
183 --*count;
184 if (usbm->urb_use_count == 0 && usbm->vma_use_count == 0) {
185 list_del(&usbm->memlist);
186 spin_unlock_irqrestore(&ps->lock, flags);
187
188 usb_free_coherent(ps->dev, usbm->size, usbm->mem,
189 usbm->dma_handle);
190 usbfs_decrease_memory_usage(
191 usbm->size + sizeof(struct usb_memory));
192 kfree(usbm);
193 } else {
194 spin_unlock_irqrestore(&ps->lock, flags);
195 }
196 }
197
198 static void usbdev_vm_open(struct vm_area_struct *vma)
199 {
200 struct usb_memory *usbm = vma->vm_private_data;
201 unsigned long flags;
202
203 spin_lock_irqsave(&usbm->ps->lock, flags);
204 ++usbm->vma_use_count;
205 spin_unlock_irqrestore(&usbm->ps->lock, flags);
206 }
207
208 static void usbdev_vm_close(struct vm_area_struct *vma)
209 {
210 struct usb_memory *usbm = vma->vm_private_data;
211
212 dec_usb_memory_use_count(usbm, &usbm->vma_use_count);
213 }
214
215 static struct vm_operations_struct usbdev_vm_ops = {
216 .open = usbdev_vm_open,
217 .close = usbdev_vm_close
218 };
219
220 static int usbdev_mmap(struct file *file, struct vm_area_struct *vma)
221 {
222 struct usb_memory *usbm = NULL;
223 struct usb_dev_state *ps = file->private_data;
224 size_t size = vma->vm_end - vma->vm_start;
225 void *mem;
226 unsigned long flags;
227 dma_addr_t dma_handle;
228 int ret;
229
230 ret = usbfs_increase_memory_usage(size + sizeof(struct usb_memory));
231 if (ret)
232 goto error;
233
234 usbm = kzalloc(sizeof(struct usb_memory), GFP_KERNEL);
235 if (!usbm) {
236 ret = -ENOMEM;
237 goto error_decrease_mem;
238 }
239
240 mem = usb_alloc_coherent(ps->dev, size, GFP_USER | __GFP_NOWARN,
241 &dma_handle);
242 if (!mem) {
243 ret = -ENOMEM;
244 goto error_free_usbm;
245 }
246
247 memset(mem, 0, size);
248
249 usbm->mem = mem;
250 usbm->dma_handle = dma_handle;
251 usbm->size = size;
252 usbm->ps = ps;
253 usbm->vm_start = vma->vm_start;
254 usbm->vma_use_count = 1;
255 INIT_LIST_HEAD(&usbm->memlist);
256
257 if (remap_pfn_range(vma, vma->vm_start,
258 virt_to_phys(usbm->mem) >> PAGE_SHIFT,
259 size, vma->vm_page_prot) < 0) {
260 dec_usb_memory_use_count(usbm, &usbm->vma_use_count);
261 return -EAGAIN;
262 }
263
264 vma->vm_flags |= VM_IO;
265 vma->vm_flags |= (VM_DONTEXPAND | VM_DONTDUMP);
266 vma->vm_ops = &usbdev_vm_ops;
267 vma->vm_private_data = usbm;
268
269 spin_lock_irqsave(&ps->lock, flags);
270 list_add_tail(&usbm->memlist, &ps->memory_list);
271 spin_unlock_irqrestore(&ps->lock, flags);
272
273 return 0;
274
275 error_free_usbm:
276 kfree(usbm);
277 error_decrease_mem:
278 usbfs_decrease_memory_usage(size + sizeof(struct usb_memory));
279 error:
280 return ret;
281 }
282
283 static ssize_t usbdev_read(struct file *file, char __user *buf, size_t nbytes,
284 loff_t *ppos)
285 {
286 struct usb_dev_state *ps = file->private_data;
287 struct usb_device *dev = ps->dev;
288 ssize_t ret = 0;
289 unsigned len;
290 loff_t pos;
291 int i;
292
293 pos = *ppos;
294 usb_lock_device(dev);
295 if (!connected(ps)) {
296 ret = -ENODEV;
297 goto err;
298 } else if (pos < 0) {
299 ret = -EINVAL;
300 goto err;
301 }
302
303 if (pos < sizeof(struct usb_device_descriptor)) {
304 /* 18 bytes - fits on the stack */
305 struct usb_device_descriptor temp_desc;
306
307 memcpy(&temp_desc, &dev->descriptor, sizeof(dev->descriptor));
308 le16_to_cpus(&temp_desc.bcdUSB);
309 le16_to_cpus(&temp_desc.idVendor);
310 le16_to_cpus(&temp_desc.idProduct);
311 le16_to_cpus(&temp_desc.bcdDevice);
312
313 len = sizeof(struct usb_device_descriptor) - pos;
314 if (len > nbytes)
315 len = nbytes;
316 if (copy_to_user(buf, ((char *)&temp_desc) + pos, len)) {
317 ret = -EFAULT;
318 goto err;
319 }
320
321 *ppos += len;
322 buf += len;
323 nbytes -= len;
324 ret += len;
325 }
326
327 pos = sizeof(struct usb_device_descriptor);
328 for (i = 0; nbytes && i < dev->descriptor.bNumConfigurations; i++) {
329 struct usb_config_descriptor *config =
330 (struct usb_config_descriptor *)dev->rawdescriptors[i];
331 unsigned int length = le16_to_cpu(config->wTotalLength);
332
333 if (*ppos < pos + length) {
334
335 /* The descriptor may claim to be longer than it
336 * really is. Here is the actual allocated length. */
337 unsigned alloclen =
338 le16_to_cpu(dev->config[i].desc.wTotalLength);
339
340 len = length - (*ppos - pos);
341 if (len > nbytes)
342 len = nbytes;
343
344 /* Simply don't write (skip over) unallocated parts */
345 if (alloclen > (*ppos - pos)) {
346 alloclen -= (*ppos - pos);
347 if (copy_to_user(buf,
348 dev->rawdescriptors[i] + (*ppos - pos),
349 min(len, alloclen))) {
350 ret = -EFAULT;
351 goto err;
352 }
353 }
354
355 *ppos += len;
356 buf += len;
357 nbytes -= len;
358 ret += len;
359 }
360
361 pos += length;
362 }
363
364 err:
365 usb_unlock_device(dev);
366 return ret;
367 }
368
369 /*
370 * async list handling
371 */
372
373 static struct async *alloc_async(unsigned int numisoframes)
374 {
375 struct async *as;
376
377 as = kzalloc(sizeof(struct async), GFP_KERNEL);
378 if (!as)
379 return NULL;
380 as->urb = usb_alloc_urb(numisoframes, GFP_KERNEL);
381 if (!as->urb) {
382 kfree(as);
383 return NULL;
384 }
385 return as;
386 }
387
388 static void free_async(struct async *as)
389 {
390 int i;
391
392 put_pid(as->pid);
393 if (as->cred)
394 put_cred(as->cred);
395 for (i = 0; i < as->urb->num_sgs; i++) {
396 if (sg_page(&as->urb->sg[i]))
397 kfree(sg_virt(&as->urb->sg[i]));
398 }
399
400 kfree(as->urb->sg);
401 if (as->usbm == NULL)
402 kfree(as->urb->transfer_buffer);
403 else
404 dec_usb_memory_use_count(as->usbm, &as->usbm->urb_use_count);
405
406 kfree(as->urb->setup_packet);
407 usb_free_urb(as->urb);
408 usbfs_decrease_memory_usage(as->mem_usage);
409 kfree(as);
410 }
411
412 static void async_newpending(struct async *as)
413 {
414 struct usb_dev_state *ps = as->ps;
415 unsigned long flags;
416
417 spin_lock_irqsave(&ps->lock, flags);
418 list_add_tail(&as->asynclist, &ps->async_pending);
419 spin_unlock_irqrestore(&ps->lock, flags);
420 }
421
422 static void async_removepending(struct async *as)
423 {
424 struct usb_dev_state *ps = as->ps;
425 unsigned long flags;
426
427 spin_lock_irqsave(&ps->lock, flags);
428 list_del_init(&as->asynclist);
429 spin_unlock_irqrestore(&ps->lock, flags);
430 }
431
432 static struct async *async_getcompleted(struct usb_dev_state *ps)
433 {
434 unsigned long flags;
435 struct async *as = NULL;
436
437 spin_lock_irqsave(&ps->lock, flags);
438 if (!list_empty(&ps->async_completed)) {
439 as = list_entry(ps->async_completed.next, struct async,
440 asynclist);
441 list_del_init(&as->asynclist);
442 }
443 spin_unlock_irqrestore(&ps->lock, flags);
444 return as;
445 }
446
447 static struct async *async_getpending(struct usb_dev_state *ps,
448 void __user *userurb)
449 {
450 struct async *as;
451
452 list_for_each_entry(as, &ps->async_pending, asynclist)
453 if (as->userurb == userurb) {
454 list_del_init(&as->asynclist);
455 return as;
456 }
457
458 return NULL;
459 }
460
461 static void snoop_urb(struct usb_device *udev,
462 void __user *userurb, int pipe, unsigned length,
463 int timeout_or_status, enum snoop_when when,
464 unsigned char *data, unsigned data_len)
465 {
466 static const char *types[] = {"isoc", "int", "ctrl", "bulk"};
467 static const char *dirs[] = {"out", "in"};
468 int ep;
469 const char *t, *d;
470
471 if (!usbfs_snoop)
472 return;
473
474 ep = usb_pipeendpoint(pipe);
475 t = types[usb_pipetype(pipe)];
476 d = dirs[!!usb_pipein(pipe)];
477
478 if (userurb) { /* Async */
479 if (when == SUBMIT)
480 dev_info(&udev->dev, "userurb %pK, ep%d %s-%s, "
481 "length %u\n",
482 userurb, ep, t, d, length);
483 else
484 dev_info(&udev->dev, "userurb %pK, ep%d %s-%s, "
485 "actual_length %u status %d\n",
486 userurb, ep, t, d, length,
487 timeout_or_status);
488 } else {
489 if (when == SUBMIT)
490 dev_info(&udev->dev, "ep%d %s-%s, length %u, "
491 "timeout %d\n",
492 ep, t, d, length, timeout_or_status);
493 else
494 dev_info(&udev->dev, "ep%d %s-%s, actual_length %u, "
495 "status %d\n",
496 ep, t, d, length, timeout_or_status);
497 }
498
499 data_len = min(data_len, usbfs_snoop_max);
500 if (data && data_len > 0) {
501 print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
502 data, data_len, 1);
503 }
504 }
505
506 static void snoop_urb_data(struct urb *urb, unsigned len)
507 {
508 int i, size;
509
510 len = min(len, usbfs_snoop_max);
511 if (!usbfs_snoop || len == 0)
512 return;
513
514 if (urb->num_sgs == 0) {
515 print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
516 urb->transfer_buffer, len, 1);
517 return;
518 }
519
520 for (i = 0; i < urb->num_sgs && len; i++) {
521 size = (len > USB_SG_SIZE) ? USB_SG_SIZE : len;
522 print_hex_dump(KERN_DEBUG, "data: ", DUMP_PREFIX_NONE, 32, 1,
523 sg_virt(&urb->sg[i]), size, 1);
524 len -= size;
525 }
526 }
527
528 static int copy_urb_data_to_user(u8 __user *userbuffer, struct urb *urb)
529 {
530 unsigned i, len, size;
531
532 if (urb->number_of_packets > 0) /* Isochronous */
533 len = urb->transfer_buffer_length;
534 else /* Non-Isoc */
535 len = urb->actual_length;
536
537 if (urb->num_sgs == 0) {
538 if (copy_to_user(userbuffer, urb->transfer_buffer, len))
539 return -EFAULT;
540 return 0;
541 }
542
543 for (i = 0; i < urb->num_sgs && len; i++) {
544 size = (len > USB_SG_SIZE) ? USB_SG_SIZE : len;
545 if (copy_to_user(userbuffer, sg_virt(&urb->sg[i]), size))
546 return -EFAULT;
547 userbuffer += size;
548 len -= size;
549 }
550
551 return 0;
552 }
553
554 #define AS_CONTINUATION 1
555 #define AS_UNLINK 2
556
557 static void cancel_bulk_urbs(struct usb_dev_state *ps, unsigned bulk_addr)
558 __releases(ps->lock)
559 __acquires(ps->lock)
560 {
561 struct urb *urb;
562 struct async *as;
563
564 /* Mark all the pending URBs that match bulk_addr, up to but not
565 * including the first one without AS_CONTINUATION. If such an
566 * URB is encountered then a new transfer has already started so
567 * the endpoint doesn't need to be disabled; otherwise it does.
568 */
569 list_for_each_entry(as, &ps->async_pending, asynclist) {
570 if (as->bulk_addr == bulk_addr) {
571 if (as->bulk_status != AS_CONTINUATION)
572 goto rescan;
573 as->bulk_status = AS_UNLINK;
574 as->bulk_addr = 0;
575 }
576 }
577 ps->disabled_bulk_eps |= (1 << bulk_addr);
578
579 /* Now carefully unlink all the marked pending URBs */
580 rescan:
581 list_for_each_entry(as, &ps->async_pending, asynclist) {
582 if (as->bulk_status == AS_UNLINK) {
583 as->bulk_status = 0; /* Only once */
584 urb = as->urb;
585 usb_get_urb(urb);
586 spin_unlock(&ps->lock); /* Allow completions */
587 usb_unlink_urb(urb);
588 usb_put_urb(urb);
589 spin_lock(&ps->lock);
590 goto rescan;
591 }
592 }
593 }
594
595 static void async_completed(struct urb *urb)
596 {
597 struct async *as = urb->context;
598 struct usb_dev_state *ps = as->ps;
599 struct siginfo sinfo;
600 struct pid *pid = NULL;
601 u32 secid = 0;
602 const struct cred *cred = NULL;
603 int signr;
604
605 spin_lock(&ps->lock);
606 list_move_tail(&as->asynclist, &ps->async_completed);
607 as->status = urb->status;
608 signr = as->signr;
609 if (signr) {
610 memset(&sinfo, 0, sizeof(sinfo));
611 sinfo.si_signo = as->signr;
612 sinfo.si_errno = as->status;
613 sinfo.si_code = SI_ASYNCIO;
614 sinfo.si_addr = as->userurb;
615 pid = get_pid(as->pid);
616 cred = get_cred(as->cred);
617 secid = as->secid;
618 }
619 snoop(&urb->dev->dev, "urb complete\n");
620 snoop_urb(urb->dev, as->userurb, urb->pipe, urb->actual_length,
621 as->status, COMPLETE, NULL, 0);
622 if ((urb->transfer_flags & URB_DIR_MASK) == URB_DIR_IN)
623 snoop_urb_data(urb, urb->actual_length);
624
625 if (as->status < 0 && as->bulk_addr && as->status != -ECONNRESET &&
626 as->status != -ENOENT)
627 cancel_bulk_urbs(ps, as->bulk_addr);
628
629 wake_up(&ps->wait);
630 spin_unlock(&ps->lock);
631
632 if (signr) {
633 kill_pid_info_as_cred(sinfo.si_signo, &sinfo, pid, cred, secid);
634 put_pid(pid);
635 put_cred(cred);
636 }
637 }
638
639 static void destroy_async(struct usb_dev_state *ps, struct list_head *list)
640 {
641 struct urb *urb;
642 struct async *as;
643 unsigned long flags;
644
645 spin_lock_irqsave(&ps->lock, flags);
646 while (!list_empty(list)) {
647 as = list_entry(list->next, struct async, asynclist);
648 list_del_init(&as->asynclist);
649 urb = as->urb;
650 usb_get_urb(urb);
651
652 /* drop the spinlock so the completion handler can run */
653 spin_unlock_irqrestore(&ps->lock, flags);
654 usb_kill_urb(urb);
655 usb_put_urb(urb);
656 spin_lock_irqsave(&ps->lock, flags);
657 }
658 spin_unlock_irqrestore(&ps->lock, flags);
659 }
660
661 static void destroy_async_on_interface(struct usb_dev_state *ps,
662 unsigned int ifnum)
663 {
664 struct list_head *p, *q, hitlist;
665 unsigned long flags;
666
667 INIT_LIST_HEAD(&hitlist);
668 spin_lock_irqsave(&ps->lock, flags);
669 list_for_each_safe(p, q, &ps->async_pending)
670 if (ifnum == list_entry(p, struct async, asynclist)->ifnum)
671 list_move_tail(p, &hitlist);
672 spin_unlock_irqrestore(&ps->lock, flags);
673 destroy_async(ps, &hitlist);
674 }
675
676 static void destroy_all_async(struct usb_dev_state *ps)
677 {
678 destroy_async(ps, &ps->async_pending);
679 }
680
681 /*
682 * interface claims are made only at the request of user level code,
683 * which can also release them (explicitly or by closing files).
684 * they're also undone when devices disconnect.
685 */
686
687 static int driver_probe(struct usb_interface *intf,
688 const struct usb_device_id *id)
689 {
690 return -ENODEV;
691 }
692
693 static void driver_disconnect(struct usb_interface *intf)
694 {
695 struct usb_dev_state *ps = usb_get_intfdata(intf);
696 unsigned int ifnum = intf->altsetting->desc.bInterfaceNumber;
697
698 if (!ps)
699 return;
700
701 /* NOTE: this relies on usbcore having canceled and completed
702 * all pending I/O requests; 2.6 does that.
703 */
704
705 if (likely(ifnum < 8*sizeof(ps->ifclaimed)))
706 clear_bit(ifnum, &ps->ifclaimed);
707 else
708 dev_warn(&intf->dev, "interface number %u out of range\n",
709 ifnum);
710
711 usb_set_intfdata(intf, NULL);
712
713 /* force async requests to complete */
714 destroy_async_on_interface(ps, ifnum);
715 }
716
717 /* The following routines are merely placeholders. There is no way
718 * to inform a user task about suspend or resumes.
719 */
720 static int driver_suspend(struct usb_interface *intf, pm_message_t msg)
721 {
722 return 0;
723 }
724
725 static int driver_resume(struct usb_interface *intf)
726 {
727 return 0;
728 }
729
730 struct usb_driver usbfs_driver = {
731 .name = "usbfs",
732 .probe = driver_probe,
733 .disconnect = driver_disconnect,
734 .suspend = driver_suspend,
735 .resume = driver_resume,
736 };
737
738 static int claimintf(struct usb_dev_state *ps, unsigned int ifnum)
739 {
740 struct usb_device *dev = ps->dev;
741 struct usb_interface *intf;
742 int err;
743
744 if (ifnum >= 8*sizeof(ps->ifclaimed))
745 return -EINVAL;
746 /* already claimed */
747 if (test_bit(ifnum, &ps->ifclaimed))
748 return 0;
749
750 if (ps->privileges_dropped &&
751 !test_bit(ifnum, &ps->interface_allowed_mask))
752 return -EACCES;
753
754 intf = usb_ifnum_to_if(dev, ifnum);
755 if (!intf)
756 err = -ENOENT;
757 else
758 err = usb_driver_claim_interface(&usbfs_driver, intf, ps);
759 if (err == 0)
760 set_bit(ifnum, &ps->ifclaimed);
761 return err;
762 }
763
764 static int releaseintf(struct usb_dev_state *ps, unsigned int ifnum)
765 {
766 struct usb_device *dev;
767 struct usb_interface *intf;
768 int err;
769
770 err = -EINVAL;
771 if (ifnum >= 8*sizeof(ps->ifclaimed))
772 return err;
773 dev = ps->dev;
774 intf = usb_ifnum_to_if(dev, ifnum);
775 if (!intf)
776 err = -ENOENT;
777 else if (test_and_clear_bit(ifnum, &ps->ifclaimed)) {
778 usb_driver_release_interface(&usbfs_driver, intf);
779 err = 0;
780 }
781 return err;
782 }
783
784 static int checkintf(struct usb_dev_state *ps, unsigned int ifnum)
785 {
786 if (ps->dev->state != USB_STATE_CONFIGURED)
787 return -EHOSTUNREACH;
788 if (ifnum >= 8*sizeof(ps->ifclaimed))
789 return -EINVAL;
790 if (test_bit(ifnum, &ps->ifclaimed))
791 return 0;
792 /* if not yet claimed, claim it for the driver */
793 dev_warn(&ps->dev->dev, "usbfs: process %d (%s) did not claim "
794 "interface %u before use\n", task_pid_nr(current),
795 current->comm, ifnum);
796 return claimintf(ps, ifnum);
797 }
798
799 static int findintfep(struct usb_device *dev, unsigned int ep)
800 {
801 unsigned int i, j, e;
802 struct usb_interface *intf;
803 struct usb_host_interface *alts;
804 struct usb_endpoint_descriptor *endpt;
805
806 if (ep & ~(USB_DIR_IN|0xf))
807 return -EINVAL;
808 if (!dev->actconfig)
809 return -ESRCH;
810 for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
811 intf = dev->actconfig->interface[i];
812 for (j = 0; j < intf->num_altsetting; j++) {
813 alts = &intf->altsetting[j];
814 for (e = 0; e < alts->desc.bNumEndpoints; e++) {
815 endpt = &alts->endpoint[e].desc;
816 if (endpt->bEndpointAddress == ep)
817 return alts->desc.bInterfaceNumber;
818 }
819 }
820 }
821 return -ENOENT;
822 }
823
824 static int check_ctrlrecip(struct usb_dev_state *ps, unsigned int requesttype,
825 unsigned int request, unsigned int index)
826 {
827 int ret = 0;
828 struct usb_host_interface *alt_setting;
829
830 if (ps->dev->state != USB_STATE_UNAUTHENTICATED
831 && ps->dev->state != USB_STATE_ADDRESS
832 && ps->dev->state != USB_STATE_CONFIGURED)
833 return -EHOSTUNREACH;
834 if (USB_TYPE_VENDOR == (USB_TYPE_MASK & requesttype))
835 return 0;
836
837 /*
838 * check for the special corner case 'get_device_id' in the printer
839 * class specification, which we always want to allow as it is used
840 * to query things like ink level, etc.
841 */
842 if (requesttype == 0xa1 && request == 0) {
843 alt_setting = usb_find_alt_setting(ps->dev->actconfig,
844 index >> 8, index & 0xff);
845 if (alt_setting
846 && alt_setting->desc.bInterfaceClass == USB_CLASS_PRINTER)
847 return 0;
848 }
849
850 index &= 0xff;
851 switch (requesttype & USB_RECIP_MASK) {
852 case USB_RECIP_ENDPOINT:
853 if ((index & ~USB_DIR_IN) == 0)
854 return 0;
855 ret = findintfep(ps->dev, index);
856 if (ret < 0) {
857 /*
858 * Some not fully compliant Win apps seem to get
859 * index wrong and have the endpoint number here
860 * rather than the endpoint address (with the
861 * correct direction). Win does let this through,
862 * so we'll not reject it here but leave it to
863 * the device to not break KVM. But we warn.
864 */
865 ret = findintfep(ps->dev, index ^ 0x80);
866 if (ret >= 0)
867 dev_info(&ps->dev->dev,
868 "%s: process %i (%s) requesting ep %02x but needs %02x\n",
869 __func__, task_pid_nr(current),
870 current->comm, index, index ^ 0x80);
871 }
872 if (ret >= 0)
873 ret = checkintf(ps, ret);
874 break;
875
876 case USB_RECIP_INTERFACE:
877 ret = checkintf(ps, index);
878 break;
879 }
880 return ret;
881 }
882
883 static struct usb_host_endpoint *ep_to_host_endpoint(struct usb_device *dev,
884 unsigned char ep)
885 {
886 if (ep & USB_ENDPOINT_DIR_MASK)
887 return dev->ep_in[ep & USB_ENDPOINT_NUMBER_MASK];
888 else
889 return dev->ep_out[ep & USB_ENDPOINT_NUMBER_MASK];
890 }
891
892 static int parse_usbdevfs_streams(struct usb_dev_state *ps,
893 struct usbdevfs_streams __user *streams,
894 unsigned int *num_streams_ret,
895 unsigned int *num_eps_ret,
896 struct usb_host_endpoint ***eps_ret,
897 struct usb_interface **intf_ret)
898 {
899 unsigned int i, num_streams, num_eps;
900 struct usb_host_endpoint **eps;
901 struct usb_interface *intf = NULL;
902 unsigned char ep;
903 int ifnum, ret;
904
905 if (get_user(num_streams, &streams->num_streams) ||
906 get_user(num_eps, &streams->num_eps))
907 return -EFAULT;
908
909 if (num_eps < 1 || num_eps > USB_MAXENDPOINTS)
910 return -EINVAL;
911
912 /* The XHCI controller allows max 2 ^ 16 streams */
913 if (num_streams_ret && (num_streams < 2 || num_streams > 65536))
914 return -EINVAL;
915
916 eps = kmalloc(num_eps * sizeof(*eps), GFP_KERNEL);
917 if (!eps)
918 return -ENOMEM;
919
920 for (i = 0; i < num_eps; i++) {
921 if (get_user(ep, &streams->eps[i])) {
922 ret = -EFAULT;
923 goto error;
924 }
925 eps[i] = ep_to_host_endpoint(ps->dev, ep);
926 if (!eps[i]) {
927 ret = -EINVAL;
928 goto error;
929 }
930
931 /* usb_alloc/free_streams operate on an usb_interface */
932 ifnum = findintfep(ps->dev, ep);
933 if (ifnum < 0) {
934 ret = ifnum;
935 goto error;
936 }
937
938 if (i == 0) {
939 ret = checkintf(ps, ifnum);
940 if (ret < 0)
941 goto error;
942 intf = usb_ifnum_to_if(ps->dev, ifnum);
943 } else {
944 /* Verify all eps belong to the same interface */
945 if (ifnum != intf->altsetting->desc.bInterfaceNumber) {
946 ret = -EINVAL;
947 goto error;
948 }
949 }
950 }
951
952 if (num_streams_ret)
953 *num_streams_ret = num_streams;
954 *num_eps_ret = num_eps;
955 *eps_ret = eps;
956 *intf_ret = intf;
957
958 return 0;
959
960 error:
961 kfree(eps);
962 return ret;
963 }
964
965 static int match_devt(struct device *dev, void *data)
966 {
967 return dev->devt == (dev_t) (unsigned long) data;
968 }
969
970 static struct usb_device *usbdev_lookup_by_devt(dev_t devt)
971 {
972 struct device *dev;
973
974 dev = bus_find_device(&usb_bus_type, NULL,
975 (void *) (unsigned long) devt, match_devt);
976 if (!dev)
977 return NULL;
978 return to_usb_device(dev);
979 }
980
981 /*
982 * file operations
983 */
984 static int usbdev_open(struct inode *inode, struct file *file)
985 {
986 struct usb_device *dev = NULL;
987 struct usb_dev_state *ps;
988 int ret;
989
990 ret = -ENOMEM;
991 ps = kzalloc(sizeof(struct usb_dev_state), GFP_KERNEL);
992 if (!ps)
993 goto out_free_ps;
994
995 ret = -ENODEV;
996
997 /* Protect against simultaneous removal or release */
998 mutex_lock(&usbfs_mutex);
999
1000 /* usbdev device-node */
1001 if (imajor(inode) == USB_DEVICE_MAJOR)
1002 dev = usbdev_lookup_by_devt(inode->i_rdev);
1003
1004 mutex_unlock(&usbfs_mutex);
1005
1006 if (!dev)
1007 goto out_free_ps;
1008
1009 usb_lock_device(dev);
1010 if (dev->state == USB_STATE_NOTATTACHED)
1011 goto out_unlock_device;
1012
1013 ret = usb_autoresume_device(dev);
1014 if (ret)
1015 goto out_unlock_device;
1016
1017 ps->dev = dev;
1018 ps->file = file;
1019 ps->interface_allowed_mask = 0xFFFFFFFF; /* 32 bits */
1020 spin_lock_init(&ps->lock);
1021 INIT_LIST_HEAD(&ps->list);
1022 INIT_LIST_HEAD(&ps->async_pending);
1023 INIT_LIST_HEAD(&ps->async_completed);
1024 INIT_LIST_HEAD(&ps->memory_list);
1025 init_waitqueue_head(&ps->wait);
1026 ps->disc_pid = get_pid(task_pid(current));
1027 ps->cred = get_current_cred();
1028 security_task_getsecid(current, &ps->secid);
1029 smp_wmb();
1030 list_add_tail(&ps->list, &dev->filelist);
1031 file->private_data = ps;
1032 usb_unlock_device(dev);
1033 snoop(&dev->dev, "opened by process %d: %s\n", task_pid_nr(current),
1034 current->comm);
1035 return ret;
1036
1037 out_unlock_device:
1038 usb_unlock_device(dev);
1039 usb_put_dev(dev);
1040 out_free_ps:
1041 kfree(ps);
1042 return ret;
1043 }
1044
1045 static int usbdev_release(struct inode *inode, struct file *file)
1046 {
1047 struct usb_dev_state *ps = file->private_data;
1048 struct usb_device *dev = ps->dev;
1049 unsigned int ifnum;
1050 struct async *as;
1051
1052 usb_lock_device(dev);
1053 usb_hub_release_all_ports(dev, ps);
1054
1055 list_del_init(&ps->list);
1056
1057 for (ifnum = 0; ps->ifclaimed && ifnum < 8*sizeof(ps->ifclaimed);
1058 ifnum++) {
1059 if (test_bit(ifnum, &ps->ifclaimed))
1060 releaseintf(ps, ifnum);
1061 }
1062 destroy_all_async(ps);
1063 usb_autosuspend_device(dev);
1064 usb_unlock_device(dev);
1065 usb_put_dev(dev);
1066 put_pid(ps->disc_pid);
1067 put_cred(ps->cred);
1068
1069 as = async_getcompleted(ps);
1070 while (as) {
1071 free_async(as);
1072 as = async_getcompleted(ps);
1073 }
1074
1075 kfree(ps);
1076 return 0;
1077 }
1078
1079 static int proc_control(struct usb_dev_state *ps, void __user *arg)
1080 {
1081 struct usb_device *dev = ps->dev;
1082 struct usbdevfs_ctrltransfer ctrl;
1083 unsigned int tmo;
1084 unsigned char *tbuf;
1085 unsigned wLength;
1086 int i, pipe, ret;
1087
1088 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
1089 return -EFAULT;
1090 ret = check_ctrlrecip(ps, ctrl.bRequestType, ctrl.bRequest,
1091 ctrl.wIndex);
1092 if (ret)
1093 return ret;
1094 wLength = ctrl.wLength; /* To suppress 64k PAGE_SIZE warning */
1095 if (wLength > PAGE_SIZE)
1096 return -EINVAL;
1097 ret = usbfs_increase_memory_usage(PAGE_SIZE + sizeof(struct urb) +
1098 sizeof(struct usb_ctrlrequest));
1099 if (ret)
1100 return ret;
1101 tbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
1102 if (!tbuf) {
1103 ret = -ENOMEM;
1104 goto done;
1105 }
1106 tmo = ctrl.timeout;
1107 snoop(&dev->dev, "control urb: bRequestType=%02x "
1108 "bRequest=%02x wValue=%04x "
1109 "wIndex=%04x wLength=%04x\n",
1110 ctrl.bRequestType, ctrl.bRequest, ctrl.wValue,
1111 ctrl.wIndex, ctrl.wLength);
1112 if (ctrl.bRequestType & 0x80) {
1113 if (ctrl.wLength && !access_ok(VERIFY_WRITE, ctrl.data,
1114 ctrl.wLength)) {
1115 ret = -EINVAL;
1116 goto done;
1117 }
1118 pipe = usb_rcvctrlpipe(dev, 0);
1119 snoop_urb(dev, NULL, pipe, ctrl.wLength, tmo, SUBMIT, NULL, 0);
1120
1121 usb_unlock_device(dev);
1122 i = usb_control_msg(dev, pipe, ctrl.bRequest,
1123 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
1124 tbuf, ctrl.wLength, tmo);
1125 usb_lock_device(dev);
1126 snoop_urb(dev, NULL, pipe, max(i, 0), min(i, 0), COMPLETE,
1127 tbuf, max(i, 0));
1128 if ((i > 0) && ctrl.wLength) {
1129 if (copy_to_user(ctrl.data, tbuf, i)) {
1130 ret = -EFAULT;
1131 goto done;
1132 }
1133 }
1134 } else {
1135 if (ctrl.wLength) {
1136 if (copy_from_user(tbuf, ctrl.data, ctrl.wLength)) {
1137 ret = -EFAULT;
1138 goto done;
1139 }
1140 }
1141 pipe = usb_sndctrlpipe(dev, 0);
1142 snoop_urb(dev, NULL, pipe, ctrl.wLength, tmo, SUBMIT,
1143 tbuf, ctrl.wLength);
1144
1145 usb_unlock_device(dev);
1146 i = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ctrl.bRequest,
1147 ctrl.bRequestType, ctrl.wValue, ctrl.wIndex,
1148 tbuf, ctrl.wLength, tmo);
1149 usb_lock_device(dev);
1150 snoop_urb(dev, NULL, pipe, max(i, 0), min(i, 0), COMPLETE, NULL, 0);
1151 }
1152 if (i < 0 && i != -EPIPE) {
1153 dev_printk(KERN_DEBUG, &dev->dev, "usbfs: USBDEVFS_CONTROL "
1154 "failed cmd %s rqt %u rq %u len %u ret %d\n",
1155 current->comm, ctrl.bRequestType, ctrl.bRequest,
1156 ctrl.wLength, i);
1157 }
1158 ret = i;
1159 done:
1160 free_page((unsigned long) tbuf);
1161 usbfs_decrease_memory_usage(PAGE_SIZE + sizeof(struct urb) +
1162 sizeof(struct usb_ctrlrequest));
1163 return ret;
1164 }
1165
1166 static int proc_bulk(struct usb_dev_state *ps, void __user *arg)
1167 {
1168 struct usb_device *dev = ps->dev;
1169 struct usbdevfs_bulktransfer bulk;
1170 unsigned int tmo, len1, pipe;
1171 int len2;
1172 unsigned char *tbuf;
1173 int i, ret;
1174
1175 if (copy_from_user(&bulk, arg, sizeof(bulk)))
1176 return -EFAULT;
1177 ret = findintfep(ps->dev, bulk.ep);
1178 if (ret < 0)
1179 return ret;
1180 ret = checkintf(ps, ret);
1181 if (ret)
1182 return ret;
1183 if (bulk.ep & USB_DIR_IN)
1184 pipe = usb_rcvbulkpipe(dev, bulk.ep & 0x7f);
1185 else
1186 pipe = usb_sndbulkpipe(dev, bulk.ep & 0x7f);
1187 if (!usb_maxpacket(dev, pipe, !(bulk.ep & USB_DIR_IN)))
1188 return -EINVAL;
1189 len1 = bulk.len;
1190 if (len1 >= (INT_MAX - sizeof(struct urb)))
1191 return -EINVAL;
1192 ret = usbfs_increase_memory_usage(len1 + sizeof(struct urb));
1193 if (ret)
1194 return ret;
1195 tbuf = kmalloc(len1, GFP_KERNEL);
1196 if (!tbuf) {
1197 ret = -ENOMEM;
1198 goto done;
1199 }
1200 tmo = bulk.timeout;
1201 if (bulk.ep & 0x80) {
1202 if (len1 && !access_ok(VERIFY_WRITE, bulk.data, len1)) {
1203 ret = -EINVAL;
1204 goto done;
1205 }
1206 snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, NULL, 0);
1207
1208 usb_unlock_device(dev);
1209 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
1210 usb_lock_device(dev);
1211 snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, tbuf, len2);
1212
1213 if (!i && len2) {
1214 if (copy_to_user(bulk.data, tbuf, len2)) {
1215 ret = -EFAULT;
1216 goto done;
1217 }
1218 }
1219 } else {
1220 if (len1) {
1221 if (copy_from_user(tbuf, bulk.data, len1)) {
1222 ret = -EFAULT;
1223 goto done;
1224 }
1225 }
1226 snoop_urb(dev, NULL, pipe, len1, tmo, SUBMIT, tbuf, len1);
1227
1228 usb_unlock_device(dev);
1229 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
1230 usb_lock_device(dev);
1231 snoop_urb(dev, NULL, pipe, len2, i, COMPLETE, NULL, 0);
1232 }
1233 ret = (i < 0 ? i : len2);
1234 done:
1235 kfree(tbuf);
1236 usbfs_decrease_memory_usage(len1 + sizeof(struct urb));
1237 return ret;
1238 }
1239
1240 static void check_reset_of_active_ep(struct usb_device *udev,
1241 unsigned int epnum, char *ioctl_name)
1242 {
1243 struct usb_host_endpoint **eps;
1244 struct usb_host_endpoint *ep;
1245
1246 eps = (epnum & USB_DIR_IN) ? udev->ep_in : udev->ep_out;
1247 ep = eps[epnum & 0x0f];
1248 if (ep && !list_empty(&ep->urb_list))
1249 dev_warn(&udev->dev, "Process %d (%s) called USBDEVFS_%s for active endpoint 0x%02x\n",
1250 task_pid_nr(current), current->comm,
1251 ioctl_name, epnum);
1252 }
1253
1254 static int proc_resetep(struct usb_dev_state *ps, void __user *arg)
1255 {
1256 unsigned int ep;
1257 int ret;
1258
1259 if (get_user(ep, (unsigned int __user *)arg))
1260 return -EFAULT;
1261 ret = findintfep(ps->dev, ep);
1262 if (ret < 0)
1263 return ret;
1264 ret = checkintf(ps, ret);
1265 if (ret)
1266 return ret;
1267 check_reset_of_active_ep(ps->dev, ep, "RESETEP");
1268 usb_reset_endpoint(ps->dev, ep);
1269 return 0;
1270 }
1271
1272 static int proc_clearhalt(struct usb_dev_state *ps, void __user *arg)
1273 {
1274 unsigned int ep;
1275 int pipe;
1276 int ret;
1277
1278 if (get_user(ep, (unsigned int __user *)arg))
1279 return -EFAULT;
1280 ret = findintfep(ps->dev, ep);
1281 if (ret < 0)
1282 return ret;
1283 ret = checkintf(ps, ret);
1284 if (ret)
1285 return ret;
1286 check_reset_of_active_ep(ps->dev, ep, "CLEAR_HALT");
1287 if (ep & USB_DIR_IN)
1288 pipe = usb_rcvbulkpipe(ps->dev, ep & 0x7f);
1289 else
1290 pipe = usb_sndbulkpipe(ps->dev, ep & 0x7f);
1291
1292 return usb_clear_halt(ps->dev, pipe);
1293 }
1294
1295 static int proc_getdriver(struct usb_dev_state *ps, void __user *arg)
1296 {
1297 struct usbdevfs_getdriver gd;
1298 struct usb_interface *intf;
1299 int ret;
1300
1301 if (copy_from_user(&gd, arg, sizeof(gd)))
1302 return -EFAULT;
1303 intf = usb_ifnum_to_if(ps->dev, gd.interface);
1304 if (!intf || !intf->dev.driver)
1305 ret = -ENODATA;
1306 else {
1307 strlcpy(gd.driver, intf->dev.driver->name,
1308 sizeof(gd.driver));
1309 ret = (copy_to_user(arg, &gd, sizeof(gd)) ? -EFAULT : 0);
1310 }
1311 return ret;
1312 }
1313
1314 static int proc_connectinfo(struct usb_dev_state *ps, void __user *arg)
1315 {
1316 struct usbdevfs_connectinfo ci;
1317
1318 memset(&ci, 0, sizeof(ci));
1319 ci.devnum = ps->dev->devnum;
1320 ci.slow = ps->dev->speed == USB_SPEED_LOW;
1321
1322 if (copy_to_user(arg, &ci, sizeof(ci)))
1323 return -EFAULT;
1324 return 0;
1325 }
1326
1327 static int proc_resetdevice(struct usb_dev_state *ps)
1328 {
1329 struct usb_host_config *actconfig = ps->dev->actconfig;
1330 struct usb_interface *interface;
1331 int i, number;
1332
1333 /* Don't allow a device reset if the process has dropped the
1334 * privilege to do such things and any of the interfaces are
1335 * currently claimed.
1336 */
1337 if (ps->privileges_dropped && actconfig) {
1338 for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
1339 interface = actconfig->interface[i];
1340 number = interface->cur_altsetting->desc.bInterfaceNumber;
1341 if (usb_interface_claimed(interface) &&
1342 !test_bit(number, &ps->ifclaimed)) {
1343 dev_warn(&ps->dev->dev,
1344 "usbfs: interface %d claimed by %s while '%s' resets device\n",
1345 number, interface->dev.driver->name, current->comm);
1346 return -EACCES;
1347 }
1348 }
1349 }
1350
1351 return usb_reset_device(ps->dev);
1352 }
1353
1354 static int proc_setintf(struct usb_dev_state *ps, void __user *arg)
1355 {
1356 struct usbdevfs_setinterface setintf;
1357 int ret;
1358
1359 if (copy_from_user(&setintf, arg, sizeof(setintf)))
1360 return -EFAULT;
1361 ret = checkintf(ps, setintf.interface);
1362 if (ret)
1363 return ret;
1364
1365 destroy_async_on_interface(ps, setintf.interface);
1366
1367 return usb_set_interface(ps->dev, setintf.interface,
1368 setintf.altsetting);
1369 }
1370
1371 static int proc_setconfig(struct usb_dev_state *ps, void __user *arg)
1372 {
1373 int u;
1374 int status = 0;
1375 struct usb_host_config *actconfig;
1376
1377 if (get_user(u, (int __user *)arg))
1378 return -EFAULT;
1379
1380 actconfig = ps->dev->actconfig;
1381
1382 /* Don't touch the device if any interfaces are claimed.
1383 * It could interfere with other drivers' operations, and if
1384 * an interface is claimed by usbfs it could easily deadlock.
1385 */
1386 if (actconfig) {
1387 int i;
1388
1389 for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
1390 if (usb_interface_claimed(actconfig->interface[i])) {
1391 dev_warn(&ps->dev->dev,
1392 "usbfs: interface %d claimed by %s "
1393 "while '%s' sets config #%d\n",
1394 actconfig->interface[i]
1395 ->cur_altsetting
1396 ->desc.bInterfaceNumber,
1397 actconfig->interface[i]
1398 ->dev.driver->name,
1399 current->comm, u);
1400 status = -EBUSY;
1401 break;
1402 }
1403 }
1404 }
1405
1406 /* SET_CONFIGURATION is often abused as a "cheap" driver reset,
1407 * so avoid usb_set_configuration()'s kick to sysfs
1408 */
1409 if (status == 0) {
1410 if (actconfig && actconfig->desc.bConfigurationValue == u)
1411 status = usb_reset_configuration(ps->dev);
1412 else
1413 status = usb_set_configuration(ps->dev, u);
1414 }
1415
1416 return status;
1417 }
1418
1419 static struct usb_memory *
1420 find_memory_area(struct usb_dev_state *ps, const struct usbdevfs_urb *uurb)
1421 {
1422 struct usb_memory *usbm = NULL, *iter;
1423 unsigned long flags;
1424 unsigned long uurb_start = (unsigned long)uurb->buffer;
1425
1426 spin_lock_irqsave(&ps->lock, flags);
1427 list_for_each_entry(iter, &ps->memory_list, memlist) {
1428 if (uurb_start >= iter->vm_start &&
1429 uurb_start < iter->vm_start + iter->size) {
1430 if (uurb->buffer_length > iter->vm_start + iter->size -
1431 uurb_start) {
1432 usbm = ERR_PTR(-EINVAL);
1433 } else {
1434 usbm = iter;
1435 usbm->urb_use_count++;
1436 }
1437 break;
1438 }
1439 }
1440 spin_unlock_irqrestore(&ps->lock, flags);
1441 return usbm;
1442 }
1443
1444 static int proc_do_submiturb(struct usb_dev_state *ps, struct usbdevfs_urb *uurb,
1445 struct usbdevfs_iso_packet_desc __user *iso_frame_desc,
1446 void __user *arg)
1447 {
1448 struct usbdevfs_iso_packet_desc *isopkt = NULL;
1449 struct usb_host_endpoint *ep;
1450 struct async *as = NULL;
1451 struct usb_ctrlrequest *dr = NULL;
1452 unsigned int u, totlen, isofrmlen;
1453 int i, ret, is_in, num_sgs = 0, ifnum = -1;
1454 int number_of_packets = 0;
1455 unsigned int stream_id = 0;
1456 void *buf;
1457 unsigned long mask = USBDEVFS_URB_SHORT_NOT_OK |
1458 USBDEVFS_URB_BULK_CONTINUATION |
1459 USBDEVFS_URB_NO_FSBR |
1460 USBDEVFS_URB_ZERO_PACKET |
1461 USBDEVFS_URB_NO_INTERRUPT;
1462 /* USBDEVFS_URB_ISO_ASAP is a special case */
1463 if (uurb->type == USBDEVFS_URB_TYPE_ISO)
1464 mask |= USBDEVFS_URB_ISO_ASAP;
1465
1466 if (uurb->flags & ~mask)
1467 return -EINVAL;
1468
1469 if ((unsigned int)uurb->buffer_length >= USBFS_XFER_MAX)
1470 return -EINVAL;
1471 if (uurb->buffer_length > 0 && !uurb->buffer)
1472 return -EINVAL;
1473 if (!(uurb->type == USBDEVFS_URB_TYPE_CONTROL &&
1474 (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) == 0)) {
1475 ifnum = findintfep(ps->dev, uurb->endpoint);
1476 if (ifnum < 0)
1477 return ifnum;
1478 ret = checkintf(ps, ifnum);
1479 if (ret)
1480 return ret;
1481 }
1482 ep = ep_to_host_endpoint(ps->dev, uurb->endpoint);
1483 if (!ep)
1484 return -ENOENT;
1485 is_in = (uurb->endpoint & USB_ENDPOINT_DIR_MASK) != 0;
1486
1487 u = 0;
1488 switch (uurb->type) {
1489 case USBDEVFS_URB_TYPE_CONTROL:
1490 if (!usb_endpoint_xfer_control(&ep->desc))
1491 return -EINVAL;
1492 /* min 8 byte setup packet */
1493 if (uurb->buffer_length < 8)
1494 return -EINVAL;
1495 dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL);
1496 if (!dr)
1497 return -ENOMEM;
1498 if (copy_from_user(dr, uurb->buffer, 8)) {
1499 ret = -EFAULT;
1500 goto error;
1501 }
1502 if (uurb->buffer_length < (le16_to_cpup(&dr->wLength) + 8)) {
1503 ret = -EINVAL;
1504 goto error;
1505 }
1506 ret = check_ctrlrecip(ps, dr->bRequestType, dr->bRequest,
1507 le16_to_cpup(&dr->wIndex));
1508 if (ret)
1509 goto error;
1510 uurb->buffer_length = le16_to_cpup(&dr->wLength);
1511 uurb->buffer += 8;
1512 if ((dr->bRequestType & USB_DIR_IN) && uurb->buffer_length) {
1513 is_in = 1;
1514 uurb->endpoint |= USB_DIR_IN;
1515 } else {
1516 is_in = 0;
1517 uurb->endpoint &= ~USB_DIR_IN;
1518 }
1519 snoop(&ps->dev->dev, "control urb: bRequestType=%02x "
1520 "bRequest=%02x wValue=%04x "
1521 "wIndex=%04x wLength=%04x\n",
1522 dr->bRequestType, dr->bRequest,
1523 __le16_to_cpup(&dr->wValue),
1524 __le16_to_cpup(&dr->wIndex),
1525 __le16_to_cpup(&dr->wLength));
1526 u = sizeof(struct usb_ctrlrequest);
1527 break;
1528
1529 case USBDEVFS_URB_TYPE_BULK:
1530 switch (usb_endpoint_type(&ep->desc)) {
1531 case USB_ENDPOINT_XFER_CONTROL:
1532 case USB_ENDPOINT_XFER_ISOC:
1533 return -EINVAL;
1534 case USB_ENDPOINT_XFER_INT:
1535 /* allow single-shot interrupt transfers */
1536 uurb->type = USBDEVFS_URB_TYPE_INTERRUPT;
1537 goto interrupt_urb;
1538 }
1539 num_sgs = DIV_ROUND_UP(uurb->buffer_length, USB_SG_SIZE);
1540 if (num_sgs == 1 || num_sgs > ps->dev->bus->sg_tablesize)
1541 num_sgs = 0;
1542 if (ep->streams)
1543 stream_id = uurb->stream_id;
1544 break;
1545
1546 case USBDEVFS_URB_TYPE_INTERRUPT:
1547 if (!usb_endpoint_xfer_int(&ep->desc))
1548 return -EINVAL;
1549 interrupt_urb:
1550 break;
1551
1552 case USBDEVFS_URB_TYPE_ISO:
1553 /* arbitrary limit */
1554 if (uurb->number_of_packets < 1 ||
1555 uurb->number_of_packets > 128)
1556 return -EINVAL;
1557 if (!usb_endpoint_xfer_isoc(&ep->desc))
1558 return -EINVAL;
1559 number_of_packets = uurb->number_of_packets;
1560 isofrmlen = sizeof(struct usbdevfs_iso_packet_desc) *
1561 number_of_packets;
1562 isopkt = memdup_user(iso_frame_desc, isofrmlen);
1563 if (IS_ERR(isopkt)) {
1564 ret = PTR_ERR(isopkt);
1565 isopkt = NULL;
1566 goto error;
1567 }
1568 for (totlen = u = 0; u < number_of_packets; u++) {
1569 /*
1570 * arbitrary limit need for USB 3.0
1571 * bMaxBurst (0~15 allowed, 1~16 packets)
1572 * bmAttributes (bit 1:0, mult 0~2, 1~3 packets)
1573 * sizemax: 1024 * 16 * 3 = 49152
1574 */
1575 if (isopkt[u].length > 49152) {
1576 ret = -EINVAL;
1577 goto error;
1578 }
1579 totlen += isopkt[u].length;
1580 }
1581 u *= sizeof(struct usb_iso_packet_descriptor);
1582 uurb->buffer_length = totlen;
1583 break;
1584
1585 default:
1586 return -EINVAL;
1587 }
1588
1589 if (uurb->buffer_length > 0 &&
1590 !access_ok(is_in ? VERIFY_WRITE : VERIFY_READ,
1591 uurb->buffer, uurb->buffer_length)) {
1592 ret = -EFAULT;
1593 goto error;
1594 }
1595 as = alloc_async(number_of_packets);
1596 if (!as) {
1597 ret = -ENOMEM;
1598 goto error;
1599 }
1600
1601 as->usbm = find_memory_area(ps, uurb);
1602 if (IS_ERR(as->usbm)) {
1603 ret = PTR_ERR(as->usbm);
1604 as->usbm = NULL;
1605 goto error;
1606 }
1607
1608 /* do not use SG buffers when memory mapped segments
1609 * are in use
1610 */
1611 if (as->usbm)
1612 num_sgs = 0;
1613
1614 u += sizeof(struct async) + sizeof(struct urb) + uurb->buffer_length +
1615 num_sgs * sizeof(struct scatterlist);
1616 ret = usbfs_increase_memory_usage(u);
1617 if (ret)
1618 goto error;
1619 as->mem_usage = u;
1620
1621 if (num_sgs) {
1622 as->urb->sg = kmalloc(num_sgs * sizeof(struct scatterlist),
1623 GFP_KERNEL);
1624 if (!as->urb->sg) {
1625 ret = -ENOMEM;
1626 goto error;
1627 }
1628 as->urb->num_sgs = num_sgs;
1629 sg_init_table(as->urb->sg, as->urb->num_sgs);
1630
1631 totlen = uurb->buffer_length;
1632 for (i = 0; i < as->urb->num_sgs; i++) {
1633 u = (totlen > USB_SG_SIZE) ? USB_SG_SIZE : totlen;
1634 buf = kmalloc(u, GFP_KERNEL);
1635 if (!buf) {
1636 ret = -ENOMEM;
1637 goto error;
1638 }
1639 sg_set_buf(&as->urb->sg[i], buf, u);
1640
1641 if (!is_in) {
1642 if (copy_from_user(buf, uurb->buffer, u)) {
1643 ret = -EFAULT;
1644 goto error;
1645 }
1646 uurb->buffer += u;
1647 }
1648 totlen -= u;
1649 }
1650 } else if (uurb->buffer_length > 0) {
1651 if (as->usbm) {
1652 unsigned long uurb_start = (unsigned long)uurb->buffer;
1653
1654 as->urb->transfer_buffer = as->usbm->mem +
1655 (uurb_start - as->usbm->vm_start);
1656 } else {
1657 as->urb->transfer_buffer = kmalloc(uurb->buffer_length,
1658 GFP_KERNEL);
1659 if (!as->urb->transfer_buffer) {
1660 ret = -ENOMEM;
1661 goto error;
1662 }
1663 if (!is_in) {
1664 if (copy_from_user(as->urb->transfer_buffer,
1665 uurb->buffer,
1666 uurb->buffer_length)) {
1667 ret = -EFAULT;
1668 goto error;
1669 }
1670 } else if (uurb->type == USBDEVFS_URB_TYPE_ISO) {
1671 /*
1672 * Isochronous input data may end up being
1673 * discontiguous if some of the packets are
1674 * short. Clear the buffer so that the gaps
1675 * don't leak kernel data to userspace.
1676 */
1677 memset(as->urb->transfer_buffer, 0,
1678 uurb->buffer_length);
1679 }
1680 }
1681 }
1682 as->urb->dev = ps->dev;
1683 as->urb->pipe = (uurb->type << 30) |
1684 __create_pipe(ps->dev, uurb->endpoint & 0xf) |
1685 (uurb->endpoint & USB_DIR_IN);
1686
1687 /* This tedious sequence is necessary because the URB_* flags
1688 * are internal to the kernel and subject to change, whereas
1689 * the USBDEVFS_URB_* flags are a user API and must not be changed.
1690 */
1691 u = (is_in ? URB_DIR_IN : URB_DIR_OUT);
1692 if (uurb->flags & USBDEVFS_URB_ISO_ASAP)
1693 u |= URB_ISO_ASAP;
1694 if (uurb->flags & USBDEVFS_URB_SHORT_NOT_OK && is_in)
1695 u |= URB_SHORT_NOT_OK;
1696 if (uurb->flags & USBDEVFS_URB_NO_FSBR)
1697 u |= URB_NO_FSBR;
1698 if (uurb->flags & USBDEVFS_URB_ZERO_PACKET)
1699 u |= URB_ZERO_PACKET;
1700 if (uurb->flags & USBDEVFS_URB_NO_INTERRUPT)
1701 u |= URB_NO_INTERRUPT;
1702 as->urb->transfer_flags = u;
1703
1704 as->urb->transfer_buffer_length = uurb->buffer_length;
1705 as->urb->setup_packet = (unsigned char *)dr;
1706 dr = NULL;
1707 as->urb->start_frame = uurb->start_frame;
1708 as->urb->number_of_packets = number_of_packets;
1709 as->urb->stream_id = stream_id;
1710
1711 if (ep->desc.bInterval) {
1712 if (uurb->type == USBDEVFS_URB_TYPE_ISO ||
1713 ps->dev->speed == USB_SPEED_HIGH ||
1714 ps->dev->speed >= USB_SPEED_SUPER)
1715 as->urb->interval = 1 <<
1716 min(15, ep->desc.bInterval - 1);
1717 else
1718 as->urb->interval = ep->desc.bInterval;
1719 }
1720
1721 as->urb->context = as;
1722 as->urb->complete = async_completed;
1723 for (totlen = u = 0; u < number_of_packets; u++) {
1724 as->urb->iso_frame_desc[u].offset = totlen;
1725 as->urb->iso_frame_desc[u].length = isopkt[u].length;
1726 totlen += isopkt[u].length;
1727 }
1728 kfree(isopkt);
1729 isopkt = NULL;
1730 as->ps = ps;
1731 as->userurb = arg;
1732 if (as->usbm) {
1733 unsigned long uurb_start = (unsigned long)uurb->buffer;
1734
1735 as->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
1736 as->urb->transfer_dma = as->usbm->dma_handle +
1737 (uurb_start - as->usbm->vm_start);
1738 } else if (is_in && uurb->buffer_length > 0)
1739 as->userbuffer = uurb->buffer;
1740 as->signr = uurb->signr;
1741 as->ifnum = ifnum;
1742 as->pid = get_pid(task_pid(current));
1743 as->cred = get_current_cred();
1744 security_task_getsecid(current, &as->secid);
1745 snoop_urb(ps->dev, as->userurb, as->urb->pipe,
1746 as->urb->transfer_buffer_length, 0, SUBMIT,
1747 NULL, 0);
1748 if (!is_in)
1749 snoop_urb_data(as->urb, as->urb->transfer_buffer_length);
1750
1751 async_newpending(as);
1752
1753 if (usb_endpoint_xfer_bulk(&ep->desc)) {
1754 spin_lock_irq(&ps->lock);
1755
1756 /* Not exactly the endpoint address; the direction bit is
1757 * shifted to the 0x10 position so that the value will be
1758 * between 0 and 31.
1759 */
1760 as->bulk_addr = usb_endpoint_num(&ep->desc) |
1761 ((ep->desc.bEndpointAddress & USB_ENDPOINT_DIR_MASK)
1762 >> 3);
1763
1764 /* If this bulk URB is the start of a new transfer, re-enable
1765 * the endpoint. Otherwise mark it as a continuation URB.
1766 */
1767 if (uurb->flags & USBDEVFS_URB_BULK_CONTINUATION)
1768 as->bulk_status = AS_CONTINUATION;
1769 else
1770 ps->disabled_bulk_eps &= ~(1 << as->bulk_addr);
1771
1772 /* Don't accept continuation URBs if the endpoint is
1773 * disabled because of an earlier error.
1774 */
1775 if (ps->disabled_bulk_eps & (1 << as->bulk_addr))
1776 ret = -EREMOTEIO;
1777 else
1778 ret = usb_submit_urb(as->urb, GFP_ATOMIC);
1779 spin_unlock_irq(&ps->lock);
1780 } else {
1781 ret = usb_submit_urb(as->urb, GFP_KERNEL);
1782 }
1783
1784 if (ret) {
1785 dev_printk(KERN_DEBUG, &ps->dev->dev,
1786 "usbfs: usb_submit_urb returned %d\n", ret);
1787 snoop_urb(ps->dev, as->userurb, as->urb->pipe,
1788 0, ret, COMPLETE, NULL, 0);
1789 async_removepending(as);
1790 goto error;
1791 }
1792 return 0;
1793
1794 error:
1795 if (as && as->usbm)
1796 dec_usb_memory_use_count(as->usbm, &as->usbm->urb_use_count);
1797 kfree(isopkt);
1798 kfree(dr);
1799 if (as)
1800 free_async(as);
1801 return ret;
1802 }
1803
1804 static int proc_submiturb(struct usb_dev_state *ps, void __user *arg)
1805 {
1806 struct usbdevfs_urb uurb;
1807
1808 if (copy_from_user(&uurb, arg, sizeof(uurb)))
1809 return -EFAULT;
1810
1811 return proc_do_submiturb(ps, &uurb,
1812 (((struct usbdevfs_urb __user *)arg)->iso_frame_desc),
1813 arg);
1814 }
1815
1816 static int proc_unlinkurb(struct usb_dev_state *ps, void __user *arg)
1817 {
1818 struct urb *urb;
1819 struct async *as;
1820 unsigned long flags;
1821
1822 spin_lock_irqsave(&ps->lock, flags);
1823 as = async_getpending(ps, arg);
1824 if (!as) {
1825 spin_unlock_irqrestore(&ps->lock, flags);
1826 return -EINVAL;
1827 }
1828
1829 urb = as->urb;
1830 usb_get_urb(urb);
1831 spin_unlock_irqrestore(&ps->lock, flags);
1832
1833 usb_kill_urb(urb);
1834 usb_put_urb(urb);
1835
1836 return 0;
1837 }
1838
1839 static void compute_isochronous_actual_length(struct urb *urb)
1840 {
1841 unsigned int i;
1842
1843 if (urb->number_of_packets > 0) {
1844 urb->actual_length = 0;
1845 for (i = 0; i < urb->number_of_packets; i++)
1846 urb->actual_length +=
1847 urb->iso_frame_desc[i].actual_length;
1848 }
1849 }
1850
1851 static int processcompl(struct async *as, void __user * __user *arg)
1852 {
1853 struct urb *urb = as->urb;
1854 struct usbdevfs_urb __user *userurb = as->userurb;
1855 void __user *addr = as->userurb;
1856 unsigned int i;
1857
1858 compute_isochronous_actual_length(urb);
1859 if (as->userbuffer && urb->actual_length) {
1860 if (copy_urb_data_to_user(as->userbuffer, urb))
1861 goto err_out;
1862 }
1863 if (put_user(as->status, &userurb->status))
1864 goto err_out;
1865 if (put_user(urb->actual_length, &userurb->actual_length))
1866 goto err_out;
1867 if (put_user(urb->error_count, &userurb->error_count))
1868 goto err_out;
1869
1870 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
1871 for (i = 0; i < urb->number_of_packets; i++) {
1872 if (put_user(urb->iso_frame_desc[i].actual_length,
1873 &userurb->iso_frame_desc[i].actual_length))
1874 goto err_out;
1875 if (put_user(urb->iso_frame_desc[i].status,
1876 &userurb->iso_frame_desc[i].status))
1877 goto err_out;
1878 }
1879 }
1880
1881 if (put_user(addr, (void __user * __user *)arg))
1882 return -EFAULT;
1883 return 0;
1884
1885 err_out:
1886 return -EFAULT;
1887 }
1888
1889 static struct async *reap_as(struct usb_dev_state *ps)
1890 {
1891 DECLARE_WAITQUEUE(wait, current);
1892 struct async *as = NULL;
1893 struct usb_device *dev = ps->dev;
1894
1895 add_wait_queue(&ps->wait, &wait);
1896 for (;;) {
1897 __set_current_state(TASK_INTERRUPTIBLE);
1898 as = async_getcompleted(ps);
1899 if (as || !connected(ps))
1900 break;
1901 if (signal_pending(current))
1902 break;
1903 usb_unlock_device(dev);
1904 schedule();
1905 usb_lock_device(dev);
1906 }
1907 remove_wait_queue(&ps->wait, &wait);
1908 set_current_state(TASK_RUNNING);
1909 return as;
1910 }
1911
1912 static int proc_reapurb(struct usb_dev_state *ps, void __user *arg)
1913 {
1914 struct async *as = reap_as(ps);
1915
1916 if (as) {
1917 int retval;
1918
1919 snoop(&ps->dev->dev, "reap %pK\n", as->userurb);
1920 retval = processcompl(as, (void __user * __user *)arg);
1921 free_async(as);
1922 return retval;
1923 }
1924 if (signal_pending(current))
1925 return -EINTR;
1926 return -ENODEV;
1927 }
1928
1929 static int proc_reapurbnonblock(struct usb_dev_state *ps, void __user *arg)
1930 {
1931 int retval;
1932 struct async *as;
1933
1934 as = async_getcompleted(ps);
1935 if (as) {
1936 snoop(&ps->dev->dev, "reap %pK\n", as->userurb);
1937 retval = processcompl(as, (void __user * __user *)arg);
1938 free_async(as);
1939 } else {
1940 retval = (connected(ps) ? -EAGAIN : -ENODEV);
1941 }
1942 return retval;
1943 }
1944
1945 #ifdef CONFIG_COMPAT
1946 static int proc_control_compat(struct usb_dev_state *ps,
1947 struct usbdevfs_ctrltransfer32 __user *p32)
1948 {
1949 struct usbdevfs_ctrltransfer __user *p;
1950 __u32 udata;
1951 p = compat_alloc_user_space(sizeof(*p));
1952 if (copy_in_user(p, p32, (sizeof(*p32) - sizeof(compat_caddr_t))) ||
1953 get_user(udata, &p32->data) ||
1954 put_user(compat_ptr(udata), &p->data))
1955 return -EFAULT;
1956 return proc_control(ps, p);
1957 }
1958
1959 static int proc_bulk_compat(struct usb_dev_state *ps,
1960 struct usbdevfs_bulktransfer32 __user *p32)
1961 {
1962 struct usbdevfs_bulktransfer __user *p;
1963 compat_uint_t n;
1964 compat_caddr_t addr;
1965
1966 p = compat_alloc_user_space(sizeof(*p));
1967
1968 if (get_user(n, &p32->ep) || put_user(n, &p->ep) ||
1969 get_user(n, &p32->len) || put_user(n, &p->len) ||
1970 get_user(n, &p32->timeout) || put_user(n, &p->timeout) ||
1971 get_user(addr, &p32->data) || put_user(compat_ptr(addr), &p->data))
1972 return -EFAULT;
1973
1974 return proc_bulk(ps, p);
1975 }
1976 static int proc_disconnectsignal_compat(struct usb_dev_state *ps, void __user *arg)
1977 {
1978 struct usbdevfs_disconnectsignal32 ds;
1979
1980 if (copy_from_user(&ds, arg, sizeof(ds)))
1981 return -EFAULT;
1982 ps->discsignr = ds.signr;
1983 ps->disccontext = compat_ptr(ds.context);
1984 return 0;
1985 }
1986
1987 static int get_urb32(struct usbdevfs_urb *kurb,
1988 struct usbdevfs_urb32 __user *uurb)
1989 {
1990 __u32 uptr;
1991 if (!access_ok(VERIFY_READ, uurb, sizeof(*uurb)) ||
1992 __get_user(kurb->type, &uurb->type) ||
1993 __get_user(kurb->endpoint, &uurb->endpoint) ||
1994 __get_user(kurb->status, &uurb->status) ||
1995 __get_user(kurb->flags, &uurb->flags) ||
1996 __get_user(kurb->buffer_length, &uurb->buffer_length) ||
1997 __get_user(kurb->actual_length, &uurb->actual_length) ||
1998 __get_user(kurb->start_frame, &uurb->start_frame) ||
1999 __get_user(kurb->number_of_packets, &uurb->number_of_packets) ||
2000 __get_user(kurb->error_count, &uurb->error_count) ||
2001 __get_user(kurb->signr, &uurb->signr))
2002 return -EFAULT;
2003
2004 if (__get_user(uptr, &uurb->buffer))
2005 return -EFAULT;
2006 kurb->buffer = compat_ptr(uptr);
2007 if (__get_user(uptr, &uurb->usercontext))
2008 return -EFAULT;
2009 kurb->usercontext = compat_ptr(uptr);
2010
2011 return 0;
2012 }
2013
2014 static int proc_submiturb_compat(struct usb_dev_state *ps, void __user *arg)
2015 {
2016 struct usbdevfs_urb uurb;
2017
2018 if (get_urb32(&uurb, (struct usbdevfs_urb32 __user *)arg))
2019 return -EFAULT;
2020
2021 return proc_do_submiturb(ps, &uurb,
2022 ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc,
2023 arg);
2024 }
2025
2026 static int processcompl_compat(struct async *as, void __user * __user *arg)
2027 {
2028 struct urb *urb = as->urb;
2029 struct usbdevfs_urb32 __user *userurb = as->userurb;
2030 void __user *addr = as->userurb;
2031 unsigned int i;
2032
2033 compute_isochronous_actual_length(urb);
2034 if (as->userbuffer && urb->actual_length) {
2035 if (copy_urb_data_to_user(as->userbuffer, urb))
2036 return -EFAULT;
2037 }
2038 if (put_user(as->status, &userurb->status))
2039 return -EFAULT;
2040 if (put_user(urb->actual_length, &userurb->actual_length))
2041 return -EFAULT;
2042 if (put_user(urb->error_count, &userurb->error_count))
2043 return -EFAULT;
2044
2045 if (usb_endpoint_xfer_isoc(&urb->ep->desc)) {
2046 for (i = 0; i < urb->number_of_packets; i++) {
2047 if (put_user(urb->iso_frame_desc[i].actual_length,
2048 &userurb->iso_frame_desc[i].actual_length))
2049 return -EFAULT;
2050 if (put_user(urb->iso_frame_desc[i].status,
2051 &userurb->iso_frame_desc[i].status))
2052 return -EFAULT;
2053 }
2054 }
2055
2056 if (put_user(ptr_to_compat(addr), (u32 __user *)arg))
2057 return -EFAULT;
2058 return 0;
2059 }
2060
2061 static int proc_reapurb_compat(struct usb_dev_state *ps, void __user *arg)
2062 {
2063 struct async *as = reap_as(ps);
2064
2065 if (as) {
2066 int retval;
2067
2068 snoop(&ps->dev->dev, "reap %pK\n", as->userurb);
2069 retval = processcompl_compat(as, (void __user * __user *)arg);
2070 free_async(as);
2071 return retval;
2072 }
2073 if (signal_pending(current))
2074 return -EINTR;
2075 return -ENODEV;
2076 }
2077
2078 static int proc_reapurbnonblock_compat(struct usb_dev_state *ps, void __user *arg)
2079 {
2080 int retval;
2081 struct async *as;
2082
2083 as = async_getcompleted(ps);
2084 if (as) {
2085 snoop(&ps->dev->dev, "reap %pK\n", as->userurb);
2086 retval = processcompl_compat(as, (void __user * __user *)arg);
2087 free_async(as);
2088 } else {
2089 retval = (connected(ps) ? -EAGAIN : -ENODEV);
2090 }
2091 return retval;
2092 }
2093
2094
2095 #endif
2096
2097 static int proc_disconnectsignal(struct usb_dev_state *ps, void __user *arg)
2098 {
2099 struct usbdevfs_disconnectsignal ds;
2100
2101 if (copy_from_user(&ds, arg, sizeof(ds)))
2102 return -EFAULT;
2103 ps->discsignr = ds.signr;
2104 ps->disccontext = ds.context;
2105 return 0;
2106 }
2107
2108 static int proc_claiminterface(struct usb_dev_state *ps, void __user *arg)
2109 {
2110 unsigned int ifnum;
2111
2112 if (get_user(ifnum, (unsigned int __user *)arg))
2113 return -EFAULT;
2114 return claimintf(ps, ifnum);
2115 }
2116
2117 static int proc_releaseinterface(struct usb_dev_state *ps, void __user *arg)
2118 {
2119 unsigned int ifnum;
2120 int ret;
2121
2122 if (get_user(ifnum, (unsigned int __user *)arg))
2123 return -EFAULT;
2124 ret = releaseintf(ps, ifnum);
2125 if (ret < 0)
2126 return ret;
2127 destroy_async_on_interface(ps, ifnum);
2128 return 0;
2129 }
2130
2131 static int proc_ioctl(struct usb_dev_state *ps, struct usbdevfs_ioctl *ctl)
2132 {
2133 int size;
2134 void *buf = NULL;
2135 int retval = 0;
2136 struct usb_interface *intf = NULL;
2137 struct usb_driver *driver = NULL;
2138
2139 if (ps->privileges_dropped)
2140 return -EACCES;
2141
2142 /* alloc buffer */
2143 size = _IOC_SIZE(ctl->ioctl_code);
2144 if (size > 0) {
2145 buf = kmalloc(size, GFP_KERNEL);
2146 if (buf == NULL)
2147 return -ENOMEM;
2148 if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) {
2149 if (copy_from_user(buf, ctl->data, size)) {
2150 kfree(buf);
2151 return -EFAULT;
2152 }
2153 } else {
2154 memset(buf, 0, size);
2155 }
2156 }
2157
2158 if (!connected(ps)) {
2159 kfree(buf);
2160 return -ENODEV;
2161 }
2162
2163 if (ps->dev->state != USB_STATE_CONFIGURED)
2164 retval = -EHOSTUNREACH;
2165 else if (!(intf = usb_ifnum_to_if(ps->dev, ctl->ifno)))
2166 retval = -EINVAL;
2167 else switch (ctl->ioctl_code) {
2168
2169 /* disconnect kernel driver from interface */
2170 case USBDEVFS_DISCONNECT:
2171 if (intf->dev.driver) {
2172 driver = to_usb_driver(intf->dev.driver);
2173 dev_dbg(&intf->dev, "disconnect by usbfs\n");
2174 usb_driver_release_interface(driver, intf);
2175 } else
2176 retval = -ENODATA;
2177 break;
2178
2179 /* let kernel drivers try to (re)bind to the interface */
2180 case USBDEVFS_CONNECT:
2181 if (!intf->dev.driver)
2182 retval = device_attach(&intf->dev);
2183 else
2184 retval = -EBUSY;
2185 break;
2186
2187 /* talk directly to the interface's driver */
2188 default:
2189 if (intf->dev.driver)
2190 driver = to_usb_driver(intf->dev.driver);
2191 if (driver == NULL || driver->unlocked_ioctl == NULL) {
2192 retval = -ENOTTY;
2193 } else {
2194 retval = driver->unlocked_ioctl(intf, ctl->ioctl_code, buf);
2195 if (retval == -ENOIOCTLCMD)
2196 retval = -ENOTTY;
2197 }
2198 }
2199
2200 /* cleanup and return */
2201 if (retval >= 0
2202 && (_IOC_DIR(ctl->ioctl_code) & _IOC_READ) != 0
2203 && size > 0
2204 && copy_to_user(ctl->data, buf, size) != 0)
2205 retval = -EFAULT;
2206
2207 kfree(buf);
2208 return retval;
2209 }
2210
2211 static int proc_ioctl_default(struct usb_dev_state *ps, void __user *arg)
2212 {
2213 struct usbdevfs_ioctl ctrl;
2214
2215 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
2216 return -EFAULT;
2217 return proc_ioctl(ps, &ctrl);
2218 }
2219
2220 #ifdef CONFIG_COMPAT
2221 static int proc_ioctl_compat(struct usb_dev_state *ps, compat_uptr_t arg)
2222 {
2223 struct usbdevfs_ioctl32 __user *uioc;
2224 struct usbdevfs_ioctl ctrl;
2225 u32 udata;
2226
2227 uioc = compat_ptr((long)arg);
2228 if (!access_ok(VERIFY_READ, uioc, sizeof(*uioc)) ||
2229 __get_user(ctrl.ifno, &uioc->ifno) ||
2230 __get_user(ctrl.ioctl_code, &uioc->ioctl_code) ||
2231 __get_user(udata, &uioc->data))
2232 return -EFAULT;
2233 ctrl.data = compat_ptr(udata);
2234
2235 return proc_ioctl(ps, &ctrl);
2236 }
2237 #endif
2238
2239 static int proc_claim_port(struct usb_dev_state *ps, void __user *arg)
2240 {
2241 unsigned portnum;
2242 int rc;
2243
2244 if (get_user(portnum, (unsigned __user *) arg))
2245 return -EFAULT;
2246 rc = usb_hub_claim_port(ps->dev, portnum, ps);
2247 if (rc == 0)
2248 snoop(&ps->dev->dev, "port %d claimed by process %d: %s\n",
2249 portnum, task_pid_nr(current), current->comm);
2250 return rc;
2251 }
2252
2253 static int proc_release_port(struct usb_dev_state *ps, void __user *arg)
2254 {
2255 unsigned portnum;
2256
2257 if (get_user(portnum, (unsigned __user *) arg))
2258 return -EFAULT;
2259 return usb_hub_release_port(ps->dev, portnum, ps);
2260 }
2261
2262 static int proc_get_capabilities(struct usb_dev_state *ps, void __user *arg)
2263 {
2264 __u32 caps;
2265
2266 caps = USBDEVFS_CAP_ZERO_PACKET | USBDEVFS_CAP_NO_PACKET_SIZE_LIM |
2267 USBDEVFS_CAP_REAP_AFTER_DISCONNECT | USBDEVFS_CAP_MMAP |
2268 USBDEVFS_CAP_DROP_PRIVILEGES;
2269 if (!ps->dev->bus->no_stop_on_short)
2270 caps |= USBDEVFS_CAP_BULK_CONTINUATION;
2271 if (ps->dev->bus->sg_tablesize)
2272 caps |= USBDEVFS_CAP_BULK_SCATTER_GATHER;
2273
2274 if (put_user(caps, (__u32 __user *)arg))
2275 return -EFAULT;
2276
2277 return 0;
2278 }
2279
2280 static int proc_disconnect_claim(struct usb_dev_state *ps, void __user *arg)
2281 {
2282 struct usbdevfs_disconnect_claim dc;
2283 struct usb_interface *intf;
2284
2285 if (copy_from_user(&dc, arg, sizeof(dc)))
2286 return -EFAULT;
2287
2288 intf = usb_ifnum_to_if(ps->dev, dc.interface);
2289 if (!intf)
2290 return -EINVAL;
2291
2292 if (intf->dev.driver) {
2293 struct usb_driver *driver = to_usb_driver(intf->dev.driver);
2294
2295 if (ps->privileges_dropped)
2296 return -EACCES;
2297
2298 if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_IF_DRIVER) &&
2299 strncmp(dc.driver, intf->dev.driver->name,
2300 sizeof(dc.driver)) != 0)
2301 return -EBUSY;
2302
2303 if ((dc.flags & USBDEVFS_DISCONNECT_CLAIM_EXCEPT_DRIVER) &&
2304 strncmp(dc.driver, intf->dev.driver->name,
2305 sizeof(dc.driver)) == 0)
2306 return -EBUSY;
2307
2308 dev_dbg(&intf->dev, "disconnect by usbfs\n");
2309 usb_driver_release_interface(driver, intf);
2310 }
2311
2312 return claimintf(ps, dc.interface);
2313 }
2314
2315 static int proc_alloc_streams(struct usb_dev_state *ps, void __user *arg)
2316 {
2317 unsigned num_streams, num_eps;
2318 struct usb_host_endpoint **eps;
2319 struct usb_interface *intf;
2320 int r;
2321
2322 r = parse_usbdevfs_streams(ps, arg, &num_streams, &num_eps,
2323 &eps, &intf);
2324 if (r)
2325 return r;
2326
2327 destroy_async_on_interface(ps,
2328 intf->altsetting[0].desc.bInterfaceNumber);
2329
2330 r = usb_alloc_streams(intf, eps, num_eps, num_streams, GFP_KERNEL);
2331 kfree(eps);
2332 return r;
2333 }
2334
2335 static int proc_free_streams(struct usb_dev_state *ps, void __user *arg)
2336 {
2337 unsigned num_eps;
2338 struct usb_host_endpoint **eps;
2339 struct usb_interface *intf;
2340 int r;
2341
2342 r = parse_usbdevfs_streams(ps, arg, NULL, &num_eps, &eps, &intf);
2343 if (r)
2344 return r;
2345
2346 destroy_async_on_interface(ps,
2347 intf->altsetting[0].desc.bInterfaceNumber);
2348
2349 r = usb_free_streams(intf, eps, num_eps, GFP_KERNEL);
2350 kfree(eps);
2351 return r;
2352 }
2353
2354 static int proc_drop_privileges(struct usb_dev_state *ps, void __user *arg)
2355 {
2356 u32 data;
2357
2358 if (copy_from_user(&data, arg, sizeof(data)))
2359 return -EFAULT;
2360
2361 /* This is an one way operation. Once privileges are
2362 * dropped, you cannot regain them. You may however reissue
2363 * this ioctl to shrink the allowed interfaces mask.
2364 */
2365 ps->interface_allowed_mask &= data;
2366 ps->privileges_dropped = true;
2367
2368 return 0;
2369 }
2370
2371 /*
2372 * NOTE: All requests here that have interface numbers as parameters
2373 * are assuming that somehow the configuration has been prevented from
2374 * changing. But there's no mechanism to ensure that...
2375 */
2376 static long usbdev_do_ioctl(struct file *file, unsigned int cmd,
2377 void __user *p)
2378 {
2379 struct usb_dev_state *ps = file->private_data;
2380 struct inode *inode = file_inode(file);
2381 struct usb_device *dev = ps->dev;
2382 int ret = -ENOTTY;
2383
2384 if (!(file->f_mode & FMODE_WRITE))
2385 return -EPERM;
2386
2387 usb_lock_device(dev);
2388
2389 /* Reap operations are allowed even after disconnection */
2390 switch (cmd) {
2391 case USBDEVFS_REAPURB:
2392 snoop(&dev->dev, "%s: REAPURB\n", __func__);
2393 ret = proc_reapurb(ps, p);
2394 goto done;
2395
2396 case USBDEVFS_REAPURBNDELAY:
2397 snoop(&dev->dev, "%s: REAPURBNDELAY\n", __func__);
2398 ret = proc_reapurbnonblock(ps, p);
2399 goto done;
2400
2401 #ifdef CONFIG_COMPAT
2402 case USBDEVFS_REAPURB32:
2403 snoop(&dev->dev, "%s: REAPURB32\n", __func__);
2404 ret = proc_reapurb_compat(ps, p);
2405 goto done;
2406
2407 case USBDEVFS_REAPURBNDELAY32:
2408 snoop(&dev->dev, "%s: REAPURBNDELAY32\n", __func__);
2409 ret = proc_reapurbnonblock_compat(ps, p);
2410 goto done;
2411 #endif
2412 }
2413
2414 if (!connected(ps)) {
2415 usb_unlock_device(dev);
2416 return -ENODEV;
2417 }
2418
2419 switch (cmd) {
2420 case USBDEVFS_CONTROL:
2421 snoop(&dev->dev, "%s: CONTROL\n", __func__);
2422 ret = proc_control(ps, p);
2423 if (ret >= 0)
2424 inode->i_mtime = current_time(inode);
2425 break;
2426
2427 case USBDEVFS_BULK:
2428 snoop(&dev->dev, "%s: BULK\n", __func__);
2429 ret = proc_bulk(ps, p);
2430 if (ret >= 0)
2431 inode->i_mtime = current_time(inode);
2432 break;
2433
2434 case USBDEVFS_RESETEP:
2435 snoop(&dev->dev, "%s: RESETEP\n", __func__);
2436 ret = proc_resetep(ps, p);
2437 if (ret >= 0)
2438 inode->i_mtime = current_time(inode);
2439 break;
2440
2441 case USBDEVFS_RESET:
2442 snoop(&dev->dev, "%s: RESET\n", __func__);
2443 ret = proc_resetdevice(ps);
2444 break;
2445
2446 case USBDEVFS_CLEAR_HALT:
2447 snoop(&dev->dev, "%s: CLEAR_HALT\n", __func__);
2448 ret = proc_clearhalt(ps, p);
2449 if (ret >= 0)
2450 inode->i_mtime = current_time(inode);
2451 break;
2452
2453 case USBDEVFS_GETDRIVER:
2454 snoop(&dev->dev, "%s: GETDRIVER\n", __func__);
2455 ret = proc_getdriver(ps, p);
2456 break;
2457
2458 case USBDEVFS_CONNECTINFO:
2459 snoop(&dev->dev, "%s: CONNECTINFO\n", __func__);
2460 ret = proc_connectinfo(ps, p);
2461 break;
2462
2463 case USBDEVFS_SETINTERFACE:
2464 snoop(&dev->dev, "%s: SETINTERFACE\n", __func__);
2465 ret = proc_setintf(ps, p);
2466 break;
2467
2468 case USBDEVFS_SETCONFIGURATION:
2469 snoop(&dev->dev, "%s: SETCONFIGURATION\n", __func__);
2470 ret = proc_setconfig(ps, p);
2471 break;
2472
2473 case USBDEVFS_SUBMITURB:
2474 snoop(&dev->dev, "%s: SUBMITURB\n", __func__);
2475 ret = proc_submiturb(ps, p);
2476 if (ret >= 0)
2477 inode->i_mtime = current_time(inode);
2478 break;
2479
2480 #ifdef CONFIG_COMPAT
2481 case USBDEVFS_CONTROL32:
2482 snoop(&dev->dev, "%s: CONTROL32\n", __func__);
2483 ret = proc_control_compat(ps, p);
2484 if (ret >= 0)
2485 inode->i_mtime = current_time(inode);
2486 break;
2487
2488 case USBDEVFS_BULK32:
2489 snoop(&dev->dev, "%s: BULK32\n", __func__);
2490 ret = proc_bulk_compat(ps, p);
2491 if (ret >= 0)
2492 inode->i_mtime = current_time(inode);
2493 break;
2494
2495 case USBDEVFS_DISCSIGNAL32:
2496 snoop(&dev->dev, "%s: DISCSIGNAL32\n", __func__);
2497 ret = proc_disconnectsignal_compat(ps, p);
2498 break;
2499
2500 case USBDEVFS_SUBMITURB32:
2501 snoop(&dev->dev, "%s: SUBMITURB32\n", __func__);
2502 ret = proc_submiturb_compat(ps, p);
2503 if (ret >= 0)
2504 inode->i_mtime = current_time(inode);
2505 break;
2506
2507 case USBDEVFS_IOCTL32:
2508 snoop(&dev->dev, "%s: IOCTL32\n", __func__);
2509 ret = proc_ioctl_compat(ps, ptr_to_compat(p));
2510 break;
2511 #endif
2512
2513 case USBDEVFS_DISCARDURB:
2514 snoop(&dev->dev, "%s: DISCARDURB %pK\n", __func__, p);
2515 ret = proc_unlinkurb(ps, p);
2516 break;
2517
2518 case USBDEVFS_DISCSIGNAL:
2519 snoop(&dev->dev, "%s: DISCSIGNAL\n", __func__);
2520 ret = proc_disconnectsignal(ps, p);
2521 break;
2522
2523 case USBDEVFS_CLAIMINTERFACE:
2524 snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __func__);
2525 ret = proc_claiminterface(ps, p);
2526 break;
2527
2528 case USBDEVFS_RELEASEINTERFACE:
2529 snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __func__);
2530 ret = proc_releaseinterface(ps, p);
2531 break;
2532
2533 case USBDEVFS_IOCTL:
2534 snoop(&dev->dev, "%s: IOCTL\n", __func__);
2535 ret = proc_ioctl_default(ps, p);
2536 break;
2537
2538 case USBDEVFS_CLAIM_PORT:
2539 snoop(&dev->dev, "%s: CLAIM_PORT\n", __func__);
2540 ret = proc_claim_port(ps, p);
2541 break;
2542
2543 case USBDEVFS_RELEASE_PORT:
2544 snoop(&dev->dev, "%s: RELEASE_PORT\n", __func__);
2545 ret = proc_release_port(ps, p);
2546 break;
2547 case USBDEVFS_GET_CAPABILITIES:
2548 ret = proc_get_capabilities(ps, p);
2549 break;
2550 case USBDEVFS_DISCONNECT_CLAIM:
2551 ret = proc_disconnect_claim(ps, p);
2552 break;
2553 case USBDEVFS_ALLOC_STREAMS:
2554 ret = proc_alloc_streams(ps, p);
2555 break;
2556 case USBDEVFS_FREE_STREAMS:
2557 ret = proc_free_streams(ps, p);
2558 break;
2559 case USBDEVFS_DROP_PRIVILEGES:
2560 ret = proc_drop_privileges(ps, p);
2561 break;
2562 }
2563
2564 done:
2565 usb_unlock_device(dev);
2566 if (ret >= 0)
2567 inode->i_atime = current_time(inode);
2568 return ret;
2569 }
2570
2571 static long usbdev_ioctl(struct file *file, unsigned int cmd,
2572 unsigned long arg)
2573 {
2574 int ret;
2575
2576 ret = usbdev_do_ioctl(file, cmd, (void __user *)arg);
2577
2578 return ret;
2579 }
2580
2581 #ifdef CONFIG_COMPAT
2582 static long usbdev_compat_ioctl(struct file *file, unsigned int cmd,
2583 unsigned long arg)
2584 {
2585 int ret;
2586
2587 ret = usbdev_do_ioctl(file, cmd, compat_ptr(arg));
2588
2589 return ret;
2590 }
2591 #endif
2592
2593 /* No kernel lock - fine */
2594 static unsigned int usbdev_poll(struct file *file,
2595 struct poll_table_struct *wait)
2596 {
2597 struct usb_dev_state *ps = file->private_data;
2598 unsigned int mask = 0;
2599
2600 poll_wait(file, &ps->wait, wait);
2601 if (file->f_mode & FMODE_WRITE && !list_empty(&ps->async_completed))
2602 mask |= POLLOUT | POLLWRNORM;
2603 if (!connected(ps))
2604 mask |= POLLHUP;
2605 if (list_empty(&ps->list))
2606 mask |= POLLERR;
2607 return mask;
2608 }
2609
2610 const struct file_operations usbdev_file_operations = {
2611 .owner = THIS_MODULE,
2612 .llseek = no_seek_end_llseek,
2613 .read = usbdev_read,
2614 .poll = usbdev_poll,
2615 .unlocked_ioctl = usbdev_ioctl,
2616 #ifdef CONFIG_COMPAT
2617 .compat_ioctl = usbdev_compat_ioctl,
2618 #endif
2619 .mmap = usbdev_mmap,
2620 .open = usbdev_open,
2621 .release = usbdev_release,
2622 };
2623
2624 static void usbdev_remove(struct usb_device *udev)
2625 {
2626 struct usb_dev_state *ps;
2627 struct siginfo sinfo;
2628
2629 while (!list_empty(&udev->filelist)) {
2630 ps = list_entry(udev->filelist.next, struct usb_dev_state, list);
2631 destroy_all_async(ps);
2632 wake_up_all(&ps->wait);
2633 list_del_init(&ps->list);
2634 if (ps->discsignr) {
2635 memset(&sinfo, 0, sizeof(sinfo));
2636 sinfo.si_signo = ps->discsignr;
2637 sinfo.si_errno = EPIPE;
2638 sinfo.si_code = SI_ASYNCIO;
2639 sinfo.si_addr = ps->disccontext;
2640 kill_pid_info_as_cred(ps->discsignr, &sinfo,
2641 ps->disc_pid, ps->cred, ps->secid);
2642 }
2643 }
2644 }
2645
2646 static int usbdev_notify(struct notifier_block *self,
2647 unsigned long action, void *dev)
2648 {
2649 switch (action) {
2650 case USB_DEVICE_ADD:
2651 break;
2652 case USB_DEVICE_REMOVE:
2653 usbdev_remove(dev);
2654 break;
2655 }
2656 return NOTIFY_OK;
2657 }
2658
2659 static struct notifier_block usbdev_nb = {
2660 .notifier_call = usbdev_notify,
2661 };
2662
2663 static struct cdev usb_device_cdev;
2664
2665 int __init usb_devio_init(void)
2666 {
2667 int retval;
2668
2669 retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX,
2670 "usb_device");
2671 if (retval) {
2672 printk(KERN_ERR "Unable to register minors for usb_device\n");
2673 goto out;
2674 }
2675 cdev_init(&usb_device_cdev, &usbdev_file_operations);
2676 retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX);
2677 if (retval) {
2678 printk(KERN_ERR "Unable to get usb_device major %d\n",
2679 USB_DEVICE_MAJOR);
2680 goto error_cdev;
2681 }
2682 usb_register_notify(&usbdev_nb);
2683 out:
2684 return retval;
2685
2686 error_cdev:
2687 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
2688 goto out;
2689 }
2690
2691 void usb_devio_cleanup(void)
2692 {
2693 usb_unregister_notify(&usbdev_nb);
2694 cdev_del(&usb_device_cdev);
2695 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
2696 }
Linux with added FPC-III support