Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

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