1 /* vi: ts=8 sw=8 2 * 3 * TI 3410/5052 USB Serial Driver 4 * 5 * Copyright (C) 2004 Texas Instruments 6 * 7 * This driver is based on the Linux io_ti driver, which is 8 * Copyright (C) 2000-2002 Inside Out Networks 9 * Copyright (C) 2001-2002 Greg Kroah-Hartman 10 * 11 * This program is free software; you can redistribute it and/or modify 12 * it under the terms of the GNU General Public License as published by 13 * the Free Software Foundation; either version 2 of the License, or 14 * (at your option) any later version. 15 * 16 * For questions or problems with this driver, contact Texas Instruments 17 * technical support, or Al Borchers <alborchers@steinerpoint.com>, or 18 * Peter Berger <pberger@brimson.com>. 19 */ 20 21 #include <linux/kernel.h> 22 #include <linux/errno.h> 23 #include <linux/firmware.h> 24 #include <linux/init.h> 25 #include <linux/slab.h> 26 #include <linux/tty.h> 27 #include <linux/tty_driver.h> 28 #include <linux/tty_flip.h> 29 #include <linux/module.h> 30 #include <linux/spinlock.h> 31 #include <linux/ioctl.h> 32 #include <linux/serial.h> 33 #include <linux/kfifo.h> 34 #include <linux/mutex.h> 35 #include <linux/uaccess.h> 36 #include <linux/usb.h> 37 #include <linux/usb/serial.h> 38 39 #include "ti_usb_3410_5052.h" 40 41 /* Defines */ 42 43 #define TI_DRIVER_VERSION "v0.10" 44 #define TI_DRIVER_AUTHOR "Al Borchers <alborchers@steinerpoint.com>" 45 #define TI_DRIVER_DESC "TI USB 3410/5052 Serial Driver" 46 47 #define TI_FIRMWARE_BUF_SIZE 16284 48 49 #define TI_WRITE_BUF_SIZE 1024 50 51 #define TI_TRANSFER_TIMEOUT 2 52 53 #define TI_DEFAULT_CLOSING_WAIT 4000 /* in .01 secs */ 54 55 /* supported setserial flags */ 56 #define TI_SET_SERIAL_FLAGS 0 57 58 /* read urb states */ 59 #define TI_READ_URB_RUNNING 0 60 #define TI_READ_URB_STOPPING 1 61 #define TI_READ_URB_STOPPED 2 62 63 #define TI_EXTRA_VID_PID_COUNT 5 64 65 66 /* Structures */ 67 68 struct ti_port { 69 int tp_is_open; 70 __u8 tp_msr; 71 __u8 tp_lsr; 72 __u8 tp_shadow_mcr; 73 __u8 tp_uart_mode; /* 232 or 485 modes */ 74 unsigned int tp_uart_base_addr; 75 int tp_flags; 76 int tp_closing_wait;/* in .01 secs */ 77 struct async_icount tp_icount; 78 wait_queue_head_t tp_msr_wait; /* wait for msr change */ 79 wait_queue_head_t tp_write_wait; 80 struct ti_device *tp_tdev; 81 struct usb_serial_port *tp_port; 82 spinlock_t tp_lock; 83 int tp_read_urb_state; 84 int tp_write_urb_in_use; 85 struct kfifo write_fifo; 86 }; 87 88 struct ti_device { 89 struct mutex td_open_close_lock; 90 int td_open_port_count; 91 struct usb_serial *td_serial; 92 int td_is_3410; 93 int td_urb_error; 94 }; 95 96 97 /* Function Declarations */ 98 99 static int ti_startup(struct usb_serial *serial); 100 static void ti_release(struct usb_serial *serial); 101 static int ti_open(struct tty_struct *tty, struct usb_serial_port *port); 102 static void ti_close(struct usb_serial_port *port); 103 static int ti_write(struct tty_struct *tty, struct usb_serial_port *port, 104 const unsigned char *data, int count); 105 static int ti_write_room(struct tty_struct *tty); 106 static int ti_chars_in_buffer(struct tty_struct *tty); 107 static void ti_throttle(struct tty_struct *tty); 108 static void ti_unthrottle(struct tty_struct *tty); 109 static int ti_ioctl(struct tty_struct *tty, 110 unsigned int cmd, unsigned long arg); 111 static int ti_get_icount(struct tty_struct *tty, 112 struct serial_icounter_struct *icount); 113 static void ti_set_termios(struct tty_struct *tty, 114 struct usb_serial_port *port, struct ktermios *old_termios); 115 static int ti_tiocmget(struct tty_struct *tty); 116 static int ti_tiocmset(struct tty_struct *tty, 117 unsigned int set, unsigned int clear); 118 static void ti_break(struct tty_struct *tty, int break_state); 119 static void ti_interrupt_callback(struct urb *urb); 120 static void ti_bulk_in_callback(struct urb *urb); 121 static void ti_bulk_out_callback(struct urb *urb); 122 123 static void ti_recv(struct device *dev, struct tty_struct *tty, 124 unsigned char *data, int length); 125 static void ti_send(struct ti_port *tport); 126 static int ti_set_mcr(struct ti_port *tport, unsigned int mcr); 127 static int ti_get_lsr(struct ti_port *tport); 128 static int ti_get_serial_info(struct ti_port *tport, 129 struct serial_struct __user *ret_arg); 130 static int ti_set_serial_info(struct tty_struct *tty, struct ti_port *tport, 131 struct serial_struct __user *new_arg); 132 static void ti_handle_new_msr(struct ti_port *tport, __u8 msr); 133 134 static void ti_drain(struct ti_port *tport, unsigned long timeout, int flush); 135 136 static void ti_stop_read(struct ti_port *tport, struct tty_struct *tty); 137 static int ti_restart_read(struct ti_port *tport, struct tty_struct *tty); 138 139 static int ti_command_out_sync(struct ti_device *tdev, __u8 command, 140 __u16 moduleid, __u16 value, __u8 *data, int size); 141 static int ti_command_in_sync(struct ti_device *tdev, __u8 command, 142 __u16 moduleid, __u16 value, __u8 *data, int size); 143 144 static int ti_write_byte(struct ti_device *tdev, unsigned long addr, 145 __u8 mask, __u8 byte); 146 147 static int ti_download_firmware(struct ti_device *tdev); 148 149 150 /* Data */ 151 152 /* module parameters */ 153 static bool debug; 154 static int closing_wait = TI_DEFAULT_CLOSING_WAIT; 155 static ushort vendor_3410[TI_EXTRA_VID_PID_COUNT]; 156 static unsigned int vendor_3410_count; 157 static ushort product_3410[TI_EXTRA_VID_PID_COUNT]; 158 static unsigned int product_3410_count; 159 static ushort vendor_5052[TI_EXTRA_VID_PID_COUNT]; 160 static unsigned int vendor_5052_count; 161 static ushort product_5052[TI_EXTRA_VID_PID_COUNT]; 162 static unsigned int product_5052_count; 163 164 /* supported devices */ 165 /* the array dimension is the number of default entries plus */ 166 /* TI_EXTRA_VID_PID_COUNT user defined entries plus 1 terminating */ 167 /* null entry */ 168 static struct usb_device_id ti_id_table_3410[13+TI_EXTRA_VID_PID_COUNT+1] = { 169 { USB_DEVICE(TI_VENDOR_ID, TI_3410_PRODUCT_ID) }, 170 { USB_DEVICE(TI_VENDOR_ID, TI_3410_EZ430_ID) }, 171 { USB_DEVICE(MTS_VENDOR_ID, MTS_GSM_NO_FW_PRODUCT_ID) }, 172 { USB_DEVICE(MTS_VENDOR_ID, MTS_CDMA_NO_FW_PRODUCT_ID) }, 173 { USB_DEVICE(MTS_VENDOR_ID, MTS_CDMA_PRODUCT_ID) }, 174 { USB_DEVICE(MTS_VENDOR_ID, MTS_GSM_PRODUCT_ID) }, 175 { USB_DEVICE(MTS_VENDOR_ID, MTS_EDGE_PRODUCT_ID) }, 176 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234MU_PRODUCT_ID) }, 177 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234ZBA_PRODUCT_ID) }, 178 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234ZBAOLD_PRODUCT_ID) }, 179 { USB_DEVICE(IBM_VENDOR_ID, IBM_4543_PRODUCT_ID) }, 180 { USB_DEVICE(IBM_VENDOR_ID, IBM_454B_PRODUCT_ID) }, 181 { USB_DEVICE(IBM_VENDOR_ID, IBM_454C_PRODUCT_ID) }, 182 }; 183 184 static struct usb_device_id ti_id_table_5052[5+TI_EXTRA_VID_PID_COUNT+1] = { 185 { USB_DEVICE(TI_VENDOR_ID, TI_5052_BOOT_PRODUCT_ID) }, 186 { USB_DEVICE(TI_VENDOR_ID, TI_5152_BOOT_PRODUCT_ID) }, 187 { USB_DEVICE(TI_VENDOR_ID, TI_5052_EEPROM_PRODUCT_ID) }, 188 { USB_DEVICE(TI_VENDOR_ID, TI_5052_FIRMWARE_PRODUCT_ID) }, 189 }; 190 191 static struct usb_device_id ti_id_table_combined[17+2*TI_EXTRA_VID_PID_COUNT+1] = { 192 { USB_DEVICE(TI_VENDOR_ID, TI_3410_PRODUCT_ID) }, 193 { USB_DEVICE(TI_VENDOR_ID, TI_3410_EZ430_ID) }, 194 { USB_DEVICE(MTS_VENDOR_ID, MTS_GSM_NO_FW_PRODUCT_ID) }, 195 { USB_DEVICE(MTS_VENDOR_ID, MTS_CDMA_NO_FW_PRODUCT_ID) }, 196 { USB_DEVICE(MTS_VENDOR_ID, MTS_CDMA_PRODUCT_ID) }, 197 { USB_DEVICE(MTS_VENDOR_ID, MTS_GSM_PRODUCT_ID) }, 198 { USB_DEVICE(MTS_VENDOR_ID, MTS_EDGE_PRODUCT_ID) }, 199 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234MU_PRODUCT_ID) }, 200 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234ZBA_PRODUCT_ID) }, 201 { USB_DEVICE(MTS_VENDOR_ID, MTS_MT9234ZBAOLD_PRODUCT_ID) }, 202 { USB_DEVICE(TI_VENDOR_ID, TI_5052_BOOT_PRODUCT_ID) }, 203 { USB_DEVICE(TI_VENDOR_ID, TI_5152_BOOT_PRODUCT_ID) }, 204 { USB_DEVICE(TI_VENDOR_ID, TI_5052_EEPROM_PRODUCT_ID) }, 205 { USB_DEVICE(TI_VENDOR_ID, TI_5052_FIRMWARE_PRODUCT_ID) }, 206 { USB_DEVICE(IBM_VENDOR_ID, IBM_4543_PRODUCT_ID) }, 207 { USB_DEVICE(IBM_VENDOR_ID, IBM_454B_PRODUCT_ID) }, 208 { USB_DEVICE(IBM_VENDOR_ID, IBM_454C_PRODUCT_ID) }, 209 { } 210 }; 211 212 static struct usb_driver ti_usb_driver = { 213 .name = "ti_usb_3410_5052", 214 .probe = usb_serial_probe, 215 .disconnect = usb_serial_disconnect, 216 .id_table = ti_id_table_combined, 217 .no_dynamic_id = 1, 218 }; 219 220 static struct usb_serial_driver ti_1port_device = { 221 .driver = { 222 .owner = THIS_MODULE, 223 .name = "ti_usb_3410_5052_1", 224 }, 225 .description = "TI USB 3410 1 port adapter", 226 .usb_driver = &ti_usb_driver, 227 .id_table = ti_id_table_3410, 228 .num_ports = 1, 229 .attach = ti_startup, 230 .release = ti_release, 231 .open = ti_open, 232 .close = ti_close, 233 .write = ti_write, 234 .write_room = ti_write_room, 235 .chars_in_buffer = ti_chars_in_buffer, 236 .throttle = ti_throttle, 237 .unthrottle = ti_unthrottle, 238 .ioctl = ti_ioctl, 239 .set_termios = ti_set_termios, 240 .tiocmget = ti_tiocmget, 241 .tiocmset = ti_tiocmset, 242 .get_icount = ti_get_icount, 243 .break_ctl = ti_break, 244 .read_int_callback = ti_interrupt_callback, 245 .read_bulk_callback = ti_bulk_in_callback, 246 .write_bulk_callback = ti_bulk_out_callback, 247 }; 248 249 static struct usb_serial_driver ti_2port_device = { 250 .driver = { 251 .owner = THIS_MODULE, 252 .name = "ti_usb_3410_5052_2", 253 }, 254 .description = "TI USB 5052 2 port adapter", 255 .usb_driver = &ti_usb_driver, 256 .id_table = ti_id_table_5052, 257 .num_ports = 2, 258 .attach = ti_startup, 259 .release = ti_release, 260 .open = ti_open, 261 .close = ti_close, 262 .write = ti_write, 263 .write_room = ti_write_room, 264 .chars_in_buffer = ti_chars_in_buffer, 265 .throttle = ti_throttle, 266 .unthrottle = ti_unthrottle, 267 .ioctl = ti_ioctl, 268 .set_termios = ti_set_termios, 269 .tiocmget = ti_tiocmget, 270 .tiocmset = ti_tiocmset, 271 .get_icount = ti_get_icount, 272 .break_ctl = ti_break, 273 .read_int_callback = ti_interrupt_callback, 274 .read_bulk_callback = ti_bulk_in_callback, 275 .write_bulk_callback = ti_bulk_out_callback, 276 }; 277 278 279 /* Module */ 280 281 MODULE_AUTHOR(TI_DRIVER_AUTHOR); 282 MODULE_DESCRIPTION(TI_DRIVER_DESC); 283 MODULE_VERSION(TI_DRIVER_VERSION); 284 MODULE_LICENSE("GPL"); 285 286 MODULE_FIRMWARE("ti_3410.fw"); 287 MODULE_FIRMWARE("ti_5052.fw"); 288 MODULE_FIRMWARE("mts_cdma.fw"); 289 MODULE_FIRMWARE("mts_gsm.fw"); 290 MODULE_FIRMWARE("mts_edge.fw"); 291 MODULE_FIRMWARE("mts_mt9234mu.fw"); 292 MODULE_FIRMWARE("mts_mt9234zba.fw"); 293 294 module_param(debug, bool, S_IRUGO | S_IWUSR); 295 MODULE_PARM_DESC(debug, "Enable debugging, 0=no, 1=yes"); 296 297 module_param(closing_wait, int, S_IRUGO | S_IWUSR); 298 MODULE_PARM_DESC(closing_wait, 299 "Maximum wait for data to drain in close, in .01 secs, default is 4000"); 300 301 module_param_array(vendor_3410, ushort, &vendor_3410_count, S_IRUGO); 302 MODULE_PARM_DESC(vendor_3410, 303 "Vendor ids for 3410 based devices, 1-5 short integers"); 304 module_param_array(product_3410, ushort, &product_3410_count, S_IRUGO); 305 MODULE_PARM_DESC(product_3410, 306 "Product ids for 3410 based devices, 1-5 short integers"); 307 module_param_array(vendor_5052, ushort, &vendor_5052_count, S_IRUGO); 308 MODULE_PARM_DESC(vendor_5052, 309 "Vendor ids for 5052 based devices, 1-5 short integers"); 310 module_param_array(product_5052, ushort, &product_5052_count, S_IRUGO); 311 MODULE_PARM_DESC(product_5052, 312 "Product ids for 5052 based devices, 1-5 short integers"); 313 314 MODULE_DEVICE_TABLE(usb, ti_id_table_combined); 315 316 317 /* Functions */ 318 319 static int __init ti_init(void) 320 { 321 int i, j, c; 322 int ret; 323 324 /* insert extra vendor and product ids */ 325 c = ARRAY_SIZE(ti_id_table_combined) - 2 * TI_EXTRA_VID_PID_COUNT - 1; 326 j = ARRAY_SIZE(ti_id_table_3410) - TI_EXTRA_VID_PID_COUNT - 1; 327 for (i = 0; i < min(vendor_3410_count, product_3410_count); i++, j++, c++) { 328 ti_id_table_3410[j].idVendor = vendor_3410[i]; 329 ti_id_table_3410[j].idProduct = product_3410[i]; 330 ti_id_table_3410[j].match_flags = USB_DEVICE_ID_MATCH_DEVICE; 331 ti_id_table_combined[c].idVendor = vendor_3410[i]; 332 ti_id_table_combined[c].idProduct = product_3410[i]; 333 ti_id_table_combined[c].match_flags = USB_DEVICE_ID_MATCH_DEVICE; 334 } 335 j = ARRAY_SIZE(ti_id_table_5052) - TI_EXTRA_VID_PID_COUNT - 1; 336 for (i = 0; i < min(vendor_5052_count, product_5052_count); i++, j++, c++) { 337 ti_id_table_5052[j].idVendor = vendor_5052[i]; 338 ti_id_table_5052[j].idProduct = product_5052[i]; 339 ti_id_table_5052[j].match_flags = USB_DEVICE_ID_MATCH_DEVICE; 340 ti_id_table_combined[c].idVendor = vendor_5052[i]; 341 ti_id_table_combined[c].idProduct = product_5052[i]; 342 ti_id_table_combined[c].match_flags = USB_DEVICE_ID_MATCH_DEVICE; 343 } 344 345 ret = usb_serial_register(&ti_1port_device); 346 if (ret) 347 goto failed_1port; 348 ret = usb_serial_register(&ti_2port_device); 349 if (ret) 350 goto failed_2port; 351 352 ret = usb_register(&ti_usb_driver); 353 if (ret) 354 goto failed_usb; 355 356 printk(KERN_INFO KBUILD_MODNAME ": " TI_DRIVER_VERSION ":" 357 TI_DRIVER_DESC "\n"); 358 359 return 0; 360 361 failed_usb: 362 usb_serial_deregister(&ti_2port_device); 363 failed_2port: 364 usb_serial_deregister(&ti_1port_device); 365 failed_1port: 366 return ret; 367 } 368 369 370 static void __exit ti_exit(void) 371 { 372 usb_deregister(&ti_usb_driver); 373 usb_serial_deregister(&ti_1port_device); 374 usb_serial_deregister(&ti_2port_device); 375 } 376 377 378 module_init(ti_init); 379 module_exit(ti_exit); 380 381 382 static int ti_startup(struct usb_serial *serial) 383 { 384 struct ti_device *tdev; 385 struct ti_port *tport; 386 struct usb_device *dev = serial->dev; 387 int status; 388 int i; 389 390 391 dbg("%s - product 0x%4X, num configurations %d, configuration value %d", 392 __func__, le16_to_cpu(dev->descriptor.idProduct), 393 dev->descriptor.bNumConfigurations, 394 dev->actconfig->desc.bConfigurationValue); 395 396 /* create device structure */ 397 tdev = kzalloc(sizeof(struct ti_device), GFP_KERNEL); 398 if (tdev == NULL) { 399 dev_err(&dev->dev, "%s - out of memory\n", __func__); 400 return -ENOMEM; 401 } 402 mutex_init(&tdev->td_open_close_lock); 403 tdev->td_serial = serial; 404 usb_set_serial_data(serial, tdev); 405 406 /* determine device type */ 407 if (usb_match_id(serial->interface, ti_id_table_3410)) 408 tdev->td_is_3410 = 1; 409 dbg("%s - device type is %s", __func__, 410 tdev->td_is_3410 ? "3410" : "5052"); 411 412 /* if we have only 1 configuration, download firmware */ 413 if (dev->descriptor.bNumConfigurations == 1) { 414 if ((status = ti_download_firmware(tdev)) != 0) 415 goto free_tdev; 416 417 /* 3410 must be reset, 5052 resets itself */ 418 if (tdev->td_is_3410) { 419 msleep_interruptible(100); 420 usb_reset_device(dev); 421 } 422 423 status = -ENODEV; 424 goto free_tdev; 425 } 426 427 /* the second configuration must be set */ 428 if (dev->actconfig->desc.bConfigurationValue == TI_BOOT_CONFIG) { 429 status = usb_driver_set_configuration(dev, TI_ACTIVE_CONFIG); 430 status = status ? status : -ENODEV; 431 goto free_tdev; 432 } 433 434 /* set up port structures */ 435 for (i = 0; i < serial->num_ports; ++i) { 436 tport = kzalloc(sizeof(struct ti_port), GFP_KERNEL); 437 if (tport == NULL) { 438 dev_err(&dev->dev, "%s - out of memory\n", __func__); 439 status = -ENOMEM; 440 goto free_tports; 441 } 442 spin_lock_init(&tport->tp_lock); 443 tport->tp_uart_base_addr = (i == 0 ? 444 TI_UART1_BASE_ADDR : TI_UART2_BASE_ADDR); 445 tport->tp_closing_wait = closing_wait; 446 init_waitqueue_head(&tport->tp_msr_wait); 447 init_waitqueue_head(&tport->tp_write_wait); 448 if (kfifo_alloc(&tport->write_fifo, TI_WRITE_BUF_SIZE, 449 GFP_KERNEL)) { 450 dev_err(&dev->dev, "%s - out of memory\n", __func__); 451 kfree(tport); 452 status = -ENOMEM; 453 goto free_tports; 454 } 455 tport->tp_port = serial->port[i]; 456 tport->tp_tdev = tdev; 457 usb_set_serial_port_data(serial->port[i], tport); 458 tport->tp_uart_mode = 0; /* default is RS232 */ 459 } 460 461 return 0; 462 463 free_tports: 464 for (--i; i >= 0; --i) { 465 tport = usb_get_serial_port_data(serial->port[i]); 466 kfifo_free(&tport->write_fifo); 467 kfree(tport); 468 usb_set_serial_port_data(serial->port[i], NULL); 469 } 470 free_tdev: 471 kfree(tdev); 472 usb_set_serial_data(serial, NULL); 473 return status; 474 } 475 476 477 static void ti_release(struct usb_serial *serial) 478 { 479 int i; 480 struct ti_device *tdev = usb_get_serial_data(serial); 481 struct ti_port *tport; 482 483 dbg("%s", __func__); 484 485 for (i = 0; i < serial->num_ports; ++i) { 486 tport = usb_get_serial_port_data(serial->port[i]); 487 if (tport) { 488 kfifo_free(&tport->write_fifo); 489 kfree(tport); 490 } 491 } 492 493 kfree(tdev); 494 } 495 496 497 static int ti_open(struct tty_struct *tty, struct usb_serial_port *port) 498 { 499 struct ti_port *tport = usb_get_serial_port_data(port); 500 struct ti_device *tdev; 501 struct usb_device *dev; 502 struct urb *urb; 503 int port_number; 504 int status; 505 __u16 open_settings = (__u8)(TI_PIPE_MODE_CONTINOUS | 506 TI_PIPE_TIMEOUT_ENABLE | 507 (TI_TRANSFER_TIMEOUT << 2)); 508 509 dbg("%s - port %d", __func__, port->number); 510 511 if (tport == NULL) 512 return -ENODEV; 513 514 dev = port->serial->dev; 515 tdev = tport->tp_tdev; 516 517 /* only one open on any port on a device at a time */ 518 if (mutex_lock_interruptible(&tdev->td_open_close_lock)) 519 return -ERESTARTSYS; 520 521 port_number = port->number - port->serial->minor; 522 523 memset(&(tport->tp_icount), 0x00, sizeof(tport->tp_icount)); 524 525 tport->tp_msr = 0; 526 tport->tp_shadow_mcr |= (TI_MCR_RTS | TI_MCR_DTR); 527 528 /* start interrupt urb the first time a port is opened on this device */ 529 if (tdev->td_open_port_count == 0) { 530 dbg("%s - start interrupt in urb", __func__); 531 urb = tdev->td_serial->port[0]->interrupt_in_urb; 532 if (!urb) { 533 dev_err(&port->dev, "%s - no interrupt urb\n", 534 __func__); 535 status = -EINVAL; 536 goto release_lock; 537 } 538 urb->context = tdev; 539 status = usb_submit_urb(urb, GFP_KERNEL); 540 if (status) { 541 dev_err(&port->dev, 542 "%s - submit interrupt urb failed, %d\n", 543 __func__, status); 544 goto release_lock; 545 } 546 } 547 548 if (tty) 549 ti_set_termios(tty, port, tty->termios); 550 551 dbg("%s - sending TI_OPEN_PORT", __func__); 552 status = ti_command_out_sync(tdev, TI_OPEN_PORT, 553 (__u8)(TI_UART1_PORT + port_number), open_settings, NULL, 0); 554 if (status) { 555 dev_err(&port->dev, "%s - cannot send open command, %d\n", 556 __func__, status); 557 goto unlink_int_urb; 558 } 559 560 dbg("%s - sending TI_START_PORT", __func__); 561 status = ti_command_out_sync(tdev, TI_START_PORT, 562 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0); 563 if (status) { 564 dev_err(&port->dev, "%s - cannot send start command, %d\n", 565 __func__, status); 566 goto unlink_int_urb; 567 } 568 569 dbg("%s - sending TI_PURGE_PORT", __func__); 570 status = ti_command_out_sync(tdev, TI_PURGE_PORT, 571 (__u8)(TI_UART1_PORT + port_number), TI_PURGE_INPUT, NULL, 0); 572 if (status) { 573 dev_err(&port->dev, "%s - cannot clear input buffers, %d\n", 574 __func__, status); 575 goto unlink_int_urb; 576 } 577 status = ti_command_out_sync(tdev, TI_PURGE_PORT, 578 (__u8)(TI_UART1_PORT + port_number), TI_PURGE_OUTPUT, NULL, 0); 579 if (status) { 580 dev_err(&port->dev, "%s - cannot clear output buffers, %d\n", 581 __func__, status); 582 goto unlink_int_urb; 583 } 584 585 /* reset the data toggle on the bulk endpoints to work around bug in 586 * host controllers where things get out of sync some times */ 587 usb_clear_halt(dev, port->write_urb->pipe); 588 usb_clear_halt(dev, port->read_urb->pipe); 589 590 if (tty) 591 ti_set_termios(tty, port, tty->termios); 592 593 dbg("%s - sending TI_OPEN_PORT (2)", __func__); 594 status = ti_command_out_sync(tdev, TI_OPEN_PORT, 595 (__u8)(TI_UART1_PORT + port_number), open_settings, NULL, 0); 596 if (status) { 597 dev_err(&port->dev, "%s - cannot send open command (2), %d\n", 598 __func__, status); 599 goto unlink_int_urb; 600 } 601 602 dbg("%s - sending TI_START_PORT (2)", __func__); 603 status = ti_command_out_sync(tdev, TI_START_PORT, 604 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0); 605 if (status) { 606 dev_err(&port->dev, "%s - cannot send start command (2), %d\n", 607 __func__, status); 608 goto unlink_int_urb; 609 } 610 611 /* start read urb */ 612 dbg("%s - start read urb", __func__); 613 urb = port->read_urb; 614 if (!urb) { 615 dev_err(&port->dev, "%s - no read urb\n", __func__); 616 status = -EINVAL; 617 goto unlink_int_urb; 618 } 619 tport->tp_read_urb_state = TI_READ_URB_RUNNING; 620 urb->context = tport; 621 status = usb_submit_urb(urb, GFP_KERNEL); 622 if (status) { 623 dev_err(&port->dev, "%s - submit read urb failed, %d\n", 624 __func__, status); 625 goto unlink_int_urb; 626 } 627 628 tport->tp_is_open = 1; 629 ++tdev->td_open_port_count; 630 631 goto release_lock; 632 633 unlink_int_urb: 634 if (tdev->td_open_port_count == 0) 635 usb_kill_urb(port->serial->port[0]->interrupt_in_urb); 636 release_lock: 637 mutex_unlock(&tdev->td_open_close_lock); 638 dbg("%s - exit %d", __func__, status); 639 return status; 640 } 641 642 643 static void ti_close(struct usb_serial_port *port) 644 { 645 struct ti_device *tdev; 646 struct ti_port *tport; 647 int port_number; 648 int status; 649 int do_unlock; 650 651 dbg("%s - port %d", __func__, port->number); 652 653 tdev = usb_get_serial_data(port->serial); 654 tport = usb_get_serial_port_data(port); 655 if (tdev == NULL || tport == NULL) 656 return; 657 658 tport->tp_is_open = 0; 659 660 ti_drain(tport, (tport->tp_closing_wait*HZ)/100, 1); 661 662 usb_kill_urb(port->read_urb); 663 usb_kill_urb(port->write_urb); 664 tport->tp_write_urb_in_use = 0; 665 666 port_number = port->number - port->serial->minor; 667 668 dbg("%s - sending TI_CLOSE_PORT", __func__); 669 status = ti_command_out_sync(tdev, TI_CLOSE_PORT, 670 (__u8)(TI_UART1_PORT + port_number), 0, NULL, 0); 671 if (status) 672 dev_err(&port->dev, 673 "%s - cannot send close port command, %d\n" 674 , __func__, status); 675 676 /* if mutex_lock is interrupted, continue anyway */ 677 do_unlock = !mutex_lock_interruptible(&tdev->td_open_close_lock); 678 --tport->tp_tdev->td_open_port_count; 679 if (tport->tp_tdev->td_open_port_count <= 0) { 680 /* last port is closed, shut down interrupt urb */ 681 usb_kill_urb(port->serial->port[0]->interrupt_in_urb); 682 tport->tp_tdev->td_open_port_count = 0; 683 } 684 if (do_unlock) 685 mutex_unlock(&tdev->td_open_close_lock); 686 687 dbg("%s - exit", __func__); 688 } 689 690 691 static int ti_write(struct tty_struct *tty, struct usb_serial_port *port, 692 const unsigned char *data, int count) 693 { 694 struct ti_port *tport = usb_get_serial_port_data(port); 695 696 dbg("%s - port %d", __func__, port->number); 697 698 if (count == 0) { 699 dbg("%s - write request of 0 bytes", __func__); 700 return 0; 701 } 702 703 if (tport == NULL || !tport->tp_is_open) 704 return -ENODEV; 705 706 count = kfifo_in_locked(&tport->write_fifo, data, count, 707 &tport->tp_lock); 708 ti_send(tport); 709 710 return count; 711 } 712 713 714 static int ti_write_room(struct tty_struct *tty) 715 { 716 struct usb_serial_port *port = tty->driver_data; 717 struct ti_port *tport = usb_get_serial_port_data(port); 718 int room = 0; 719 unsigned long flags; 720 721 dbg("%s - port %d", __func__, port->number); 722 723 if (tport == NULL) 724 return 0; 725 726 spin_lock_irqsave(&tport->tp_lock, flags); 727 room = kfifo_avail(&tport->write_fifo); 728 spin_unlock_irqrestore(&tport->tp_lock, flags); 729 730 dbg("%s - returns %d", __func__, room); 731 return room; 732 } 733 734 735 static int ti_chars_in_buffer(struct tty_struct *tty) 736 { 737 struct usb_serial_port *port = tty->driver_data; 738 struct ti_port *tport = usb_get_serial_port_data(port); 739 int chars = 0; 740 unsigned long flags; 741 742 dbg("%s - port %d", __func__, port->number); 743 744 if (tport == NULL) 745 return 0; 746 747 spin_lock_irqsave(&tport->tp_lock, flags); 748 chars = kfifo_len(&tport->write_fifo); 749 spin_unlock_irqrestore(&tport->tp_lock, flags); 750 751 dbg("%s - returns %d", __func__, chars); 752 return chars; 753 } 754 755 756 static void ti_throttle(struct tty_struct *tty) 757 { 758 struct usb_serial_port *port = tty->driver_data; 759 struct ti_port *tport = usb_get_serial_port_data(port); 760 761 dbg("%s - port %d", __func__, port->number); 762 763 if (tport == NULL) 764 return; 765 766 if (I_IXOFF(tty) || C_CRTSCTS(tty)) 767 ti_stop_read(tport, tty); 768 769 } 770 771 772 static void ti_unthrottle(struct tty_struct *tty) 773 { 774 struct usb_serial_port *port = tty->driver_data; 775 struct ti_port *tport = usb_get_serial_port_data(port); 776 int status; 777 778 dbg("%s - port %d", __func__, port->number); 779 780 if (tport == NULL) 781 return; 782 783 if (I_IXOFF(tty) || C_CRTSCTS(tty)) { 784 status = ti_restart_read(tport, tty); 785 if (status) 786 dev_err(&port->dev, "%s - cannot restart read, %d\n", 787 __func__, status); 788 } 789 } 790 791 static int ti_get_icount(struct tty_struct *tty, 792 struct serial_icounter_struct *icount) 793 { 794 struct usb_serial_port *port = tty->driver_data; 795 struct ti_port *tport = usb_get_serial_port_data(port); 796 struct async_icount cnow = tport->tp_icount; 797 798 dbg("%s - (%d) TIOCGICOUNT RX=%d, TX=%d", 799 __func__, port->number, 800 cnow.rx, cnow.tx); 801 802 icount->cts = cnow.cts; 803 icount->dsr = cnow.dsr; 804 icount->rng = cnow.rng; 805 icount->dcd = cnow.dcd; 806 icount->rx = cnow.rx; 807 icount->tx = cnow.tx; 808 icount->frame = cnow.frame; 809 icount->overrun = cnow.overrun; 810 icount->parity = cnow.parity; 811 icount->brk = cnow.brk; 812 icount->buf_overrun = cnow.buf_overrun; 813 814 return 0; 815 } 816 817 static int ti_ioctl(struct tty_struct *tty, 818 unsigned int cmd, unsigned long arg) 819 { 820 struct usb_serial_port *port = tty->driver_data; 821 struct ti_port *tport = usb_get_serial_port_data(port); 822 struct async_icount cnow; 823 struct async_icount cprev; 824 825 dbg("%s - port %d, cmd = 0x%04X", __func__, port->number, cmd); 826 827 if (tport == NULL) 828 return -ENODEV; 829 830 switch (cmd) { 831 case TIOCGSERIAL: 832 dbg("%s - (%d) TIOCGSERIAL", __func__, port->number); 833 return ti_get_serial_info(tport, 834 (struct serial_struct __user *)arg); 835 case TIOCSSERIAL: 836 dbg("%s - (%d) TIOCSSERIAL", __func__, port->number); 837 return ti_set_serial_info(tty, tport, 838 (struct serial_struct __user *)arg); 839 case TIOCMIWAIT: 840 dbg("%s - (%d) TIOCMIWAIT", __func__, port->number); 841 cprev = tport->tp_icount; 842 while (1) { 843 interruptible_sleep_on(&tport->tp_msr_wait); 844 if (signal_pending(current)) 845 return -ERESTARTSYS; 846 cnow = tport->tp_icount; 847 if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && 848 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) 849 return -EIO; /* no change => error */ 850 if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || 851 ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || 852 ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) || 853 ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) 854 return 0; 855 cprev = cnow; 856 } 857 break; 858 } 859 return -ENOIOCTLCMD; 860 } 861 862 863 static void ti_set_termios(struct tty_struct *tty, 864 struct usb_serial_port *port, struct ktermios *old_termios) 865 { 866 struct ti_port *tport = usb_get_serial_port_data(port); 867 struct ti_uart_config *config; 868 tcflag_t cflag, iflag; 869 int baud; 870 int status; 871 int port_number = port->number - port->serial->minor; 872 unsigned int mcr; 873 874 dbg("%s - port %d", __func__, port->number); 875 876 cflag = tty->termios->c_cflag; 877 iflag = tty->termios->c_iflag; 878 879 dbg("%s - cflag %08x, iflag %08x", __func__, cflag, iflag); 880 dbg("%s - old clfag %08x, old iflag %08x", __func__, 881 old_termios->c_cflag, old_termios->c_iflag); 882 883 if (tport == NULL) 884 return; 885 886 config = kmalloc(sizeof(*config), GFP_KERNEL); 887 if (!config) { 888 dev_err(&port->dev, "%s - out of memory\n", __func__); 889 return; 890 } 891 892 config->wFlags = 0; 893 894 /* these flags must be set */ 895 config->wFlags |= TI_UART_ENABLE_MS_INTS; 896 config->wFlags |= TI_UART_ENABLE_AUTO_START_DMA; 897 config->bUartMode = (__u8)(tport->tp_uart_mode); 898 899 switch (cflag & CSIZE) { 900 case CS5: 901 config->bDataBits = TI_UART_5_DATA_BITS; 902 break; 903 case CS6: 904 config->bDataBits = TI_UART_6_DATA_BITS; 905 break; 906 case CS7: 907 config->bDataBits = TI_UART_7_DATA_BITS; 908 break; 909 default: 910 case CS8: 911 config->bDataBits = TI_UART_8_DATA_BITS; 912 break; 913 } 914 915 /* CMSPAR isn't supported by this driver */ 916 tty->termios->c_cflag &= ~CMSPAR; 917 918 if (cflag & PARENB) { 919 if (cflag & PARODD) { 920 config->wFlags |= TI_UART_ENABLE_PARITY_CHECKING; 921 config->bParity = TI_UART_ODD_PARITY; 922 } else { 923 config->wFlags |= TI_UART_ENABLE_PARITY_CHECKING; 924 config->bParity = TI_UART_EVEN_PARITY; 925 } 926 } else { 927 config->wFlags &= ~TI_UART_ENABLE_PARITY_CHECKING; 928 config->bParity = TI_UART_NO_PARITY; 929 } 930 931 if (cflag & CSTOPB) 932 config->bStopBits = TI_UART_2_STOP_BITS; 933 else 934 config->bStopBits = TI_UART_1_STOP_BITS; 935 936 if (cflag & CRTSCTS) { 937 /* RTS flow control must be off to drop RTS for baud rate B0 */ 938 if ((cflag & CBAUD) != B0) 939 config->wFlags |= TI_UART_ENABLE_RTS_IN; 940 config->wFlags |= TI_UART_ENABLE_CTS_OUT; 941 } else { 942 tty->hw_stopped = 0; 943 ti_restart_read(tport, tty); 944 } 945 946 if (I_IXOFF(tty) || I_IXON(tty)) { 947 config->cXon = START_CHAR(tty); 948 config->cXoff = STOP_CHAR(tty); 949 950 if (I_IXOFF(tty)) 951 config->wFlags |= TI_UART_ENABLE_X_IN; 952 else 953 ti_restart_read(tport, tty); 954 955 if (I_IXON(tty)) 956 config->wFlags |= TI_UART_ENABLE_X_OUT; 957 } 958 959 baud = tty_get_baud_rate(tty); 960 if (!baud) 961 baud = 9600; 962 if (tport->tp_tdev->td_is_3410) 963 config->wBaudRate = (__u16)((923077 + baud/2) / baud); 964 else 965 config->wBaudRate = (__u16)((461538 + baud/2) / baud); 966 967 /* FIXME: Should calculate resulting baud here and report it back */ 968 if ((cflag & CBAUD) != B0) 969 tty_encode_baud_rate(tty, baud, baud); 970 971 dbg("%s - BaudRate=%d, wBaudRate=%d, wFlags=0x%04X, bDataBits=%d, bParity=%d, bStopBits=%d, cXon=%d, cXoff=%d, bUartMode=%d", 972 __func__, baud, config->wBaudRate, config->wFlags, config->bDataBits, config->bParity, config->bStopBits, config->cXon, config->cXoff, config->bUartMode); 973 974 cpu_to_be16s(&config->wBaudRate); 975 cpu_to_be16s(&config->wFlags); 976 977 status = ti_command_out_sync(tport->tp_tdev, TI_SET_CONFIG, 978 (__u8)(TI_UART1_PORT + port_number), 0, (__u8 *)config, 979 sizeof(*config)); 980 if (status) 981 dev_err(&port->dev, "%s - cannot set config on port %d, %d\n", 982 __func__, port_number, status); 983 984 /* SET_CONFIG asserts RTS and DTR, reset them correctly */ 985 mcr = tport->tp_shadow_mcr; 986 /* if baud rate is B0, clear RTS and DTR */ 987 if ((cflag & CBAUD) == B0) 988 mcr &= ~(TI_MCR_DTR | TI_MCR_RTS); 989 status = ti_set_mcr(tport, mcr); 990 if (status) 991 dev_err(&port->dev, 992 "%s - cannot set modem control on port %d, %d\n", 993 __func__, port_number, status); 994 995 kfree(config); 996 } 997 998 999 static int ti_tiocmget(struct tty_struct *tty) 1000 { 1001 struct usb_serial_port *port = tty->driver_data; 1002 struct ti_port *tport = usb_get_serial_port_data(port); 1003 unsigned int result; 1004 unsigned int msr; 1005 unsigned int mcr; 1006 unsigned long flags; 1007 1008 dbg("%s - port %d", __func__, port->number); 1009 1010 if (tport == NULL) 1011 return -ENODEV; 1012 1013 spin_lock_irqsave(&tport->tp_lock, flags); 1014 msr = tport->tp_msr; 1015 mcr = tport->tp_shadow_mcr; 1016 spin_unlock_irqrestore(&tport->tp_lock, flags); 1017 1018 result = ((mcr & TI_MCR_DTR) ? TIOCM_DTR : 0) 1019 | ((mcr & TI_MCR_RTS) ? TIOCM_RTS : 0) 1020 | ((mcr & TI_MCR_LOOP) ? TIOCM_LOOP : 0) 1021 | ((msr & TI_MSR_CTS) ? TIOCM_CTS : 0) 1022 | ((msr & TI_MSR_CD) ? TIOCM_CAR : 0) 1023 | ((msr & TI_MSR_RI) ? TIOCM_RI : 0) 1024 | ((msr & TI_MSR_DSR) ? TIOCM_DSR : 0); 1025 1026 dbg("%s - 0x%04X", __func__, result); 1027 1028 return result; 1029 } 1030 1031 1032 static int ti_tiocmset(struct tty_struct *tty, 1033 unsigned int set, unsigned int clear) 1034 { 1035 struct usb_serial_port *port = tty->driver_data; 1036 struct ti_port *tport = usb_get_serial_port_data(port); 1037 unsigned int mcr; 1038 unsigned long flags; 1039 1040 dbg("%s - port %d", __func__, port->number); 1041 1042 if (tport == NULL) 1043 return -ENODEV; 1044 1045 spin_lock_irqsave(&tport->tp_lock, flags); 1046 mcr = tport->tp_shadow_mcr; 1047 1048 if (set & TIOCM_RTS) 1049 mcr |= TI_MCR_RTS; 1050 if (set & TIOCM_DTR) 1051 mcr |= TI_MCR_DTR; 1052 if (set & TIOCM_LOOP) 1053 mcr |= TI_MCR_LOOP; 1054 1055 if (clear & TIOCM_RTS) 1056 mcr &= ~TI_MCR_RTS; 1057 if (clear & TIOCM_DTR) 1058 mcr &= ~TI_MCR_DTR; 1059 if (clear & TIOCM_LOOP) 1060 mcr &= ~TI_MCR_LOOP; 1061 spin_unlock_irqrestore(&tport->tp_lock, flags); 1062 1063 return ti_set_mcr(tport, mcr); 1064 } 1065 1066 1067 static void ti_break(struct tty_struct *tty, int break_state) 1068 { 1069 struct usb_serial_port *port = tty->driver_data; 1070 struct ti_port *tport = usb_get_serial_port_data(port); 1071 int status; 1072 1073 dbg("%s - state = %d", __func__, break_state); 1074 1075 if (tport == NULL) 1076 return; 1077 1078 ti_drain(tport, (tport->tp_closing_wait*HZ)/100, 0); 1079 1080 status = ti_write_byte(tport->tp_tdev, 1081 tport->tp_uart_base_addr + TI_UART_OFFSET_LCR, 1082 TI_LCR_BREAK, break_state == -1 ? TI_LCR_BREAK : 0); 1083 1084 if (status) 1085 dbg("%s - error setting break, %d", __func__, status); 1086 } 1087 1088 1089 static void ti_interrupt_callback(struct urb *urb) 1090 { 1091 struct ti_device *tdev = urb->context; 1092 struct usb_serial_port *port; 1093 struct usb_serial *serial = tdev->td_serial; 1094 struct ti_port *tport; 1095 struct device *dev = &urb->dev->dev; 1096 unsigned char *data = urb->transfer_buffer; 1097 int length = urb->actual_length; 1098 int port_number; 1099 int function; 1100 int status = urb->status; 1101 int retval; 1102 __u8 msr; 1103 1104 dbg("%s", __func__); 1105 1106 switch (status) { 1107 case 0: 1108 break; 1109 case -ECONNRESET: 1110 case -ENOENT: 1111 case -ESHUTDOWN: 1112 dbg("%s - urb shutting down, %d", __func__, status); 1113 tdev->td_urb_error = 1; 1114 return; 1115 default: 1116 dev_err(dev, "%s - nonzero urb status, %d\n", 1117 __func__, status); 1118 tdev->td_urb_error = 1; 1119 goto exit; 1120 } 1121 1122 if (length != 2) { 1123 dbg("%s - bad packet size, %d", __func__, length); 1124 goto exit; 1125 } 1126 1127 if (data[0] == TI_CODE_HARDWARE_ERROR) { 1128 dev_err(dev, "%s - hardware error, %d\n", __func__, data[1]); 1129 goto exit; 1130 } 1131 1132 port_number = TI_GET_PORT_FROM_CODE(data[0]); 1133 function = TI_GET_FUNC_FROM_CODE(data[0]); 1134 1135 dbg("%s - port_number %d, function %d, data 0x%02X", 1136 __func__, port_number, function, data[1]); 1137 1138 if (port_number >= serial->num_ports) { 1139 dev_err(dev, "%s - bad port number, %d\n", 1140 __func__, port_number); 1141 goto exit; 1142 } 1143 1144 port = serial->port[port_number]; 1145 1146 tport = usb_get_serial_port_data(port); 1147 if (!tport) 1148 goto exit; 1149 1150 switch (function) { 1151 case TI_CODE_DATA_ERROR: 1152 dev_err(dev, "%s - DATA ERROR, port %d, data 0x%02X\n", 1153 __func__, port_number, data[1]); 1154 break; 1155 1156 case TI_CODE_MODEM_STATUS: 1157 msr = data[1]; 1158 dbg("%s - port %d, msr 0x%02X", __func__, port_number, msr); 1159 ti_handle_new_msr(tport, msr); 1160 break; 1161 1162 default: 1163 dev_err(dev, "%s - unknown interrupt code, 0x%02X\n", 1164 __func__, data[1]); 1165 break; 1166 } 1167 1168 exit: 1169 retval = usb_submit_urb(urb, GFP_ATOMIC); 1170 if (retval) 1171 dev_err(dev, "%s - resubmit interrupt urb failed, %d\n", 1172 __func__, retval); 1173 } 1174 1175 1176 static void ti_bulk_in_callback(struct urb *urb) 1177 { 1178 struct ti_port *tport = urb->context; 1179 struct usb_serial_port *port = tport->tp_port; 1180 struct device *dev = &urb->dev->dev; 1181 int status = urb->status; 1182 int retval = 0; 1183 struct tty_struct *tty; 1184 1185 dbg("%s", __func__); 1186 1187 switch (status) { 1188 case 0: 1189 break; 1190 case -ECONNRESET: 1191 case -ENOENT: 1192 case -ESHUTDOWN: 1193 dbg("%s - urb shutting down, %d", __func__, status); 1194 tport->tp_tdev->td_urb_error = 1; 1195 wake_up_interruptible(&tport->tp_write_wait); 1196 return; 1197 default: 1198 dev_err(dev, "%s - nonzero urb status, %d\n", 1199 __func__, status); 1200 tport->tp_tdev->td_urb_error = 1; 1201 wake_up_interruptible(&tport->tp_write_wait); 1202 } 1203 1204 if (status == -EPIPE) 1205 goto exit; 1206 1207 if (status) { 1208 dev_err(dev, "%s - stopping read!\n", __func__); 1209 return; 1210 } 1211 1212 tty = tty_port_tty_get(&port->port); 1213 if (tty) { 1214 if (urb->actual_length) { 1215 usb_serial_debug_data(debug, dev, __func__, 1216 urb->actual_length, urb->transfer_buffer); 1217 1218 if (!tport->tp_is_open) 1219 dbg("%s - port closed, dropping data", 1220 __func__); 1221 else 1222 ti_recv(&urb->dev->dev, tty, 1223 urb->transfer_buffer, 1224 urb->actual_length); 1225 spin_lock(&tport->tp_lock); 1226 tport->tp_icount.rx += urb->actual_length; 1227 spin_unlock(&tport->tp_lock); 1228 } 1229 tty_kref_put(tty); 1230 } 1231 1232 exit: 1233 /* continue to read unless stopping */ 1234 spin_lock(&tport->tp_lock); 1235 if (tport->tp_read_urb_state == TI_READ_URB_RUNNING) 1236 retval = usb_submit_urb(urb, GFP_ATOMIC); 1237 else if (tport->tp_read_urb_state == TI_READ_URB_STOPPING) 1238 tport->tp_read_urb_state = TI_READ_URB_STOPPED; 1239 1240 spin_unlock(&tport->tp_lock); 1241 if (retval) 1242 dev_err(dev, "%s - resubmit read urb failed, %d\n", 1243 __func__, retval); 1244 } 1245 1246 1247 static void ti_bulk_out_callback(struct urb *urb) 1248 { 1249 struct ti_port *tport = urb->context; 1250 struct usb_serial_port *port = tport->tp_port; 1251 struct device *dev = &urb->dev->dev; 1252 int status = urb->status; 1253 1254 dbg("%s - port %d", __func__, port->number); 1255 1256 tport->tp_write_urb_in_use = 0; 1257 1258 switch (status) { 1259 case 0: 1260 break; 1261 case -ECONNRESET: 1262 case -ENOENT: 1263 case -ESHUTDOWN: 1264 dbg("%s - urb shutting down, %d", __func__, status); 1265 tport->tp_tdev->td_urb_error = 1; 1266 wake_up_interruptible(&tport->tp_write_wait); 1267 return; 1268 default: 1269 dev_err(dev, "%s - nonzero urb status, %d\n", 1270 __func__, status); 1271 tport->tp_tdev->td_urb_error = 1; 1272 wake_up_interruptible(&tport->tp_write_wait); 1273 } 1274 1275 /* send any buffered data */ 1276 ti_send(tport); 1277 } 1278 1279 1280 static void ti_recv(struct device *dev, struct tty_struct *tty, 1281 unsigned char *data, int length) 1282 { 1283 int cnt; 1284 1285 do { 1286 cnt = tty_insert_flip_string(tty, data, length); 1287 if (cnt < length) { 1288 dev_err(dev, "%s - dropping data, %d bytes lost\n", 1289 __func__, length - cnt); 1290 if (cnt == 0) 1291 break; 1292 } 1293 tty_flip_buffer_push(tty); 1294 data += cnt; 1295 length -= cnt; 1296 } while (length > 0); 1297 1298 } 1299 1300 1301 static void ti_send(struct ti_port *tport) 1302 { 1303 int count, result; 1304 struct usb_serial_port *port = tport->tp_port; 1305 struct tty_struct *tty = tty_port_tty_get(&port->port); /* FIXME */ 1306 unsigned long flags; 1307 1308 1309 dbg("%s - port %d", __func__, port->number); 1310 1311 spin_lock_irqsave(&tport->tp_lock, flags); 1312 1313 if (tport->tp_write_urb_in_use) 1314 goto unlock; 1315 1316 count = kfifo_out(&tport->write_fifo, 1317 port->write_urb->transfer_buffer, 1318 port->bulk_out_size); 1319 1320 if (count == 0) 1321 goto unlock; 1322 1323 tport->tp_write_urb_in_use = 1; 1324 1325 spin_unlock_irqrestore(&tport->tp_lock, flags); 1326 1327 usb_serial_debug_data(debug, &port->dev, __func__, count, 1328 port->write_urb->transfer_buffer); 1329 1330 usb_fill_bulk_urb(port->write_urb, port->serial->dev, 1331 usb_sndbulkpipe(port->serial->dev, 1332 port->bulk_out_endpointAddress), 1333 port->write_urb->transfer_buffer, count, 1334 ti_bulk_out_callback, tport); 1335 1336 result = usb_submit_urb(port->write_urb, GFP_ATOMIC); 1337 if (result) { 1338 dev_err(&port->dev, "%s - submit write urb failed, %d\n", 1339 __func__, result); 1340 tport->tp_write_urb_in_use = 0; 1341 /* TODO: reschedule ti_send */ 1342 } else { 1343 spin_lock_irqsave(&tport->tp_lock, flags); 1344 tport->tp_icount.tx += count; 1345 spin_unlock_irqrestore(&tport->tp_lock, flags); 1346 } 1347 1348 /* more room in the buffer for new writes, wakeup */ 1349 if (tty) 1350 tty_wakeup(tty); 1351 tty_kref_put(tty); 1352 wake_up_interruptible(&tport->tp_write_wait); 1353 return; 1354 unlock: 1355 spin_unlock_irqrestore(&tport->tp_lock, flags); 1356 tty_kref_put(tty); 1357 return; 1358 } 1359 1360 1361 static int ti_set_mcr(struct ti_port *tport, unsigned int mcr) 1362 { 1363 unsigned long flags; 1364 int status; 1365 1366 status = ti_write_byte(tport->tp_tdev, 1367 tport->tp_uart_base_addr + TI_UART_OFFSET_MCR, 1368 TI_MCR_RTS | TI_MCR_DTR | TI_MCR_LOOP, mcr); 1369 1370 spin_lock_irqsave(&tport->tp_lock, flags); 1371 if (!status) 1372 tport->tp_shadow_mcr = mcr; 1373 spin_unlock_irqrestore(&tport->tp_lock, flags); 1374 1375 return status; 1376 } 1377 1378 1379 static int ti_get_lsr(struct ti_port *tport) 1380 { 1381 int size, status; 1382 struct ti_device *tdev = tport->tp_tdev; 1383 struct usb_serial_port *port = tport->tp_port; 1384 int port_number = port->number - port->serial->minor; 1385 struct ti_port_status *data; 1386 1387 dbg("%s - port %d", __func__, port->number); 1388 1389 size = sizeof(struct ti_port_status); 1390 data = kmalloc(size, GFP_KERNEL); 1391 if (!data) { 1392 dev_err(&port->dev, "%s - out of memory\n", __func__); 1393 return -ENOMEM; 1394 } 1395 1396 status = ti_command_in_sync(tdev, TI_GET_PORT_STATUS, 1397 (__u8)(TI_UART1_PORT+port_number), 0, (__u8 *)data, size); 1398 if (status) { 1399 dev_err(&port->dev, 1400 "%s - get port status command failed, %d\n", 1401 __func__, status); 1402 goto free_data; 1403 } 1404 1405 dbg("%s - lsr 0x%02X", __func__, data->bLSR); 1406 1407 tport->tp_lsr = data->bLSR; 1408 1409 free_data: 1410 kfree(data); 1411 return status; 1412 } 1413 1414 1415 static int ti_get_serial_info(struct ti_port *tport, 1416 struct serial_struct __user *ret_arg) 1417 { 1418 struct usb_serial_port *port = tport->tp_port; 1419 struct serial_struct ret_serial; 1420 1421 if (!ret_arg) 1422 return -EFAULT; 1423 1424 memset(&ret_serial, 0, sizeof(ret_serial)); 1425 1426 ret_serial.type = PORT_16550A; 1427 ret_serial.line = port->serial->minor; 1428 ret_serial.port = port->number - port->serial->minor; 1429 ret_serial.flags = tport->tp_flags; 1430 ret_serial.xmit_fifo_size = TI_WRITE_BUF_SIZE; 1431 ret_serial.baud_base = tport->tp_tdev->td_is_3410 ? 921600 : 460800; 1432 ret_serial.closing_wait = tport->tp_closing_wait; 1433 1434 if (copy_to_user(ret_arg, &ret_serial, sizeof(*ret_arg))) 1435 return -EFAULT; 1436 1437 return 0; 1438 } 1439 1440 1441 static int ti_set_serial_info(struct tty_struct *tty, struct ti_port *tport, 1442 struct serial_struct __user *new_arg) 1443 { 1444 struct serial_struct new_serial; 1445 1446 if (copy_from_user(&new_serial, new_arg, sizeof(new_serial))) 1447 return -EFAULT; 1448 1449 tport->tp_flags = new_serial.flags & TI_SET_SERIAL_FLAGS; 1450 tport->tp_closing_wait = new_serial.closing_wait; 1451 1452 return 0; 1453 } 1454 1455 1456 static void ti_handle_new_msr(struct ti_port *tport, __u8 msr) 1457 { 1458 struct async_icount *icount; 1459 struct tty_struct *tty; 1460 unsigned long flags; 1461 1462 dbg("%s - msr 0x%02X", __func__, msr); 1463 1464 if (msr & TI_MSR_DELTA_MASK) { 1465 spin_lock_irqsave(&tport->tp_lock, flags); 1466 icount = &tport->tp_icount; 1467 if (msr & TI_MSR_DELTA_CTS) 1468 icount->cts++; 1469 if (msr & TI_MSR_DELTA_DSR) 1470 icount->dsr++; 1471 if (msr & TI_MSR_DELTA_CD) 1472 icount->dcd++; 1473 if (msr & TI_MSR_DELTA_RI) 1474 icount->rng++; 1475 wake_up_interruptible(&tport->tp_msr_wait); 1476 spin_unlock_irqrestore(&tport->tp_lock, flags); 1477 } 1478 1479 tport->tp_msr = msr & TI_MSR_MASK; 1480 1481 /* handle CTS flow control */ 1482 tty = tty_port_tty_get(&tport->tp_port->port); 1483 if (tty && C_CRTSCTS(tty)) { 1484 if (msr & TI_MSR_CTS) { 1485 tty->hw_stopped = 0; 1486 tty_wakeup(tty); 1487 } else { 1488 tty->hw_stopped = 1; 1489 } 1490 } 1491 tty_kref_put(tty); 1492 } 1493 1494 1495 static void ti_drain(struct ti_port *tport, unsigned long timeout, int flush) 1496 { 1497 struct ti_device *tdev = tport->tp_tdev; 1498 struct usb_serial_port *port = tport->tp_port; 1499 wait_queue_t wait; 1500 1501 dbg("%s - port %d", __func__, port->number); 1502 1503 spin_lock_irq(&tport->tp_lock); 1504 1505 /* wait for data to drain from the buffer */ 1506 tdev->td_urb_error = 0; 1507 init_waitqueue_entry(&wait, current); 1508 add_wait_queue(&tport->tp_write_wait, &wait); 1509 for (;;) { 1510 set_current_state(TASK_INTERRUPTIBLE); 1511 if (kfifo_len(&tport->write_fifo) == 0 1512 || timeout == 0 || signal_pending(current) 1513 || tdev->td_urb_error 1514 || port->serial->disconnected) /* disconnect */ 1515 break; 1516 spin_unlock_irq(&tport->tp_lock); 1517 timeout = schedule_timeout(timeout); 1518 spin_lock_irq(&tport->tp_lock); 1519 } 1520 set_current_state(TASK_RUNNING); 1521 remove_wait_queue(&tport->tp_write_wait, &wait); 1522 1523 /* flush any remaining data in the buffer */ 1524 if (flush) 1525 kfifo_reset_out(&tport->write_fifo); 1526 1527 spin_unlock_irq(&tport->tp_lock); 1528 1529 mutex_lock(&port->serial->disc_mutex); 1530 /* wait for data to drain from the device */ 1531 /* wait for empty tx register, plus 20 ms */ 1532 timeout += jiffies; 1533 tport->tp_lsr &= ~TI_LSR_TX_EMPTY; 1534 while ((long)(jiffies - timeout) < 0 && !signal_pending(current) 1535 && !(tport->tp_lsr&TI_LSR_TX_EMPTY) && !tdev->td_urb_error 1536 && !port->serial->disconnected) { 1537 if (ti_get_lsr(tport)) 1538 break; 1539 mutex_unlock(&port->serial->disc_mutex); 1540 msleep_interruptible(20); 1541 mutex_lock(&port->serial->disc_mutex); 1542 } 1543 mutex_unlock(&port->serial->disc_mutex); 1544 } 1545 1546 1547 static void ti_stop_read(struct ti_port *tport, struct tty_struct *tty) 1548 { 1549 unsigned long flags; 1550 1551 spin_lock_irqsave(&tport->tp_lock, flags); 1552 1553 if (tport->tp_read_urb_state == TI_READ_URB_RUNNING) 1554 tport->tp_read_urb_state = TI_READ_URB_STOPPING; 1555 1556 spin_unlock_irqrestore(&tport->tp_lock, flags); 1557 } 1558 1559 1560 static int ti_restart_read(struct ti_port *tport, struct tty_struct *tty) 1561 { 1562 struct urb *urb; 1563 int status = 0; 1564 unsigned long flags; 1565 1566 spin_lock_irqsave(&tport->tp_lock, flags); 1567 1568 if (tport->tp_read_urb_state == TI_READ_URB_STOPPED) { 1569 tport->tp_read_urb_state = TI_READ_URB_RUNNING; 1570 urb = tport->tp_port->read_urb; 1571 spin_unlock_irqrestore(&tport->tp_lock, flags); 1572 urb->context = tport; 1573 status = usb_submit_urb(urb, GFP_KERNEL); 1574 } else { 1575 tport->tp_read_urb_state = TI_READ_URB_RUNNING; 1576 spin_unlock_irqrestore(&tport->tp_lock, flags); 1577 } 1578 1579 return status; 1580 } 1581 1582 1583 static int ti_command_out_sync(struct ti_device *tdev, __u8 command, 1584 __u16 moduleid, __u16 value, __u8 *data, int size) 1585 { 1586 int status; 1587 1588 status = usb_control_msg(tdev->td_serial->dev, 1589 usb_sndctrlpipe(tdev->td_serial->dev, 0), command, 1590 (USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT), 1591 value, moduleid, data, size, 1000); 1592 1593 if (status == size) 1594 status = 0; 1595 1596 if (status > 0) 1597 status = -ECOMM; 1598 1599 return status; 1600 } 1601 1602 1603 static int ti_command_in_sync(struct ti_device *tdev, __u8 command, 1604 __u16 moduleid, __u16 value, __u8 *data, int size) 1605 { 1606 int status; 1607 1608 status = usb_control_msg(tdev->td_serial->dev, 1609 usb_rcvctrlpipe(tdev->td_serial->dev, 0), command, 1610 (USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN), 1611 value, moduleid, data, size, 1000); 1612 1613 if (status == size) 1614 status = 0; 1615 1616 if (status > 0) 1617 status = -ECOMM; 1618 1619 return status; 1620 } 1621 1622 1623 static int ti_write_byte(struct ti_device *tdev, unsigned long addr, 1624 __u8 mask, __u8 byte) 1625 { 1626 int status; 1627 unsigned int size; 1628 struct ti_write_data_bytes *data; 1629 struct device *dev = &tdev->td_serial->dev->dev; 1630 1631 dbg("%s - addr 0x%08lX, mask 0x%02X, byte 0x%02X", 1632 __func__, addr, mask, byte); 1633 1634 size = sizeof(struct ti_write_data_bytes) + 2; 1635 data = kmalloc(size, GFP_KERNEL); 1636 if (!data) { 1637 dev_err(dev, "%s - out of memory\n", __func__); 1638 return -ENOMEM; 1639 } 1640 1641 data->bAddrType = TI_RW_DATA_ADDR_XDATA; 1642 data->bDataType = TI_RW_DATA_BYTE; 1643 data->bDataCounter = 1; 1644 data->wBaseAddrHi = cpu_to_be16(addr>>16); 1645 data->wBaseAddrLo = cpu_to_be16(addr); 1646 data->bData[0] = mask; 1647 data->bData[1] = byte; 1648 1649 status = ti_command_out_sync(tdev, TI_WRITE_DATA, TI_RAM_PORT, 0, 1650 (__u8 *)data, size); 1651 1652 if (status < 0) 1653 dev_err(dev, "%s - failed, %d\n", __func__, status); 1654 1655 kfree(data); 1656 1657 return status; 1658 } 1659 1660 static int ti_do_download(struct usb_device *dev, int pipe, 1661 u8 *buffer, int size) 1662 { 1663 int pos; 1664 u8 cs = 0; 1665 int done; 1666 struct ti_firmware_header *header; 1667 int status = 0; 1668 int len; 1669 1670 for (pos = sizeof(struct ti_firmware_header); pos < size; pos++) 1671 cs = (__u8)(cs + buffer[pos]); 1672 1673 header = (struct ti_firmware_header *)buffer; 1674 header->wLength = cpu_to_le16((__u16)(size 1675 - sizeof(struct ti_firmware_header))); 1676 header->bCheckSum = cs; 1677 1678 dbg("%s - downloading firmware", __func__); 1679 for (pos = 0; pos < size; pos += done) { 1680 len = min(size - pos, TI_DOWNLOAD_MAX_PACKET_SIZE); 1681 status = usb_bulk_msg(dev, pipe, buffer + pos, len, 1682 &done, 1000); 1683 if (status) 1684 break; 1685 } 1686 return status; 1687 } 1688 1689 static int ti_download_firmware(struct ti_device *tdev) 1690 { 1691 int status; 1692 int buffer_size; 1693 __u8 *buffer; 1694 struct usb_device *dev = tdev->td_serial->dev; 1695 unsigned int pipe = usb_sndbulkpipe(dev, 1696 tdev->td_serial->port[0]->bulk_out_endpointAddress); 1697 const struct firmware *fw_p; 1698 char buf[32]; 1699 1700 dbg("%s\n", __func__); 1701 /* try ID specific firmware first, then try generic firmware */ 1702 sprintf(buf, "ti_usb-v%04x-p%04x.fw", dev->descriptor.idVendor, 1703 dev->descriptor.idProduct); 1704 if ((status = request_firmware(&fw_p, buf, &dev->dev)) != 0) { 1705 buf[0] = '\0'; 1706 if (dev->descriptor.idVendor == MTS_VENDOR_ID) { 1707 switch (dev->descriptor.idProduct) { 1708 case MTS_CDMA_PRODUCT_ID: 1709 strcpy(buf, "mts_cdma.fw"); 1710 break; 1711 case MTS_GSM_PRODUCT_ID: 1712 strcpy(buf, "mts_gsm.fw"); 1713 break; 1714 case MTS_EDGE_PRODUCT_ID: 1715 strcpy(buf, "mts_edge.fw"); 1716 break; 1717 case MTS_MT9234MU_PRODUCT_ID: 1718 strcpy(buf, "mts_mt9234mu.fw"); 1719 break; 1720 case MTS_MT9234ZBA_PRODUCT_ID: 1721 strcpy(buf, "mts_mt9234zba.fw"); 1722 break; 1723 case MTS_MT9234ZBAOLD_PRODUCT_ID: 1724 strcpy(buf, "mts_mt9234zba.fw"); 1725 break; } 1726 } 1727 if (buf[0] == '\0') { 1728 if (tdev->td_is_3410) 1729 strcpy(buf, "ti_3410.fw"); 1730 else 1731 strcpy(buf, "ti_5052.fw"); 1732 } 1733 status = request_firmware(&fw_p, buf, &dev->dev); 1734 } 1735 if (status) { 1736 dev_err(&dev->dev, "%s - firmware not found\n", __func__); 1737 return -ENOENT; 1738 } 1739 if (fw_p->size > TI_FIRMWARE_BUF_SIZE) { 1740 dev_err(&dev->dev, "%s - firmware too large %zu\n", __func__, fw_p->size); 1741 release_firmware(fw_p); 1742 return -ENOENT; 1743 } 1744 1745 buffer_size = TI_FIRMWARE_BUF_SIZE + sizeof(struct ti_firmware_header); 1746 buffer = kmalloc(buffer_size, GFP_KERNEL); 1747 if (buffer) { 1748 memcpy(buffer, fw_p->data, fw_p->size); 1749 memset(buffer + fw_p->size, 0xff, buffer_size - fw_p->size); 1750 status = ti_do_download(dev, pipe, buffer, fw_p->size); 1751 kfree(buffer); 1752 } else { 1753 dbg("%s ENOMEM\n", __func__); 1754 status = -ENOMEM; 1755 } 1756 release_firmware(fw_p); 1757 if (status) { 1758 dev_err(&dev->dev, "%s - error downloading firmware, %d\n", 1759 __func__, status); 1760 return status; 1761 } 1762 1763 dbg("%s - download successful", __func__); 1764 1765 return 0; 1766 } 1767