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