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