1 /* 2 Keyspan USB to Serial Converter driver 3 4 (C) Copyright (C) 2000-2001 Hugh Blemings <hugh@blemings.org> 5 (C) Copyright (C) 2002 Greg Kroah-Hartman <greg@kroah.com> 6 7 This program is free software; you can redistribute it and/or modify 8 it under the terms of the GNU General Public License as published by 9 the Free Software Foundation; either version 2 of the License, or 10 (at your option) any later version. 11 12 See http://misc.nu/hugh/keyspan.html for more information. 13 14 Code in this driver inspired by and in a number of places taken 15 from Brian Warner's original Keyspan-PDA driver. 16 17 This driver has been put together with the support of Innosys, Inc. 18 and Keyspan, Inc the manufacturers of the Keyspan USB-serial products. 19 Thanks Guys :) 20 21 Thanks to Paulus for miscellaneous tidy ups, some largish chunks 22 of much nicer and/or completely new code and (perhaps most uniquely) 23 having the patience to sit down and explain why and where he'd changed 24 stuff. 25 26 Tip 'o the hat to IBM (and previously Linuxcare :) for supporting 27 staff in their work on open source projects. 28 29 Change History 30 31 2003sep04 LPM (Keyspan) add support for new single port product USA19HS. 32 Improve setup message handling for all devices. 33 34 Wed Feb 19 22:00:00 PST 2003 (Jeffrey S. Laing <keyspan@jsl.com>) 35 Merged the current (1/31/03) Keyspan code with the current (2.4.21-pre4) 36 Linux source tree. The Linux tree lacked support for the 49WLC and 37 others. The Keyspan patches didn't work with the current kernel. 38 39 2003jan30 LPM add support for the 49WLC and MPR 40 41 Wed Apr 25 12:00:00 PST 2002 (Keyspan) 42 Started with Hugh Blemings' code dated Jan 17, 2002. All adapters 43 now supported (including QI and QW). Modified port open, port 44 close, and send setup() logic to fix various data and endpoint 45 synchronization bugs and device LED status bugs. Changed keyspan_ 46 write_room() to accurately return transmit buffer availability. 47 Changed forwardingLength from 1 to 16 for all adapters. 48 49 Fri Oct 12 16:45:00 EST 2001 50 Preliminary USA-19QI and USA-28 support (both test OK for me, YMMV) 51 52 Wed Apr 25 12:00:00 PST 2002 (Keyspan) 53 Started with Hugh Blemings' code dated Jan 17, 2002. All adapters 54 now supported (including QI and QW). Modified port open, port 55 close, and send setup() logic to fix various data and endpoint 56 synchronization bugs and device LED status bugs. Changed keyspan_ 57 write_room() to accurately return transmit buffer availability. 58 Changed forwardingLength from 1 to 16 for all adapters. 59 60 Fri Oct 12 16:45:00 EST 2001 61 Preliminary USA-19QI and USA-28 support (both test OK for me, YMMV) 62 63 Mon Oct 8 14:29:00 EST 2001 hugh 64 Fixed bug that prevented mulitport devices operating correctly 65 if they weren't the first unit attached. 66 67 Sat Oct 6 12:31:21 EST 2001 hugh 68 Added support for USA-28XA and -28XB, misc cleanups, break support 69 for usa26 based models thanks to David Gibson. 70 71 Thu May 31 11:56:42 PDT 2001 gkh 72 switched from using spinlock to a semaphore 73 74 (04/08/2001) gb 75 Identify version on module load. 76 77 (11/01/2000) Adam J. Richter 78 usb_device_id table support. 79 80 Tue Oct 10 23:15:33 EST 2000 Hugh 81 Merged Paul's changes with my USA-49W mods. Work in progress 82 still... 83 84 Wed Jul 19 14:00:42 EST 2000 gkh 85 Added module_init and module_exit functions to handle the fact that 86 this driver is a loadable module now. 87 88 Tue Jul 18 16:14:52 EST 2000 Hugh 89 Basic character input/output for USA-19 now mostly works, 90 fixed at 9600 baud for the moment. 91 92 Sat Jul 8 11:11:48 EST 2000 Hugh 93 First public release - nothing works except the firmware upload. 94 Tested on PPC and x86 architectures, seems to behave... 95 */ 96 97 98 #include <linux/kernel.h> 99 #include <linux/jiffies.h> 100 #include <linux/errno.h> 101 #include <linux/init.h> 102 #include <linux/slab.h> 103 #include <linux/tty.h> 104 #include <linux/tty_driver.h> 105 #include <linux/tty_flip.h> 106 #include <linux/module.h> 107 #include <linux/spinlock.h> 108 #include <asm/uaccess.h> 109 #include <linux/usb.h> 110 #include <linux/usb/serial.h> 111 #include "keyspan.h" 112 113 static int debug; 114 115 /* 116 * Version Information 117 */ 118 #define DRIVER_VERSION "v1.1.5" 119 #define DRIVER_AUTHOR "Hugh Blemings <hugh@misc.nu" 120 #define DRIVER_DESC "Keyspan USB to Serial Converter Driver" 121 122 #define INSTAT_BUFLEN 32 123 #define GLOCONT_BUFLEN 64 124 #define INDAT49W_BUFLEN 512 125 126 /* Per device and per port private data */ 127 struct keyspan_serial_private { 128 const struct keyspan_device_details *device_details; 129 130 struct urb *instat_urb; 131 char instat_buf[INSTAT_BUFLEN]; 132 133 /* added to support 49wg, where data from all 4 ports comes in on 1 EP */ 134 /* and high-speed supported */ 135 struct urb *indat_urb; 136 char indat_buf[INDAT49W_BUFLEN]; 137 138 /* XXX this one probably will need a lock */ 139 struct urb *glocont_urb; 140 char glocont_buf[GLOCONT_BUFLEN]; 141 char ctrl_buf[8]; // for EP0 control message 142 }; 143 144 struct keyspan_port_private { 145 /* Keep track of which input & output endpoints to use */ 146 int in_flip; 147 int out_flip; 148 149 /* Keep duplicate of device details in each port 150 structure as well - simplifies some of the 151 callback functions etc. */ 152 const struct keyspan_device_details *device_details; 153 154 /* Input endpoints and buffer for this port */ 155 struct urb *in_urbs[2]; 156 char in_buffer[2][64]; 157 /* Output endpoints and buffer for this port */ 158 struct urb *out_urbs[2]; 159 char out_buffer[2][64]; 160 161 /* Input ack endpoint */ 162 struct urb *inack_urb; 163 char inack_buffer[1]; 164 165 /* Output control endpoint */ 166 struct urb *outcont_urb; 167 char outcont_buffer[64]; 168 169 /* Settings for the port */ 170 int baud; 171 int old_baud; 172 unsigned int cflag; 173 unsigned int old_cflag; 174 enum {flow_none, flow_cts, flow_xon} flow_control; 175 int rts_state; /* Handshaking pins (outputs) */ 176 int dtr_state; 177 int cts_state; /* Handshaking pins (inputs) */ 178 int dsr_state; 179 int dcd_state; 180 int ri_state; 181 int break_on; 182 183 unsigned long tx_start_time[2]; 184 int resend_cont; /* need to resend control packet */ 185 }; 186 187 188 /* Include Keyspan message headers. All current Keyspan Adapters 189 make use of one of five message formats which are referred 190 to as USA-26, USA-28, USA-49, USA-90, USA-67 by Keyspan and within this driver. */ 191 #include "keyspan_usa26msg.h" 192 #include "keyspan_usa28msg.h" 193 #include "keyspan_usa49msg.h" 194 #include "keyspan_usa90msg.h" 195 #include "keyspan_usa67msg.h" 196 197 198 /* Functions used by new usb-serial code. */ 199 static int __init keyspan_init (void) 200 { 201 int retval; 202 retval = usb_serial_register(&keyspan_pre_device); 203 if (retval) 204 goto failed_pre_device_register; 205 retval = usb_serial_register(&keyspan_1port_device); 206 if (retval) 207 goto failed_1port_device_register; 208 retval = usb_serial_register(&keyspan_2port_device); 209 if (retval) 210 goto failed_2port_device_register; 211 retval = usb_serial_register(&keyspan_4port_device); 212 if (retval) 213 goto failed_4port_device_register; 214 retval = usb_register(&keyspan_driver); 215 if (retval) 216 goto failed_usb_register; 217 218 info(DRIVER_VERSION ":" DRIVER_DESC); 219 220 return 0; 221 failed_usb_register: 222 usb_serial_deregister(&keyspan_4port_device); 223 failed_4port_device_register: 224 usb_serial_deregister(&keyspan_2port_device); 225 failed_2port_device_register: 226 usb_serial_deregister(&keyspan_1port_device); 227 failed_1port_device_register: 228 usb_serial_deregister(&keyspan_pre_device); 229 failed_pre_device_register: 230 return retval; 231 } 232 233 static void __exit keyspan_exit (void) 234 { 235 usb_deregister (&keyspan_driver); 236 usb_serial_deregister (&keyspan_pre_device); 237 usb_serial_deregister (&keyspan_1port_device); 238 usb_serial_deregister (&keyspan_2port_device); 239 usb_serial_deregister (&keyspan_4port_device); 240 } 241 242 module_init(keyspan_init); 243 module_exit(keyspan_exit); 244 245 static void keyspan_rx_throttle (struct usb_serial_port *port) 246 { 247 dbg("%s - port %d", __FUNCTION__, port->number); 248 } 249 250 251 static void keyspan_rx_unthrottle (struct usb_serial_port *port) 252 { 253 dbg("%s - port %d", __FUNCTION__, port->number); 254 } 255 256 257 static void keyspan_break_ctl (struct usb_serial_port *port, int break_state) 258 { 259 struct keyspan_port_private *p_priv; 260 261 dbg("%s", __FUNCTION__); 262 263 p_priv = usb_get_serial_port_data(port); 264 265 if (break_state == -1) 266 p_priv->break_on = 1; 267 else 268 p_priv->break_on = 0; 269 270 keyspan_send_setup(port, 0); 271 } 272 273 274 static void keyspan_set_termios (struct usb_serial_port *port, 275 struct ktermios *old_termios) 276 { 277 int baud_rate, device_port; 278 struct keyspan_port_private *p_priv; 279 const struct keyspan_device_details *d_details; 280 unsigned int cflag; 281 struct tty_struct *tty = port->tty; 282 283 dbg("%s", __FUNCTION__); 284 285 p_priv = usb_get_serial_port_data(port); 286 d_details = p_priv->device_details; 287 cflag = tty->termios->c_cflag; 288 device_port = port->number - port->serial->minor; 289 290 /* Baud rate calculation takes baud rate as an integer 291 so other rates can be generated if desired. */ 292 baud_rate = tty_get_baud_rate(tty); 293 /* If no match or invalid, don't change */ 294 if (d_details->calculate_baud_rate(baud_rate, d_details->baudclk, 295 NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) { 296 /* FIXME - more to do here to ensure rate changes cleanly */ 297 /* FIXME - calcuate exact rate from divisor ? */ 298 p_priv->baud = baud_rate; 299 } else 300 baud_rate = tty_termios_baud_rate(old_termios); 301 302 tty_encode_baud_rate(tty, baud_rate, baud_rate); 303 /* set CTS/RTS handshake etc. */ 304 p_priv->cflag = cflag; 305 p_priv->flow_control = (cflag & CRTSCTS)? flow_cts: flow_none; 306 307 /* Mark/Space not supported */ 308 tty->termios->c_cflag &= ~CMSPAR; 309 310 keyspan_send_setup(port, 0); 311 } 312 313 static int keyspan_tiocmget(struct usb_serial_port *port, struct file *file) 314 { 315 unsigned int value; 316 struct keyspan_port_private *p_priv; 317 318 p_priv = usb_get_serial_port_data(port); 319 320 value = ((p_priv->rts_state) ? TIOCM_RTS : 0) | 321 ((p_priv->dtr_state) ? TIOCM_DTR : 0) | 322 ((p_priv->cts_state) ? TIOCM_CTS : 0) | 323 ((p_priv->dsr_state) ? TIOCM_DSR : 0) | 324 ((p_priv->dcd_state) ? TIOCM_CAR : 0) | 325 ((p_priv->ri_state) ? TIOCM_RNG : 0); 326 327 return value; 328 } 329 330 static int keyspan_tiocmset(struct usb_serial_port *port, struct file *file, 331 unsigned int set, unsigned int clear) 332 { 333 struct keyspan_port_private *p_priv; 334 335 p_priv = usb_get_serial_port_data(port); 336 337 if (set & TIOCM_RTS) 338 p_priv->rts_state = 1; 339 if (set & TIOCM_DTR) 340 p_priv->dtr_state = 1; 341 342 if (clear & TIOCM_RTS) 343 p_priv->rts_state = 0; 344 if (clear & TIOCM_DTR) 345 p_priv->dtr_state = 0; 346 keyspan_send_setup(port, 0); 347 return 0; 348 } 349 350 static int keyspan_ioctl(struct usb_serial_port *port, struct file *file, 351 unsigned int cmd, unsigned long arg) 352 { 353 return -ENOIOCTLCMD; 354 } 355 356 /* Write function is similar for the four protocols used 357 with only a minor change for usa90 (usa19hs) required */ 358 static int keyspan_write(struct usb_serial_port *port, 359 const unsigned char *buf, int count) 360 { 361 struct keyspan_port_private *p_priv; 362 const struct keyspan_device_details *d_details; 363 int flip; 364 int left, todo; 365 struct urb *this_urb; 366 int err, maxDataLen, dataOffset; 367 368 p_priv = usb_get_serial_port_data(port); 369 d_details = p_priv->device_details; 370 371 if (d_details->msg_format == msg_usa90) { 372 maxDataLen = 64; 373 dataOffset = 0; 374 } else { 375 maxDataLen = 63; 376 dataOffset = 1; 377 } 378 379 dbg("%s - for port %d (%d chars), flip=%d", 380 __FUNCTION__, port->number, count, p_priv->out_flip); 381 382 for (left = count; left > 0; left -= todo) { 383 todo = left; 384 if (todo > maxDataLen) 385 todo = maxDataLen; 386 387 flip = p_priv->out_flip; 388 389 /* Check we have a valid urb/endpoint before we use it... */ 390 if ((this_urb = p_priv->out_urbs[flip]) == NULL) { 391 /* no bulk out, so return 0 bytes written */ 392 dbg("%s - no output urb :(", __FUNCTION__); 393 return count; 394 } 395 396 dbg("%s - endpoint %d flip %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe), flip); 397 398 if (this_urb->status == -EINPROGRESS) { 399 if (time_before(jiffies, p_priv->tx_start_time[flip] + 10 * HZ)) 400 break; 401 usb_unlink_urb(this_urb); 402 break; 403 } 404 405 /* First byte in buffer is "last flag" (except for usa19hx) - unused so 406 for now so set to zero */ 407 ((char *)this_urb->transfer_buffer)[0] = 0; 408 409 memcpy (this_urb->transfer_buffer + dataOffset, buf, todo); 410 buf += todo; 411 412 /* send the data out the bulk port */ 413 this_urb->transfer_buffer_length = todo + dataOffset; 414 415 this_urb->dev = port->serial->dev; 416 if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { 417 dbg("usb_submit_urb(write bulk) failed (%d)", err); 418 } 419 p_priv->tx_start_time[flip] = jiffies; 420 421 /* Flip for next time if usa26 or usa28 interface 422 (not used on usa49) */ 423 p_priv->out_flip = (flip + 1) & d_details->outdat_endp_flip; 424 } 425 426 return count - left; 427 } 428 429 static void usa26_indat_callback(struct urb *urb) 430 { 431 int i, err; 432 int endpoint; 433 struct usb_serial_port *port; 434 struct tty_struct *tty; 435 unsigned char *data = urb->transfer_buffer; 436 int status = urb->status; 437 438 dbg ("%s", __FUNCTION__); 439 440 endpoint = usb_pipeendpoint(urb->pipe); 441 442 if (status) { 443 dbg("%s - nonzero status: %x on endpoint %d.", 444 __FUNCTION__, status, endpoint); 445 return; 446 } 447 448 port = (struct usb_serial_port *) urb->context; 449 tty = port->tty; 450 if (tty && urb->actual_length) { 451 /* 0x80 bit is error flag */ 452 if ((data[0] & 0x80) == 0) { 453 /* no errors on individual bytes, only possible overrun err*/ 454 if (data[0] & RXERROR_OVERRUN) 455 err = TTY_OVERRUN; 456 else err = 0; 457 for (i = 1; i < urb->actual_length ; ++i) { 458 tty_insert_flip_char(tty, data[i], err); 459 } 460 } else { 461 /* some bytes had errors, every byte has status */ 462 dbg("%s - RX error!!!!", __FUNCTION__); 463 for (i = 0; i + 1 < urb->actual_length; i += 2) { 464 int stat = data[i], flag = 0; 465 if (stat & RXERROR_OVERRUN) 466 flag |= TTY_OVERRUN; 467 if (stat & RXERROR_FRAMING) 468 flag |= TTY_FRAME; 469 if (stat & RXERROR_PARITY) 470 flag |= TTY_PARITY; 471 /* XXX should handle break (0x10) */ 472 tty_insert_flip_char(tty, data[i+1], flag); 473 } 474 } 475 tty_flip_buffer_push(tty); 476 } 477 478 /* Resubmit urb so we continue receiving */ 479 urb->dev = port->serial->dev; 480 if (port->open_count) 481 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 482 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 483 } 484 return; 485 } 486 487 /* Outdat handling is common for all devices */ 488 static void usa2x_outdat_callback(struct urb *urb) 489 { 490 struct usb_serial_port *port; 491 struct keyspan_port_private *p_priv; 492 493 port = (struct usb_serial_port *) urb->context; 494 p_priv = usb_get_serial_port_data(port); 495 dbg ("%s - urb %d", __FUNCTION__, urb == p_priv->out_urbs[1]); 496 497 if (port->open_count) 498 usb_serial_port_softint(port); 499 } 500 501 static void usa26_inack_callback(struct urb *urb) 502 { 503 dbg ("%s", __FUNCTION__); 504 505 } 506 507 static void usa26_outcont_callback(struct urb *urb) 508 { 509 struct usb_serial_port *port; 510 struct keyspan_port_private *p_priv; 511 512 port = (struct usb_serial_port *) urb->context; 513 p_priv = usb_get_serial_port_data(port); 514 515 if (p_priv->resend_cont) { 516 dbg ("%s - sending setup", __FUNCTION__); 517 keyspan_usa26_send_setup(port->serial, port, p_priv->resend_cont - 1); 518 } 519 } 520 521 static void usa26_instat_callback(struct urb *urb) 522 { 523 unsigned char *data = urb->transfer_buffer; 524 struct keyspan_usa26_portStatusMessage *msg; 525 struct usb_serial *serial; 526 struct usb_serial_port *port; 527 struct keyspan_port_private *p_priv; 528 int old_dcd_state, err; 529 int status = urb->status; 530 531 serial = (struct usb_serial *) urb->context; 532 533 if (status) { 534 dbg("%s - nonzero status: %x", __FUNCTION__, status); 535 return; 536 } 537 if (urb->actual_length != 9) { 538 dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length); 539 goto exit; 540 } 541 542 msg = (struct keyspan_usa26_portStatusMessage *)data; 543 544 #if 0 545 dbg("%s - port status: port %d cts %d dcd %d dsr %d ri %d toff %d txoff %d rxen %d cr %d", 546 __FUNCTION__, msg->port, msg->hskia_cts, msg->gpia_dcd, msg->dsr, msg->ri, msg->_txOff, 547 msg->_txXoff, msg->rxEnabled, msg->controlResponse); 548 #endif 549 550 /* Now do something useful with the data */ 551 552 553 /* Check port number from message and retrieve private data */ 554 if (msg->port >= serial->num_ports) { 555 dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); 556 goto exit; 557 } 558 port = serial->port[msg->port]; 559 p_priv = usb_get_serial_port_data(port); 560 561 /* Update handshaking pin state information */ 562 old_dcd_state = p_priv->dcd_state; 563 p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0); 564 p_priv->dsr_state = ((msg->dsr) ? 1 : 0); 565 p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0); 566 p_priv->ri_state = ((msg->ri) ? 1 : 0); 567 568 if (port->tty && !C_CLOCAL(port->tty) 569 && old_dcd_state != p_priv->dcd_state) { 570 if (old_dcd_state) 571 tty_hangup(port->tty); 572 /* else */ 573 /* wake_up_interruptible(&p_priv->open_wait); */ 574 } 575 576 /* Resubmit urb so we continue receiving */ 577 urb->dev = serial->dev; 578 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 579 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 580 } 581 exit: ; 582 } 583 584 static void usa26_glocont_callback(struct urb *urb) 585 { 586 dbg ("%s", __FUNCTION__); 587 588 } 589 590 591 static void usa28_indat_callback(struct urb *urb) 592 { 593 int i, err; 594 struct usb_serial_port *port; 595 struct tty_struct *tty; 596 unsigned char *data; 597 struct keyspan_port_private *p_priv; 598 int status = urb->status; 599 600 dbg ("%s", __FUNCTION__); 601 602 port = (struct usb_serial_port *) urb->context; 603 p_priv = usb_get_serial_port_data(port); 604 data = urb->transfer_buffer; 605 606 if (urb != p_priv->in_urbs[p_priv->in_flip]) 607 return; 608 609 do { 610 if (status) { 611 dbg("%s - nonzero status: %x on endpoint %d.", 612 __FUNCTION__, status, usb_pipeendpoint(urb->pipe)); 613 return; 614 } 615 616 port = (struct usb_serial_port *) urb->context; 617 p_priv = usb_get_serial_port_data(port); 618 data = urb->transfer_buffer; 619 620 tty = port->tty; 621 if (urb->actual_length) { 622 for (i = 0; i < urb->actual_length ; ++i) { 623 tty_insert_flip_char(tty, data[i], 0); 624 } 625 tty_flip_buffer_push(tty); 626 } 627 628 /* Resubmit urb so we continue receiving */ 629 urb->dev = port->serial->dev; 630 if (port->open_count) 631 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 632 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 633 } 634 p_priv->in_flip ^= 1; 635 636 urb = p_priv->in_urbs[p_priv->in_flip]; 637 } while (urb->status != -EINPROGRESS); 638 } 639 640 static void usa28_inack_callback(struct urb *urb) 641 { 642 dbg ("%s", __FUNCTION__); 643 } 644 645 static void usa28_outcont_callback(struct urb *urb) 646 { 647 struct usb_serial_port *port; 648 struct keyspan_port_private *p_priv; 649 650 port = (struct usb_serial_port *) urb->context; 651 p_priv = usb_get_serial_port_data(port); 652 653 if (p_priv->resend_cont) { 654 dbg ("%s - sending setup", __FUNCTION__); 655 keyspan_usa28_send_setup(port->serial, port, p_priv->resend_cont - 1); 656 } 657 } 658 659 static void usa28_instat_callback(struct urb *urb) 660 { 661 int err; 662 unsigned char *data = urb->transfer_buffer; 663 struct keyspan_usa28_portStatusMessage *msg; 664 struct usb_serial *serial; 665 struct usb_serial_port *port; 666 struct keyspan_port_private *p_priv; 667 int old_dcd_state; 668 int status = urb->status; 669 670 serial = (struct usb_serial *) urb->context; 671 672 if (status) { 673 dbg("%s - nonzero status: %x", __FUNCTION__, status); 674 return; 675 } 676 677 if (urb->actual_length != sizeof(struct keyspan_usa28_portStatusMessage)) { 678 dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); 679 goto exit; 680 } 681 682 /*dbg("%s %x %x %x %x %x %x %x %x %x %x %x %x", __FUNCTION__ 683 data[0], data[1], data[2], data[3], data[4], data[5], 684 data[6], data[7], data[8], data[9], data[10], data[11]);*/ 685 686 /* Now do something useful with the data */ 687 msg = (struct keyspan_usa28_portStatusMessage *)data; 688 689 690 /* Check port number from message and retrieve private data */ 691 if (msg->port >= serial->num_ports) { 692 dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); 693 goto exit; 694 } 695 port = serial->port[msg->port]; 696 p_priv = usb_get_serial_port_data(port); 697 698 /* Update handshaking pin state information */ 699 old_dcd_state = p_priv->dcd_state; 700 p_priv->cts_state = ((msg->cts) ? 1 : 0); 701 p_priv->dsr_state = ((msg->dsr) ? 1 : 0); 702 p_priv->dcd_state = ((msg->dcd) ? 1 : 0); 703 p_priv->ri_state = ((msg->ri) ? 1 : 0); 704 705 if (port->tty && !C_CLOCAL(port->tty) 706 && old_dcd_state != p_priv->dcd_state) { 707 if (old_dcd_state) 708 tty_hangup(port->tty); 709 /* else */ 710 /* wake_up_interruptible(&p_priv->open_wait); */ 711 } 712 713 /* Resubmit urb so we continue receiving */ 714 urb->dev = serial->dev; 715 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 716 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 717 } 718 exit: ; 719 } 720 721 static void usa28_glocont_callback(struct urb *urb) 722 { 723 dbg ("%s", __FUNCTION__); 724 } 725 726 727 static void usa49_glocont_callback(struct urb *urb) 728 { 729 struct usb_serial *serial; 730 struct usb_serial_port *port; 731 struct keyspan_port_private *p_priv; 732 int i; 733 734 dbg ("%s", __FUNCTION__); 735 736 serial = (struct usb_serial *) urb->context; 737 for (i = 0; i < serial->num_ports; ++i) { 738 port = serial->port[i]; 739 p_priv = usb_get_serial_port_data(port); 740 741 if (p_priv->resend_cont) { 742 dbg ("%s - sending setup", __FUNCTION__); 743 keyspan_usa49_send_setup(serial, port, p_priv->resend_cont - 1); 744 break; 745 } 746 } 747 } 748 749 /* This is actually called glostat in the Keyspan 750 doco */ 751 static void usa49_instat_callback(struct urb *urb) 752 { 753 int err; 754 unsigned char *data = urb->transfer_buffer; 755 struct keyspan_usa49_portStatusMessage *msg; 756 struct usb_serial *serial; 757 struct usb_serial_port *port; 758 struct keyspan_port_private *p_priv; 759 int old_dcd_state; 760 int status = urb->status; 761 762 dbg ("%s", __FUNCTION__); 763 764 serial = (struct usb_serial *) urb->context; 765 766 if (status) { 767 dbg("%s - nonzero status: %x", __FUNCTION__, status); 768 return; 769 } 770 771 if (urb->actual_length != sizeof(struct keyspan_usa49_portStatusMessage)) { 772 dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); 773 goto exit; 774 } 775 776 /*dbg(" %x %x %x %x %x %x %x %x %x %x %x", __FUNCTION__, 777 data[0], data[1], data[2], data[3], data[4], data[5], 778 data[6], data[7], data[8], data[9], data[10]);*/ 779 780 /* Now do something useful with the data */ 781 msg = (struct keyspan_usa49_portStatusMessage *)data; 782 783 /* Check port number from message and retrieve private data */ 784 if (msg->portNumber >= serial->num_ports) { 785 dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->portNumber); 786 goto exit; 787 } 788 port = serial->port[msg->portNumber]; 789 p_priv = usb_get_serial_port_data(port); 790 791 /* Update handshaking pin state information */ 792 old_dcd_state = p_priv->dcd_state; 793 p_priv->cts_state = ((msg->cts) ? 1 : 0); 794 p_priv->dsr_state = ((msg->dsr) ? 1 : 0); 795 p_priv->dcd_state = ((msg->dcd) ? 1 : 0); 796 p_priv->ri_state = ((msg->ri) ? 1 : 0); 797 798 if (port->tty && !C_CLOCAL(port->tty) 799 && old_dcd_state != p_priv->dcd_state) { 800 if (old_dcd_state) 801 tty_hangup(port->tty); 802 /* else */ 803 /* wake_up_interruptible(&p_priv->open_wait); */ 804 } 805 806 /* Resubmit urb so we continue receiving */ 807 urb->dev = serial->dev; 808 809 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 810 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 811 } 812 exit: ; 813 } 814 815 static void usa49_inack_callback(struct urb *urb) 816 { 817 dbg ("%s", __FUNCTION__); 818 } 819 820 static void usa49_indat_callback(struct urb *urb) 821 { 822 int i, err; 823 int endpoint; 824 struct usb_serial_port *port; 825 struct tty_struct *tty; 826 unsigned char *data = urb->transfer_buffer; 827 int status = urb->status; 828 829 dbg ("%s", __FUNCTION__); 830 831 endpoint = usb_pipeendpoint(urb->pipe); 832 833 if (status) { 834 dbg("%s - nonzero status: %x on endpoint %d.", __FUNCTION__, 835 status, endpoint); 836 return; 837 } 838 839 port = (struct usb_serial_port *) urb->context; 840 tty = port->tty; 841 if (tty && urb->actual_length) { 842 /* 0x80 bit is error flag */ 843 if ((data[0] & 0x80) == 0) { 844 /* no error on any byte */ 845 for (i = 1; i < urb->actual_length ; ++i) { 846 tty_insert_flip_char(tty, data[i], 0); 847 } 848 } else { 849 /* some bytes had errors, every byte has status */ 850 for (i = 0; i + 1 < urb->actual_length; i += 2) { 851 int stat = data[i], flag = 0; 852 if (stat & RXERROR_OVERRUN) 853 flag |= TTY_OVERRUN; 854 if (stat & RXERROR_FRAMING) 855 flag |= TTY_FRAME; 856 if (stat & RXERROR_PARITY) 857 flag |= TTY_PARITY; 858 /* XXX should handle break (0x10) */ 859 tty_insert_flip_char(tty, data[i+1], flag); 860 } 861 } 862 tty_flip_buffer_push(tty); 863 } 864 865 /* Resubmit urb so we continue receiving */ 866 urb->dev = port->serial->dev; 867 if (port->open_count) 868 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 869 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 870 } 871 } 872 873 static void usa49wg_indat_callback(struct urb *urb) 874 { 875 int i, len, x, err; 876 struct usb_serial *serial; 877 struct usb_serial_port *port; 878 struct tty_struct *tty; 879 unsigned char *data = urb->transfer_buffer; 880 int status = urb->status; 881 882 dbg ("%s", __FUNCTION__); 883 884 serial = urb->context; 885 886 if (status) { 887 dbg("%s - nonzero status: %x", __FUNCTION__, status); 888 return; 889 } 890 891 /* inbound data is in the form P#, len, status, data */ 892 i = 0; 893 len = 0; 894 895 if (urb->actual_length) { 896 while (i < urb->actual_length) { 897 898 /* Check port number from message*/ 899 if (data[i] >= serial->num_ports) { 900 dbg ("%s - Unexpected port number %d", 901 __FUNCTION__, data[i]); 902 return; 903 } 904 port = serial->port[data[i++]]; 905 tty = port->tty; 906 len = data[i++]; 907 908 /* 0x80 bit is error flag */ 909 if ((data[i] & 0x80) == 0) { 910 /* no error on any byte */ 911 i++; 912 for (x = 1; x < len ; ++x) 913 if (port->open_count) 914 tty_insert_flip_char(tty, 915 data[i++], 0); 916 else 917 i++; 918 } else { 919 /* 920 * some bytes had errors, every byte has status 921 */ 922 for (x = 0; x + 1 < len; x += 2) { 923 int stat = data[i], flag = 0; 924 if (stat & RXERROR_OVERRUN) 925 flag |= TTY_OVERRUN; 926 if (stat & RXERROR_FRAMING) 927 flag |= TTY_FRAME; 928 if (stat & RXERROR_PARITY) 929 flag |= TTY_PARITY; 930 /* XXX should handle break (0x10) */ 931 if (port->open_count) 932 tty_insert_flip_char(tty, 933 data[i+1], flag); 934 i += 2; 935 } 936 } 937 if (port->open_count) 938 tty_flip_buffer_push(tty); 939 } 940 } 941 942 /* Resubmit urb so we continue receiving */ 943 urb->dev = serial->dev; 944 945 err = usb_submit_urb(urb, GFP_ATOMIC); 946 if (err != 0) 947 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 948 } 949 950 /* not used, usa-49 doesn't have per-port control endpoints */ 951 static void usa49_outcont_callback(struct urb *urb) 952 { 953 dbg ("%s", __FUNCTION__); 954 } 955 956 static void usa90_indat_callback(struct urb *urb) 957 { 958 int i, err; 959 int endpoint; 960 struct usb_serial_port *port; 961 struct keyspan_port_private *p_priv; 962 struct tty_struct *tty; 963 unsigned char *data = urb->transfer_buffer; 964 int status = urb->status; 965 966 dbg ("%s", __FUNCTION__); 967 968 endpoint = usb_pipeendpoint(urb->pipe); 969 970 if (status) { 971 dbg("%s - nonzero status: %x on endpoint %d.", 972 __FUNCTION__, status, endpoint); 973 return; 974 } 975 976 port = (struct usb_serial_port *) urb->context; 977 p_priv = usb_get_serial_port_data(port); 978 979 tty = port->tty; 980 if (urb->actual_length) { 981 982 /* if current mode is DMA, looks like usa28 format 983 otherwise looks like usa26 data format */ 984 985 if (p_priv->baud > 57600) { 986 for (i = 0; i < urb->actual_length ; ++i) 987 tty_insert_flip_char(tty, data[i], 0); 988 } 989 else { 990 991 /* 0x80 bit is error flag */ 992 if ((data[0] & 0x80) == 0) { 993 /* no errors on individual bytes, only possible overrun err*/ 994 if (data[0] & RXERROR_OVERRUN) 995 err = TTY_OVERRUN; 996 else err = 0; 997 for (i = 1; i < urb->actual_length ; ++i) 998 tty_insert_flip_char(tty, data[i], err); 999 1000 } 1001 else { 1002 /* some bytes had errors, every byte has status */ 1003 dbg("%s - RX error!!!!", __FUNCTION__); 1004 for (i = 0; i + 1 < urb->actual_length; i += 2) { 1005 int stat = data[i], flag = 0; 1006 if (stat & RXERROR_OVERRUN) 1007 flag |= TTY_OVERRUN; 1008 if (stat & RXERROR_FRAMING) 1009 flag |= TTY_FRAME; 1010 if (stat & RXERROR_PARITY) 1011 flag |= TTY_PARITY; 1012 /* XXX should handle break (0x10) */ 1013 tty_insert_flip_char(tty, data[i+1], flag); 1014 } 1015 } 1016 } 1017 tty_flip_buffer_push(tty); 1018 } 1019 1020 /* Resubmit urb so we continue receiving */ 1021 urb->dev = port->serial->dev; 1022 if (port->open_count) 1023 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 1024 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 1025 } 1026 return; 1027 } 1028 1029 1030 static void usa90_instat_callback(struct urb *urb) 1031 { 1032 unsigned char *data = urb->transfer_buffer; 1033 struct keyspan_usa90_portStatusMessage *msg; 1034 struct usb_serial *serial; 1035 struct usb_serial_port *port; 1036 struct keyspan_port_private *p_priv; 1037 int old_dcd_state, err; 1038 int status = urb->status; 1039 1040 serial = (struct usb_serial *) urb->context; 1041 1042 if (status) { 1043 dbg("%s - nonzero status: %x", __FUNCTION__, status); 1044 return; 1045 } 1046 if (urb->actual_length < 14) { 1047 dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length); 1048 goto exit; 1049 } 1050 1051 msg = (struct keyspan_usa90_portStatusMessage *)data; 1052 1053 /* Now do something useful with the data */ 1054 1055 port = serial->port[0]; 1056 p_priv = usb_get_serial_port_data(port); 1057 1058 /* Update handshaking pin state information */ 1059 old_dcd_state = p_priv->dcd_state; 1060 p_priv->cts_state = ((msg->cts) ? 1 : 0); 1061 p_priv->dsr_state = ((msg->dsr) ? 1 : 0); 1062 p_priv->dcd_state = ((msg->dcd) ? 1 : 0); 1063 p_priv->ri_state = ((msg->ri) ? 1 : 0); 1064 1065 if (port->tty && !C_CLOCAL(port->tty) 1066 && old_dcd_state != p_priv->dcd_state) { 1067 if (old_dcd_state) 1068 tty_hangup(port->tty); 1069 /* else */ 1070 /* wake_up_interruptible(&p_priv->open_wait); */ 1071 } 1072 1073 /* Resubmit urb so we continue receiving */ 1074 urb->dev = serial->dev; 1075 if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { 1076 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 1077 } 1078 exit: 1079 ; 1080 } 1081 1082 static void usa90_outcont_callback(struct urb *urb) 1083 { 1084 struct usb_serial_port *port; 1085 struct keyspan_port_private *p_priv; 1086 1087 port = (struct usb_serial_port *) urb->context; 1088 p_priv = usb_get_serial_port_data(port); 1089 1090 if (p_priv->resend_cont) { 1091 dbg ("%s - sending setup", __FUNCTION__); 1092 keyspan_usa90_send_setup(port->serial, port, p_priv->resend_cont - 1); 1093 } 1094 } 1095 1096 /* Status messages from the 28xg */ 1097 static void usa67_instat_callback(struct urb *urb) 1098 { 1099 int err; 1100 unsigned char *data = urb->transfer_buffer; 1101 struct keyspan_usa67_portStatusMessage *msg; 1102 struct usb_serial *serial; 1103 struct usb_serial_port *port; 1104 struct keyspan_port_private *p_priv; 1105 int old_dcd_state; 1106 int status = urb->status; 1107 1108 dbg ("%s", __FUNCTION__); 1109 1110 serial = urb->context; 1111 1112 if (status) { 1113 dbg("%s - nonzero status: %x", __FUNCTION__, status); 1114 return; 1115 } 1116 1117 if (urb->actual_length != sizeof(struct keyspan_usa67_portStatusMessage)) { 1118 dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); 1119 return; 1120 } 1121 1122 1123 /* Now do something useful with the data */ 1124 msg = (struct keyspan_usa67_portStatusMessage *)data; 1125 1126 /* Check port number from message and retrieve private data */ 1127 if (msg->port >= serial->num_ports) { 1128 dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); 1129 return; 1130 } 1131 1132 port = serial->port[msg->port]; 1133 p_priv = usb_get_serial_port_data(port); 1134 1135 /* Update handshaking pin state information */ 1136 old_dcd_state = p_priv->dcd_state; 1137 p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0); 1138 p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0); 1139 1140 if (port->tty && !C_CLOCAL(port->tty) 1141 && old_dcd_state != p_priv->dcd_state) { 1142 if (old_dcd_state) 1143 tty_hangup(port->tty); 1144 /* else */ 1145 /* wake_up_interruptible(&p_priv->open_wait); */ 1146 } 1147 1148 /* Resubmit urb so we continue receiving */ 1149 urb->dev = serial->dev; 1150 err = usb_submit_urb(urb, GFP_ATOMIC); 1151 if (err != 0) 1152 dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); 1153 } 1154 1155 static void usa67_glocont_callback(struct urb *urb) 1156 { 1157 struct usb_serial *serial; 1158 struct usb_serial_port *port; 1159 struct keyspan_port_private *p_priv; 1160 int i; 1161 1162 dbg ("%s", __FUNCTION__); 1163 1164 serial = urb->context; 1165 for (i = 0; i < serial->num_ports; ++i) { 1166 port = serial->port[i]; 1167 p_priv = usb_get_serial_port_data(port); 1168 1169 if (p_priv->resend_cont) { 1170 dbg ("%s - sending setup", __FUNCTION__); 1171 keyspan_usa67_send_setup(serial, port, 1172 p_priv->resend_cont - 1); 1173 break; 1174 } 1175 } 1176 } 1177 1178 static int keyspan_write_room (struct usb_serial_port *port) 1179 { 1180 struct keyspan_port_private *p_priv; 1181 const struct keyspan_device_details *d_details; 1182 int flip; 1183 int data_len; 1184 struct urb *this_urb; 1185 1186 dbg("%s", __FUNCTION__); 1187 p_priv = usb_get_serial_port_data(port); 1188 d_details = p_priv->device_details; 1189 1190 if (d_details->msg_format == msg_usa90) 1191 data_len = 64; 1192 else 1193 data_len = 63; 1194 1195 flip = p_priv->out_flip; 1196 1197 /* Check both endpoints to see if any are available. */ 1198 if ((this_urb = p_priv->out_urbs[flip]) != NULL) { 1199 if (this_urb->status != -EINPROGRESS) 1200 return (data_len); 1201 flip = (flip + 1) & d_details->outdat_endp_flip; 1202 if ((this_urb = p_priv->out_urbs[flip]) != NULL) 1203 if (this_urb->status != -EINPROGRESS) 1204 return (data_len); 1205 } 1206 return (0); 1207 } 1208 1209 1210 static int keyspan_chars_in_buffer (struct usb_serial_port *port) 1211 { 1212 return (0); 1213 } 1214 1215 1216 static int keyspan_open (struct usb_serial_port *port, struct file *filp) 1217 { 1218 struct keyspan_port_private *p_priv; 1219 struct keyspan_serial_private *s_priv; 1220 struct usb_serial *serial = port->serial; 1221 const struct keyspan_device_details *d_details; 1222 int i, err; 1223 int baud_rate, device_port; 1224 struct urb *urb; 1225 unsigned int cflag; 1226 1227 s_priv = usb_get_serial_data(serial); 1228 p_priv = usb_get_serial_port_data(port); 1229 d_details = p_priv->device_details; 1230 1231 dbg("%s - port%d.", __FUNCTION__, port->number); 1232 1233 /* Set some sane defaults */ 1234 p_priv->rts_state = 1; 1235 p_priv->dtr_state = 1; 1236 p_priv->baud = 9600; 1237 1238 /* force baud and lcr to be set on open */ 1239 p_priv->old_baud = 0; 1240 p_priv->old_cflag = 0; 1241 1242 p_priv->out_flip = 0; 1243 p_priv->in_flip = 0; 1244 1245 /* Reset low level data toggle and start reading from endpoints */ 1246 for (i = 0; i < 2; i++) { 1247 if ((urb = p_priv->in_urbs[i]) == NULL) 1248 continue; 1249 urb->dev = serial->dev; 1250 1251 /* make sure endpoint data toggle is synchronized with the device */ 1252 1253 usb_clear_halt(urb->dev, urb->pipe); 1254 1255 if ((err = usb_submit_urb(urb, GFP_KERNEL)) != 0) { 1256 dbg("%s - submit urb %d failed (%d)", __FUNCTION__, i, err); 1257 } 1258 } 1259 1260 /* Reset low level data toggle on out endpoints */ 1261 for (i = 0; i < 2; i++) { 1262 if ((urb = p_priv->out_urbs[i]) == NULL) 1263 continue; 1264 urb->dev = serial->dev; 1265 /* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), usb_pipeout(urb->pipe), 0); */ 1266 } 1267 1268 /* get the terminal config for the setup message now so we don't 1269 * need to send 2 of them */ 1270 1271 cflag = port->tty->termios->c_cflag; 1272 device_port = port->number - port->serial->minor; 1273 1274 /* Baud rate calculation takes baud rate as an integer 1275 so other rates can be generated if desired. */ 1276 baud_rate = tty_get_baud_rate(port->tty); 1277 /* If no match or invalid, leave as default */ 1278 if (baud_rate >= 0 1279 && d_details->calculate_baud_rate(baud_rate, d_details->baudclk, 1280 NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) { 1281 p_priv->baud = baud_rate; 1282 } 1283 1284 /* set CTS/RTS handshake etc. */ 1285 p_priv->cflag = cflag; 1286 p_priv->flow_control = (cflag & CRTSCTS)? flow_cts: flow_none; 1287 1288 keyspan_send_setup(port, 1); 1289 //mdelay(100); 1290 //keyspan_set_termios(port, NULL); 1291 1292 return (0); 1293 } 1294 1295 static inline void stop_urb(struct urb *urb) 1296 { 1297 if (urb && urb->status == -EINPROGRESS) 1298 usb_kill_urb(urb); 1299 } 1300 1301 static void keyspan_close(struct usb_serial_port *port, struct file *filp) 1302 { 1303 int i; 1304 struct usb_serial *serial = port->serial; 1305 struct keyspan_serial_private *s_priv; 1306 struct keyspan_port_private *p_priv; 1307 1308 dbg("%s", __FUNCTION__); 1309 s_priv = usb_get_serial_data(serial); 1310 p_priv = usb_get_serial_port_data(port); 1311 1312 p_priv->rts_state = 0; 1313 p_priv->dtr_state = 0; 1314 1315 if (serial->dev) { 1316 keyspan_send_setup(port, 2); 1317 /* pilot-xfer seems to work best with this delay */ 1318 mdelay(100); 1319 // keyspan_set_termios(port, NULL); 1320 } 1321 1322 /*while (p_priv->outcont_urb->status == -EINPROGRESS) { 1323 dbg("%s - urb in progress", __FUNCTION__); 1324 }*/ 1325 1326 p_priv->out_flip = 0; 1327 p_priv->in_flip = 0; 1328 1329 if (serial->dev) { 1330 /* Stop reading/writing urbs */ 1331 stop_urb(p_priv->inack_urb); 1332 /* stop_urb(p_priv->outcont_urb); */ 1333 for (i = 0; i < 2; i++) { 1334 stop_urb(p_priv->in_urbs[i]); 1335 stop_urb(p_priv->out_urbs[i]); 1336 } 1337 } 1338 port->tty = NULL; 1339 } 1340 1341 1342 /* download the firmware to a pre-renumeration device */ 1343 static int keyspan_fake_startup (struct usb_serial *serial) 1344 { 1345 int response; 1346 const struct ezusb_hex_record *record; 1347 char *fw_name; 1348 1349 dbg("Keyspan startup version %04x product %04x", 1350 le16_to_cpu(serial->dev->descriptor.bcdDevice), 1351 le16_to_cpu(serial->dev->descriptor.idProduct)); 1352 1353 if ((le16_to_cpu(serial->dev->descriptor.bcdDevice) & 0x8000) != 0x8000) { 1354 dbg("Firmware already loaded. Quitting."); 1355 return(1); 1356 } 1357 1358 /* Select firmware image on the basis of idProduct */ 1359 switch (le16_to_cpu(serial->dev->descriptor.idProduct)) { 1360 case keyspan_usa28_pre_product_id: 1361 record = &keyspan_usa28_firmware[0]; 1362 fw_name = "USA28"; 1363 break; 1364 1365 case keyspan_usa28x_pre_product_id: 1366 record = &keyspan_usa28x_firmware[0]; 1367 fw_name = "USA28X"; 1368 break; 1369 1370 case keyspan_usa28xa_pre_product_id: 1371 record = &keyspan_usa28xa_firmware[0]; 1372 fw_name = "USA28XA"; 1373 break; 1374 1375 case keyspan_usa28xb_pre_product_id: 1376 record = &keyspan_usa28xb_firmware[0]; 1377 fw_name = "USA28XB"; 1378 break; 1379 1380 case keyspan_usa19_pre_product_id: 1381 record = &keyspan_usa19_firmware[0]; 1382 fw_name = "USA19"; 1383 break; 1384 1385 case keyspan_usa19qi_pre_product_id: 1386 record = &keyspan_usa19qi_firmware[0]; 1387 fw_name = "USA19QI"; 1388 break; 1389 1390 case keyspan_mpr_pre_product_id: 1391 record = &keyspan_mpr_firmware[0]; 1392 fw_name = "MPR"; 1393 break; 1394 1395 case keyspan_usa19qw_pre_product_id: 1396 record = &keyspan_usa19qw_firmware[0]; 1397 fw_name = "USA19QI"; 1398 break; 1399 1400 case keyspan_usa18x_pre_product_id: 1401 record = &keyspan_usa18x_firmware[0]; 1402 fw_name = "USA18X"; 1403 break; 1404 1405 case keyspan_usa19w_pre_product_id: 1406 record = &keyspan_usa19w_firmware[0]; 1407 fw_name = "USA19W"; 1408 break; 1409 1410 case keyspan_usa49w_pre_product_id: 1411 record = &keyspan_usa49w_firmware[0]; 1412 fw_name = "USA49W"; 1413 break; 1414 1415 case keyspan_usa49wlc_pre_product_id: 1416 record = &keyspan_usa49wlc_firmware[0]; 1417 fw_name = "USA49WLC"; 1418 break; 1419 1420 default: 1421 record = NULL; 1422 fw_name = "Unknown"; 1423 break; 1424 } 1425 1426 if (record == NULL) { 1427 dev_err(&serial->dev->dev, "Required keyspan firmware image (%s) unavailable.\n", fw_name); 1428 return(1); 1429 } 1430 1431 dbg("Uploading Keyspan %s firmware.", fw_name); 1432 1433 /* download the firmware image */ 1434 response = ezusb_set_reset(serial, 1); 1435 1436 while(record->address != 0xffff) { 1437 response = ezusb_writememory(serial, record->address, 1438 (unsigned char *)record->data, 1439 record->data_size, 0xa0); 1440 if (response < 0) { 1441 dev_err(&serial->dev->dev, "ezusb_writememory failed for Keyspan" 1442 "firmware (%d %04X %p %d)\n", 1443 response, 1444 record->address, record->data, record->data_size); 1445 break; 1446 } 1447 record++; 1448 } 1449 /* bring device out of reset. Renumeration will occur in a 1450 moment and the new device will bind to the real driver */ 1451 response = ezusb_set_reset(serial, 0); 1452 1453 /* we don't want this device to have a driver assigned to it. */ 1454 return (1); 1455 } 1456 1457 /* Helper functions used by keyspan_setup_urbs */ 1458 static struct usb_endpoint_descriptor const *find_ep(struct usb_serial const *serial, 1459 int endpoint) 1460 { 1461 struct usb_host_interface *iface_desc; 1462 struct usb_endpoint_descriptor *ep; 1463 int i; 1464 1465 iface_desc = serial->interface->cur_altsetting; 1466 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { 1467 ep = &iface_desc->endpoint[i].desc; 1468 if (ep->bEndpointAddress == endpoint) 1469 return ep; 1470 } 1471 dev_warn(&serial->interface->dev, "found no endpoint descriptor for " 1472 "endpoint %x\n", endpoint); 1473 return NULL; 1474 } 1475 1476 static struct urb *keyspan_setup_urb (struct usb_serial *serial, int endpoint, 1477 int dir, void *ctx, char *buf, int len, 1478 void (*callback)(struct urb *)) 1479 { 1480 struct urb *urb; 1481 struct usb_endpoint_descriptor const *ep_desc; 1482 char const *ep_type_name; 1483 1484 if (endpoint == -1) 1485 return NULL; /* endpoint not needed */ 1486 1487 dbg ("%s - alloc for endpoint %d.", __FUNCTION__, endpoint); 1488 urb = usb_alloc_urb(0, GFP_KERNEL); /* No ISO */ 1489 if (urb == NULL) { 1490 dbg ("%s - alloc for endpoint %d failed.", __FUNCTION__, endpoint); 1491 return NULL; 1492 } 1493 1494 if (endpoint == 0) { 1495 /* control EP filled in when used */ 1496 return urb; 1497 } 1498 1499 ep_desc = find_ep(serial, endpoint); 1500 if (!ep_desc) { 1501 /* leak the urb, something's wrong and the callers don't care */ 1502 return urb; 1503 } 1504 if (usb_endpoint_xfer_int(ep_desc)) { 1505 ep_type_name = "INT"; 1506 usb_fill_int_urb(urb, serial->dev, 1507 usb_sndintpipe(serial->dev, endpoint) | dir, 1508 buf, len, callback, ctx, 1509 ep_desc->bInterval); 1510 } else if (usb_endpoint_xfer_bulk(ep_desc)) { 1511 ep_type_name = "BULK"; 1512 usb_fill_bulk_urb(urb, serial->dev, 1513 usb_sndbulkpipe(serial->dev, endpoint) | dir, 1514 buf, len, callback, ctx); 1515 } else { 1516 dev_warn(&serial->interface->dev, 1517 "unsupported endpoint type %x\n", 1518 ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK); 1519 usb_free_urb(urb); 1520 return NULL; 1521 } 1522 1523 dbg("%s - using urb %p for %s endpoint %x", 1524 __func__, urb, ep_type_name, endpoint); 1525 return urb; 1526 } 1527 1528 static struct callbacks { 1529 void (*instat_callback)(struct urb *); 1530 void (*glocont_callback)(struct urb *); 1531 void (*indat_callback)(struct urb *); 1532 void (*outdat_callback)(struct urb *); 1533 void (*inack_callback)(struct urb *); 1534 void (*outcont_callback)(struct urb *); 1535 } keyspan_callbacks[] = { 1536 { 1537 /* msg_usa26 callbacks */ 1538 .instat_callback = usa26_instat_callback, 1539 .glocont_callback = usa26_glocont_callback, 1540 .indat_callback = usa26_indat_callback, 1541 .outdat_callback = usa2x_outdat_callback, 1542 .inack_callback = usa26_inack_callback, 1543 .outcont_callback = usa26_outcont_callback, 1544 }, { 1545 /* msg_usa28 callbacks */ 1546 .instat_callback = usa28_instat_callback, 1547 .glocont_callback = usa28_glocont_callback, 1548 .indat_callback = usa28_indat_callback, 1549 .outdat_callback = usa2x_outdat_callback, 1550 .inack_callback = usa28_inack_callback, 1551 .outcont_callback = usa28_outcont_callback, 1552 }, { 1553 /* msg_usa49 callbacks */ 1554 .instat_callback = usa49_instat_callback, 1555 .glocont_callback = usa49_glocont_callback, 1556 .indat_callback = usa49_indat_callback, 1557 .outdat_callback = usa2x_outdat_callback, 1558 .inack_callback = usa49_inack_callback, 1559 .outcont_callback = usa49_outcont_callback, 1560 }, { 1561 /* msg_usa90 callbacks */ 1562 .instat_callback = usa90_instat_callback, 1563 .glocont_callback = usa28_glocont_callback, 1564 .indat_callback = usa90_indat_callback, 1565 .outdat_callback = usa2x_outdat_callback, 1566 .inack_callback = usa28_inack_callback, 1567 .outcont_callback = usa90_outcont_callback, 1568 }, { 1569 /* msg_usa67 callbacks */ 1570 .instat_callback = usa67_instat_callback, 1571 .glocont_callback = usa67_glocont_callback, 1572 .indat_callback = usa26_indat_callback, 1573 .outdat_callback = usa2x_outdat_callback, 1574 .inack_callback = usa26_inack_callback, 1575 .outcont_callback = usa26_outcont_callback, 1576 } 1577 }; 1578 1579 /* Generic setup urbs function that uses 1580 data in device_details */ 1581 static void keyspan_setup_urbs(struct usb_serial *serial) 1582 { 1583 int i, j; 1584 struct keyspan_serial_private *s_priv; 1585 const struct keyspan_device_details *d_details; 1586 struct usb_serial_port *port; 1587 struct keyspan_port_private *p_priv; 1588 struct callbacks *cback; 1589 int endp; 1590 1591 dbg ("%s", __FUNCTION__); 1592 1593 s_priv = usb_get_serial_data(serial); 1594 d_details = s_priv->device_details; 1595 1596 /* Setup values for the various callback routines */ 1597 cback = &keyspan_callbacks[d_details->msg_format]; 1598 1599 /* Allocate and set up urbs for each one that is in use, 1600 starting with instat endpoints */ 1601 s_priv->instat_urb = keyspan_setup_urb 1602 (serial, d_details->instat_endpoint, USB_DIR_IN, 1603 serial, s_priv->instat_buf, INSTAT_BUFLEN, 1604 cback->instat_callback); 1605 1606 s_priv->indat_urb = keyspan_setup_urb 1607 (serial, d_details->indat_endpoint, USB_DIR_IN, 1608 serial, s_priv->indat_buf, INDAT49W_BUFLEN, 1609 usa49wg_indat_callback); 1610 1611 s_priv->glocont_urb = keyspan_setup_urb 1612 (serial, d_details->glocont_endpoint, USB_DIR_OUT, 1613 serial, s_priv->glocont_buf, GLOCONT_BUFLEN, 1614 cback->glocont_callback); 1615 1616 /* Setup endpoints for each port specific thing */ 1617 for (i = 0; i < d_details->num_ports; i ++) { 1618 port = serial->port[i]; 1619 p_priv = usb_get_serial_port_data(port); 1620 1621 /* Do indat endpoints first, once for each flip */ 1622 endp = d_details->indat_endpoints[i]; 1623 for (j = 0; j <= d_details->indat_endp_flip; ++j, ++endp) { 1624 p_priv->in_urbs[j] = keyspan_setup_urb 1625 (serial, endp, USB_DIR_IN, port, 1626 p_priv->in_buffer[j], 64, 1627 cback->indat_callback); 1628 } 1629 for (; j < 2; ++j) 1630 p_priv->in_urbs[j] = NULL; 1631 1632 /* outdat endpoints also have flip */ 1633 endp = d_details->outdat_endpoints[i]; 1634 for (j = 0; j <= d_details->outdat_endp_flip; ++j, ++endp) { 1635 p_priv->out_urbs[j] = keyspan_setup_urb 1636 (serial, endp, USB_DIR_OUT, port, 1637 p_priv->out_buffer[j], 64, 1638 cback->outdat_callback); 1639 } 1640 for (; j < 2; ++j) 1641 p_priv->out_urbs[j] = NULL; 1642 1643 /* inack endpoint */ 1644 p_priv->inack_urb = keyspan_setup_urb 1645 (serial, d_details->inack_endpoints[i], USB_DIR_IN, 1646 port, p_priv->inack_buffer, 1, cback->inack_callback); 1647 1648 /* outcont endpoint */ 1649 p_priv->outcont_urb = keyspan_setup_urb 1650 (serial, d_details->outcont_endpoints[i], USB_DIR_OUT, 1651 port, p_priv->outcont_buffer, 64, 1652 cback->outcont_callback); 1653 } 1654 1655 } 1656 1657 /* usa19 function doesn't require prescaler */ 1658 static int keyspan_usa19_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, 1659 u8 *rate_low, u8 *prescaler, int portnum) 1660 { 1661 u32 b16, /* baud rate times 16 (actual rate used internally) */ 1662 div, /* divisor */ 1663 cnt; /* inverse of divisor (programmed into 8051) */ 1664 1665 dbg ("%s - %d.", __FUNCTION__, baud_rate); 1666 1667 /* prevent divide by zero... */ 1668 if( (b16 = (baud_rate * 16L)) == 0) { 1669 return (KEYSPAN_INVALID_BAUD_RATE); 1670 } 1671 1672 /* Any "standard" rate over 57k6 is marginal on the USA-19 1673 as we run out of divisor resolution. */ 1674 if (baud_rate > 57600) { 1675 return (KEYSPAN_INVALID_BAUD_RATE); 1676 } 1677 1678 /* calculate the divisor and the counter (its inverse) */ 1679 if( (div = (baudclk / b16)) == 0) { 1680 return (KEYSPAN_INVALID_BAUD_RATE); 1681 } 1682 else { 1683 cnt = 0 - div; 1684 } 1685 1686 if(div > 0xffff) { 1687 return (KEYSPAN_INVALID_BAUD_RATE); 1688 } 1689 1690 /* return the counter values if non-null */ 1691 if (rate_low) { 1692 *rate_low = (u8) (cnt & 0xff); 1693 } 1694 if (rate_hi) { 1695 *rate_hi = (u8) ((cnt >> 8) & 0xff); 1696 } 1697 if (rate_low && rate_hi) { 1698 dbg ("%s - %d %02x %02x.", __FUNCTION__, baud_rate, *rate_hi, *rate_low); 1699 } 1700 1701 return (KEYSPAN_BAUD_RATE_OK); 1702 } 1703 1704 /* usa19hs function doesn't require prescaler */ 1705 static int keyspan_usa19hs_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, 1706 u8 *rate_low, u8 *prescaler, int portnum) 1707 { 1708 u32 b16, /* baud rate times 16 (actual rate used internally) */ 1709 div; /* divisor */ 1710 1711 dbg ("%s - %d.", __FUNCTION__, baud_rate); 1712 1713 /* prevent divide by zero... */ 1714 if( (b16 = (baud_rate * 16L)) == 0) 1715 return (KEYSPAN_INVALID_BAUD_RATE); 1716 1717 1718 1719 /* calculate the divisor */ 1720 if( (div = (baudclk / b16)) == 0) 1721 return (KEYSPAN_INVALID_BAUD_RATE); 1722 1723 if(div > 0xffff) 1724 return (KEYSPAN_INVALID_BAUD_RATE); 1725 1726 /* return the counter values if non-null */ 1727 if (rate_low) 1728 *rate_low = (u8) (div & 0xff); 1729 1730 if (rate_hi) 1731 *rate_hi = (u8) ((div >> 8) & 0xff); 1732 1733 if (rate_low && rate_hi) 1734 dbg ("%s - %d %02x %02x.", __FUNCTION__, baud_rate, *rate_hi, *rate_low); 1735 1736 return (KEYSPAN_BAUD_RATE_OK); 1737 } 1738 1739 static int keyspan_usa19w_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, 1740 u8 *rate_low, u8 *prescaler, int portnum) 1741 { 1742 u32 b16, /* baud rate times 16 (actual rate used internally) */ 1743 clk, /* clock with 13/8 prescaler */ 1744 div, /* divisor using 13/8 prescaler */ 1745 res, /* resulting baud rate using 13/8 prescaler */ 1746 diff, /* error using 13/8 prescaler */ 1747 smallest_diff; 1748 u8 best_prescaler; 1749 int i; 1750 1751 dbg ("%s - %d.", __FUNCTION__, baud_rate); 1752 1753 /* prevent divide by zero */ 1754 if( (b16 = baud_rate * 16L) == 0) { 1755 return (KEYSPAN_INVALID_BAUD_RATE); 1756 } 1757 1758 /* Calculate prescaler by trying them all and looking 1759 for best fit */ 1760 1761 /* start with largest possible difference */ 1762 smallest_diff = 0xffffffff; 1763 1764 /* 0 is an invalid prescaler, used as a flag */ 1765 best_prescaler = 0; 1766 1767 for(i = 8; i <= 0xff; ++i) { 1768 clk = (baudclk * 8) / (u32) i; 1769 1770 if( (div = clk / b16) == 0) { 1771 continue; 1772 } 1773 1774 res = clk / div; 1775 diff= (res > b16) ? (res-b16) : (b16-res); 1776 1777 if(diff < smallest_diff) { 1778 best_prescaler = i; 1779 smallest_diff = diff; 1780 } 1781 } 1782 1783 if(best_prescaler == 0) { 1784 return (KEYSPAN_INVALID_BAUD_RATE); 1785 } 1786 1787 clk = (baudclk * 8) / (u32) best_prescaler; 1788 div = clk / b16; 1789 1790 /* return the divisor and prescaler if non-null */ 1791 if (rate_low) { 1792 *rate_low = (u8) (div & 0xff); 1793 } 1794 if (rate_hi) { 1795 *rate_hi = (u8) ((div >> 8) & 0xff); 1796 } 1797 if (prescaler) { 1798 *prescaler = best_prescaler; 1799 /* dbg("%s - %d %d", __FUNCTION__, *prescaler, div); */ 1800 } 1801 return (KEYSPAN_BAUD_RATE_OK); 1802 } 1803 1804 /* USA-28 supports different maximum baud rates on each port */ 1805 static int keyspan_usa28_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, 1806 u8 *rate_low, u8 *prescaler, int portnum) 1807 { 1808 u32 b16, /* baud rate times 16 (actual rate used internally) */ 1809 div, /* divisor */ 1810 cnt; /* inverse of divisor (programmed into 8051) */ 1811 1812 dbg ("%s - %d.", __FUNCTION__, baud_rate); 1813 1814 /* prevent divide by zero */ 1815 if ((b16 = baud_rate * 16L) == 0) 1816 return (KEYSPAN_INVALID_BAUD_RATE); 1817 1818 /* calculate the divisor and the counter (its inverse) */ 1819 if ((div = (KEYSPAN_USA28_BAUDCLK / b16)) == 0) { 1820 return (KEYSPAN_INVALID_BAUD_RATE); 1821 } 1822 else { 1823 cnt = 0 - div; 1824 } 1825 1826 /* check for out of range, based on portnum, 1827 and return result */ 1828 if(portnum == 0) { 1829 if(div > 0xffff) 1830 return (KEYSPAN_INVALID_BAUD_RATE); 1831 } 1832 else { 1833 if(portnum == 1) { 1834 if(div > 0xff) { 1835 return (KEYSPAN_INVALID_BAUD_RATE); 1836 } 1837 } 1838 else { 1839 return (KEYSPAN_INVALID_BAUD_RATE); 1840 } 1841 } 1842 1843 /* return the counter values if not NULL 1844 (port 1 will ignore retHi) */ 1845 if (rate_low) { 1846 *rate_low = (u8) (cnt & 0xff); 1847 } 1848 if (rate_hi) { 1849 *rate_hi = (u8) ((cnt >> 8) & 0xff); 1850 } 1851 dbg ("%s - %d OK.", __FUNCTION__, baud_rate); 1852 return (KEYSPAN_BAUD_RATE_OK); 1853 } 1854 1855 static int keyspan_usa26_send_setup(struct usb_serial *serial, 1856 struct usb_serial_port *port, 1857 int reset_port) 1858 { 1859 struct keyspan_usa26_portControlMessage msg; 1860 struct keyspan_serial_private *s_priv; 1861 struct keyspan_port_private *p_priv; 1862 const struct keyspan_device_details *d_details; 1863 int outcont_urb; 1864 struct urb *this_urb; 1865 int device_port, err; 1866 1867 dbg ("%s reset=%d", __FUNCTION__, reset_port); 1868 1869 s_priv = usb_get_serial_data(serial); 1870 p_priv = usb_get_serial_port_data(port); 1871 d_details = s_priv->device_details; 1872 device_port = port->number - port->serial->minor; 1873 1874 outcont_urb = d_details->outcont_endpoints[port->number]; 1875 this_urb = p_priv->outcont_urb; 1876 1877 dbg("%s - endpoint %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe)); 1878 1879 /* Make sure we have an urb then send the message */ 1880 if (this_urb == NULL) { 1881 dbg("%s - oops no urb.", __FUNCTION__); 1882 return -1; 1883 } 1884 1885 /* Save reset port val for resend. 1886 Don't overwrite resend for open/close condition. */ 1887 if ((reset_port + 1) > p_priv->resend_cont) 1888 p_priv->resend_cont = reset_port + 1; 1889 if (this_urb->status == -EINPROGRESS) { 1890 /* dbg ("%s - already writing", __FUNCTION__); */ 1891 mdelay(5); 1892 return(-1); 1893 } 1894 1895 memset(&msg, 0, sizeof (struct keyspan_usa26_portControlMessage)); 1896 1897 /* Only set baud rate if it's changed */ 1898 if (p_priv->old_baud != p_priv->baud) { 1899 p_priv->old_baud = p_priv->baud; 1900 msg.setClocking = 0xff; 1901 if (d_details->calculate_baud_rate 1902 (p_priv->baud, d_details->baudclk, &msg.baudHi, 1903 &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { 1904 dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, 1905 p_priv->baud); 1906 msg.baudLo = 0; 1907 msg.baudHi = 125; /* Values for 9600 baud */ 1908 msg.prescaler = 10; 1909 } 1910 msg.setPrescaler = 0xff; 1911 } 1912 1913 msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; 1914 switch (p_priv->cflag & CSIZE) { 1915 case CS5: 1916 msg.lcr |= USA_DATABITS_5; 1917 break; 1918 case CS6: 1919 msg.lcr |= USA_DATABITS_6; 1920 break; 1921 case CS7: 1922 msg.lcr |= USA_DATABITS_7; 1923 break; 1924 case CS8: 1925 msg.lcr |= USA_DATABITS_8; 1926 break; 1927 } 1928 if (p_priv->cflag & PARENB) { 1929 /* note USA_PARITY_NONE == 0 */ 1930 msg.lcr |= (p_priv->cflag & PARODD)? 1931 USA_PARITY_ODD: USA_PARITY_EVEN; 1932 } 1933 msg.setLcr = 0xff; 1934 1935 msg.ctsFlowControl = (p_priv->flow_control == flow_cts); 1936 msg.xonFlowControl = 0; 1937 msg.setFlowControl = 0xff; 1938 msg.forwardingLength = 16; 1939 msg.xonChar = 17; 1940 msg.xoffChar = 19; 1941 1942 /* Opening port */ 1943 if (reset_port == 1) { 1944 msg._txOn = 1; 1945 msg._txOff = 0; 1946 msg.txFlush = 0; 1947 msg.txBreak = 0; 1948 msg.rxOn = 1; 1949 msg.rxOff = 0; 1950 msg.rxFlush = 1; 1951 msg.rxForward = 0; 1952 msg.returnStatus = 0; 1953 msg.resetDataToggle = 0xff; 1954 } 1955 1956 /* Closing port */ 1957 else if (reset_port == 2) { 1958 msg._txOn = 0; 1959 msg._txOff = 1; 1960 msg.txFlush = 0; 1961 msg.txBreak = 0; 1962 msg.rxOn = 0; 1963 msg.rxOff = 1; 1964 msg.rxFlush = 1; 1965 msg.rxForward = 0; 1966 msg.returnStatus = 0; 1967 msg.resetDataToggle = 0; 1968 } 1969 1970 /* Sending intermediate configs */ 1971 else { 1972 msg._txOn = (! p_priv->break_on); 1973 msg._txOff = 0; 1974 msg.txFlush = 0; 1975 msg.txBreak = (p_priv->break_on); 1976 msg.rxOn = 0; 1977 msg.rxOff = 0; 1978 msg.rxFlush = 0; 1979 msg.rxForward = 0; 1980 msg.returnStatus = 0; 1981 msg.resetDataToggle = 0x0; 1982 } 1983 1984 /* Do handshaking outputs */ 1985 msg.setTxTriState_setRts = 0xff; 1986 msg.txTriState_rts = p_priv->rts_state; 1987 1988 msg.setHskoa_setDtr = 0xff; 1989 msg.hskoa_dtr = p_priv->dtr_state; 1990 1991 p_priv->resend_cont = 0; 1992 memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); 1993 1994 /* send the data out the device on control endpoint */ 1995 this_urb->transfer_buffer_length = sizeof(msg); 1996 1997 this_urb->dev = serial->dev; 1998 if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { 1999 dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); 2000 } 2001 #if 0 2002 else { 2003 dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __FUNCTION__ 2004 outcont_urb, this_urb->transfer_buffer_length, 2005 usb_pipeendpoint(this_urb->pipe)); 2006 } 2007 #endif 2008 2009 return (0); 2010 } 2011 2012 static int keyspan_usa28_send_setup(struct usb_serial *serial, 2013 struct usb_serial_port *port, 2014 int reset_port) 2015 { 2016 struct keyspan_usa28_portControlMessage msg; 2017 struct keyspan_serial_private *s_priv; 2018 struct keyspan_port_private *p_priv; 2019 const struct keyspan_device_details *d_details; 2020 struct urb *this_urb; 2021 int device_port, err; 2022 2023 dbg ("%s", __FUNCTION__); 2024 2025 s_priv = usb_get_serial_data(serial); 2026 p_priv = usb_get_serial_port_data(port); 2027 d_details = s_priv->device_details; 2028 device_port = port->number - port->serial->minor; 2029 2030 /* only do something if we have a bulk out endpoint */ 2031 if ((this_urb = p_priv->outcont_urb) == NULL) { 2032 dbg("%s - oops no urb.", __FUNCTION__); 2033 return -1; 2034 } 2035 2036 /* Save reset port val for resend. 2037 Don't overwrite resend for open/close condition. */ 2038 if ((reset_port + 1) > p_priv->resend_cont) 2039 p_priv->resend_cont = reset_port + 1; 2040 if (this_urb->status == -EINPROGRESS) { 2041 dbg ("%s already writing", __FUNCTION__); 2042 mdelay(5); 2043 return(-1); 2044 } 2045 2046 memset(&msg, 0, sizeof (struct keyspan_usa28_portControlMessage)); 2047 2048 msg.setBaudRate = 1; 2049 if (d_details->calculate_baud_rate(p_priv->baud, d_details->baudclk, 2050 &msg.baudHi, &msg.baudLo, NULL, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { 2051 dbg("%s - Invalid baud rate requested %d.", __FUNCTION__, p_priv->baud); 2052 msg.baudLo = 0xff; 2053 msg.baudHi = 0xb2; /* Values for 9600 baud */ 2054 } 2055 2056 /* If parity is enabled, we must calculate it ourselves. */ 2057 msg.parity = 0; /* XXX for now */ 2058 2059 msg.ctsFlowControl = (p_priv->flow_control == flow_cts); 2060 msg.xonFlowControl = 0; 2061 2062 /* Do handshaking outputs, DTR is inverted relative to RTS */ 2063 msg.rts = p_priv->rts_state; 2064 msg.dtr = p_priv->dtr_state; 2065 2066 msg.forwardingLength = 16; 2067 msg.forwardMs = 10; 2068 msg.breakThreshold = 45; 2069 msg.xonChar = 17; 2070 msg.xoffChar = 19; 2071 2072 /*msg.returnStatus = 1; 2073 msg.resetDataToggle = 0xff;*/ 2074 /* Opening port */ 2075 if (reset_port == 1) { 2076 msg._txOn = 1; 2077 msg._txOff = 0; 2078 msg.txFlush = 0; 2079 msg.txForceXoff = 0; 2080 msg.txBreak = 0; 2081 msg.rxOn = 1; 2082 msg.rxOff = 0; 2083 msg.rxFlush = 1; 2084 msg.rxForward = 0; 2085 msg.returnStatus = 0; 2086 msg.resetDataToggle = 0xff; 2087 } 2088 /* Closing port */ 2089 else if (reset_port == 2) { 2090 msg._txOn = 0; 2091 msg._txOff = 1; 2092 msg.txFlush = 0; 2093 msg.txForceXoff = 0; 2094 msg.txBreak = 0; 2095 msg.rxOn = 0; 2096 msg.rxOff = 1; 2097 msg.rxFlush = 1; 2098 msg.rxForward = 0; 2099 msg.returnStatus = 0; 2100 msg.resetDataToggle = 0; 2101 } 2102 /* Sending intermediate configs */ 2103 else { 2104 msg._txOn = (! p_priv->break_on); 2105 msg._txOff = 0; 2106 msg.txFlush = 0; 2107 msg.txForceXoff = 0; 2108 msg.txBreak = (p_priv->break_on); 2109 msg.rxOn = 0; 2110 msg.rxOff = 0; 2111 msg.rxFlush = 0; 2112 msg.rxForward = 0; 2113 msg.returnStatus = 0; 2114 msg.resetDataToggle = 0x0; 2115 } 2116 2117 p_priv->resend_cont = 0; 2118 memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); 2119 2120 /* send the data out the device on control endpoint */ 2121 this_urb->transfer_buffer_length = sizeof(msg); 2122 2123 this_urb->dev = serial->dev; 2124 if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { 2125 dbg("%s - usb_submit_urb(setup) failed", __FUNCTION__); 2126 } 2127 #if 0 2128 else { 2129 dbg("%s - usb_submit_urb(setup) OK %d bytes", __FUNCTION__, 2130 this_urb->transfer_buffer_length); 2131 } 2132 #endif 2133 2134 return (0); 2135 } 2136 2137 static int keyspan_usa49_send_setup(struct usb_serial *serial, 2138 struct usb_serial_port *port, 2139 int reset_port) 2140 { 2141 struct keyspan_usa49_portControlMessage msg; 2142 struct usb_ctrlrequest *dr = NULL; 2143 struct keyspan_serial_private *s_priv; 2144 struct keyspan_port_private *p_priv; 2145 const struct keyspan_device_details *d_details; 2146 struct urb *this_urb; 2147 int err, device_port; 2148 2149 dbg ("%s", __FUNCTION__); 2150 2151 s_priv = usb_get_serial_data(serial); 2152 p_priv = usb_get_serial_port_data(port); 2153 d_details = s_priv->device_details; 2154 2155 this_urb = s_priv->glocont_urb; 2156 2157 /* Work out which port within the device is being setup */ 2158 device_port = port->number - port->serial->minor; 2159 2160 dbg("%s - endpoint %d port %d (%d)",__FUNCTION__, usb_pipeendpoint(this_urb->pipe), port->number, device_port); 2161 2162 /* Make sure we have an urb then send the message */ 2163 if (this_urb == NULL) { 2164 dbg("%s - oops no urb for port %d.", __FUNCTION__, port->number); 2165 return -1; 2166 } 2167 2168 /* Save reset port val for resend. 2169 Don't overwrite resend for open/close condition. */ 2170 if ((reset_port + 1) > p_priv->resend_cont) 2171 p_priv->resend_cont = reset_port + 1; 2172 2173 if (this_urb->status == -EINPROGRESS) { 2174 /* dbg ("%s - already writing", __FUNCTION__); */ 2175 mdelay(5); 2176 return(-1); 2177 } 2178 2179 memset(&msg, 0, sizeof (struct keyspan_usa49_portControlMessage)); 2180 2181 /*msg.portNumber = port->number;*/ 2182 msg.portNumber = device_port; 2183 2184 /* Only set baud rate if it's changed */ 2185 if (p_priv->old_baud != p_priv->baud) { 2186 p_priv->old_baud = p_priv->baud; 2187 msg.setClocking = 0xff; 2188 if (d_details->calculate_baud_rate 2189 (p_priv->baud, d_details->baudclk, &msg.baudHi, 2190 &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { 2191 dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, 2192 p_priv->baud); 2193 msg.baudLo = 0; 2194 msg.baudHi = 125; /* Values for 9600 baud */ 2195 msg.prescaler = 10; 2196 } 2197 //msg.setPrescaler = 0xff; 2198 } 2199 2200 msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; 2201 switch (p_priv->cflag & CSIZE) { 2202 case CS5: 2203 msg.lcr |= USA_DATABITS_5; 2204 break; 2205 case CS6: 2206 msg.lcr |= USA_DATABITS_6; 2207 break; 2208 case CS7: 2209 msg.lcr |= USA_DATABITS_7; 2210 break; 2211 case CS8: 2212 msg.lcr |= USA_DATABITS_8; 2213 break; 2214 } 2215 if (p_priv->cflag & PARENB) { 2216 /* note USA_PARITY_NONE == 0 */ 2217 msg.lcr |= (p_priv->cflag & PARODD)? 2218 USA_PARITY_ODD: USA_PARITY_EVEN; 2219 } 2220 msg.setLcr = 0xff; 2221 2222 msg.ctsFlowControl = (p_priv->flow_control == flow_cts); 2223 msg.xonFlowControl = 0; 2224 msg.setFlowControl = 0xff; 2225 2226 msg.forwardingLength = 16; 2227 msg.xonChar = 17; 2228 msg.xoffChar = 19; 2229 2230 /* Opening port */ 2231 if (reset_port == 1) { 2232 msg._txOn = 1; 2233 msg._txOff = 0; 2234 msg.txFlush = 0; 2235 msg.txBreak = 0; 2236 msg.rxOn = 1; 2237 msg.rxOff = 0; 2238 msg.rxFlush = 1; 2239 msg.rxForward = 0; 2240 msg.returnStatus = 0; 2241 msg.resetDataToggle = 0xff; 2242 msg.enablePort = 1; 2243 msg.disablePort = 0; 2244 } 2245 /* Closing port */ 2246 else if (reset_port == 2) { 2247 msg._txOn = 0; 2248 msg._txOff = 1; 2249 msg.txFlush = 0; 2250 msg.txBreak = 0; 2251 msg.rxOn = 0; 2252 msg.rxOff = 1; 2253 msg.rxFlush = 1; 2254 msg.rxForward = 0; 2255 msg.returnStatus = 0; 2256 msg.resetDataToggle = 0; 2257 msg.enablePort = 0; 2258 msg.disablePort = 1; 2259 } 2260 /* Sending intermediate configs */ 2261 else { 2262 msg._txOn = (! p_priv->break_on); 2263 msg._txOff = 0; 2264 msg.txFlush = 0; 2265 msg.txBreak = (p_priv->break_on); 2266 msg.rxOn = 0; 2267 msg.rxOff = 0; 2268 msg.rxFlush = 0; 2269 msg.rxForward = 0; 2270 msg.returnStatus = 0; 2271 msg.resetDataToggle = 0x0; 2272 msg.enablePort = 0; 2273 msg.disablePort = 0; 2274 } 2275 2276 /* Do handshaking outputs */ 2277 msg.setRts = 0xff; 2278 msg.rts = p_priv->rts_state; 2279 2280 msg.setDtr = 0xff; 2281 msg.dtr = p_priv->dtr_state; 2282 2283 p_priv->resend_cont = 0; 2284 2285 /* if the device is a 49wg, we send control message on usb control EP 0 */ 2286 2287 if (d_details->product_id == keyspan_usa49wg_product_id) { 2288 dr = (void *)(s_priv->ctrl_buf); 2289 dr->bRequestType = USB_TYPE_VENDOR | USB_DIR_OUT; 2290 dr->bRequest = 0xB0; /* 49wg control message */; 2291 dr->wValue = 0; 2292 dr->wIndex = 0; 2293 dr->wLength = cpu_to_le16(sizeof(msg)); 2294 2295 memcpy (s_priv->glocont_buf, &msg, sizeof(msg)); 2296 2297 usb_fill_control_urb(this_urb, serial->dev, usb_sndctrlpipe(serial->dev, 0), 2298 (unsigned char *)dr, s_priv->glocont_buf, sizeof(msg), 2299 usa49_glocont_callback, serial); 2300 2301 } else { 2302 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg)); 2303 2304 /* send the data out the device on control endpoint */ 2305 this_urb->transfer_buffer_length = sizeof(msg); 2306 2307 this_urb->dev = serial->dev; 2308 } 2309 if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { 2310 dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); 2311 } 2312 #if 0 2313 else { 2314 dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __FUNCTION__, 2315 outcont_urb, this_urb->transfer_buffer_length, 2316 usb_pipeendpoint(this_urb->pipe)); 2317 } 2318 #endif 2319 2320 return (0); 2321 } 2322 2323 static int keyspan_usa90_send_setup(struct usb_serial *serial, 2324 struct usb_serial_port *port, 2325 int reset_port) 2326 { 2327 struct keyspan_usa90_portControlMessage msg; 2328 struct keyspan_serial_private *s_priv; 2329 struct keyspan_port_private *p_priv; 2330 const struct keyspan_device_details *d_details; 2331 struct urb *this_urb; 2332 int err; 2333 u8 prescaler; 2334 2335 dbg ("%s", __FUNCTION__); 2336 2337 s_priv = usb_get_serial_data(serial); 2338 p_priv = usb_get_serial_port_data(port); 2339 d_details = s_priv->device_details; 2340 2341 /* only do something if we have a bulk out endpoint */ 2342 if ((this_urb = p_priv->outcont_urb) == NULL) { 2343 dbg("%s - oops no urb.", __FUNCTION__); 2344 return -1; 2345 } 2346 2347 /* Save reset port val for resend. 2348 Don't overwrite resend for open/close condition. */ 2349 if ((reset_port + 1) > p_priv->resend_cont) 2350 p_priv->resend_cont = reset_port + 1; 2351 if (this_urb->status == -EINPROGRESS) { 2352 dbg ("%s already writing", __FUNCTION__); 2353 mdelay(5); 2354 return(-1); 2355 } 2356 2357 memset(&msg, 0, sizeof (struct keyspan_usa90_portControlMessage)); 2358 2359 /* Only set baud rate if it's changed */ 2360 if (p_priv->old_baud != p_priv->baud) { 2361 p_priv->old_baud = p_priv->baud; 2362 msg.setClocking = 0x01; 2363 if (d_details->calculate_baud_rate 2364 (p_priv->baud, d_details->baudclk, &msg.baudHi, 2365 &msg.baudLo, &prescaler, 0) == KEYSPAN_INVALID_BAUD_RATE ) { 2366 dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, 2367 p_priv->baud); 2368 p_priv->baud = 9600; 2369 d_details->calculate_baud_rate (p_priv->baud, d_details->baudclk, 2370 &msg.baudHi, &msg.baudLo, &prescaler, 0); 2371 } 2372 msg.setRxMode = 1; 2373 msg.setTxMode = 1; 2374 } 2375 2376 /* modes must always be correctly specified */ 2377 if (p_priv->baud > 57600) 2378 { 2379 msg.rxMode = RXMODE_DMA; 2380 msg.txMode = TXMODE_DMA; 2381 } 2382 else 2383 { 2384 msg.rxMode = RXMODE_BYHAND; 2385 msg.txMode = TXMODE_BYHAND; 2386 } 2387 2388 msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; 2389 switch (p_priv->cflag & CSIZE) { 2390 case CS5: 2391 msg.lcr |= USA_DATABITS_5; 2392 break; 2393 case CS6: 2394 msg.lcr |= USA_DATABITS_6; 2395 break; 2396 case CS7: 2397 msg.lcr |= USA_DATABITS_7; 2398 break; 2399 case CS8: 2400 msg.lcr |= USA_DATABITS_8; 2401 break; 2402 } 2403 if (p_priv->cflag & PARENB) { 2404 /* note USA_PARITY_NONE == 0 */ 2405 msg.lcr |= (p_priv->cflag & PARODD)? 2406 USA_PARITY_ODD: USA_PARITY_EVEN; 2407 } 2408 if (p_priv->old_cflag != p_priv->cflag) { 2409 p_priv->old_cflag = p_priv->cflag; 2410 msg.setLcr = 0x01; 2411 } 2412 2413 if (p_priv->flow_control == flow_cts) 2414 msg.txFlowControl = TXFLOW_CTS; 2415 msg.setTxFlowControl = 0x01; 2416 msg.setRxFlowControl = 0x01; 2417 2418 msg.rxForwardingLength = 16; 2419 msg.rxForwardingTimeout = 16; 2420 msg.txAckSetting = 0; 2421 msg.xonChar = 17; 2422 msg.xoffChar = 19; 2423 2424 /* Opening port */ 2425 if (reset_port == 1) { 2426 msg.portEnabled = 1; 2427 msg.rxFlush = 1; 2428 msg.txBreak = (p_priv->break_on); 2429 } 2430 /* Closing port */ 2431 else if (reset_port == 2) { 2432 msg.portEnabled = 0; 2433 } 2434 /* Sending intermediate configs */ 2435 else { 2436 if (port->open_count) 2437 msg.portEnabled = 1; 2438 msg.txBreak = (p_priv->break_on); 2439 } 2440 2441 /* Do handshaking outputs */ 2442 msg.setRts = 0x01; 2443 msg.rts = p_priv->rts_state; 2444 2445 msg.setDtr = 0x01; 2446 msg.dtr = p_priv->dtr_state; 2447 2448 p_priv->resend_cont = 0; 2449 memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); 2450 2451 /* send the data out the device on control endpoint */ 2452 this_urb->transfer_buffer_length = sizeof(msg); 2453 2454 this_urb->dev = serial->dev; 2455 if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { 2456 dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); 2457 } 2458 return (0); 2459 } 2460 2461 static int keyspan_usa67_send_setup(struct usb_serial *serial, 2462 struct usb_serial_port *port, 2463 int reset_port) 2464 { 2465 struct keyspan_usa67_portControlMessage msg; 2466 struct keyspan_serial_private *s_priv; 2467 struct keyspan_port_private *p_priv; 2468 const struct keyspan_device_details *d_details; 2469 struct urb *this_urb; 2470 int err, device_port; 2471 2472 dbg ("%s", __FUNCTION__); 2473 2474 s_priv = usb_get_serial_data(serial); 2475 p_priv = usb_get_serial_port_data(port); 2476 d_details = s_priv->device_details; 2477 2478 this_urb = s_priv->glocont_urb; 2479 2480 /* Work out which port within the device is being setup */ 2481 device_port = port->number - port->serial->minor; 2482 2483 /* Make sure we have an urb then send the message */ 2484 if (this_urb == NULL) { 2485 dbg("%s - oops no urb for port %d.", __FUNCTION__, 2486 port->number); 2487 return -1; 2488 } 2489 2490 /* Save reset port val for resend. 2491 Don't overwrite resend for open/close condition. */ 2492 if ((reset_port + 1) > p_priv->resend_cont) 2493 p_priv->resend_cont = reset_port + 1; 2494 if (this_urb->status == -EINPROGRESS) { 2495 /* dbg ("%s - already writing", __FUNCTION__); */ 2496 mdelay(5); 2497 return(-1); 2498 } 2499 2500 memset(&msg, 0, sizeof(struct keyspan_usa67_portControlMessage)); 2501 2502 msg.port = device_port; 2503 2504 /* Only set baud rate if it's changed */ 2505 if (p_priv->old_baud != p_priv->baud) { 2506 p_priv->old_baud = p_priv->baud; 2507 msg.setClocking = 0xff; 2508 if (d_details->calculate_baud_rate 2509 (p_priv->baud, d_details->baudclk, &msg.baudHi, 2510 &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { 2511 dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, 2512 p_priv->baud); 2513 msg.baudLo = 0; 2514 msg.baudHi = 125; /* Values for 9600 baud */ 2515 msg.prescaler = 10; 2516 } 2517 msg.setPrescaler = 0xff; 2518 } 2519 2520 msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1; 2521 switch (p_priv->cflag & CSIZE) { 2522 case CS5: 2523 msg.lcr |= USA_DATABITS_5; 2524 break; 2525 case CS6: 2526 msg.lcr |= USA_DATABITS_6; 2527 break; 2528 case CS7: 2529 msg.lcr |= USA_DATABITS_7; 2530 break; 2531 case CS8: 2532 msg.lcr |= USA_DATABITS_8; 2533 break; 2534 } 2535 if (p_priv->cflag & PARENB) { 2536 /* note USA_PARITY_NONE == 0 */ 2537 msg.lcr |= (p_priv->cflag & PARODD)? 2538 USA_PARITY_ODD: USA_PARITY_EVEN; 2539 } 2540 msg.setLcr = 0xff; 2541 2542 msg.ctsFlowControl = (p_priv->flow_control == flow_cts); 2543 msg.xonFlowControl = 0; 2544 msg.setFlowControl = 0xff; 2545 msg.forwardingLength = 16; 2546 msg.xonChar = 17; 2547 msg.xoffChar = 19; 2548 2549 if (reset_port == 1) { 2550 /* Opening port */ 2551 msg._txOn = 1; 2552 msg._txOff = 0; 2553 msg.txFlush = 0; 2554 msg.txBreak = 0; 2555 msg.rxOn = 1; 2556 msg.rxOff = 0; 2557 msg.rxFlush = 1; 2558 msg.rxForward = 0; 2559 msg.returnStatus = 0; 2560 msg.resetDataToggle = 0xff; 2561 } else if (reset_port == 2) { 2562 /* Closing port */ 2563 msg._txOn = 0; 2564 msg._txOff = 1; 2565 msg.txFlush = 0; 2566 msg.txBreak = 0; 2567 msg.rxOn = 0; 2568 msg.rxOff = 1; 2569 msg.rxFlush = 1; 2570 msg.rxForward = 0; 2571 msg.returnStatus = 0; 2572 msg.resetDataToggle = 0; 2573 } else { 2574 /* Sending intermediate configs */ 2575 msg._txOn = (! p_priv->break_on); 2576 msg._txOff = 0; 2577 msg.txFlush = 0; 2578 msg.txBreak = (p_priv->break_on); 2579 msg.rxOn = 0; 2580 msg.rxOff = 0; 2581 msg.rxFlush = 0; 2582 msg.rxForward = 0; 2583 msg.returnStatus = 0; 2584 msg.resetDataToggle = 0x0; 2585 } 2586 2587 /* Do handshaking outputs */ 2588 msg.setTxTriState_setRts = 0xff; 2589 msg.txTriState_rts = p_priv->rts_state; 2590 2591 msg.setHskoa_setDtr = 0xff; 2592 msg.hskoa_dtr = p_priv->dtr_state; 2593 2594 p_priv->resend_cont = 0; 2595 2596 memcpy(this_urb->transfer_buffer, &msg, sizeof(msg)); 2597 2598 /* send the data out the device on control endpoint */ 2599 this_urb->transfer_buffer_length = sizeof(msg); 2600 this_urb->dev = serial->dev; 2601 2602 err = usb_submit_urb(this_urb, GFP_ATOMIC); 2603 if (err != 0) 2604 dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, 2605 err); 2606 return (0); 2607 } 2608 2609 static void keyspan_send_setup(struct usb_serial_port *port, int reset_port) 2610 { 2611 struct usb_serial *serial = port->serial; 2612 struct keyspan_serial_private *s_priv; 2613 const struct keyspan_device_details *d_details; 2614 2615 dbg ("%s", __FUNCTION__); 2616 2617 s_priv = usb_get_serial_data(serial); 2618 d_details = s_priv->device_details; 2619 2620 switch (d_details->msg_format) { 2621 case msg_usa26: 2622 keyspan_usa26_send_setup(serial, port, reset_port); 2623 break; 2624 case msg_usa28: 2625 keyspan_usa28_send_setup(serial, port, reset_port); 2626 break; 2627 case msg_usa49: 2628 keyspan_usa49_send_setup(serial, port, reset_port); 2629 break; 2630 case msg_usa90: 2631 keyspan_usa90_send_setup(serial, port, reset_port); 2632 break; 2633 case msg_usa67: 2634 keyspan_usa67_send_setup(serial, port, reset_port); 2635 break; 2636 } 2637 } 2638 2639 2640 /* Gets called by the "real" driver (ie once firmware is loaded 2641 and renumeration has taken place. */ 2642 static int keyspan_startup (struct usb_serial *serial) 2643 { 2644 int i, err; 2645 struct usb_serial_port *port; 2646 struct keyspan_serial_private *s_priv; 2647 struct keyspan_port_private *p_priv; 2648 const struct keyspan_device_details *d_details; 2649 2650 dbg("%s", __FUNCTION__); 2651 2652 for (i = 0; (d_details = keyspan_devices[i]) != NULL; ++i) 2653 if (d_details->product_id == le16_to_cpu(serial->dev->descriptor.idProduct)) 2654 break; 2655 if (d_details == NULL) { 2656 dev_err(&serial->dev->dev, "%s - unknown product id %x\n", __FUNCTION__, le16_to_cpu(serial->dev->descriptor.idProduct)); 2657 return 1; 2658 } 2659 2660 /* Setup private data for serial driver */ 2661 s_priv = kzalloc(sizeof(struct keyspan_serial_private), GFP_KERNEL); 2662 if (!s_priv) { 2663 dbg("%s - kmalloc for keyspan_serial_private failed.", __FUNCTION__); 2664 return -ENOMEM; 2665 } 2666 2667 s_priv->device_details = d_details; 2668 usb_set_serial_data(serial, s_priv); 2669 2670 /* Now setup per port private data */ 2671 for (i = 0; i < serial->num_ports; i++) { 2672 port = serial->port[i]; 2673 p_priv = kzalloc(sizeof(struct keyspan_port_private), GFP_KERNEL); 2674 if (!p_priv) { 2675 dbg("%s - kmalloc for keyspan_port_private (%d) failed!.", __FUNCTION__, i); 2676 return (1); 2677 } 2678 p_priv->device_details = d_details; 2679 usb_set_serial_port_data(port, p_priv); 2680 } 2681 2682 keyspan_setup_urbs(serial); 2683 2684 if (s_priv->instat_urb != NULL) { 2685 s_priv->instat_urb->dev = serial->dev; 2686 err = usb_submit_urb(s_priv->instat_urb, GFP_KERNEL); 2687 if (err != 0) 2688 dbg("%s - submit instat urb failed %d", __FUNCTION__, 2689 err); 2690 } 2691 if (s_priv->indat_urb != NULL) { 2692 s_priv->indat_urb->dev = serial->dev; 2693 err = usb_submit_urb(s_priv->indat_urb, GFP_KERNEL); 2694 if (err != 0) 2695 dbg("%s - submit indat urb failed %d", __FUNCTION__, 2696 err); 2697 } 2698 2699 return (0); 2700 } 2701 2702 static void keyspan_shutdown (struct usb_serial *serial) 2703 { 2704 int i, j; 2705 struct usb_serial_port *port; 2706 struct keyspan_serial_private *s_priv; 2707 struct keyspan_port_private *p_priv; 2708 2709 dbg("%s", __FUNCTION__); 2710 2711 s_priv = usb_get_serial_data(serial); 2712 2713 /* Stop reading/writing urbs */ 2714 stop_urb(s_priv->instat_urb); 2715 stop_urb(s_priv->glocont_urb); 2716 stop_urb(s_priv->indat_urb); 2717 for (i = 0; i < serial->num_ports; ++i) { 2718 port = serial->port[i]; 2719 p_priv = usb_get_serial_port_data(port); 2720 stop_urb(p_priv->inack_urb); 2721 stop_urb(p_priv->outcont_urb); 2722 for (j = 0; j < 2; j++) { 2723 stop_urb(p_priv->in_urbs[j]); 2724 stop_urb(p_priv->out_urbs[j]); 2725 } 2726 } 2727 2728 /* Now free them */ 2729 usb_free_urb(s_priv->instat_urb); 2730 usb_free_urb(s_priv->indat_urb); 2731 usb_free_urb(s_priv->glocont_urb); 2732 for (i = 0; i < serial->num_ports; ++i) { 2733 port = serial->port[i]; 2734 p_priv = usb_get_serial_port_data(port); 2735 usb_free_urb(p_priv->inack_urb); 2736 usb_free_urb(p_priv->outcont_urb); 2737 for (j = 0; j < 2; j++) { 2738 usb_free_urb(p_priv->in_urbs[j]); 2739 usb_free_urb(p_priv->out_urbs[j]); 2740 } 2741 } 2742 2743 /* dbg("Freeing serial->private."); */ 2744 kfree(s_priv); 2745 2746 /* dbg("Freeing port->private."); */ 2747 /* Now free per port private data */ 2748 for (i = 0; i < serial->num_ports; i++) { 2749 port = serial->port[i]; 2750 kfree(usb_get_serial_port_data(port)); 2751 } 2752 } 2753 2754 MODULE_AUTHOR( DRIVER_AUTHOR ); 2755 MODULE_DESCRIPTION( DRIVER_DESC ); 2756 MODULE_LICENSE("GPL"); 2757 2758 module_param(debug, bool, S_IRUGO | S_IWUSR); 2759 MODULE_PARM_DESC(debug, "Debug enabled or not"); 2760 2761