projects / GitHub / mt8127 / android_kernel_alcatel_ttab.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge branch 'drm-patches' of git://git.kernel.org/pub/scm/linux/kernel/git/airlied...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / usb / core / devio.c
1 /*****************************************************************************/
2
3 /*
4 * devio.c -- User space communication with USB devices.
5 *
6 * Copyright (C) 1999-2000 Thomas Sailer (sailer@ife.ee.ethz.ch)
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 *
22 * $Id: devio.c,v 1.7 2000/02/01 17:28:48 fliegl Exp $
23 *
24 * This file implements the usbfs/x/y files, where
25 * x is the bus number and y the device number.
26 *
27 * It allows user space programs/"drivers" to communicate directly
28 * with USB devices without intervening kernel driver.
29 *
30 * Revision history
31 * 22.12.1999 0.1 Initial release (split from proc_usb.c)
32 * 04.01.2000 0.2 Turned into its own filesystem
33 * 30.09.2005 0.3 Fix user-triggerable oops in async URB delivery
34 * (CAN-2005-3055)
35 */
36
37 /*****************************************************************************/
38
39 #include <linux/fs.h>
40 #include <linux/mm.h>
41 #include <linux/slab.h>
42 #include <linux/smp_lock.h>
43 #include <linux/signal.h>
44 #include <linux/poll.h>
45 #include <linux/module.h>
46 #include <linux/usb.h>
47 #include <linux/usbdevice_fs.h>
48 #include <linux/cdev.h>
49 #include <linux/notifier.h>
50 #include <linux/security.h>
51 #include <asm/uaccess.h>
52 #include <asm/byteorder.h>
53 #include <linux/moduleparam.h>
54
55 #include "hcd.h" /* for usbcore internals */
56 #include "usb.h"
57
58 #define USB_MAXBUS 64
59 #define USB_DEVICE_MAX USB_MAXBUS * 128
60 static struct class *usb_device_class;
61
62 /* Mutual exclusion for removal, open, and release */
63 DEFINE_MUTEX(usbfs_mutex);
64
65 struct async {
66 struct list_head asynclist;
67 struct dev_state *ps;
68 pid_t pid;
69 uid_t uid, euid;
70 unsigned int signr;
71 unsigned int ifnum;
72 void __user *userbuffer;
73 void __user *userurb;
74 struct urb *urb;
75 u32 secid;
76 };
77
78 static int usbfs_snoop = 0;
79 module_param (usbfs_snoop, bool, S_IRUGO | S_IWUSR);
80 MODULE_PARM_DESC (usbfs_snoop, "true to log all usbfs traffic");
81
82 #define snoop(dev, format, arg...) \
83 do { \
84 if (usbfs_snoop) \
85 dev_info( dev , format , ## arg); \
86 } while (0)
87
88 #define USB_DEVICE_DEV MKDEV(USB_DEVICE_MAJOR, 0)
89
90
91 #define MAX_USBFS_BUFFER_SIZE 16384
92
93 static inline int connected (struct dev_state *ps)
94 {
95 return (!list_empty(&ps->list) &&
96 ps->dev->state != USB_STATE_NOTATTACHED);
97 }
98
99 static loff_t usbdev_lseek(struct file *file, loff_t offset, int orig)
100 {
101 loff_t ret;
102
103 lock_kernel();
104
105 switch (orig) {
106 case 0:
107 file->f_pos = offset;
108 ret = file->f_pos;
109 break;
110 case 1:
111 file->f_pos += offset;
112 ret = file->f_pos;
113 break;
114 case 2:
115 default:
116 ret = -EINVAL;
117 }
118
119 unlock_kernel();
120 return ret;
121 }
122
123 static ssize_t usbdev_read(struct file *file, char __user *buf, size_t nbytes, loff_t *ppos)
124 {
125 struct dev_state *ps = file->private_data;
126 struct usb_device *dev = ps->dev;
127 ssize_t ret = 0;
128 unsigned len;
129 loff_t pos;
130 int i;
131
132 pos = *ppos;
133 usb_lock_device(dev);
134 if (!connected(ps)) {
135 ret = -ENODEV;
136 goto err;
137 } else if (pos < 0) {
138 ret = -EINVAL;
139 goto err;
140 }
141
142 if (pos < sizeof(struct usb_device_descriptor)) {
143 struct usb_device_descriptor temp_desc ; /* 18 bytes - fits on the stack */
144
145 memcpy(&temp_desc, &dev->descriptor, sizeof(dev->descriptor));
146 le16_to_cpus(&temp_desc.bcdUSB);
147 le16_to_cpus(&temp_desc.idVendor);
148 le16_to_cpus(&temp_desc.idProduct);
149 le16_to_cpus(&temp_desc.bcdDevice);
150
151 len = sizeof(struct usb_device_descriptor) - pos;
152 if (len > nbytes)
153 len = nbytes;
154 if (copy_to_user(buf, ((char *)&temp_desc) + pos, len)) {
155 ret = -EFAULT;
156 goto err;
157 }
158
159 *ppos += len;
160 buf += len;
161 nbytes -= len;
162 ret += len;
163 }
164
165 pos = sizeof(struct usb_device_descriptor);
166 for (i = 0; nbytes && i < dev->descriptor.bNumConfigurations; i++) {
167 struct usb_config_descriptor *config =
168 (struct usb_config_descriptor *)dev->rawdescriptors[i];
169 unsigned int length = le16_to_cpu(config->wTotalLength);
170
171 if (*ppos < pos + length) {
172
173 /* The descriptor may claim to be longer than it
174 * really is. Here is the actual allocated length. */
175 unsigned alloclen =
176 le16_to_cpu(dev->config[i].desc.wTotalLength);
177
178 len = length - (*ppos - pos);
179 if (len > nbytes)
180 len = nbytes;
181
182 /* Simply don't write (skip over) unallocated parts */
183 if (alloclen > (*ppos - pos)) {
184 alloclen -= (*ppos - pos);
185 if (copy_to_user(buf,
186 dev->rawdescriptors[i] + (*ppos - pos),
187 min(len, alloclen))) {
188 ret = -EFAULT;
189 goto err;
190 }
191 }
192
193 *ppos += len;
194 buf += len;
195 nbytes -= len;
196 ret += len;
197 }
198
199 pos += length;
200 }
201
202 err:
203 usb_unlock_device(dev);
204 return ret;
205 }
206
207 /*
208 * async list handling
209 */
210
211 static struct async *alloc_async(unsigned int numisoframes)
212 {
213 unsigned int assize = sizeof(struct async) + numisoframes * sizeof(struct usb_iso_packet_descriptor);
214 struct async *as = kzalloc(assize, GFP_KERNEL);
215
216 if (!as)
217 return NULL;
218 as->urb = usb_alloc_urb(numisoframes, GFP_KERNEL);
219 if (!as->urb) {
220 kfree(as);
221 return NULL;
222 }
223 return as;
224 }
225
226 static void free_async(struct async *as)
227 {
228 kfree(as->urb->transfer_buffer);
229 kfree(as->urb->setup_packet);
230 usb_free_urb(as->urb);
231 kfree(as);
232 }
233
234 static inline void async_newpending(struct async *as)
235 {
236 struct dev_state *ps = as->ps;
237 unsigned long flags;
238
239 spin_lock_irqsave(&ps->lock, flags);
240 list_add_tail(&as->asynclist, &ps->async_pending);
241 spin_unlock_irqrestore(&ps->lock, flags);
242 }
243
244 static inline void async_removepending(struct async *as)
245 {
246 struct dev_state *ps = as->ps;
247 unsigned long flags;
248
249 spin_lock_irqsave(&ps->lock, flags);
250 list_del_init(&as->asynclist);
251 spin_unlock_irqrestore(&ps->lock, flags);
252 }
253
254 static inline struct async *async_getcompleted(struct dev_state *ps)
255 {
256 unsigned long flags;
257 struct async *as = NULL;
258
259 spin_lock_irqsave(&ps->lock, flags);
260 if (!list_empty(&ps->async_completed)) {
261 as = list_entry(ps->async_completed.next, struct async, asynclist);
262 list_del_init(&as->asynclist);
263 }
264 spin_unlock_irqrestore(&ps->lock, flags);
265 return as;
266 }
267
268 static inline struct async *async_getpending(struct dev_state *ps, void __user *userurb)
269 {
270 unsigned long flags;
271 struct async *as;
272
273 spin_lock_irqsave(&ps->lock, flags);
274 list_for_each_entry(as, &ps->async_pending, asynclist)
275 if (as->userurb == userurb) {
276 list_del_init(&as->asynclist);
277 spin_unlock_irqrestore(&ps->lock, flags);
278 return as;
279 }
280 spin_unlock_irqrestore(&ps->lock, flags);
281 return NULL;
282 }
283
284 static void snoop_urb(struct urb *urb, void __user *userurb)
285 {
286 int j;
287 unsigned char *data = urb->transfer_buffer;
288
289 if (!usbfs_snoop)
290 return;
291
292 if (urb->pipe & USB_DIR_IN)
293 dev_info(&urb->dev->dev, "direction=IN\n");
294 else
295 dev_info(&urb->dev->dev, "direction=OUT\n");
296 dev_info(&urb->dev->dev, "userurb=%p\n", userurb);
297 dev_info(&urb->dev->dev, "transfer_buffer_length=%d\n",
298 urb->transfer_buffer_length);
299 dev_info(&urb->dev->dev, "actual_length=%d\n", urb->actual_length);
300 dev_info(&urb->dev->dev, "data: ");
301 for (j = 0; j < urb->transfer_buffer_length; ++j)
302 printk ("%02x ", data[j]);
303 printk("\n");
304 }
305
306 static void async_completed(struct urb *urb, struct pt_regs *regs)
307 {
308 struct async *as = urb->context;
309 struct dev_state *ps = as->ps;
310 struct siginfo sinfo;
311
312 spin_lock(&ps->lock);
313 list_move_tail(&as->asynclist, &ps->async_completed);
314 spin_unlock(&ps->lock);
315 if (as->signr) {
316 sinfo.si_signo = as->signr;
317 sinfo.si_errno = as->urb->status;
318 sinfo.si_code = SI_ASYNCIO;
319 sinfo.si_addr = as->userurb;
320 kill_proc_info_as_uid(as->signr, &sinfo, as->pid, as->uid,
321 as->euid, as->secid);
322 }
323 snoop(&urb->dev->dev, "urb complete\n");
324 snoop_urb(urb, as->userurb);
325 wake_up(&ps->wait);
326 }
327
328 static void destroy_async (struct dev_state *ps, struct list_head *list)
329 {
330 struct async *as;
331 unsigned long flags;
332
333 spin_lock_irqsave(&ps->lock, flags);
334 while (!list_empty(list)) {
335 as = list_entry(list->next, struct async, asynclist);
336 list_del_init(&as->asynclist);
337
338 /* drop the spinlock so the completion handler can run */
339 spin_unlock_irqrestore(&ps->lock, flags);
340 usb_kill_urb(as->urb);
341 spin_lock_irqsave(&ps->lock, flags);
342 }
343 spin_unlock_irqrestore(&ps->lock, flags);
344 as = async_getcompleted(ps);
345 while (as) {
346 free_async(as);
347 as = async_getcompleted(ps);
348 }
349 }
350
351 static void destroy_async_on_interface (struct dev_state *ps, unsigned int ifnum)
352 {
353 struct list_head *p, *q, hitlist;
354 unsigned long flags;
355
356 INIT_LIST_HEAD(&hitlist);
357 spin_lock_irqsave(&ps->lock, flags);
358 list_for_each_safe(p, q, &ps->async_pending)
359 if (ifnum == list_entry(p, struct async, asynclist)->ifnum)
360 list_move_tail(p, &hitlist);
361 spin_unlock_irqrestore(&ps->lock, flags);
362 destroy_async(ps, &hitlist);
363 }
364
365 static inline void destroy_all_async(struct dev_state *ps)
366 {
367 destroy_async(ps, &ps->async_pending);
368 }
369
370 /*
371 * interface claims are made only at the request of user level code,
372 * which can also release them (explicitly or by closing files).
373 * they're also undone when devices disconnect.
374 */
375
376 static int driver_probe (struct usb_interface *intf,
377 const struct usb_device_id *id)
378 {
379 return -ENODEV;
380 }
381
382 static void driver_disconnect(struct usb_interface *intf)
383 {
384 struct dev_state *ps = usb_get_intfdata (intf);
385 unsigned int ifnum = intf->altsetting->desc.bInterfaceNumber;
386
387 if (!ps)
388 return;
389
390 /* NOTE: this relies on usbcore having canceled and completed
391 * all pending I/O requests; 2.6 does that.
392 */
393
394 if (likely(ifnum < 8*sizeof(ps->ifclaimed)))
395 clear_bit(ifnum, &ps->ifclaimed);
396 else
397 warn("interface number %u out of range", ifnum);
398
399 usb_set_intfdata (intf, NULL);
400
401 /* force async requests to complete */
402 destroy_async_on_interface(ps, ifnum);
403 }
404
405 struct usb_driver usbfs_driver = {
406 .name = "usbfs",
407 .probe = driver_probe,
408 .disconnect = driver_disconnect,
409 };
410
411 static int claimintf(struct dev_state *ps, unsigned int ifnum)
412 {
413 struct usb_device *dev = ps->dev;
414 struct usb_interface *intf;
415 int err;
416
417 if (ifnum >= 8*sizeof(ps->ifclaimed))
418 return -EINVAL;
419 /* already claimed */
420 if (test_bit(ifnum, &ps->ifclaimed))
421 return 0;
422
423 /* lock against other changes to driver bindings */
424 down_write(&usb_bus_type.subsys.rwsem);
425 intf = usb_ifnum_to_if(dev, ifnum);
426 if (!intf)
427 err = -ENOENT;
428 else
429 err = usb_driver_claim_interface(&usbfs_driver, intf, ps);
430 up_write(&usb_bus_type.subsys.rwsem);
431 if (err == 0)
432 set_bit(ifnum, &ps->ifclaimed);
433 return err;
434 }
435
436 static int releaseintf(struct dev_state *ps, unsigned int ifnum)
437 {
438 struct usb_device *dev;
439 struct usb_interface *intf;
440 int err;
441
442 err = -EINVAL;
443 if (ifnum >= 8*sizeof(ps->ifclaimed))
444 return err;
445 dev = ps->dev;
446 /* lock against other changes to driver bindings */
447 down_write(&usb_bus_type.subsys.rwsem);
448 intf = usb_ifnum_to_if(dev, ifnum);
449 if (!intf)
450 err = -ENOENT;
451 else if (test_and_clear_bit(ifnum, &ps->ifclaimed)) {
452 usb_driver_release_interface(&usbfs_driver, intf);
453 err = 0;
454 }
455 up_write(&usb_bus_type.subsys.rwsem);
456 return err;
457 }
458
459 static int checkintf(struct dev_state *ps, unsigned int ifnum)
460 {
461 if (ps->dev->state != USB_STATE_CONFIGURED)
462 return -EHOSTUNREACH;
463 if (ifnum >= 8*sizeof(ps->ifclaimed))
464 return -EINVAL;
465 if (test_bit(ifnum, &ps->ifclaimed))
466 return 0;
467 /* if not yet claimed, claim it for the driver */
468 dev_warn(&ps->dev->dev, "usbfs: process %d (%s) did not claim interface %u before use\n",
469 current->pid, current->comm, ifnum);
470 return claimintf(ps, ifnum);
471 }
472
473 static int findintfep(struct usb_device *dev, unsigned int ep)
474 {
475 unsigned int i, j, e;
476 struct usb_interface *intf;
477 struct usb_host_interface *alts;
478 struct usb_endpoint_descriptor *endpt;
479
480 if (ep & ~(USB_DIR_IN|0xf))
481 return -EINVAL;
482 if (!dev->actconfig)
483 return -ESRCH;
484 for (i = 0; i < dev->actconfig->desc.bNumInterfaces; i++) {
485 intf = dev->actconfig->interface[i];
486 for (j = 0; j < intf->num_altsetting; j++) {
487 alts = &intf->altsetting[j];
488 for (e = 0; e < alts->desc.bNumEndpoints; e++) {
489 endpt = &alts->endpoint[e].desc;
490 if (endpt->bEndpointAddress == ep)
491 return alts->desc.bInterfaceNumber;
492 }
493 }
494 }
495 return -ENOENT;
496 }
497
498 static int check_ctrlrecip(struct dev_state *ps, unsigned int requesttype, unsigned int index)
499 {
500 int ret = 0;
501
502 if (ps->dev->state != USB_STATE_ADDRESS
503 && ps->dev->state != USB_STATE_CONFIGURED)
504 return -EHOSTUNREACH;
505 if (USB_TYPE_VENDOR == (USB_TYPE_MASK & requesttype))
506 return 0;
507
508 index &= 0xff;
509 switch (requesttype & USB_RECIP_MASK) {
510 case USB_RECIP_ENDPOINT:
511 if ((ret = findintfep(ps->dev, index)) >= 0)
512 ret = checkintf(ps, ret);
513 break;
514
515 case USB_RECIP_INTERFACE:
516 ret = checkintf(ps, index);
517 break;
518 }
519 return ret;
520 }
521
522 static struct usb_device *usbdev_lookup_minor(int minor)
523 {
524 struct class_device *class_dev;
525 struct usb_device *dev = NULL;
526
527 down(&usb_device_class->sem);
528 list_for_each_entry(class_dev, &usb_device_class->children, node) {
529 if (class_dev->devt == MKDEV(USB_DEVICE_MAJOR, minor)) {
530 dev = class_dev->class_data;
531 break;
532 }
533 }
534 up(&usb_device_class->sem);
535
536 return dev;
537 };
538
539 /*
540 * file operations
541 */
542 static int usbdev_open(struct inode *inode, struct file *file)
543 {
544 struct usb_device *dev = NULL;
545 struct dev_state *ps;
546 int ret;
547
548 /* Protect against simultaneous removal or release */
549 mutex_lock(&usbfs_mutex);
550
551 ret = -ENOMEM;
552 if (!(ps = kmalloc(sizeof(struct dev_state), GFP_KERNEL)))
553 goto out;
554
555 ret = -ENOENT;
556 /* check if we are called from a real node or usbfs */
557 if (imajor(inode) == USB_DEVICE_MAJOR)
558 dev = usbdev_lookup_minor(iminor(inode));
559 if (!dev)
560 dev = inode->i_private;
561 if (!dev)
562 goto out;
563 ret = usb_autoresume_device(dev, 1);
564 if (ret)
565 goto out;
566
567 usb_get_dev(dev);
568 ret = 0;
569 ps->dev = dev;
570 ps->file = file;
571 spin_lock_init(&ps->lock);
572 INIT_LIST_HEAD(&ps->async_pending);
573 INIT_LIST_HEAD(&ps->async_completed);
574 init_waitqueue_head(&ps->wait);
575 ps->discsignr = 0;
576 ps->disc_pid = current->pid;
577 ps->disc_uid = current->uid;
578 ps->disc_euid = current->euid;
579 ps->disccontext = NULL;
580 ps->ifclaimed = 0;
581 security_task_getsecid(current, &ps->secid);
582 wmb();
583 list_add_tail(&ps->list, &dev->filelist);
584 file->private_data = ps;
585 out:
586 if (ret)
587 kfree(ps);
588 mutex_unlock(&usbfs_mutex);
589 return ret;
590 }
591
592 static int usbdev_release(struct inode *inode, struct file *file)
593 {
594 struct dev_state *ps = file->private_data;
595 struct usb_device *dev = ps->dev;
596 unsigned int ifnum;
597
598 usb_lock_device(dev);
599
600 /* Protect against simultaneous open */
601 mutex_lock(&usbfs_mutex);
602 list_del_init(&ps->list);
603 mutex_unlock(&usbfs_mutex);
604
605 for (ifnum = 0; ps->ifclaimed && ifnum < 8*sizeof(ps->ifclaimed);
606 ifnum++) {
607 if (test_bit(ifnum, &ps->ifclaimed))
608 releaseintf(ps, ifnum);
609 }
610 destroy_all_async(ps);
611 usb_autosuspend_device(dev, 1);
612 usb_unlock_device(dev);
613 usb_put_dev(dev);
614 kfree(ps);
615 return 0;
616 }
617
618 static int proc_control(struct dev_state *ps, void __user *arg)
619 {
620 struct usb_device *dev = ps->dev;
621 struct usbdevfs_ctrltransfer ctrl;
622 unsigned int tmo;
623 unsigned char *tbuf;
624 int i, j, ret;
625
626 if (copy_from_user(&ctrl, arg, sizeof(ctrl)))
627 return -EFAULT;
628 if ((ret = check_ctrlrecip(ps, ctrl.bRequestType, ctrl.wIndex)))
629 return ret;
630 if (ctrl.wLength > PAGE_SIZE)
631 return -EINVAL;
632 if (!(tbuf = (unsigned char *)__get_free_page(GFP_KERNEL)))
633 return -ENOMEM;
634 tmo = ctrl.timeout;
635 if (ctrl.bRequestType & 0x80) {
636 if (ctrl.wLength && !access_ok(VERIFY_WRITE, ctrl.data, ctrl.wLength)) {
637 free_page((unsigned long)tbuf);
638 return -EINVAL;
639 }
640 snoop(&dev->dev, "control read: bRequest=%02x "
641 "bRrequestType=%02x wValue=%04x "
642 "wIndex=%04x wLength=%04x\n",
643 ctrl.bRequest, ctrl.bRequestType, ctrl.wValue,
644 ctrl.wIndex, ctrl.wLength);
645
646 usb_unlock_device(dev);
647 i = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), ctrl.bRequest, ctrl.bRequestType,
648 ctrl.wValue, ctrl.wIndex, tbuf, ctrl.wLength, tmo);
649 usb_lock_device(dev);
650 if ((i > 0) && ctrl.wLength) {
651 if (usbfs_snoop) {
652 dev_info(&dev->dev, "control read: data ");
653 for (j = 0; j < i; ++j)
654 printk("%02x ", (unsigned char)(tbuf)[j]);
655 printk("\n");
656 }
657 if (copy_to_user(ctrl.data, tbuf, i)) {
658 free_page((unsigned long)tbuf);
659 return -EFAULT;
660 }
661 }
662 } else {
663 if (ctrl.wLength) {
664 if (copy_from_user(tbuf, ctrl.data, ctrl.wLength)) {
665 free_page((unsigned long)tbuf);
666 return -EFAULT;
667 }
668 }
669 snoop(&dev->dev, "control write: bRequest=%02x "
670 "bRrequestType=%02x wValue=%04x "
671 "wIndex=%04x wLength=%04x\n",
672 ctrl.bRequest, ctrl.bRequestType, ctrl.wValue,
673 ctrl.wIndex, ctrl.wLength);
674 if (usbfs_snoop) {
675 dev_info(&dev->dev, "control write: data: ");
676 for (j = 0; j < ctrl.wLength; ++j)
677 printk("%02x ", (unsigned char)(tbuf)[j]);
678 printk("\n");
679 }
680 usb_unlock_device(dev);
681 i = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), ctrl.bRequest, ctrl.bRequestType,
682 ctrl.wValue, ctrl.wIndex, tbuf, ctrl.wLength, tmo);
683 usb_lock_device(dev);
684 }
685 free_page((unsigned long)tbuf);
686 if (i<0 && i != -EPIPE) {
687 dev_printk(KERN_DEBUG, &dev->dev, "usbfs: USBDEVFS_CONTROL "
688 "failed cmd %s rqt %u rq %u len %u ret %d\n",
689 current->comm, ctrl.bRequestType, ctrl.bRequest,
690 ctrl.wLength, i);
691 }
692 return i;
693 }
694
695 static int proc_bulk(struct dev_state *ps, void __user *arg)
696 {
697 struct usb_device *dev = ps->dev;
698 struct usbdevfs_bulktransfer bulk;
699 unsigned int tmo, len1, pipe;
700 int len2;
701 unsigned char *tbuf;
702 int i, j, ret;
703
704 if (copy_from_user(&bulk, arg, sizeof(bulk)))
705 return -EFAULT;
706 if ((ret = findintfep(ps->dev, bulk.ep)) < 0)
707 return ret;
708 if ((ret = checkintf(ps, ret)))
709 return ret;
710 if (bulk.ep & USB_DIR_IN)
711 pipe = usb_rcvbulkpipe(dev, bulk.ep & 0x7f);
712 else
713 pipe = usb_sndbulkpipe(dev, bulk.ep & 0x7f);
714 if (!usb_maxpacket(dev, pipe, !(bulk.ep & USB_DIR_IN)))
715 return -EINVAL;
716 len1 = bulk.len;
717 if (len1 > MAX_USBFS_BUFFER_SIZE)
718 return -EINVAL;
719 if (!(tbuf = kmalloc(len1, GFP_KERNEL)))
720 return -ENOMEM;
721 tmo = bulk.timeout;
722 if (bulk.ep & 0x80) {
723 if (len1 && !access_ok(VERIFY_WRITE, bulk.data, len1)) {
724 kfree(tbuf);
725 return -EINVAL;
726 }
727 snoop(&dev->dev, "bulk read: len=0x%02x timeout=%04d\n",
728 bulk.len, bulk.timeout);
729 usb_unlock_device(dev);
730 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
731 usb_lock_device(dev);
732 if (!i && len2) {
733 if (usbfs_snoop) {
734 dev_info(&dev->dev, "bulk read: data ");
735 for (j = 0; j < len2; ++j)
736 printk("%02x ", (unsigned char)(tbuf)[j]);
737 printk("\n");
738 }
739 if (copy_to_user(bulk.data, tbuf, len2)) {
740 kfree(tbuf);
741 return -EFAULT;
742 }
743 }
744 } else {
745 if (len1) {
746 if (copy_from_user(tbuf, bulk.data, len1)) {
747 kfree(tbuf);
748 return -EFAULT;
749 }
750 }
751 snoop(&dev->dev, "bulk write: len=0x%02x timeout=%04d\n",
752 bulk.len, bulk.timeout);
753 if (usbfs_snoop) {
754 dev_info(&dev->dev, "bulk write: data: ");
755 for (j = 0; j < len1; ++j)
756 printk("%02x ", (unsigned char)(tbuf)[j]);
757 printk("\n");
758 }
759 usb_unlock_device(dev);
760 i = usb_bulk_msg(dev, pipe, tbuf, len1, &len2, tmo);
761 usb_lock_device(dev);
762 }
763 kfree(tbuf);
764 if (i < 0)
765 return i;
766 return len2;
767 }
768
769 static int proc_resetep(struct dev_state *ps, void __user *arg)
770 {
771 unsigned int ep;
772 int ret;
773
774 if (get_user(ep, (unsigned int __user *)arg))
775 return -EFAULT;
776 if ((ret = findintfep(ps->dev, ep)) < 0)
777 return ret;
778 if ((ret = checkintf(ps, ret)))
779 return ret;
780 usb_settoggle(ps->dev, ep & 0xf, !(ep & USB_DIR_IN), 0);
781 return 0;
782 }
783
784 static int proc_clearhalt(struct dev_state *ps, void __user *arg)
785 {
786 unsigned int ep;
787 int pipe;
788 int ret;
789
790 if (get_user(ep, (unsigned int __user *)arg))
791 return -EFAULT;
792 if ((ret = findintfep(ps->dev, ep)) < 0)
793 return ret;
794 if ((ret = checkintf(ps, ret)))
795 return ret;
796 if (ep & USB_DIR_IN)
797 pipe = usb_rcvbulkpipe(ps->dev, ep & 0x7f);
798 else
799 pipe = usb_sndbulkpipe(ps->dev, ep & 0x7f);
800
801 return usb_clear_halt(ps->dev, pipe);
802 }
803
804
805 static int proc_getdriver(struct dev_state *ps, void __user *arg)
806 {
807 struct usbdevfs_getdriver gd;
808 struct usb_interface *intf;
809 int ret;
810
811 if (copy_from_user(&gd, arg, sizeof(gd)))
812 return -EFAULT;
813 down_read(&usb_bus_type.subsys.rwsem);
814 intf = usb_ifnum_to_if(ps->dev, gd.interface);
815 if (!intf || !intf->dev.driver)
816 ret = -ENODATA;
817 else {
818 strncpy(gd.driver, intf->dev.driver->name,
819 sizeof(gd.driver));
820 ret = (copy_to_user(arg, &gd, sizeof(gd)) ? -EFAULT : 0);
821 }
822 up_read(&usb_bus_type.subsys.rwsem);
823 return ret;
824 }
825
826 static int proc_connectinfo(struct dev_state *ps, void __user *arg)
827 {
828 struct usbdevfs_connectinfo ci;
829
830 ci.devnum = ps->dev->devnum;
831 ci.slow = ps->dev->speed == USB_SPEED_LOW;
832 if (copy_to_user(arg, &ci, sizeof(ci)))
833 return -EFAULT;
834 return 0;
835 }
836
837 static int proc_resetdevice(struct dev_state *ps)
838 {
839 return usb_reset_composite_device(ps->dev, NULL);
840 }
841
842 static int proc_setintf(struct dev_state *ps, void __user *arg)
843 {
844 struct usbdevfs_setinterface setintf;
845 int ret;
846
847 if (copy_from_user(&setintf, arg, sizeof(setintf)))
848 return -EFAULT;
849 if ((ret = checkintf(ps, setintf.interface)))
850 return ret;
851 return usb_set_interface(ps->dev, setintf.interface,
852 setintf.altsetting);
853 }
854
855 static int proc_setconfig(struct dev_state *ps, void __user *arg)
856 {
857 unsigned int u;
858 int status = 0;
859 struct usb_host_config *actconfig;
860
861 if (get_user(u, (unsigned int __user *)arg))
862 return -EFAULT;
863
864 actconfig = ps->dev->actconfig;
865
866 /* Don't touch the device if any interfaces are claimed.
867 * It could interfere with other drivers' operations, and if
868 * an interface is claimed by usbfs it could easily deadlock.
869 */
870 if (actconfig) {
871 int i;
872
873 for (i = 0; i < actconfig->desc.bNumInterfaces; ++i) {
874 if (usb_interface_claimed(actconfig->interface[i])) {
875 dev_warn (&ps->dev->dev,
876 "usbfs: interface %d claimed by %s "
877 "while '%s' sets config #%d\n",
878 actconfig->interface[i]
879 ->cur_altsetting
880 ->desc.bInterfaceNumber,
881 actconfig->interface[i]
882 ->dev.driver->name,
883 current->comm, u);
884 status = -EBUSY;
885 break;
886 }
887 }
888 }
889
890 /* SET_CONFIGURATION is often abused as a "cheap" driver reset,
891 * so avoid usb_set_configuration()'s kick to sysfs
892 */
893 if (status == 0) {
894 if (actconfig && actconfig->desc.bConfigurationValue == u)
895 status = usb_reset_configuration(ps->dev);
896 else
897 status = usb_set_configuration(ps->dev, u);
898 }
899
900 return status;
901 }
902
903 static int proc_do_submiturb(struct dev_state *ps, struct usbdevfs_urb *uurb,
904 struct usbdevfs_iso_packet_desc __user *iso_frame_desc,
905 void __user *arg)
906 {
907 struct usbdevfs_iso_packet_desc *isopkt = NULL;
908 struct usb_host_endpoint *ep;
909 struct async *as;
910 struct usb_ctrlrequest *dr = NULL;
911 unsigned int u, totlen, isofrmlen;
912 int ret, interval = 0, ifnum = -1;
913
914 if (uurb->flags & ~(USBDEVFS_URB_ISO_ASAP|USBDEVFS_URB_SHORT_NOT_OK|
915 URB_NO_FSBR|URB_ZERO_PACKET))
916 return -EINVAL;
917 if (!uurb->buffer)
918 return -EINVAL;
919 if (uurb->signr != 0 && (uurb->signr < SIGRTMIN || uurb->signr > SIGRTMAX))
920 return -EINVAL;
921 if (!(uurb->type == USBDEVFS_URB_TYPE_CONTROL && (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) == 0)) {
922 if ((ifnum = findintfep(ps->dev, uurb->endpoint)) < 0)
923 return ifnum;
924 if ((ret = checkintf(ps, ifnum)))
925 return ret;
926 }
927 if ((uurb->endpoint & USB_ENDPOINT_DIR_MASK) != 0)
928 ep = ps->dev->ep_in [uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
929 else
930 ep = ps->dev->ep_out [uurb->endpoint & USB_ENDPOINT_NUMBER_MASK];
931 if (!ep)
932 return -ENOENT;
933 switch(uurb->type) {
934 case USBDEVFS_URB_TYPE_CONTROL:
935 if ((ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK)
936 != USB_ENDPOINT_XFER_CONTROL)
937 return -EINVAL;
938 /* min 8 byte setup packet, max 8 byte setup plus an arbitrary data stage */
939 if (uurb->buffer_length < 8 || uurb->buffer_length > (8 + MAX_USBFS_BUFFER_SIZE))
940 return -EINVAL;
941 if (!(dr = kmalloc(sizeof(struct usb_ctrlrequest), GFP_KERNEL)))
942 return -ENOMEM;
943 if (copy_from_user(dr, uurb->buffer, 8)) {
944 kfree(dr);
945 return -EFAULT;
946 }
947 if (uurb->buffer_length < (le16_to_cpup(&dr->wLength) + 8)) {
948 kfree(dr);
949 return -EINVAL;
950 }
951 if ((ret = check_ctrlrecip(ps, dr->bRequestType, le16_to_cpup(&dr->wIndex)))) {
952 kfree(dr);
953 return ret;
954 }
955 uurb->endpoint = (uurb->endpoint & ~USB_ENDPOINT_DIR_MASK) | (dr->bRequestType & USB_ENDPOINT_DIR_MASK);
956 uurb->number_of_packets = 0;
957 uurb->buffer_length = le16_to_cpup(&dr->wLength);
958 uurb->buffer += 8;
959 if (!access_ok((uurb->endpoint & USB_DIR_IN) ? VERIFY_WRITE : VERIFY_READ, uurb->buffer, uurb->buffer_length)) {
960 kfree(dr);
961 return -EFAULT;
962 }
963 snoop(&ps->dev->dev, "control urb\n");
964 break;
965
966 case USBDEVFS_URB_TYPE_BULK:
967 switch (ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) {
968 case USB_ENDPOINT_XFER_CONTROL:
969 case USB_ENDPOINT_XFER_ISOC:
970 return -EINVAL;
971 /* allow single-shot interrupt transfers, at bogus rates */
972 }
973 uurb->number_of_packets = 0;
974 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
975 return -EINVAL;
976 if (!access_ok((uurb->endpoint & USB_DIR_IN) ? VERIFY_WRITE : VERIFY_READ, uurb->buffer, uurb->buffer_length))
977 return -EFAULT;
978 snoop(&ps->dev->dev, "bulk urb\n");
979 break;
980
981 case USBDEVFS_URB_TYPE_ISO:
982 /* arbitrary limit */
983 if (uurb->number_of_packets < 1 || uurb->number_of_packets > 128)
984 return -EINVAL;
985 if ((ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK)
986 != USB_ENDPOINT_XFER_ISOC)
987 return -EINVAL;
988 interval = 1 << min (15, ep->desc.bInterval - 1);
989 isofrmlen = sizeof(struct usbdevfs_iso_packet_desc) * uurb->number_of_packets;
990 if (!(isopkt = kmalloc(isofrmlen, GFP_KERNEL)))
991 return -ENOMEM;
992 if (copy_from_user(isopkt, iso_frame_desc, isofrmlen)) {
993 kfree(isopkt);
994 return -EFAULT;
995 }
996 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
997 /* arbitrary limit, sufficient for USB 2.0 high-bandwidth iso */
998 if (isopkt[u].length > 8192) {
999 kfree(isopkt);
1000 return -EINVAL;
1001 }
1002 totlen += isopkt[u].length;
1003 }
1004 if (totlen > 32768) {
1005 kfree(isopkt);
1006 return -EINVAL;
1007 }
1008 uurb->buffer_length = totlen;
1009 snoop(&ps->dev->dev, "iso urb\n");
1010 break;
1011
1012 case USBDEVFS_URB_TYPE_INTERRUPT:
1013 uurb->number_of_packets = 0;
1014 if ((ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK)
1015 != USB_ENDPOINT_XFER_INT)
1016 return -EINVAL;
1017 if (ps->dev->speed == USB_SPEED_HIGH)
1018 interval = 1 << min (15, ep->desc.bInterval - 1);
1019 else
1020 interval = ep->desc.bInterval;
1021 if (uurb->buffer_length > MAX_USBFS_BUFFER_SIZE)
1022 return -EINVAL;
1023 if (!access_ok((uurb->endpoint & USB_DIR_IN) ? VERIFY_WRITE : VERIFY_READ, uurb->buffer, uurb->buffer_length))
1024 return -EFAULT;
1025 snoop(&ps->dev->dev, "interrupt urb\n");
1026 break;
1027
1028 default:
1029 return -EINVAL;
1030 }
1031 if (!(as = alloc_async(uurb->number_of_packets))) {
1032 kfree(isopkt);
1033 kfree(dr);
1034 return -ENOMEM;
1035 }
1036 if (!(as->urb->transfer_buffer = kmalloc(uurb->buffer_length, GFP_KERNEL))) {
1037 kfree(isopkt);
1038 kfree(dr);
1039 free_async(as);
1040 return -ENOMEM;
1041 }
1042 as->urb->dev = ps->dev;
1043 as->urb->pipe = (uurb->type << 30) | __create_pipe(ps->dev, uurb->endpoint & 0xf) | (uurb->endpoint & USB_DIR_IN);
1044 as->urb->transfer_flags = uurb->flags;
1045 as->urb->transfer_buffer_length = uurb->buffer_length;
1046 as->urb->setup_packet = (unsigned char*)dr;
1047 as->urb->start_frame = uurb->start_frame;
1048 as->urb->number_of_packets = uurb->number_of_packets;
1049 as->urb->interval = interval;
1050 as->urb->context = as;
1051 as->urb->complete = async_completed;
1052 for (totlen = u = 0; u < uurb->number_of_packets; u++) {
1053 as->urb->iso_frame_desc[u].offset = totlen;
1054 as->urb->iso_frame_desc[u].length = isopkt[u].length;
1055 totlen += isopkt[u].length;
1056 }
1057 kfree(isopkt);
1058 as->ps = ps;
1059 as->userurb = arg;
1060 if (uurb->endpoint & USB_DIR_IN)
1061 as->userbuffer = uurb->buffer;
1062 else
1063 as->userbuffer = NULL;
1064 as->signr = uurb->signr;
1065 as->ifnum = ifnum;
1066 as->pid = current->pid;
1067 as->uid = current->uid;
1068 as->euid = current->euid;
1069 security_task_getsecid(current, &as->secid);
1070 if (!(uurb->endpoint & USB_DIR_IN)) {
1071 if (copy_from_user(as->urb->transfer_buffer, uurb->buffer, as->urb->transfer_buffer_length)) {
1072 free_async(as);
1073 return -EFAULT;
1074 }
1075 }
1076 snoop(&as->urb->dev->dev, "submit urb\n");
1077 snoop_urb(as->urb, as->userurb);
1078 async_newpending(as);
1079 if ((ret = usb_submit_urb(as->urb, GFP_KERNEL))) {
1080 dev_printk(KERN_DEBUG, &ps->dev->dev, "usbfs: usb_submit_urb returned %d\n", ret);
1081 async_removepending(as);
1082 free_async(as);
1083 return ret;
1084 }
1085 return 0;
1086 }
1087
1088 static int proc_submiturb(struct dev_state *ps, void __user *arg)
1089 {
1090 struct usbdevfs_urb uurb;
1091
1092 if (copy_from_user(&uurb, arg, sizeof(uurb)))
1093 return -EFAULT;
1094
1095 return proc_do_submiturb(ps, &uurb, (((struct usbdevfs_urb __user *)arg)->iso_frame_desc), arg);
1096 }
1097
1098 static int proc_unlinkurb(struct dev_state *ps, void __user *arg)
1099 {
1100 struct async *as;
1101
1102 as = async_getpending(ps, arg);
1103 if (!as)
1104 return -EINVAL;
1105 usb_kill_urb(as->urb);
1106 return 0;
1107 }
1108
1109 static int processcompl(struct async *as, void __user * __user *arg)
1110 {
1111 struct urb *urb = as->urb;
1112 struct usbdevfs_urb __user *userurb = as->userurb;
1113 void __user *addr = as->userurb;
1114 unsigned int i;
1115
1116 if (as->userbuffer)
1117 if (copy_to_user(as->userbuffer, urb->transfer_buffer, urb->transfer_buffer_length))
1118 return -EFAULT;
1119 if (put_user(urb->status, &userurb->status))
1120 return -EFAULT;
1121 if (put_user(urb->actual_length, &userurb->actual_length))
1122 return -EFAULT;
1123 if (put_user(urb->error_count, &userurb->error_count))
1124 return -EFAULT;
1125
1126 if (usb_pipeisoc(urb->pipe)) {
1127 for (i = 0; i < urb->number_of_packets; i++) {
1128 if (put_user(urb->iso_frame_desc[i].actual_length,
1129 &userurb->iso_frame_desc[i].actual_length))
1130 return -EFAULT;
1131 if (put_user(urb->iso_frame_desc[i].status,
1132 &userurb->iso_frame_desc[i].status))
1133 return -EFAULT;
1134 }
1135 }
1136
1137 free_async(as);
1138
1139 if (put_user(addr, (void __user * __user *)arg))
1140 return -EFAULT;
1141 return 0;
1142 }
1143
1144 static struct async* reap_as(struct dev_state *ps)
1145 {
1146 DECLARE_WAITQUEUE(wait, current);
1147 struct async *as = NULL;
1148 struct usb_device *dev = ps->dev;
1149
1150 add_wait_queue(&ps->wait, &wait);
1151 for (;;) {
1152 __set_current_state(TASK_INTERRUPTIBLE);
1153 if ((as = async_getcompleted(ps)))
1154 break;
1155 if (signal_pending(current))
1156 break;
1157 usb_unlock_device(dev);
1158 schedule();
1159 usb_lock_device(dev);
1160 }
1161 remove_wait_queue(&ps->wait, &wait);
1162 set_current_state(TASK_RUNNING);
1163 return as;
1164 }
1165
1166 static int proc_reapurb(struct dev_state *ps, void __user *arg)
1167 {
1168 struct async *as = reap_as(ps);
1169 if (as)
1170 return processcompl(as, (void __user * __user *)arg);
1171 if (signal_pending(current))
1172 return -EINTR;
1173 return -EIO;
1174 }
1175
1176 static int proc_reapurbnonblock(struct dev_state *ps, void __user *arg)
1177 {
1178 struct async *as;
1179
1180 if (!(as = async_getcompleted(ps)))
1181 return -EAGAIN;
1182 return processcompl(as, (void __user * __user *)arg);
1183 }
1184
1185 #ifdef CONFIG_COMPAT
1186
1187 static int get_urb32(struct usbdevfs_urb *kurb,
1188 struct usbdevfs_urb32 __user *uurb)
1189 {
1190 __u32 uptr;
1191 if (get_user(kurb->type, &uurb->type) ||
1192 __get_user(kurb->endpoint, &uurb->endpoint) ||
1193 __get_user(kurb->status, &uurb->status) ||
1194 __get_user(kurb->flags, &uurb->flags) ||
1195 __get_user(kurb->buffer_length, &uurb->buffer_length) ||
1196 __get_user(kurb->actual_length, &uurb->actual_length) ||
1197 __get_user(kurb->start_frame, &uurb->start_frame) ||
1198 __get_user(kurb->number_of_packets, &uurb->number_of_packets) ||
1199 __get_user(kurb->error_count, &uurb->error_count) ||
1200 __get_user(kurb->signr, &uurb->signr))
1201 return -EFAULT;
1202
1203 if (__get_user(uptr, &uurb->buffer))
1204 return -EFAULT;
1205 kurb->buffer = compat_ptr(uptr);
1206 if (__get_user(uptr, &uurb->buffer))
1207 return -EFAULT;
1208 kurb->usercontext = compat_ptr(uptr);
1209
1210 return 0;
1211 }
1212
1213 static int proc_submiturb_compat(struct dev_state *ps, void __user *arg)
1214 {
1215 struct usbdevfs_urb uurb;
1216
1217 if (get_urb32(&uurb,(struct usbdevfs_urb32 *)arg))
1218 return -EFAULT;
1219
1220 return proc_do_submiturb(ps, &uurb, ((struct usbdevfs_urb32 __user *)arg)->iso_frame_desc, arg);
1221 }
1222
1223 static int processcompl_compat(struct async *as, void __user * __user *arg)
1224 {
1225 struct urb *urb = as->urb;
1226 struct usbdevfs_urb32 __user *userurb = as->userurb;
1227 void __user *addr = as->userurb;
1228 unsigned int i;
1229
1230 if (as->userbuffer)
1231 if (copy_to_user(as->userbuffer, urb->transfer_buffer, urb->transfer_buffer_length))
1232 return -EFAULT;
1233 if (put_user(urb->status, &userurb->status))
1234 return -EFAULT;
1235 if (put_user(urb->actual_length, &userurb->actual_length))
1236 return -EFAULT;
1237 if (put_user(urb->error_count, &userurb->error_count))
1238 return -EFAULT;
1239
1240 if (usb_pipeisoc(urb->pipe)) {
1241 for (i = 0; i < urb->number_of_packets; i++) {
1242 if (put_user(urb->iso_frame_desc[i].actual_length,
1243 &userurb->iso_frame_desc[i].actual_length))
1244 return -EFAULT;
1245 if (put_user(urb->iso_frame_desc[i].status,
1246 &userurb->iso_frame_desc[i].status))
1247 return -EFAULT;
1248 }
1249 }
1250
1251 free_async(as);
1252 if (put_user((u32)(u64)addr, (u32 __user *)arg))
1253 return -EFAULT;
1254 return 0;
1255 }
1256
1257 static int proc_reapurb_compat(struct dev_state *ps, void __user *arg)
1258 {
1259 struct async *as = reap_as(ps);
1260 if (as)
1261 return processcompl_compat(as, (void __user * __user *)arg);
1262 if (signal_pending(current))
1263 return -EINTR;
1264 return -EIO;
1265 }
1266
1267 static int proc_reapurbnonblock_compat(struct dev_state *ps, void __user *arg)
1268 {
1269 struct async *as;
1270
1271 if (!(as = async_getcompleted(ps)))
1272 return -EAGAIN;
1273 return processcompl_compat(as, (void __user * __user *)arg);
1274 }
1275
1276 #endif
1277
1278 static int proc_disconnectsignal(struct dev_state *ps, void __user *arg)
1279 {
1280 struct usbdevfs_disconnectsignal ds;
1281
1282 if (copy_from_user(&ds, arg, sizeof(ds)))
1283 return -EFAULT;
1284 if (ds.signr != 0 && (ds.signr < SIGRTMIN || ds.signr > SIGRTMAX))
1285 return -EINVAL;
1286 ps->discsignr = ds.signr;
1287 ps->disccontext = ds.context;
1288 return 0;
1289 }
1290
1291 static int proc_claiminterface(struct dev_state *ps, void __user *arg)
1292 {
1293 unsigned int ifnum;
1294
1295 if (get_user(ifnum, (unsigned int __user *)arg))
1296 return -EFAULT;
1297 return claimintf(ps, ifnum);
1298 }
1299
1300 static int proc_releaseinterface(struct dev_state *ps, void __user *arg)
1301 {
1302 unsigned int ifnum;
1303 int ret;
1304
1305 if (get_user(ifnum, (unsigned int __user *)arg))
1306 return -EFAULT;
1307 if ((ret = releaseintf(ps, ifnum)) < 0)
1308 return ret;
1309 destroy_async_on_interface (ps, ifnum);
1310 return 0;
1311 }
1312
1313 static int proc_ioctl(struct dev_state *ps, struct usbdevfs_ioctl *ctl)
1314 {
1315 int size;
1316 void *buf = NULL;
1317 int retval = 0;
1318 struct usb_interface *intf = NULL;
1319 struct usb_driver *driver = NULL;
1320
1321 /* alloc buffer */
1322 if ((size = _IOC_SIZE (ctl->ioctl_code)) > 0) {
1323 if ((buf = kmalloc (size, GFP_KERNEL)) == NULL)
1324 return -ENOMEM;
1325 if ((_IOC_DIR(ctl->ioctl_code) & _IOC_WRITE)) {
1326 if (copy_from_user (buf, ctl->data, size)) {
1327 kfree(buf);
1328 return -EFAULT;
1329 }
1330 } else {
1331 memset (buf, 0, size);
1332 }
1333 }
1334
1335 if (!connected(ps)) {
1336 kfree(buf);
1337 return -ENODEV;
1338 }
1339
1340 if (ps->dev->state != USB_STATE_CONFIGURED)
1341 retval = -EHOSTUNREACH;
1342 else if (!(intf = usb_ifnum_to_if (ps->dev, ctl->ifno)))
1343 retval = -EINVAL;
1344 else switch (ctl->ioctl_code) {
1345
1346 /* disconnect kernel driver from interface */
1347 case USBDEVFS_DISCONNECT:
1348
1349 down_write(&usb_bus_type.subsys.rwsem);
1350 if (intf->dev.driver) {
1351 driver = to_usb_driver(intf->dev.driver);
1352 dev_dbg (&intf->dev, "disconnect by usbfs\n");
1353 usb_driver_release_interface(driver, intf);
1354 } else
1355 retval = -ENODATA;
1356 up_write(&usb_bus_type.subsys.rwsem);
1357 break;
1358
1359 /* let kernel drivers try to (re)bind to the interface */
1360 case USBDEVFS_CONNECT:
1361 usb_unlock_device(ps->dev);
1362 retval = bus_rescan_devices(intf->dev.bus);
1363 usb_lock_device(ps->dev);
1364 break;
1365
1366 /* talk directly to the interface's driver */
1367 default:
1368 down_read(&usb_bus_type.subsys.rwsem);
1369 if (intf->dev.driver)
1370 driver = to_usb_driver(intf->dev.driver);
1371 if (driver == NULL || driver->ioctl == NULL) {
1372 retval = -ENOTTY;
1373 } else {
1374 retval = driver->ioctl (intf, ctl->ioctl_code, buf);
1375 if (retval == -ENOIOCTLCMD)
1376 retval = -ENOTTY;
1377 }
1378 up_read(&usb_bus_type.subsys.rwsem);
1379 }
1380
1381 /* cleanup and return */
1382 if (retval >= 0
1383 && (_IOC_DIR (ctl->ioctl_code) & _IOC_READ) != 0
1384 && size > 0
1385 && copy_to_user (ctl->data, buf, size) != 0)
1386 retval = -EFAULT;
1387
1388 kfree(buf);
1389 return retval;
1390 }
1391
1392 static int proc_ioctl_default(struct dev_state *ps, void __user *arg)
1393 {
1394 struct usbdevfs_ioctl ctrl;
1395
1396 if (copy_from_user(&ctrl, arg, sizeof (ctrl)))
1397 return -EFAULT;
1398 return proc_ioctl(ps, &ctrl);
1399 }
1400
1401 #ifdef CONFIG_COMPAT
1402 static int proc_ioctl_compat(struct dev_state *ps, compat_uptr_t arg)
1403 {
1404 struct usbdevfs_ioctl32 __user *uioc;
1405 struct usbdevfs_ioctl ctrl;
1406 u32 udata;
1407
1408 uioc = compat_ptr((long)arg);
1409 if (get_user(ctrl.ifno, &uioc->ifno) ||
1410 get_user(ctrl.ioctl_code, &uioc->ioctl_code) ||
1411 __get_user(udata, &uioc->data))
1412 return -EFAULT;
1413 ctrl.data = compat_ptr(udata);
1414
1415 return proc_ioctl(ps, &ctrl);
1416 }
1417 #endif
1418
1419 /*
1420 * NOTE: All requests here that have interface numbers as parameters
1421 * are assuming that somehow the configuration has been prevented from
1422 * changing. But there's no mechanism to ensure that...
1423 */
1424 static int usbdev_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
1425 {
1426 struct dev_state *ps = file->private_data;
1427 struct usb_device *dev = ps->dev;
1428 void __user *p = (void __user *)arg;
1429 int ret = -ENOTTY;
1430
1431 if (!(file->f_mode & FMODE_WRITE))
1432 return -EPERM;
1433 usb_lock_device(dev);
1434 if (!connected(ps)) {
1435 usb_unlock_device(dev);
1436 return -ENODEV;
1437 }
1438
1439 switch (cmd) {
1440 case USBDEVFS_CONTROL:
1441 snoop(&dev->dev, "%s: CONTROL\n", __FUNCTION__);
1442 ret = proc_control(ps, p);
1443 if (ret >= 0)
1444 inode->i_mtime = CURRENT_TIME;
1445 break;
1446
1447 case USBDEVFS_BULK:
1448 snoop(&dev->dev, "%s: BULK\n", __FUNCTION__);
1449 ret = proc_bulk(ps, p);
1450 if (ret >= 0)
1451 inode->i_mtime = CURRENT_TIME;
1452 break;
1453
1454 case USBDEVFS_RESETEP:
1455 snoop(&dev->dev, "%s: RESETEP\n", __FUNCTION__);
1456 ret = proc_resetep(ps, p);
1457 if (ret >= 0)
1458 inode->i_mtime = CURRENT_TIME;
1459 break;
1460
1461 case USBDEVFS_RESET:
1462 snoop(&dev->dev, "%s: RESET\n", __FUNCTION__);
1463 ret = proc_resetdevice(ps);
1464 break;
1465
1466 case USBDEVFS_CLEAR_HALT:
1467 snoop(&dev->dev, "%s: CLEAR_HALT\n", __FUNCTION__);
1468 ret = proc_clearhalt(ps, p);
1469 if (ret >= 0)
1470 inode->i_mtime = CURRENT_TIME;
1471 break;
1472
1473 case USBDEVFS_GETDRIVER:
1474 snoop(&dev->dev, "%s: GETDRIVER\n", __FUNCTION__);
1475 ret = proc_getdriver(ps, p);
1476 break;
1477
1478 case USBDEVFS_CONNECTINFO:
1479 snoop(&dev->dev, "%s: CONNECTINFO\n", __FUNCTION__);
1480 ret = proc_connectinfo(ps, p);
1481 break;
1482
1483 case USBDEVFS_SETINTERFACE:
1484 snoop(&dev->dev, "%s: SETINTERFACE\n", __FUNCTION__);
1485 ret = proc_setintf(ps, p);
1486 break;
1487
1488 case USBDEVFS_SETCONFIGURATION:
1489 snoop(&dev->dev, "%s: SETCONFIGURATION\n", __FUNCTION__);
1490 ret = proc_setconfig(ps, p);
1491 break;
1492
1493 case USBDEVFS_SUBMITURB:
1494 snoop(&dev->dev, "%s: SUBMITURB\n", __FUNCTION__);
1495 ret = proc_submiturb(ps, p);
1496 if (ret >= 0)
1497 inode->i_mtime = CURRENT_TIME;
1498 break;
1499
1500 #ifdef CONFIG_COMPAT
1501
1502 case USBDEVFS_SUBMITURB32:
1503 snoop(&dev->dev, "%s: SUBMITURB32\n", __FUNCTION__);
1504 ret = proc_submiturb_compat(ps, p);
1505 if (ret >= 0)
1506 inode->i_mtime = CURRENT_TIME;
1507 break;
1508
1509 case USBDEVFS_REAPURB32:
1510 snoop(&dev->dev, "%s: REAPURB32\n", __FUNCTION__);
1511 ret = proc_reapurb_compat(ps, p);
1512 break;
1513
1514 case USBDEVFS_REAPURBNDELAY32:
1515 snoop(&dev->dev, "%s: REAPURBDELAY32\n", __FUNCTION__);
1516 ret = proc_reapurbnonblock_compat(ps, p);
1517 break;
1518
1519 case USBDEVFS_IOCTL32:
1520 snoop(&dev->dev, "%s: IOCTL\n", __FUNCTION__);
1521 ret = proc_ioctl_compat(ps, (compat_uptr_t)(long)p);
1522 break;
1523 #endif
1524
1525 case USBDEVFS_DISCARDURB:
1526 snoop(&dev->dev, "%s: DISCARDURB\n", __FUNCTION__);
1527 ret = proc_unlinkurb(ps, p);
1528 break;
1529
1530 case USBDEVFS_REAPURB:
1531 snoop(&dev->dev, "%s: REAPURB\n", __FUNCTION__);
1532 ret = proc_reapurb(ps, p);
1533 break;
1534
1535 case USBDEVFS_REAPURBNDELAY:
1536 snoop(&dev->dev, "%s: REAPURBDELAY\n", __FUNCTION__);
1537 ret = proc_reapurbnonblock(ps, p);
1538 break;
1539
1540 case USBDEVFS_DISCSIGNAL:
1541 snoop(&dev->dev, "%s: DISCSIGNAL\n", __FUNCTION__);
1542 ret = proc_disconnectsignal(ps, p);
1543 break;
1544
1545 case USBDEVFS_CLAIMINTERFACE:
1546 snoop(&dev->dev, "%s: CLAIMINTERFACE\n", __FUNCTION__);
1547 ret = proc_claiminterface(ps, p);
1548 break;
1549
1550 case USBDEVFS_RELEASEINTERFACE:
1551 snoop(&dev->dev, "%s: RELEASEINTERFACE\n", __FUNCTION__);
1552 ret = proc_releaseinterface(ps, p);
1553 break;
1554
1555 case USBDEVFS_IOCTL:
1556 snoop(&dev->dev, "%s: IOCTL\n", __FUNCTION__);
1557 ret = proc_ioctl_default(ps, p);
1558 break;
1559 }
1560 usb_unlock_device(dev);
1561 if (ret >= 0)
1562 inode->i_atime = CURRENT_TIME;
1563 return ret;
1564 }
1565
1566 /* No kernel lock - fine */
1567 static unsigned int usbdev_poll(struct file *file, struct poll_table_struct *wait)
1568 {
1569 struct dev_state *ps = file->private_data;
1570 unsigned int mask = 0;
1571
1572 poll_wait(file, &ps->wait, wait);
1573 if (file->f_mode & FMODE_WRITE && !list_empty(&ps->async_completed))
1574 mask |= POLLOUT | POLLWRNORM;
1575 if (!connected(ps))
1576 mask |= POLLERR | POLLHUP;
1577 return mask;
1578 }
1579
1580 const struct file_operations usbfs_device_file_operations = {
1581 .llseek = usbdev_lseek,
1582 .read = usbdev_read,
1583 .poll = usbdev_poll,
1584 .ioctl = usbdev_ioctl,
1585 .open = usbdev_open,
1586 .release = usbdev_release,
1587 };
1588
1589 static void usbdev_add(struct usb_device *dev)
1590 {
1591 int minor = ((dev->bus->busnum-1) * 128) + (dev->devnum-1);
1592
1593 dev->class_dev = class_device_create(usb_device_class, NULL,
1594 MKDEV(USB_DEVICE_MAJOR, minor), &dev->dev,
1595 "usbdev%d.%d", dev->bus->busnum, dev->devnum);
1596
1597 dev->class_dev->class_data = dev;
1598 }
1599
1600 static void usbdev_remove(struct usb_device *dev)
1601 {
1602 class_device_unregister(dev->class_dev);
1603 }
1604
1605 static int usbdev_notify(struct notifier_block *self, unsigned long action,
1606 void *dev)
1607 {
1608 switch (action) {
1609 case USB_DEVICE_ADD:
1610 usbdev_add(dev);
1611 break;
1612 case USB_DEVICE_REMOVE:
1613 usbdev_remove(dev);
1614 break;
1615 }
1616 return NOTIFY_OK;
1617 }
1618
1619 static struct notifier_block usbdev_nb = {
1620 .notifier_call = usbdev_notify,
1621 };
1622
1623 static struct cdev usb_device_cdev = {
1624 .kobj = {.name = "usb_device", },
1625 .owner = THIS_MODULE,
1626 };
1627
1628 int __init usbdev_init(void)
1629 {
1630 int retval;
1631
1632 retval = register_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX,
1633 "usb_device");
1634 if (retval) {
1635 err("unable to register minors for usb_device");
1636 goto out;
1637 }
1638 cdev_init(&usb_device_cdev, &usbfs_device_file_operations);
1639 retval = cdev_add(&usb_device_cdev, USB_DEVICE_DEV, USB_DEVICE_MAX);
1640 if (retval) {
1641 err("unable to get usb_device major %d", USB_DEVICE_MAJOR);
1642 goto error_cdev;
1643 }
1644 usb_device_class = class_create(THIS_MODULE, "usb_device");
1645 if (IS_ERR(usb_device_class)) {
1646 err("unable to register usb_device class");
1647 retval = PTR_ERR(usb_device_class);
1648 goto error_class;
1649 }
1650
1651 usb_register_notify(&usbdev_nb);
1652
1653 out:
1654 return retval;
1655
1656 error_class:
1657 usb_device_class = NULL;
1658 cdev_del(&usb_device_cdev);
1659
1660 error_cdev:
1661 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
1662 goto out;
1663 }
1664
1665 void usbdev_cleanup(void)
1666 {
1667 usb_unregister_notify(&usbdev_nb);
1668 class_destroy(usb_device_class);
1669 cdev_del(&usb_device_cdev);
1670 unregister_chrdev_region(USB_DEVICE_DEV, USB_DEVICE_MAX);
1671 }
1672
kernel source for telekom puls (alcatel/mediatek)