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.24-rc8 760 lines 21 kB view raw
1/* 2 * Silicon Laboratories CP2101/CP2102 USB to RS232 serial adaptor driver 3 * 4 * Copyright (C) 2005 Craig Shelley (craig@microtron.org.uk) 5 * 6 * This program is free software; you can redistribute it and/or 7 * modify it under the terms of the GNU General Public License version 8 * 2 as published by the Free Software Foundation. 9 * 10 * Support to set flow control line levels using TIOCMGET and TIOCMSET 11 * thanks to Karl Hiramoto karl@hiramoto.org. RTSCTS hardware flow 12 * control thanks to Munir Nassar nassarmu@real-time.com 13 * 14 * Outstanding Issues: 15 * Buffers are not flushed when the port is opened. 16 * Multiple calls to write() may fail with "Resource temporarily unavailable" 17 * 18 */ 19 20#include <linux/kernel.h> 21#include <linux/errno.h> 22#include <linux/slab.h> 23#include <linux/tty.h> 24#include <linux/tty_flip.h> 25#include <linux/module.h> 26#include <linux/moduleparam.h> 27#include <linux/usb.h> 28#include <asm/uaccess.h> 29#include <linux/usb/serial.h> 30 31/* 32 * Version Information 33 */ 34#define DRIVER_VERSION "v0.07" 35#define DRIVER_DESC "Silicon Labs CP2101/CP2102 RS232 serial adaptor driver" 36 37/* 38 * Function Prototypes 39 */ 40static int cp2101_open(struct usb_serial_port*, struct file*); 41static void cp2101_cleanup(struct usb_serial_port*); 42static void cp2101_close(struct usb_serial_port*, struct file*); 43static void cp2101_get_termios(struct usb_serial_port*); 44static void cp2101_set_termios(struct usb_serial_port*, struct ktermios*); 45static int cp2101_tiocmget (struct usb_serial_port *, struct file *); 46static int cp2101_tiocmset (struct usb_serial_port *, struct file *, 47 unsigned int, unsigned int); 48static void cp2101_break_ctl(struct usb_serial_port*, int); 49static int cp2101_startup (struct usb_serial *); 50static void cp2101_shutdown(struct usb_serial*); 51 52 53static int debug; 54 55static struct usb_device_id id_table [] = { 56 { USB_DEVICE(0x08e6, 0x5501) }, /* Gemalto Prox-PU/CU contactless smartcard reader */ 57 { USB_DEVICE(0x0FCF, 0x1003) }, /* Dynastream ANT development board */ 58 { USB_DEVICE(0x0FCF, 0x1004) }, /* Dynastream ANT2USB */ 59 { USB_DEVICE(0x10A6, 0xAA26) }, /* Knock-off DCU-11 cable */ 60 { USB_DEVICE(0x10AB, 0x10C5) }, /* Siemens MC60 Cable */ 61 { USB_DEVICE(0x10B5, 0xAC70) }, /* Nokia CA-42 USB */ 62 { USB_DEVICE(0x10C4, 0x803B) }, /* Pololu USB-serial converter */ 63 { USB_DEVICE(0x10C4, 0x8053) }, /* Enfora EDG1228 */ 64 { USB_DEVICE(0x10C4, 0x8066) }, /* Argussoft In-System Programmer */ 65 { USB_DEVICE(0x10C4, 0x807A) }, /* Crumb128 board */ 66 { USB_DEVICE(0x10C4, 0x80CA) }, /* Degree Controls Inc */ 67 { USB_DEVICE(0x10C4, 0x80DD) }, /* Tracient RFID */ 68 { USB_DEVICE(0x10C4, 0x80F6) }, /* Suunto sports instrument */ 69 { USB_DEVICE(0x10C4, 0x813D) }, /* Burnside Telecom Deskmobile */ 70 { USB_DEVICE(0x10C4, 0x814A) }, /* West Mountain Radio RIGblaster P&P */ 71 { USB_DEVICE(0x10C4, 0x814B) }, /* West Mountain Radio RIGtalk */ 72 { USB_DEVICE(0x10C4, 0x815E) }, /* Helicomm IP-Link 1220-DVM */ 73 { USB_DEVICE(0x10C4, 0x81C8) }, /* Lipowsky Industrie Elektronik GmbH, Baby-JTAG */ 74 { USB_DEVICE(0x10C4, 0x81E2) }, /* Lipowsky Industrie Elektronik GmbH, Baby-LIN */ 75 { USB_DEVICE(0x10C4, 0x81E7) }, /* Aerocomm Radio */ 76 { USB_DEVICE(0x10C4, 0x8218) }, /* Lipowsky Industrie Elektronik GmbH, HARP-1 */ 77 { USB_DEVICE(0x10C4, 0xEA60) }, /* Silicon Labs factory default */ 78 { USB_DEVICE(0x10C4, 0xEA61) }, /* Silicon Labs factory default */ 79 { USB_DEVICE(0x10C5, 0xEA61) }, /* Silicon Labs MobiData GPRS USB Modem */ 80 { USB_DEVICE(0x13AD, 0x9999) }, /* Baltech card reader */ 81 { USB_DEVICE(0x16D6, 0x0001) }, /* Jablotron serial interface */ 82 { } /* Terminating Entry */ 83}; 84 85MODULE_DEVICE_TABLE (usb, id_table); 86 87static struct usb_driver cp2101_driver = { 88 .name = "cp2101", 89 .probe = usb_serial_probe, 90 .disconnect = usb_serial_disconnect, 91 .id_table = id_table, 92 .no_dynamic_id = 1, 93}; 94 95static struct usb_serial_driver cp2101_device = { 96 .driver = { 97 .owner = THIS_MODULE, 98 .name = "cp2101", 99 }, 100 .usb_driver = &cp2101_driver, 101 .id_table = id_table, 102 .num_interrupt_in = 0, 103 .num_bulk_in = NUM_DONT_CARE, 104 .num_bulk_out = NUM_DONT_CARE, 105 .num_ports = 1, 106 .open = cp2101_open, 107 .close = cp2101_close, 108 .break_ctl = cp2101_break_ctl, 109 .set_termios = cp2101_set_termios, 110 .tiocmget = cp2101_tiocmget, 111 .tiocmset = cp2101_tiocmset, 112 .attach = cp2101_startup, 113 .shutdown = cp2101_shutdown, 114}; 115 116/* Config request types */ 117#define REQTYPE_HOST_TO_DEVICE 0x41 118#define REQTYPE_DEVICE_TO_HOST 0xc1 119 120/* Config SET requests. To GET, add 1 to the request number */ 121#define CP2101_UART 0x00 /* Enable / Disable */ 122#define CP2101_BAUDRATE 0x01 /* (BAUD_RATE_GEN_FREQ / baudrate) */ 123#define CP2101_BITS 0x03 /* 0x(0)(databits)(parity)(stopbits) */ 124#define CP2101_BREAK 0x05 /* On / Off */ 125#define CP2101_CONTROL 0x07 /* Flow control line states */ 126#define CP2101_MODEMCTL 0x13 /* Modem controls */ 127#define CP2101_CONFIG_6 0x19 /* 6 bytes of config data ??? */ 128 129/* CP2101_UART */ 130#define UART_ENABLE 0x0001 131#define UART_DISABLE 0x0000 132 133/* CP2101_BAUDRATE */ 134#define BAUD_RATE_GEN_FREQ 0x384000 135 136/* CP2101_BITS */ 137#define BITS_DATA_MASK 0X0f00 138#define BITS_DATA_5 0X0500 139#define BITS_DATA_6 0X0600 140#define BITS_DATA_7 0X0700 141#define BITS_DATA_8 0X0800 142#define BITS_DATA_9 0X0900 143 144#define BITS_PARITY_MASK 0x00f0 145#define BITS_PARITY_NONE 0x0000 146#define BITS_PARITY_ODD 0x0010 147#define BITS_PARITY_EVEN 0x0020 148#define BITS_PARITY_MARK 0x0030 149#define BITS_PARITY_SPACE 0x0040 150 151#define BITS_STOP_MASK 0x000f 152#define BITS_STOP_1 0x0000 153#define BITS_STOP_1_5 0x0001 154#define BITS_STOP_2 0x0002 155 156/* CP2101_BREAK */ 157#define BREAK_ON 0x0000 158#define BREAK_OFF 0x0001 159 160/* CP2101_CONTROL */ 161#define CONTROL_DTR 0x0001 162#define CONTROL_RTS 0x0002 163#define CONTROL_CTS 0x0010 164#define CONTROL_DSR 0x0020 165#define CONTROL_RING 0x0040 166#define CONTROL_DCD 0x0080 167#define CONTROL_WRITE_DTR 0x0100 168#define CONTROL_WRITE_RTS 0x0200 169 170/* 171 * cp2101_get_config 172 * Reads from the CP2101 configuration registers 173 * 'size' is specified in bytes. 174 * 'data' is a pointer to a pre-allocated array of integers large 175 * enough to hold 'size' bytes (with 4 bytes to each integer) 176 */ 177static int cp2101_get_config(struct usb_serial_port* port, u8 request, 178 unsigned int *data, int size) 179{ 180 struct usb_serial *serial = port->serial; 181 __le32 *buf; 182 int result, i, length; 183 184 /* Number of integers required to contain the array */ 185 length = (((size - 1) | 3) + 1)/4; 186 187 buf = kcalloc(length, sizeof(__le32), GFP_KERNEL); 188 if (!buf) { 189 dev_err(&port->dev, "%s - out of memory.\n", __FUNCTION__); 190 return -ENOMEM; 191 } 192 193 /* For get requests, the request number must be incremented */ 194 request++; 195 196 /* Issue the request, attempting to read 'size' bytes */ 197 result = usb_control_msg (serial->dev,usb_rcvctrlpipe (serial->dev, 0), 198 request, REQTYPE_DEVICE_TO_HOST, 0x0000, 199 0, buf, size, 300); 200 201 /* Convert data into an array of integers */ 202 for (i=0; i<length; i++) 203 data[i] = le32_to_cpu(buf[i]); 204 205 kfree(buf); 206 207 if (result != size) { 208 dev_err(&port->dev, "%s - Unable to send config request, " 209 "request=0x%x size=%d result=%d\n", 210 __FUNCTION__, request, size, result); 211 return -EPROTO; 212 } 213 214 return 0; 215} 216 217/* 218 * cp2101_set_config 219 * Writes to the CP2101 configuration registers 220 * Values less than 16 bits wide are sent directly 221 * 'size' is specified in bytes. 222 */ 223static int cp2101_set_config(struct usb_serial_port* port, u8 request, 224 unsigned int *data, int size) 225{ 226 struct usb_serial *serial = port->serial; 227 __le32 *buf; 228 int result, i, length; 229 230 /* Number of integers required to contain the array */ 231 length = (((size - 1) | 3) + 1)/4; 232 233 buf = kmalloc(length * sizeof(__le32), GFP_KERNEL); 234 if (!buf) { 235 dev_err(&port->dev, "%s - out of memory.\n", 236 __FUNCTION__); 237 return -ENOMEM; 238 } 239 240 /* Array of integers into bytes */ 241 for (i = 0; i < length; i++) 242 buf[i] = cpu_to_le32(data[i]); 243 244 if (size > 2) { 245 result = usb_control_msg (serial->dev, 246 usb_sndctrlpipe(serial->dev, 0), 247 request, REQTYPE_HOST_TO_DEVICE, 0x0000, 248 0, buf, size, 300); 249 } else { 250 result = usb_control_msg (serial->dev, 251 usb_sndctrlpipe(serial->dev, 0), 252 request, REQTYPE_HOST_TO_DEVICE, data[0], 253 0, NULL, 0, 300); 254 } 255 256 kfree(buf); 257 258 if ((size > 2 && result != size) || result < 0) { 259 dev_err(&port->dev, "%s - Unable to send request, " 260 "request=0x%x size=%d result=%d\n", 261 __FUNCTION__, request, size, result); 262 return -EPROTO; 263 } 264 265 /* Single data value */ 266 result = usb_control_msg (serial->dev, 267 usb_sndctrlpipe(serial->dev, 0), 268 request, REQTYPE_HOST_TO_DEVICE, data[0], 269 0, NULL, 0, 300); 270 return 0; 271} 272 273/* 274 * cp2101_set_config_single 275 * Convenience function for calling cp2101_set_config on single data values 276 * without requiring an integer pointer 277 */ 278static inline int cp2101_set_config_single(struct usb_serial_port* port, 279 u8 request, unsigned int data) 280{ 281 return cp2101_set_config(port, request, &data, 2); 282} 283 284static int cp2101_open (struct usb_serial_port *port, struct file *filp) 285{ 286 struct usb_serial *serial = port->serial; 287 int result; 288 289 dbg("%s - port %d", __FUNCTION__, port->number); 290 291 if (cp2101_set_config_single(port, CP2101_UART, UART_ENABLE)) { 292 dev_err(&port->dev, "%s - Unable to enable UART\n", 293 __FUNCTION__); 294 return -EPROTO; 295 } 296 297 /* Start reading from the device */ 298 usb_fill_bulk_urb (port->read_urb, serial->dev, 299 usb_rcvbulkpipe(serial->dev, 300 port->bulk_in_endpointAddress), 301 port->read_urb->transfer_buffer, 302 port->read_urb->transfer_buffer_length, 303 serial->type->read_bulk_callback, 304 port); 305 result = usb_submit_urb(port->read_urb, GFP_KERNEL); 306 if (result) { 307 dev_err(&port->dev, "%s - failed resubmitting read urb, " 308 "error %d\n", __FUNCTION__, result); 309 return result; 310 } 311 312 /* Configure the termios structure */ 313 cp2101_get_termios(port); 314 315 /* Set the DTR and RTS pins low */ 316 cp2101_tiocmset(port, NULL, TIOCM_DTR | TIOCM_RTS, 0); 317 318 return 0; 319} 320 321static void cp2101_cleanup (struct usb_serial_port *port) 322{ 323 struct usb_serial *serial = port->serial; 324 325 dbg("%s - port %d", __FUNCTION__, port->number); 326 327 if (serial->dev) { 328 /* shutdown any bulk reads that might be going on */ 329 if (serial->num_bulk_out) 330 usb_kill_urb(port->write_urb); 331 if (serial->num_bulk_in) 332 usb_kill_urb(port->read_urb); 333 } 334} 335 336static void cp2101_close (struct usb_serial_port *port, struct file * filp) 337{ 338 dbg("%s - port %d", __FUNCTION__, port->number); 339 340 /* shutdown our urbs */ 341 dbg("%s - shutting down urbs", __FUNCTION__); 342 usb_kill_urb(port->write_urb); 343 usb_kill_urb(port->read_urb); 344 345 cp2101_set_config_single(port, CP2101_UART, UART_DISABLE); 346} 347 348/* 349 * cp2101_get_termios 350 * Reads the baud rate, data bits, parity, stop bits and flow control mode 351 * from the device, corrects any unsupported values, and configures the 352 * termios structure to reflect the state of the device 353 */ 354static void cp2101_get_termios (struct usb_serial_port *port) 355{ 356 unsigned int cflag, modem_ctl[4]; 357 int baud; 358 int bits; 359 360 dbg("%s - port %d", __FUNCTION__, port->number); 361 362 if (!port->tty || !port->tty->termios) { 363 dbg("%s - no tty structures", __FUNCTION__); 364 return; 365 } 366 367 cp2101_get_config(port, CP2101_BAUDRATE, &baud, 2); 368 /* Convert to baudrate */ 369 if (baud) 370 baud = BAUD_RATE_GEN_FREQ / baud; 371 372 dbg("%s - baud rate = %d", __FUNCTION__, baud); 373 374 tty_encode_baud_rate(port->tty, baud, baud); 375 cflag = port->tty->termios->c_cflag; 376 377 cp2101_get_config(port, CP2101_BITS, &bits, 2); 378 cflag &= ~CSIZE; 379 switch(bits & BITS_DATA_MASK) { 380 case BITS_DATA_5: 381 dbg("%s - data bits = 5", __FUNCTION__); 382 cflag |= CS5; 383 break; 384 case BITS_DATA_6: 385 dbg("%s - data bits = 6", __FUNCTION__); 386 cflag |= CS6; 387 break; 388 case BITS_DATA_7: 389 dbg("%s - data bits = 7", __FUNCTION__); 390 cflag |= CS7; 391 break; 392 case BITS_DATA_8: 393 dbg("%s - data bits = 8", __FUNCTION__); 394 cflag |= CS8; 395 break; 396 case BITS_DATA_9: 397 dbg("%s - data bits = 9 (not supported, " 398 "using 8 data bits)", __FUNCTION__); 399 cflag |= CS8; 400 bits &= ~BITS_DATA_MASK; 401 bits |= BITS_DATA_8; 402 cp2101_set_config(port, CP2101_BITS, &bits, 2); 403 break; 404 default: 405 dbg("%s - Unknown number of data bits, " 406 "using 8", __FUNCTION__); 407 cflag |= CS8; 408 bits &= ~BITS_DATA_MASK; 409 bits |= BITS_DATA_8; 410 cp2101_set_config(port, CP2101_BITS, &bits, 2); 411 break; 412 } 413 414 switch(bits & BITS_PARITY_MASK) { 415 case BITS_PARITY_NONE: 416 dbg("%s - parity = NONE", __FUNCTION__); 417 cflag &= ~PARENB; 418 break; 419 case BITS_PARITY_ODD: 420 dbg("%s - parity = ODD", __FUNCTION__); 421 cflag |= (PARENB|PARODD); 422 break; 423 case BITS_PARITY_EVEN: 424 dbg("%s - parity = EVEN", __FUNCTION__); 425 cflag &= ~PARODD; 426 cflag |= PARENB; 427 break; 428 case BITS_PARITY_MARK: 429 dbg("%s - parity = MARK (not supported, " 430 "disabling parity)", __FUNCTION__); 431 cflag &= ~PARENB; 432 bits &= ~BITS_PARITY_MASK; 433 cp2101_set_config(port, CP2101_BITS, &bits, 2); 434 break; 435 case BITS_PARITY_SPACE: 436 dbg("%s - parity = SPACE (not supported, " 437 "disabling parity)", __FUNCTION__); 438 cflag &= ~PARENB; 439 bits &= ~BITS_PARITY_MASK; 440 cp2101_set_config(port, CP2101_BITS, &bits, 2); 441 break; 442 default: 443 dbg("%s - Unknown parity mode, " 444 "disabling parity", __FUNCTION__); 445 cflag &= ~PARENB; 446 bits &= ~BITS_PARITY_MASK; 447 cp2101_set_config(port, CP2101_BITS, &bits, 2); 448 break; 449 } 450 451 cflag &= ~CSTOPB; 452 switch(bits & BITS_STOP_MASK) { 453 case BITS_STOP_1: 454 dbg("%s - stop bits = 1", __FUNCTION__); 455 break; 456 case BITS_STOP_1_5: 457 dbg("%s - stop bits = 1.5 (not supported, " 458 "using 1 stop bit)", __FUNCTION__); 459 bits &= ~BITS_STOP_MASK; 460 cp2101_set_config(port, CP2101_BITS, &bits, 2); 461 break; 462 case BITS_STOP_2: 463 dbg("%s - stop bits = 2", __FUNCTION__); 464 cflag |= CSTOPB; 465 break; 466 default: 467 dbg("%s - Unknown number of stop bits, " 468 "using 1 stop bit", __FUNCTION__); 469 bits &= ~BITS_STOP_MASK; 470 cp2101_set_config(port, CP2101_BITS, &bits, 2); 471 break; 472 } 473 474 cp2101_get_config(port, CP2101_MODEMCTL, modem_ctl, 16); 475 if (modem_ctl[0] & 0x0008) { 476 dbg("%s - flow control = CRTSCTS", __FUNCTION__); 477 cflag |= CRTSCTS; 478 } else { 479 dbg("%s - flow control = NONE", __FUNCTION__); 480 cflag &= ~CRTSCTS; 481 } 482 483 port->tty->termios->c_cflag = cflag; 484} 485 486static void cp2101_set_termios (struct usb_serial_port *port, 487 struct ktermios *old_termios) 488{ 489 unsigned int cflag, old_cflag; 490 int baud=0, bits; 491 unsigned int modem_ctl[4]; 492 493 dbg("%s - port %d", __FUNCTION__, port->number); 494 495 if (!port->tty || !port->tty->termios) { 496 dbg("%s - no tty structures", __FUNCTION__); 497 return; 498 } 499 port->tty->termios->c_cflag &= ~CMSPAR; 500 501 cflag = port->tty->termios->c_cflag; 502 old_cflag = old_termios->c_cflag; 503 baud = tty_get_baud_rate(port->tty); 504 505 /* If the baud rate is to be updated*/ 506 if (baud != tty_termios_baud_rate(old_termios)) { 507 switch (baud) { 508 case 0: 509 case 600: 510 case 1200: 511 case 1800: 512 case 2400: 513 case 4800: 514 case 7200: 515 case 9600: 516 case 14400: 517 case 19200: 518 case 28800: 519 case 38400: 520 case 55854: 521 case 57600: 522 case 115200: 523 case 127117: 524 case 230400: 525 case 460800: 526 case 921600: 527 case 3686400: 528 break; 529 default: 530 baud = 9600; 531 break; 532 } 533 534 if (baud) { 535 dbg("%s - Setting baud rate to %d baud", __FUNCTION__, 536 baud); 537 if (cp2101_set_config_single(port, CP2101_BAUDRATE, 538 (BAUD_RATE_GEN_FREQ / baud))) { 539 dev_err(&port->dev, "Baud rate requested not " 540 "supported by device\n"); 541 baud = tty_termios_baud_rate(old_termios); 542 } 543 } 544 } 545 /* Report back the resulting baud rate */ 546 tty_encode_baud_rate(port->tty, baud, baud); 547 548 /* If the number of data bits is to be updated */ 549 if ((cflag & CSIZE) != (old_cflag & CSIZE)) { 550 cp2101_get_config(port, CP2101_BITS, &bits, 2); 551 bits &= ~BITS_DATA_MASK; 552 switch (cflag & CSIZE) { 553 case CS5: 554 bits |= BITS_DATA_5; 555 dbg("%s - data bits = 5", __FUNCTION__); 556 break; 557 case CS6: 558 bits |= BITS_DATA_6; 559 dbg("%s - data bits = 6", __FUNCTION__); 560 break; 561 case CS7: 562 bits |= BITS_DATA_7; 563 dbg("%s - data bits = 7", __FUNCTION__); 564 break; 565 case CS8: 566 bits |= BITS_DATA_8; 567 dbg("%s - data bits = 8", __FUNCTION__); 568 break; 569 /*case CS9: 570 bits |= BITS_DATA_9; 571 dbg("%s - data bits = 9", __FUNCTION__); 572 break;*/ 573 default: 574 dev_err(&port->dev, "cp2101 driver does not " 575 "support the number of bits requested," 576 " using 8 bit mode\n"); 577 bits |= BITS_DATA_8; 578 break; 579 } 580 if (cp2101_set_config(port, CP2101_BITS, &bits, 2)) 581 dev_err(&port->dev, "Number of data bits requested " 582 "not supported by device\n"); 583 } 584 585 if ((cflag & (PARENB|PARODD)) != (old_cflag & (PARENB|PARODD))) { 586 cp2101_get_config(port, CP2101_BITS, &bits, 2); 587 bits &= ~BITS_PARITY_MASK; 588 if (cflag & PARENB) { 589 if (cflag & PARODD) { 590 bits |= BITS_PARITY_ODD; 591 dbg("%s - parity = ODD", __FUNCTION__); 592 } else { 593 bits |= BITS_PARITY_EVEN; 594 dbg("%s - parity = EVEN", __FUNCTION__); 595 } 596 } 597 if (cp2101_set_config(port, CP2101_BITS, &bits, 2)) 598 dev_err(&port->dev, "Parity mode not supported " 599 "by device\n"); 600 } 601 602 if ((cflag & CSTOPB) != (old_cflag & CSTOPB)) { 603 cp2101_get_config(port, CP2101_BITS, &bits, 2); 604 bits &= ~BITS_STOP_MASK; 605 if (cflag & CSTOPB) { 606 bits |= BITS_STOP_2; 607 dbg("%s - stop bits = 2", __FUNCTION__); 608 } else { 609 bits |= BITS_STOP_1; 610 dbg("%s - stop bits = 1", __FUNCTION__); 611 } 612 if (cp2101_set_config(port, CP2101_BITS, &bits, 2)) 613 dev_err(&port->dev, "Number of stop bits requested " 614 "not supported by device\n"); 615 } 616 617 if ((cflag & CRTSCTS) != (old_cflag & CRTSCTS)) { 618 cp2101_get_config(port, CP2101_MODEMCTL, modem_ctl, 16); 619 dbg("%s - read modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x", 620 __FUNCTION__, modem_ctl[0], modem_ctl[1], 621 modem_ctl[2], modem_ctl[3]); 622 623 if (cflag & CRTSCTS) { 624 modem_ctl[0] &= ~0x7B; 625 modem_ctl[0] |= 0x09; 626 modem_ctl[1] = 0x80; 627 dbg("%s - flow control = CRTSCTS", __FUNCTION__); 628 } else { 629 modem_ctl[0] &= ~0x7B; 630 modem_ctl[0] |= 0x01; 631 modem_ctl[1] |= 0x40; 632 dbg("%s - flow control = NONE", __FUNCTION__); 633 } 634 635 dbg("%s - write modem controls = 0x%.4x 0x%.4x 0x%.4x 0x%.4x", 636 __FUNCTION__, modem_ctl[0], modem_ctl[1], 637 modem_ctl[2], modem_ctl[3]); 638 cp2101_set_config(port, CP2101_MODEMCTL, modem_ctl, 16); 639 } 640 641} 642 643static int cp2101_tiocmset (struct usb_serial_port *port, struct file *file, 644 unsigned int set, unsigned int clear) 645{ 646 int control = 0; 647 648 dbg("%s - port %d", __FUNCTION__, port->number); 649 650 if (set & TIOCM_RTS) { 651 control |= CONTROL_RTS; 652 control |= CONTROL_WRITE_RTS; 653 } 654 if (set & TIOCM_DTR) { 655 control |= CONTROL_DTR; 656 control |= CONTROL_WRITE_DTR; 657 } 658 if (clear & TIOCM_RTS) { 659 control &= ~CONTROL_RTS; 660 control |= CONTROL_WRITE_RTS; 661 } 662 if (clear & TIOCM_DTR) { 663 control &= ~CONTROL_DTR; 664 control |= CONTROL_WRITE_DTR; 665 } 666 667 dbg("%s - control = 0x%.4x", __FUNCTION__, control); 668 669 return cp2101_set_config(port, CP2101_CONTROL, &control, 2); 670 671} 672 673static int cp2101_tiocmget (struct usb_serial_port *port, struct file *file) 674{ 675 int control, result; 676 677 dbg("%s - port %d", __FUNCTION__, port->number); 678 679 cp2101_get_config(port, CP2101_CONTROL, &control, 1); 680 681 result = ((control & CONTROL_DTR) ? TIOCM_DTR : 0) 682 |((control & CONTROL_RTS) ? TIOCM_RTS : 0) 683 |((control & CONTROL_CTS) ? TIOCM_CTS : 0) 684 |((control & CONTROL_DSR) ? TIOCM_DSR : 0) 685 |((control & CONTROL_RING)? TIOCM_RI : 0) 686 |((control & CONTROL_DCD) ? TIOCM_CD : 0); 687 688 dbg("%s - control = 0x%.2x", __FUNCTION__, control); 689 690 return result; 691} 692 693static void cp2101_break_ctl (struct usb_serial_port *port, int break_state) 694{ 695 int state; 696 697 dbg("%s - port %d", __FUNCTION__, port->number); 698 if (break_state == 0) 699 state = BREAK_OFF; 700 else 701 state = BREAK_ON; 702 dbg("%s - turning break %s", __FUNCTION__, 703 state==BREAK_OFF ? "off" : "on"); 704 cp2101_set_config(port, CP2101_BREAK, &state, 2); 705} 706 707static int cp2101_startup (struct usb_serial *serial) 708{ 709 /* CP2101 buffers behave strangely unless device is reset */ 710 usb_reset_device(serial->dev); 711 return 0; 712} 713 714static void cp2101_shutdown (struct usb_serial *serial) 715{ 716 int i; 717 718 dbg("%s", __FUNCTION__); 719 720 /* Stop reads and writes on all ports */ 721 for (i=0; i < serial->num_ports; ++i) { 722 cp2101_cleanup(serial->port[i]); 723 } 724} 725 726static int __init cp2101_init (void) 727{ 728 int retval; 729 730 retval = usb_serial_register(&cp2101_device); 731 if (retval) 732 return retval; /* Failed to register */ 733 734 retval = usb_register(&cp2101_driver); 735 if (retval) { 736 /* Failed to register */ 737 usb_serial_deregister(&cp2101_device); 738 return retval; 739 } 740 741 /* Success */ 742 info(DRIVER_DESC " " DRIVER_VERSION); 743 return 0; 744} 745 746static void __exit cp2101_exit (void) 747{ 748 usb_deregister (&cp2101_driver); 749 usb_serial_deregister (&cp2101_device); 750} 751 752module_init(cp2101_init); 753module_exit(cp2101_exit); 754 755MODULE_DESCRIPTION(DRIVER_DESC); 756MODULE_VERSION(DRIVER_VERSION); 757MODULE_LICENSE("GPL"); 758 759module_param(debug, bool, S_IRUGO | S_IWUSR); 760MODULE_PARM_DESC(debug, "Enable verbose debugging messages");