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