1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * USB Serial Converter driver 4 * 5 * Copyright (C) 2009 - 2013 Johan Hovold (jhovold@gmail.com) 6 * Copyright (C) 1999 - 2012 Greg Kroah-Hartman (greg@kroah.com) 7 * Copyright (C) 2000 Peter Berger (pberger@brimson.com) 8 * Copyright (C) 2000 Al Borchers (borchers@steinerpoint.com) 9 * 10 * This driver was originally based on the ACM driver by Armin Fuerst (which was 11 * based on a driver by Brad Keryan) 12 * 13 * See Documentation/usb/usb-serial.rst for more information on using this 14 * driver 15 */ 16 17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 18 19 #include <linux/kernel.h> 20 #include <linux/errno.h> 21 #include <linux/init.h> 22 #include <linux/slab.h> 23 #include <linux/tty.h> 24 #include <linux/tty_driver.h> 25 #include <linux/tty_flip.h> 26 #include <linux/module.h> 27 #include <linux/moduleparam.h> 28 #include <linux/seq_file.h> 29 #include <linux/spinlock.h> 30 #include <linux/mutex.h> 31 #include <linux/list.h> 32 #include <linux/uaccess.h> 33 #include <linux/serial.h> 34 #include <linux/usb.h> 35 #include <linux/usb/serial.h> 36 #include <linux/kfifo.h> 37 #include <linux/idr.h> 38 39 #define DRIVER_AUTHOR "Greg Kroah-Hartman <gregkh@linuxfoundation.org>" 40 #define DRIVER_DESC "USB Serial Driver core" 41 42 #define USB_SERIAL_TTY_MAJOR 188 43 #define USB_SERIAL_TTY_MINORS 512 /* should be enough for a while */ 44 45 /* There is no MODULE_DEVICE_TABLE for usbserial.c. Instead 46 the MODULE_DEVICE_TABLE declarations in each serial driver 47 cause the "hotplug" program to pull in whatever module is necessary 48 via modprobe, and modprobe will load usbserial because the serial 49 drivers depend on it. 50 */ 51 52 static DEFINE_IDR(serial_minors); 53 static DEFINE_MUTEX(table_lock); 54 static LIST_HEAD(usb_serial_driver_list); 55 56 /* 57 * Look up the serial port structure. If it is found and it hasn't been 58 * disconnected, return with the parent usb_serial structure's disc_mutex held 59 * and its refcount incremented. Otherwise return NULL. 60 */ 61 struct usb_serial_port *usb_serial_port_get_by_minor(unsigned minor) 62 { 63 struct usb_serial *serial; 64 struct usb_serial_port *port; 65 66 mutex_lock(&table_lock); 67 port = idr_find(&serial_minors, minor); 68 if (!port) 69 goto exit; 70 71 serial = port->serial; 72 mutex_lock(&serial->disc_mutex); 73 if (serial->disconnected) { 74 mutex_unlock(&serial->disc_mutex); 75 port = NULL; 76 } else { 77 kref_get(&serial->kref); 78 } 79 exit: 80 mutex_unlock(&table_lock); 81 return port; 82 } 83 84 static int allocate_minors(struct usb_serial *serial, int num_ports) 85 { 86 struct usb_serial_port *port; 87 unsigned int i, j; 88 int minor; 89 90 dev_dbg(&serial->interface->dev, "%s %d\n", __func__, num_ports); 91 92 mutex_lock(&table_lock); 93 for (i = 0; i < num_ports; ++i) { 94 port = serial->port[i]; 95 minor = idr_alloc(&serial_minors, port, 0, 96 USB_SERIAL_TTY_MINORS, GFP_KERNEL); 97 if (minor < 0) 98 goto error; 99 port->minor = minor; 100 port->port_number = i; 101 } 102 serial->minors_reserved = 1; 103 mutex_unlock(&table_lock); 104 return 0; 105 error: 106 /* unwind the already allocated minors */ 107 for (j = 0; j < i; ++j) 108 idr_remove(&serial_minors, serial->port[j]->minor); 109 mutex_unlock(&table_lock); 110 return minor; 111 } 112 113 static void release_minors(struct usb_serial *serial) 114 { 115 int i; 116 117 mutex_lock(&table_lock); 118 for (i = 0; i < serial->num_ports; ++i) 119 idr_remove(&serial_minors, serial->port[i]->minor); 120 mutex_unlock(&table_lock); 121 serial->minors_reserved = 0; 122 } 123 124 int usb_serial_claim_interface(struct usb_serial *serial, struct usb_interface *intf) 125 { 126 struct usb_driver *driver = serial->type->usb_driver; 127 int ret; 128 129 if (serial->sibling) 130 return -EBUSY; 131 132 ret = usb_driver_claim_interface(driver, intf, serial); 133 if (ret) { 134 dev_err(&serial->interface->dev, 135 "failed to claim sibling interface: %d\n", ret); 136 return ret; 137 } 138 139 serial->sibling = intf; 140 141 return 0; 142 } 143 EXPORT_SYMBOL_GPL(usb_serial_claim_interface); 144 145 static void release_sibling(struct usb_serial *serial, struct usb_interface *intf) 146 { 147 struct usb_driver *driver = serial->type->usb_driver; 148 struct usb_interface *sibling; 149 150 if (!serial->sibling) 151 return; 152 153 if (intf == serial->sibling) 154 sibling = serial->interface; 155 else 156 sibling = serial->sibling; 157 158 usb_set_intfdata(sibling, NULL); 159 usb_driver_release_interface(driver, sibling); 160 } 161 162 static void destroy_serial(struct kref *kref) 163 { 164 struct usb_serial *serial; 165 struct usb_serial_port *port; 166 int i; 167 168 serial = to_usb_serial(kref); 169 170 /* return the minor range that this device had */ 171 if (serial->minors_reserved) 172 release_minors(serial); 173 174 if (serial->attached && serial->type->release) 175 serial->type->release(serial); 176 177 /* Now that nothing is using the ports, they can be freed */ 178 for (i = 0; i < serial->num_port_pointers; ++i) { 179 port = serial->port[i]; 180 if (port) { 181 port->serial = NULL; 182 put_device(&port->dev); 183 } 184 } 185 186 usb_put_intf(serial->interface); 187 usb_put_dev(serial->dev); 188 kfree(serial); 189 } 190 191 void usb_serial_put(struct usb_serial *serial) 192 { 193 kref_put(&serial->kref, destroy_serial); 194 } 195 196 /***************************************************************************** 197 * Driver tty interface functions 198 *****************************************************************************/ 199 200 /** 201 * serial_install - install tty 202 * @driver: the driver (USB in our case) 203 * @tty: the tty being created 204 * 205 * Initialise the termios structure for this tty. We use the default 206 * USB serial settings but permit them to be overridden by 207 * serial->type->init_termios on first open. 208 * 209 * This is the first place a new tty gets used. Hence this is where we 210 * acquire references to the usb_serial structure and the driver module, 211 * where we store a pointer to the port. All these actions are reversed 212 * in serial_cleanup(). 213 */ 214 static int serial_install(struct tty_driver *driver, struct tty_struct *tty) 215 { 216 int idx = tty->index; 217 struct usb_serial *serial; 218 struct usb_serial_port *port; 219 bool init_termios; 220 int retval = -ENODEV; 221 222 port = usb_serial_port_get_by_minor(idx); 223 if (!port) 224 return retval; 225 226 serial = port->serial; 227 if (!try_module_get(serial->type->driver.owner)) 228 goto err_put_serial; 229 230 init_termios = (driver->termios[idx] == NULL); 231 232 retval = tty_standard_install(driver, tty); 233 if (retval) 234 goto err_put_module; 235 236 mutex_unlock(&serial->disc_mutex); 237 238 /* allow the driver to update the initial settings */ 239 if (init_termios && serial->type->init_termios) 240 serial->type->init_termios(tty); 241 242 tty->driver_data = port; 243 244 return retval; 245 246 err_put_module: 247 module_put(serial->type->driver.owner); 248 err_put_serial: 249 usb_serial_put(serial); 250 mutex_unlock(&serial->disc_mutex); 251 return retval; 252 } 253 254 static int serial_port_activate(struct tty_port *tport, struct tty_struct *tty) 255 { 256 struct usb_serial_port *port = 257 container_of(tport, struct usb_serial_port, port); 258 struct usb_serial *serial = port->serial; 259 int retval; 260 261 mutex_lock(&serial->disc_mutex); 262 if (serial->disconnected) { 263 retval = -ENODEV; 264 goto out_unlock; 265 } 266 267 retval = usb_autopm_get_interface(serial->interface); 268 if (retval) 269 goto out_unlock; 270 271 retval = port->serial->type->open(tty, port); 272 if (retval) 273 usb_autopm_put_interface(serial->interface); 274 out_unlock: 275 mutex_unlock(&serial->disc_mutex); 276 277 if (retval < 0) 278 retval = usb_translate_errors(retval); 279 280 return retval; 281 } 282 283 static int serial_open(struct tty_struct *tty, struct file *filp) 284 { 285 struct usb_serial_port *port = tty->driver_data; 286 287 dev_dbg(&port->dev, "%s\n", __func__); 288 289 return tty_port_open(&port->port, tty, filp); 290 } 291 292 /** 293 * serial_port_shutdown - shut down hardware 294 * @tport: tty port to shut down 295 * 296 * Shut down a USB serial port. Serialized against activate by the 297 * tport mutex and kept to matching open/close pairs 298 * of calls by the tty-port initialized flag. 299 * 300 * Not called if tty is console. 301 */ 302 static void serial_port_shutdown(struct tty_port *tport) 303 { 304 struct usb_serial_port *port = 305 container_of(tport, struct usb_serial_port, port); 306 struct usb_serial_driver *drv = port->serial->type; 307 308 if (drv->close) 309 drv->close(port); 310 311 usb_autopm_put_interface(port->serial->interface); 312 } 313 314 static void serial_hangup(struct tty_struct *tty) 315 { 316 struct usb_serial_port *port = tty->driver_data; 317 318 dev_dbg(&port->dev, "%s\n", __func__); 319 320 tty_port_hangup(&port->port); 321 } 322 323 static void serial_close(struct tty_struct *tty, struct file *filp) 324 { 325 struct usb_serial_port *port = tty->driver_data; 326 327 dev_dbg(&port->dev, "%s\n", __func__); 328 329 tty_port_close(&port->port, tty, filp); 330 } 331 332 /** 333 * serial_cleanup - free resources post close/hangup 334 * @tty: tty to clean up 335 * 336 * Do the resource freeing and refcount dropping for the port. 337 * Avoid freeing the console. 338 * 339 * Called asynchronously after the last tty kref is dropped. 340 */ 341 static void serial_cleanup(struct tty_struct *tty) 342 { 343 struct usb_serial_port *port = tty->driver_data; 344 struct usb_serial *serial; 345 struct module *owner; 346 347 dev_dbg(&port->dev, "%s\n", __func__); 348 349 /* The console is magical. Do not hang up the console hardware 350 * or there will be tears. 351 */ 352 if (port->port.console) 353 return; 354 355 tty->driver_data = NULL; 356 357 serial = port->serial; 358 owner = serial->type->driver.owner; 359 360 usb_serial_put(serial); 361 module_put(owner); 362 } 363 364 static int serial_write(struct tty_struct *tty, const unsigned char *buf, 365 int count) 366 { 367 struct usb_serial_port *port = tty->driver_data; 368 int retval = -ENODEV; 369 370 if (port->serial->dev->state == USB_STATE_NOTATTACHED) 371 goto exit; 372 373 dev_dbg(&port->dev, "%s - %d byte(s)\n", __func__, count); 374 375 retval = port->serial->type->write(tty, port, buf, count); 376 if (retval < 0) 377 retval = usb_translate_errors(retval); 378 exit: 379 return retval; 380 } 381 382 static unsigned int serial_write_room(struct tty_struct *tty) 383 { 384 struct usb_serial_port *port = tty->driver_data; 385 386 dev_dbg(&port->dev, "%s\n", __func__); 387 388 return port->serial->type->write_room(tty); 389 } 390 391 static unsigned int serial_chars_in_buffer(struct tty_struct *tty) 392 { 393 struct usb_serial_port *port = tty->driver_data; 394 struct usb_serial *serial = port->serial; 395 396 dev_dbg(&port->dev, "%s\n", __func__); 397 398 if (serial->disconnected) 399 return 0; 400 401 return serial->type->chars_in_buffer(tty); 402 } 403 404 static void serial_wait_until_sent(struct tty_struct *tty, int timeout) 405 { 406 struct usb_serial_port *port = tty->driver_data; 407 struct usb_serial *serial = port->serial; 408 409 dev_dbg(&port->dev, "%s\n", __func__); 410 411 if (!port->serial->type->wait_until_sent) 412 return; 413 414 mutex_lock(&serial->disc_mutex); 415 if (!serial->disconnected) 416 port->serial->type->wait_until_sent(tty, timeout); 417 mutex_unlock(&serial->disc_mutex); 418 } 419 420 static void serial_throttle(struct tty_struct *tty) 421 { 422 struct usb_serial_port *port = tty->driver_data; 423 424 dev_dbg(&port->dev, "%s\n", __func__); 425 426 if (port->serial->type->throttle) 427 port->serial->type->throttle(tty); 428 } 429 430 static void serial_unthrottle(struct tty_struct *tty) 431 { 432 struct usb_serial_port *port = tty->driver_data; 433 434 dev_dbg(&port->dev, "%s\n", __func__); 435 436 if (port->serial->type->unthrottle) 437 port->serial->type->unthrottle(tty); 438 } 439 440 static int serial_get_serial(struct tty_struct *tty, struct serial_struct *ss) 441 { 442 struct usb_serial_port *port = tty->driver_data; 443 struct tty_port *tport = &port->port; 444 unsigned int close_delay, closing_wait; 445 446 mutex_lock(&tport->mutex); 447 448 close_delay = jiffies_to_msecs(tport->close_delay) / 10; 449 closing_wait = tport->closing_wait; 450 if (closing_wait != ASYNC_CLOSING_WAIT_NONE) 451 closing_wait = jiffies_to_msecs(closing_wait) / 10; 452 453 ss->line = port->minor; 454 ss->close_delay = close_delay; 455 ss->closing_wait = closing_wait; 456 457 if (port->serial->type->get_serial) 458 port->serial->type->get_serial(tty, ss); 459 460 mutex_unlock(&tport->mutex); 461 462 return 0; 463 } 464 465 static int serial_set_serial(struct tty_struct *tty, struct serial_struct *ss) 466 { 467 struct usb_serial_port *port = tty->driver_data; 468 struct tty_port *tport = &port->port; 469 unsigned int close_delay, closing_wait; 470 int ret = 0; 471 472 close_delay = msecs_to_jiffies(ss->close_delay * 10); 473 closing_wait = ss->closing_wait; 474 if (closing_wait != ASYNC_CLOSING_WAIT_NONE) 475 closing_wait = msecs_to_jiffies(closing_wait * 10); 476 477 mutex_lock(&tport->mutex); 478 479 if (!capable(CAP_SYS_ADMIN)) { 480 if (close_delay != tport->close_delay || 481 closing_wait != tport->closing_wait) { 482 ret = -EPERM; 483 goto out_unlock; 484 } 485 } 486 487 if (port->serial->type->set_serial) { 488 ret = port->serial->type->set_serial(tty, ss); 489 if (ret) 490 goto out_unlock; 491 } 492 493 tport->close_delay = close_delay; 494 tport->closing_wait = closing_wait; 495 out_unlock: 496 mutex_unlock(&tport->mutex); 497 498 return ret; 499 } 500 501 static int serial_ioctl(struct tty_struct *tty, 502 unsigned int cmd, unsigned long arg) 503 { 504 struct usb_serial_port *port = tty->driver_data; 505 int retval = -ENOIOCTLCMD; 506 507 dev_dbg(&port->dev, "%s - cmd 0x%04x\n", __func__, cmd); 508 509 switch (cmd) { 510 case TIOCMIWAIT: 511 if (port->serial->type->tiocmiwait) 512 retval = port->serial->type->tiocmiwait(tty, arg); 513 break; 514 default: 515 if (port->serial->type->ioctl) 516 retval = port->serial->type->ioctl(tty, cmd, arg); 517 } 518 519 return retval; 520 } 521 522 static void serial_set_termios(struct tty_struct *tty, 523 const struct ktermios *old) 524 { 525 struct usb_serial_port *port = tty->driver_data; 526 527 dev_dbg(&port->dev, "%s\n", __func__); 528 529 if (port->serial->type->set_termios) 530 port->serial->type->set_termios(tty, port, old); 531 else 532 tty_termios_copy_hw(&tty->termios, old); 533 } 534 535 static int serial_break(struct tty_struct *tty, int break_state) 536 { 537 struct usb_serial_port *port = tty->driver_data; 538 539 dev_dbg(&port->dev, "%s\n", __func__); 540 541 if (port->serial->type->break_ctl) 542 port->serial->type->break_ctl(tty, break_state); 543 544 return 0; 545 } 546 547 static int serial_proc_show(struct seq_file *m, void *v) 548 { 549 struct usb_serial *serial; 550 struct usb_serial_port *port; 551 int i; 552 char tmp[40]; 553 554 seq_puts(m, "usbserinfo:1.0 driver:2.0\n"); 555 for (i = 0; i < USB_SERIAL_TTY_MINORS; ++i) { 556 port = usb_serial_port_get_by_minor(i); 557 if (port == NULL) 558 continue; 559 serial = port->serial; 560 561 seq_printf(m, "%d:", i); 562 if (serial->type->driver.owner) 563 seq_printf(m, " module:%s", 564 module_name(serial->type->driver.owner)); 565 seq_printf(m, " name:\"%s\"", 566 serial->type->description); 567 seq_printf(m, " vendor:%04x product:%04x", 568 le16_to_cpu(serial->dev->descriptor.idVendor), 569 le16_to_cpu(serial->dev->descriptor.idProduct)); 570 seq_printf(m, " num_ports:%d", serial->num_ports); 571 seq_printf(m, " port:%d", port->port_number); 572 usb_make_path(serial->dev, tmp, sizeof(tmp)); 573 seq_printf(m, " path:%s", tmp); 574 575 seq_putc(m, '\n'); 576 usb_serial_put(serial); 577 mutex_unlock(&serial->disc_mutex); 578 } 579 return 0; 580 } 581 582 static int serial_tiocmget(struct tty_struct *tty) 583 { 584 struct usb_serial_port *port = tty->driver_data; 585 586 dev_dbg(&port->dev, "%s\n", __func__); 587 588 if (port->serial->type->tiocmget) 589 return port->serial->type->tiocmget(tty); 590 return -ENOTTY; 591 } 592 593 static int serial_tiocmset(struct tty_struct *tty, 594 unsigned int set, unsigned int clear) 595 { 596 struct usb_serial_port *port = tty->driver_data; 597 598 dev_dbg(&port->dev, "%s\n", __func__); 599 600 if (port->serial->type->tiocmset) 601 return port->serial->type->tiocmset(tty, set, clear); 602 return -ENOTTY; 603 } 604 605 static int serial_get_icount(struct tty_struct *tty, 606 struct serial_icounter_struct *icount) 607 { 608 struct usb_serial_port *port = tty->driver_data; 609 610 dev_dbg(&port->dev, "%s\n", __func__); 611 612 if (port->serial->type->get_icount) 613 return port->serial->type->get_icount(tty, icount); 614 return -ENOTTY; 615 } 616 617 /* 618 * We would be calling tty_wakeup here, but unfortunately some line 619 * disciplines have an annoying habit of calling tty->write from 620 * the write wakeup callback (e.g. n_hdlc.c). 621 */ 622 void usb_serial_port_softint(struct usb_serial_port *port) 623 { 624 schedule_work(&port->work); 625 } 626 EXPORT_SYMBOL_GPL(usb_serial_port_softint); 627 628 static void usb_serial_port_work(struct work_struct *work) 629 { 630 struct usb_serial_port *port = 631 container_of(work, struct usb_serial_port, work); 632 633 tty_port_tty_wakeup(&port->port); 634 } 635 636 static void usb_serial_port_poison_urbs(struct usb_serial_port *port) 637 { 638 int i; 639 640 for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) 641 usb_poison_urb(port->read_urbs[i]); 642 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) 643 usb_poison_urb(port->write_urbs[i]); 644 645 usb_poison_urb(port->interrupt_in_urb); 646 usb_poison_urb(port->interrupt_out_urb); 647 } 648 649 static void usb_serial_port_unpoison_urbs(struct usb_serial_port *port) 650 { 651 int i; 652 653 for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) 654 usb_unpoison_urb(port->read_urbs[i]); 655 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) 656 usb_unpoison_urb(port->write_urbs[i]); 657 658 usb_unpoison_urb(port->interrupt_in_urb); 659 usb_unpoison_urb(port->interrupt_out_urb); 660 } 661 662 static void usb_serial_port_release(struct device *dev) 663 { 664 struct usb_serial_port *port = to_usb_serial_port(dev); 665 int i; 666 667 dev_dbg(dev, "%s\n", __func__); 668 669 usb_free_urb(port->interrupt_in_urb); 670 usb_free_urb(port->interrupt_out_urb); 671 for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) { 672 usb_free_urb(port->read_urbs[i]); 673 kfree(port->bulk_in_buffers[i]); 674 } 675 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) { 676 usb_free_urb(port->write_urbs[i]); 677 kfree(port->bulk_out_buffers[i]); 678 } 679 kfifo_free(&port->write_fifo); 680 kfree(port->interrupt_in_buffer); 681 kfree(port->interrupt_out_buffer); 682 tty_port_destroy(&port->port); 683 kfree(port); 684 } 685 686 static struct usb_serial *create_serial(struct usb_device *dev, 687 struct usb_interface *interface, 688 struct usb_serial_driver *driver) 689 { 690 struct usb_serial *serial; 691 692 serial = kzalloc(sizeof(*serial), GFP_KERNEL); 693 if (!serial) 694 return NULL; 695 serial->dev = usb_get_dev(dev); 696 serial->type = driver; 697 serial->interface = usb_get_intf(interface); 698 kref_init(&serial->kref); 699 mutex_init(&serial->disc_mutex); 700 serial->minors_reserved = 0; 701 702 return serial; 703 } 704 705 static const struct usb_device_id *match_dynamic_id(struct usb_interface *intf, 706 struct usb_serial_driver *drv) 707 { 708 struct usb_dynid *dynid; 709 710 spin_lock(&drv->dynids.lock); 711 list_for_each_entry(dynid, &drv->dynids.list, node) { 712 if (usb_match_one_id(intf, &dynid->id)) { 713 spin_unlock(&drv->dynids.lock); 714 return &dynid->id; 715 } 716 } 717 spin_unlock(&drv->dynids.lock); 718 return NULL; 719 } 720 721 static const struct usb_device_id *get_iface_id(struct usb_serial_driver *drv, 722 struct usb_interface *intf) 723 { 724 const struct usb_device_id *id; 725 726 id = usb_match_id(intf, drv->id_table); 727 if (id) { 728 dev_dbg(&intf->dev, "static descriptor matches\n"); 729 goto exit; 730 } 731 id = match_dynamic_id(intf, drv); 732 if (id) 733 dev_dbg(&intf->dev, "dynamic descriptor matches\n"); 734 exit: 735 return id; 736 } 737 738 /* Caller must hold table_lock */ 739 static struct usb_serial_driver *search_serial_device( 740 struct usb_interface *iface) 741 { 742 const struct usb_device_id *id = NULL; 743 struct usb_serial_driver *drv; 744 struct usb_driver *driver = to_usb_driver(iface->dev.driver); 745 746 /* Check if the usb id matches a known device */ 747 list_for_each_entry(drv, &usb_serial_driver_list, driver_list) { 748 if (drv->usb_driver == driver) 749 id = get_iface_id(drv, iface); 750 if (id) 751 return drv; 752 } 753 754 return NULL; 755 } 756 757 static int serial_port_carrier_raised(struct tty_port *port) 758 { 759 struct usb_serial_port *p = container_of(port, struct usb_serial_port, port); 760 struct usb_serial_driver *drv = p->serial->type; 761 762 if (drv->carrier_raised) 763 return drv->carrier_raised(p); 764 /* No carrier control - don't block */ 765 return 1; 766 } 767 768 static void serial_port_dtr_rts(struct tty_port *port, int on) 769 { 770 struct usb_serial_port *p = container_of(port, struct usb_serial_port, port); 771 struct usb_serial_driver *drv = p->serial->type; 772 773 if (drv->dtr_rts) 774 drv->dtr_rts(p, on); 775 } 776 777 static ssize_t port_number_show(struct device *dev, 778 struct device_attribute *attr, char *buf) 779 { 780 struct usb_serial_port *port = to_usb_serial_port(dev); 781 782 return sprintf(buf, "%u\n", port->port_number); 783 } 784 static DEVICE_ATTR_RO(port_number); 785 786 static struct attribute *usb_serial_port_attrs[] = { 787 &dev_attr_port_number.attr, 788 NULL 789 }; 790 ATTRIBUTE_GROUPS(usb_serial_port); 791 792 static const struct tty_port_operations serial_port_ops = { 793 .carrier_raised = serial_port_carrier_raised, 794 .dtr_rts = serial_port_dtr_rts, 795 .activate = serial_port_activate, 796 .shutdown = serial_port_shutdown, 797 }; 798 799 static void store_endpoint(struct usb_serial *serial, 800 struct usb_serial_endpoints *epds, 801 struct usb_endpoint_descriptor *epd) 802 { 803 struct device *dev = &serial->interface->dev; 804 u8 addr = epd->bEndpointAddress; 805 806 if (usb_endpoint_is_bulk_in(epd)) { 807 if (epds->num_bulk_in == ARRAY_SIZE(epds->bulk_in)) 808 return; 809 dev_dbg(dev, "found bulk in endpoint %02x\n", addr); 810 epds->bulk_in[epds->num_bulk_in++] = epd; 811 } else if (usb_endpoint_is_bulk_out(epd)) { 812 if (epds->num_bulk_out == ARRAY_SIZE(epds->bulk_out)) 813 return; 814 dev_dbg(dev, "found bulk out endpoint %02x\n", addr); 815 epds->bulk_out[epds->num_bulk_out++] = epd; 816 } else if (usb_endpoint_is_int_in(epd)) { 817 if (epds->num_interrupt_in == ARRAY_SIZE(epds->interrupt_in)) 818 return; 819 dev_dbg(dev, "found interrupt in endpoint %02x\n", addr); 820 epds->interrupt_in[epds->num_interrupt_in++] = epd; 821 } else if (usb_endpoint_is_int_out(epd)) { 822 if (epds->num_interrupt_out == ARRAY_SIZE(epds->interrupt_out)) 823 return; 824 dev_dbg(dev, "found interrupt out endpoint %02x\n", addr); 825 epds->interrupt_out[epds->num_interrupt_out++] = epd; 826 } 827 } 828 829 static void find_endpoints(struct usb_serial *serial, 830 struct usb_serial_endpoints *epds, 831 struct usb_interface *intf) 832 { 833 struct usb_host_interface *iface_desc; 834 struct usb_endpoint_descriptor *epd; 835 unsigned int i; 836 837 iface_desc = intf->cur_altsetting; 838 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { 839 epd = &iface_desc->endpoint[i].desc; 840 store_endpoint(serial, epds, epd); 841 } 842 } 843 844 static int setup_port_bulk_in(struct usb_serial_port *port, 845 struct usb_endpoint_descriptor *epd) 846 { 847 struct usb_serial_driver *type = port->serial->type; 848 struct usb_device *udev = port->serial->dev; 849 int buffer_size; 850 int i; 851 852 buffer_size = max_t(int, type->bulk_in_size, usb_endpoint_maxp(epd)); 853 port->bulk_in_size = buffer_size; 854 port->bulk_in_endpointAddress = epd->bEndpointAddress; 855 856 for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) { 857 set_bit(i, &port->read_urbs_free); 858 port->read_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); 859 if (!port->read_urbs[i]) 860 return -ENOMEM; 861 port->bulk_in_buffers[i] = kmalloc(buffer_size, GFP_KERNEL); 862 if (!port->bulk_in_buffers[i]) 863 return -ENOMEM; 864 usb_fill_bulk_urb(port->read_urbs[i], udev, 865 usb_rcvbulkpipe(udev, epd->bEndpointAddress), 866 port->bulk_in_buffers[i], buffer_size, 867 type->read_bulk_callback, port); 868 } 869 870 port->read_urb = port->read_urbs[0]; 871 port->bulk_in_buffer = port->bulk_in_buffers[0]; 872 873 return 0; 874 } 875 876 static int setup_port_bulk_out(struct usb_serial_port *port, 877 struct usb_endpoint_descriptor *epd) 878 { 879 struct usb_serial_driver *type = port->serial->type; 880 struct usb_device *udev = port->serial->dev; 881 int buffer_size; 882 int i; 883 884 if (kfifo_alloc(&port->write_fifo, PAGE_SIZE, GFP_KERNEL)) 885 return -ENOMEM; 886 if (type->bulk_out_size) 887 buffer_size = type->bulk_out_size; 888 else 889 buffer_size = usb_endpoint_maxp(epd); 890 port->bulk_out_size = buffer_size; 891 port->bulk_out_endpointAddress = epd->bEndpointAddress; 892 893 for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) { 894 set_bit(i, &port->write_urbs_free); 895 port->write_urbs[i] = usb_alloc_urb(0, GFP_KERNEL); 896 if (!port->write_urbs[i]) 897 return -ENOMEM; 898 port->bulk_out_buffers[i] = kmalloc(buffer_size, GFP_KERNEL); 899 if (!port->bulk_out_buffers[i]) 900 return -ENOMEM; 901 usb_fill_bulk_urb(port->write_urbs[i], udev, 902 usb_sndbulkpipe(udev, epd->bEndpointAddress), 903 port->bulk_out_buffers[i], buffer_size, 904 type->write_bulk_callback, port); 905 } 906 907 port->write_urb = port->write_urbs[0]; 908 port->bulk_out_buffer = port->bulk_out_buffers[0]; 909 910 return 0; 911 } 912 913 static int setup_port_interrupt_in(struct usb_serial_port *port, 914 struct usb_endpoint_descriptor *epd) 915 { 916 struct usb_serial_driver *type = port->serial->type; 917 struct usb_device *udev = port->serial->dev; 918 int buffer_size; 919 920 port->interrupt_in_urb = usb_alloc_urb(0, GFP_KERNEL); 921 if (!port->interrupt_in_urb) 922 return -ENOMEM; 923 buffer_size = usb_endpoint_maxp(epd); 924 port->interrupt_in_endpointAddress = epd->bEndpointAddress; 925 port->interrupt_in_buffer = kmalloc(buffer_size, GFP_KERNEL); 926 if (!port->interrupt_in_buffer) 927 return -ENOMEM; 928 usb_fill_int_urb(port->interrupt_in_urb, udev, 929 usb_rcvintpipe(udev, epd->bEndpointAddress), 930 port->interrupt_in_buffer, buffer_size, 931 type->read_int_callback, port, 932 epd->bInterval); 933 934 return 0; 935 } 936 937 static int setup_port_interrupt_out(struct usb_serial_port *port, 938 struct usb_endpoint_descriptor *epd) 939 { 940 struct usb_serial_driver *type = port->serial->type; 941 struct usb_device *udev = port->serial->dev; 942 int buffer_size; 943 944 port->interrupt_out_urb = usb_alloc_urb(0, GFP_KERNEL); 945 if (!port->interrupt_out_urb) 946 return -ENOMEM; 947 buffer_size = usb_endpoint_maxp(epd); 948 port->interrupt_out_size = buffer_size; 949 port->interrupt_out_endpointAddress = epd->bEndpointAddress; 950 port->interrupt_out_buffer = kmalloc(buffer_size, GFP_KERNEL); 951 if (!port->interrupt_out_buffer) 952 return -ENOMEM; 953 usb_fill_int_urb(port->interrupt_out_urb, udev, 954 usb_sndintpipe(udev, epd->bEndpointAddress), 955 port->interrupt_out_buffer, buffer_size, 956 type->write_int_callback, port, 957 epd->bInterval); 958 959 return 0; 960 } 961 962 static int usb_serial_probe(struct usb_interface *interface, 963 const struct usb_device_id *id) 964 { 965 struct device *ddev = &interface->dev; 966 struct usb_device *dev = interface_to_usbdev(interface); 967 struct usb_serial *serial = NULL; 968 struct usb_serial_port *port; 969 struct usb_serial_endpoints *epds; 970 struct usb_serial_driver *type = NULL; 971 int retval; 972 int i; 973 int num_ports = 0; 974 unsigned char max_endpoints; 975 976 mutex_lock(&table_lock); 977 type = search_serial_device(interface); 978 if (!type) { 979 mutex_unlock(&table_lock); 980 dev_dbg(ddev, "none matched\n"); 981 return -ENODEV; 982 } 983 984 if (!try_module_get(type->driver.owner)) { 985 mutex_unlock(&table_lock); 986 dev_err(ddev, "module get failed, exiting\n"); 987 return -EIO; 988 } 989 mutex_unlock(&table_lock); 990 991 serial = create_serial(dev, interface, type); 992 if (!serial) { 993 retval = -ENOMEM; 994 goto err_put_module; 995 } 996 997 /* if this device type has a probe function, call it */ 998 if (type->probe) { 999 const struct usb_device_id *id; 1000 1001 id = get_iface_id(type, interface); 1002 retval = type->probe(serial, id); 1003 1004 if (retval) { 1005 dev_dbg(ddev, "sub driver rejected device\n"); 1006 goto err_release_sibling; 1007 } 1008 } 1009 1010 /* descriptor matches, let's find the endpoints needed */ 1011 epds = kzalloc(sizeof(*epds), GFP_KERNEL); 1012 if (!epds) { 1013 retval = -ENOMEM; 1014 goto err_release_sibling; 1015 } 1016 1017 find_endpoints(serial, epds, interface); 1018 if (serial->sibling) 1019 find_endpoints(serial, epds, serial->sibling); 1020 1021 if (epds->num_bulk_in < type->num_bulk_in || 1022 epds->num_bulk_out < type->num_bulk_out || 1023 epds->num_interrupt_in < type->num_interrupt_in || 1024 epds->num_interrupt_out < type->num_interrupt_out) { 1025 dev_err(ddev, "required endpoints missing\n"); 1026 retval = -ENODEV; 1027 goto err_free_epds; 1028 } 1029 1030 if (type->calc_num_ports) { 1031 retval = type->calc_num_ports(serial, epds); 1032 if (retval < 0) 1033 goto err_free_epds; 1034 num_ports = retval; 1035 } 1036 1037 if (!num_ports) 1038 num_ports = type->num_ports; 1039 1040 if (num_ports > MAX_NUM_PORTS) { 1041 dev_warn(ddev, "too many ports requested: %d\n", num_ports); 1042 num_ports = MAX_NUM_PORTS; 1043 } 1044 1045 serial->num_ports = (unsigned char)num_ports; 1046 serial->num_bulk_in = epds->num_bulk_in; 1047 serial->num_bulk_out = epds->num_bulk_out; 1048 serial->num_interrupt_in = epds->num_interrupt_in; 1049 serial->num_interrupt_out = epds->num_interrupt_out; 1050 1051 /* found all that we need */ 1052 dev_info(ddev, "%s converter detected\n", type->description); 1053 1054 /* create our ports, we need as many as the max endpoints */ 1055 /* we don't use num_ports here because some devices have more 1056 endpoint pairs than ports */ 1057 max_endpoints = max(epds->num_bulk_in, epds->num_bulk_out); 1058 max_endpoints = max(max_endpoints, epds->num_interrupt_in); 1059 max_endpoints = max(max_endpoints, epds->num_interrupt_out); 1060 max_endpoints = max(max_endpoints, serial->num_ports); 1061 serial->num_port_pointers = max_endpoints; 1062 1063 dev_dbg(ddev, "setting up %d port structure(s)\n", max_endpoints); 1064 for (i = 0; i < max_endpoints; ++i) { 1065 port = kzalloc(sizeof(struct usb_serial_port), GFP_KERNEL); 1066 if (!port) { 1067 retval = -ENOMEM; 1068 goto err_free_epds; 1069 } 1070 tty_port_init(&port->port); 1071 port->port.ops = &serial_port_ops; 1072 port->serial = serial; 1073 spin_lock_init(&port->lock); 1074 /* Keep this for private driver use for the moment but 1075 should probably go away */ 1076 INIT_WORK(&port->work, usb_serial_port_work); 1077 serial->port[i] = port; 1078 port->dev.parent = &interface->dev; 1079 port->dev.driver = NULL; 1080 port->dev.bus = &usb_serial_bus_type; 1081 port->dev.release = &usb_serial_port_release; 1082 port->dev.groups = usb_serial_port_groups; 1083 device_initialize(&port->dev); 1084 } 1085 1086 /* set up the endpoint information */ 1087 for (i = 0; i < epds->num_bulk_in; ++i) { 1088 retval = setup_port_bulk_in(serial->port[i], epds->bulk_in[i]); 1089 if (retval) 1090 goto err_free_epds; 1091 } 1092 1093 for (i = 0; i < epds->num_bulk_out; ++i) { 1094 retval = setup_port_bulk_out(serial->port[i], 1095 epds->bulk_out[i]); 1096 if (retval) 1097 goto err_free_epds; 1098 } 1099 1100 if (serial->type->read_int_callback) { 1101 for (i = 0; i < epds->num_interrupt_in; ++i) { 1102 retval = setup_port_interrupt_in(serial->port[i], 1103 epds->interrupt_in[i]); 1104 if (retval) 1105 goto err_free_epds; 1106 } 1107 } else if (epds->num_interrupt_in) { 1108 dev_dbg(ddev, "The device claims to support interrupt in transfers, but read_int_callback is not defined\n"); 1109 } 1110 1111 if (serial->type->write_int_callback) { 1112 for (i = 0; i < epds->num_interrupt_out; ++i) { 1113 retval = setup_port_interrupt_out(serial->port[i], 1114 epds->interrupt_out[i]); 1115 if (retval) 1116 goto err_free_epds; 1117 } 1118 } else if (epds->num_interrupt_out) { 1119 dev_dbg(ddev, "The device claims to support interrupt out transfers, but write_int_callback is not defined\n"); 1120 } 1121 1122 usb_set_intfdata(interface, serial); 1123 1124 /* if this device type has an attach function, call it */ 1125 if (type->attach) { 1126 retval = type->attach(serial); 1127 if (retval < 0) 1128 goto err_free_epds; 1129 serial->attached = 1; 1130 if (retval > 0) { 1131 /* quietly accept this device, but don't bind to a 1132 serial port as it's about to disappear */ 1133 serial->num_ports = 0; 1134 goto exit; 1135 } 1136 } else { 1137 serial->attached = 1; 1138 } 1139 1140 retval = allocate_minors(serial, num_ports); 1141 if (retval) { 1142 dev_err(ddev, "No more free serial minor numbers\n"); 1143 goto err_free_epds; 1144 } 1145 1146 /* register all of the individual ports with the driver core */ 1147 for (i = 0; i < num_ports; ++i) { 1148 port = serial->port[i]; 1149 dev_set_name(&port->dev, "ttyUSB%d", port->minor); 1150 dev_dbg(ddev, "registering %s\n", dev_name(&port->dev)); 1151 device_enable_async_suspend(&port->dev); 1152 1153 retval = device_add(&port->dev); 1154 if (retval) 1155 dev_err(ddev, "Error registering port device, continuing\n"); 1156 } 1157 1158 if (num_ports > 0) 1159 usb_serial_console_init(serial->port[0]->minor); 1160 exit: 1161 kfree(epds); 1162 module_put(type->driver.owner); 1163 return 0; 1164 1165 err_free_epds: 1166 kfree(epds); 1167 err_release_sibling: 1168 release_sibling(serial, interface); 1169 usb_serial_put(serial); 1170 err_put_module: 1171 module_put(type->driver.owner); 1172 1173 return retval; 1174 } 1175 1176 static void usb_serial_disconnect(struct usb_interface *interface) 1177 { 1178 int i; 1179 struct usb_serial *serial = usb_get_intfdata(interface); 1180 struct device *dev = &interface->dev; 1181 struct usb_serial_port *port; 1182 struct tty_struct *tty; 1183 1184 /* sibling interface is cleaning up */ 1185 if (!serial) 1186 return; 1187 1188 usb_serial_console_disconnect(serial); 1189 1190 mutex_lock(&serial->disc_mutex); 1191 /* must set a flag, to signal subdrivers */ 1192 serial->disconnected = 1; 1193 mutex_unlock(&serial->disc_mutex); 1194 1195 for (i = 0; i < serial->num_ports; ++i) { 1196 port = serial->port[i]; 1197 tty = tty_port_tty_get(&port->port); 1198 if (tty) { 1199 tty_vhangup(tty); 1200 tty_kref_put(tty); 1201 } 1202 usb_serial_port_poison_urbs(port); 1203 wake_up_interruptible(&port->port.delta_msr_wait); 1204 cancel_work_sync(&port->work); 1205 if (device_is_registered(&port->dev)) 1206 device_del(&port->dev); 1207 } 1208 if (serial->type->disconnect) 1209 serial->type->disconnect(serial); 1210 1211 release_sibling(serial, interface); 1212 1213 /* let the last holder of this object cause it to be cleaned up */ 1214 usb_serial_put(serial); 1215 dev_info(dev, "device disconnected\n"); 1216 } 1217 1218 int usb_serial_suspend(struct usb_interface *intf, pm_message_t message) 1219 { 1220 struct usb_serial *serial = usb_get_intfdata(intf); 1221 int i, r; 1222 1223 /* suspend when called for first sibling interface */ 1224 if (serial->suspend_count++) 1225 return 0; 1226 1227 /* 1228 * serial->type->suspend() MUST return 0 in system sleep context, 1229 * otherwise, the resume callback has to recover device from 1230 * previous suspend failure. 1231 */ 1232 if (serial->type->suspend) { 1233 r = serial->type->suspend(serial, message); 1234 if (r < 0) { 1235 serial->suspend_count--; 1236 return r; 1237 } 1238 } 1239 1240 for (i = 0; i < serial->num_ports; ++i) 1241 usb_serial_port_poison_urbs(serial->port[i]); 1242 1243 return 0; 1244 } 1245 EXPORT_SYMBOL(usb_serial_suspend); 1246 1247 static void usb_serial_unpoison_port_urbs(struct usb_serial *serial) 1248 { 1249 int i; 1250 1251 for (i = 0; i < serial->num_ports; ++i) 1252 usb_serial_port_unpoison_urbs(serial->port[i]); 1253 } 1254 1255 int usb_serial_resume(struct usb_interface *intf) 1256 { 1257 struct usb_serial *serial = usb_get_intfdata(intf); 1258 int rv; 1259 1260 /* resume when called for last sibling interface */ 1261 if (--serial->suspend_count) 1262 return 0; 1263 1264 usb_serial_unpoison_port_urbs(serial); 1265 1266 if (serial->type->resume) 1267 rv = serial->type->resume(serial); 1268 else 1269 rv = usb_serial_generic_resume(serial); 1270 1271 return rv; 1272 } 1273 EXPORT_SYMBOL(usb_serial_resume); 1274 1275 static int usb_serial_reset_resume(struct usb_interface *intf) 1276 { 1277 struct usb_serial *serial = usb_get_intfdata(intf); 1278 int rv; 1279 1280 /* resume when called for last sibling interface */ 1281 if (--serial->suspend_count) 1282 return 0; 1283 1284 usb_serial_unpoison_port_urbs(serial); 1285 1286 if (serial->type->reset_resume) { 1287 rv = serial->type->reset_resume(serial); 1288 } else { 1289 rv = -EOPNOTSUPP; 1290 intf->needs_binding = 1; 1291 } 1292 1293 return rv; 1294 } 1295 1296 static const struct tty_operations serial_ops = { 1297 .open = serial_open, 1298 .close = serial_close, 1299 .write = serial_write, 1300 .hangup = serial_hangup, 1301 .write_room = serial_write_room, 1302 .ioctl = serial_ioctl, 1303 .set_termios = serial_set_termios, 1304 .throttle = serial_throttle, 1305 .unthrottle = serial_unthrottle, 1306 .break_ctl = serial_break, 1307 .chars_in_buffer = serial_chars_in_buffer, 1308 .wait_until_sent = serial_wait_until_sent, 1309 .tiocmget = serial_tiocmget, 1310 .tiocmset = serial_tiocmset, 1311 .get_icount = serial_get_icount, 1312 .set_serial = serial_set_serial, 1313 .get_serial = serial_get_serial, 1314 .cleanup = serial_cleanup, 1315 .install = serial_install, 1316 .proc_show = serial_proc_show, 1317 }; 1318 1319 1320 struct tty_driver *usb_serial_tty_driver; 1321 1322 static int __init usb_serial_init(void) 1323 { 1324 int result; 1325 1326 usb_serial_tty_driver = tty_alloc_driver(USB_SERIAL_TTY_MINORS, 1327 TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV); 1328 if (IS_ERR(usb_serial_tty_driver)) 1329 return PTR_ERR(usb_serial_tty_driver); 1330 1331 /* Initialize our global data */ 1332 result = bus_register(&usb_serial_bus_type); 1333 if (result) { 1334 pr_err("%s - registering bus driver failed\n", __func__); 1335 goto err_put_driver; 1336 } 1337 1338 usb_serial_tty_driver->driver_name = "usbserial"; 1339 usb_serial_tty_driver->name = "ttyUSB"; 1340 usb_serial_tty_driver->major = USB_SERIAL_TTY_MAJOR; 1341 usb_serial_tty_driver->minor_start = 0; 1342 usb_serial_tty_driver->type = TTY_DRIVER_TYPE_SERIAL; 1343 usb_serial_tty_driver->subtype = SERIAL_TYPE_NORMAL; 1344 usb_serial_tty_driver->init_termios = tty_std_termios; 1345 usb_serial_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD 1346 | HUPCL | CLOCAL; 1347 usb_serial_tty_driver->init_termios.c_ispeed = 9600; 1348 usb_serial_tty_driver->init_termios.c_ospeed = 9600; 1349 tty_set_operations(usb_serial_tty_driver, &serial_ops); 1350 result = tty_register_driver(usb_serial_tty_driver); 1351 if (result) { 1352 pr_err("%s - tty_register_driver failed\n", __func__); 1353 goto err_unregister_bus; 1354 } 1355 1356 /* register the generic driver, if we should */ 1357 result = usb_serial_generic_register(); 1358 if (result < 0) { 1359 pr_err("%s - registering generic driver failed\n", __func__); 1360 goto err_unregister_driver; 1361 } 1362 1363 return result; 1364 1365 err_unregister_driver: 1366 tty_unregister_driver(usb_serial_tty_driver); 1367 err_unregister_bus: 1368 bus_unregister(&usb_serial_bus_type); 1369 err_put_driver: 1370 pr_err("%s - returning with error %d\n", __func__, result); 1371 tty_driver_kref_put(usb_serial_tty_driver); 1372 return result; 1373 } 1374 1375 1376 static void __exit usb_serial_exit(void) 1377 { 1378 usb_serial_console_exit(); 1379 1380 usb_serial_generic_deregister(); 1381 1382 tty_unregister_driver(usb_serial_tty_driver); 1383 tty_driver_kref_put(usb_serial_tty_driver); 1384 bus_unregister(&usb_serial_bus_type); 1385 idr_destroy(&serial_minors); 1386 } 1387 1388 1389 module_init(usb_serial_init); 1390 module_exit(usb_serial_exit); 1391 1392 #define set_to_generic_if_null(type, function) \ 1393 do { \ 1394 if (!type->function) { \ 1395 type->function = usb_serial_generic_##function; \ 1396 pr_debug("%s: using generic " #function "\n", \ 1397 type->driver.name); \ 1398 } \ 1399 } while (0) 1400 1401 static void usb_serial_operations_init(struct usb_serial_driver *device) 1402 { 1403 set_to_generic_if_null(device, open); 1404 set_to_generic_if_null(device, write); 1405 set_to_generic_if_null(device, close); 1406 set_to_generic_if_null(device, write_room); 1407 set_to_generic_if_null(device, chars_in_buffer); 1408 if (device->tx_empty) 1409 set_to_generic_if_null(device, wait_until_sent); 1410 set_to_generic_if_null(device, read_bulk_callback); 1411 set_to_generic_if_null(device, write_bulk_callback); 1412 set_to_generic_if_null(device, process_read_urb); 1413 set_to_generic_if_null(device, prepare_write_buffer); 1414 } 1415 1416 static int usb_serial_register(struct usb_serial_driver *driver) 1417 { 1418 int retval; 1419 1420 if (usb_disabled()) 1421 return -ENODEV; 1422 1423 if (!driver->description) 1424 driver->description = driver->driver.name; 1425 if (!driver->usb_driver) { 1426 WARN(1, "Serial driver %s has no usb_driver\n", 1427 driver->description); 1428 return -EINVAL; 1429 } 1430 1431 /* Prevent individual ports from being unbound. */ 1432 driver->driver.suppress_bind_attrs = true; 1433 1434 usb_serial_operations_init(driver); 1435 1436 /* Add this device to our list of devices */ 1437 mutex_lock(&table_lock); 1438 list_add(&driver->driver_list, &usb_serial_driver_list); 1439 1440 retval = usb_serial_bus_register(driver); 1441 if (retval) { 1442 pr_err("problem %d when registering driver %s\n", retval, driver->description); 1443 list_del(&driver->driver_list); 1444 } else { 1445 pr_info("USB Serial support registered for %s\n", driver->description); 1446 } 1447 mutex_unlock(&table_lock); 1448 return retval; 1449 } 1450 1451 static void usb_serial_deregister(struct usb_serial_driver *device) 1452 { 1453 pr_info("USB Serial deregistering driver %s\n", device->description); 1454 1455 mutex_lock(&table_lock); 1456 list_del(&device->driver_list); 1457 mutex_unlock(&table_lock); 1458 1459 usb_serial_bus_deregister(device); 1460 } 1461 1462 /** 1463 * usb_serial_register_drivers - register drivers for a usb-serial module 1464 * @serial_drivers: NULL-terminated array of pointers to drivers to be registered 1465 * @name: name of the usb_driver for this set of @serial_drivers 1466 * @id_table: list of all devices this @serial_drivers set binds to 1467 * 1468 * Registers all the drivers in the @serial_drivers array, and dynamically 1469 * creates a struct usb_driver with the name @name and id_table of @id_table. 1470 */ 1471 int usb_serial_register_drivers(struct usb_serial_driver *const serial_drivers[], 1472 const char *name, 1473 const struct usb_device_id *id_table) 1474 { 1475 int rc; 1476 struct usb_driver *udriver; 1477 struct usb_serial_driver * const *sd; 1478 1479 /* 1480 * udriver must be registered before any of the serial drivers, 1481 * because the store_new_id() routine for the serial drivers (in 1482 * bus.c) probes udriver. 1483 * 1484 * Performance hack: We don't want udriver to be probed until 1485 * the serial drivers are registered, because the probe would 1486 * simply fail for lack of a matching serial driver. 1487 * So we leave udriver's id_table set to NULL until we are all set. 1488 * 1489 * Suspend/resume support is implemented in the usb-serial core, 1490 * so fill in the PM-related fields in udriver. 1491 */ 1492 udriver = kzalloc(sizeof(*udriver), GFP_KERNEL); 1493 if (!udriver) 1494 return -ENOMEM; 1495 1496 udriver->name = name; 1497 udriver->no_dynamic_id = 1; 1498 udriver->supports_autosuspend = 1; 1499 udriver->suspend = usb_serial_suspend; 1500 udriver->resume = usb_serial_resume; 1501 udriver->probe = usb_serial_probe; 1502 udriver->disconnect = usb_serial_disconnect; 1503 1504 /* we only set the reset_resume field if the serial_driver has one */ 1505 for (sd = serial_drivers; *sd; ++sd) { 1506 if ((*sd)->reset_resume) { 1507 udriver->reset_resume = usb_serial_reset_resume; 1508 break; 1509 } 1510 } 1511 1512 rc = usb_register(udriver); 1513 if (rc) 1514 goto err_free_driver; 1515 1516 for (sd = serial_drivers; *sd; ++sd) { 1517 (*sd)->usb_driver = udriver; 1518 rc = usb_serial_register(*sd); 1519 if (rc) 1520 goto err_deregister_drivers; 1521 } 1522 1523 /* Now set udriver's id_table and look for matches */ 1524 udriver->id_table = id_table; 1525 rc = driver_attach(&udriver->drvwrap.driver); 1526 return 0; 1527 1528 err_deregister_drivers: 1529 while (sd-- > serial_drivers) 1530 usb_serial_deregister(*sd); 1531 usb_deregister(udriver); 1532 err_free_driver: 1533 kfree(udriver); 1534 return rc; 1535 } 1536 EXPORT_SYMBOL_GPL(usb_serial_register_drivers); 1537 1538 /** 1539 * usb_serial_deregister_drivers - deregister drivers for a usb-serial module 1540 * @serial_drivers: NULL-terminated array of pointers to drivers to be deregistered 1541 * 1542 * Deregisters all the drivers in the @serial_drivers array and deregisters and 1543 * frees the struct usb_driver that was created by the call to 1544 * usb_serial_register_drivers(). 1545 */ 1546 void usb_serial_deregister_drivers(struct usb_serial_driver *const serial_drivers[]) 1547 { 1548 struct usb_driver *udriver = (*serial_drivers)->usb_driver; 1549 1550 for (; *serial_drivers; ++serial_drivers) 1551 usb_serial_deregister(*serial_drivers); 1552 usb_deregister(udriver); 1553 kfree(udriver); 1554 } 1555 EXPORT_SYMBOL_GPL(usb_serial_deregister_drivers); 1556 1557 MODULE_AUTHOR(DRIVER_AUTHOR); 1558 MODULE_DESCRIPTION(DRIVER_DESC); 1559 MODULE_LICENSE("GPL v2"); 1560