| /* |
| Keyspan USB to Serial Converter driver |
| |
| (C) Copyright (C) 2000-2001 Hugh Blemings <hugh@blemings.org> |
| (C) Copyright (C) 2002 Greg Kroah-Hartman <greg@kroah.com> |
| |
| This program is free software; you can redistribute it and/or modify |
| it under the terms of the GNU General Public License as published by |
| the Free Software Foundation; either version 2 of the License, or |
| (at your option) any later version. |
| |
| See http://misc.nu/hugh/keyspan.html for more information. |
| |
| Code in this driver inspired by and in a number of places taken |
| from Brian Warner's original Keyspan-PDA driver. |
| |
| This driver has been put together with the support of Innosys, Inc. |
| and Keyspan, Inc the manufacturers of the Keyspan USB-serial products. |
| Thanks Guys :) |
| |
| Thanks to Paulus for miscellaneous tidy ups, some largish chunks |
| of much nicer and/or completely new code and (perhaps most uniquely) |
| having the patience to sit down and explain why and where he'd changed |
| stuff. |
| |
| Tip 'o the hat to IBM (and previously Linuxcare :) for supporting |
| staff in their work on open source projects. |
| |
| Change History |
| |
| 2003sep04 LPM (Keyspan) add support for new single port product USA19HS. |
| Improve setup message handling for all devices. |
| |
| Wed Feb 19 22:00:00 PST 2003 (Jeffrey S. Laing <keyspan@jsl.com>) |
| Merged the current (1/31/03) Keyspan code with the current (2.4.21-pre4) |
| Linux source tree. The Linux tree lacked support for the 49WLC and |
| others. The Keyspan patches didn't work with the current kernel. |
| |
| 2003jan30 LPM add support for the 49WLC and MPR |
| |
| Wed Apr 25 12:00:00 PST 2002 (Keyspan) |
| Started with Hugh Blemings' code dated Jan 17, 2002. All adapters |
| now supported (including QI and QW). Modified port open, port |
| close, and send setup() logic to fix various data and endpoint |
| synchronization bugs and device LED status bugs. Changed keyspan_ |
| write_room() to accurately return transmit buffer availability. |
| Changed forwardingLength from 1 to 16 for all adapters. |
| |
| Fri Oct 12 16:45:00 EST 2001 |
| Preliminary USA-19QI and USA-28 support (both test OK for me, YMMV) |
| |
| Wed Apr 25 12:00:00 PST 2002 (Keyspan) |
| Started with Hugh Blemings' code dated Jan 17, 2002. All adapters |
| now supported (including QI and QW). Modified port open, port |
| close, and send setup() logic to fix various data and endpoint |
| synchronization bugs and device LED status bugs. Changed keyspan_ |
| write_room() to accurately return transmit buffer availability. |
| Changed forwardingLength from 1 to 16 for all adapters. |
| |
| Fri Oct 12 16:45:00 EST 2001 |
| Preliminary USA-19QI and USA-28 support (both test OK for me, YMMV) |
| |
| Mon Oct 8 14:29:00 EST 2001 hugh |
| Fixed bug that prevented mulitport devices operating correctly |
| if they weren't the first unit attached. |
| |
| Sat Oct 6 12:31:21 EST 2001 hugh |
| Added support for USA-28XA and -28XB, misc cleanups, break support |
| for usa26 based models thanks to David Gibson. |
| |
| Thu May 31 11:56:42 PDT 2001 gkh |
| switched from using spinlock to a semaphore |
| |
| (04/08/2001) gb |
| Identify version on module load. |
| |
| (11/01/2000) Adam J. Richter |
| usb_device_id table support. |
| |
| Tue Oct 10 23:15:33 EST 2000 Hugh |
| Merged Paul's changes with my USA-49W mods. Work in progress |
| still... |
| |
| Wed Jul 19 14:00:42 EST 2000 gkh |
| Added module_init and module_exit functions to handle the fact that |
| this driver is a loadable module now. |
| |
| Tue Jul 18 16:14:52 EST 2000 Hugh |
| Basic character input/output for USA-19 now mostly works, |
| fixed at 9600 baud for the moment. |
| |
| Sat Jul 8 11:11:48 EST 2000 Hugh |
| First public release - nothing works except the firmware upload. |
| Tested on PPC and x86 architectures, seems to behave... |
| */ |
| |
| |
| #include <linux/kernel.h> |
| #include <linux/jiffies.h> |
| #include <linux/errno.h> |
| #include <linux/init.h> |
| #include <linux/slab.h> |
| #include <linux/tty.h> |
| #include <linux/tty_driver.h> |
| #include <linux/tty_flip.h> |
| #include <linux/module.h> |
| #include <linux/spinlock.h> |
| #include <asm/uaccess.h> |
| #include <linux/usb.h> |
| #include <linux/usb/serial.h> |
| #include "keyspan.h" |
| |
| static int debug; |
| |
| /* |
| * Version Information |
| */ |
| #define DRIVER_VERSION "v1.1.5" |
| #define DRIVER_AUTHOR "Hugh Blemings <hugh@misc.nu" |
| #define DRIVER_DESC "Keyspan USB to Serial Converter Driver" |
| |
| #define INSTAT_BUFLEN 32 |
| #define GLOCONT_BUFLEN 64 |
| #define INDAT49W_BUFLEN 512 |
| |
| /* Per device and per port private data */ |
| struct keyspan_serial_private { |
| const struct keyspan_device_details *device_details; |
| |
| struct urb *instat_urb; |
| char instat_buf[INSTAT_BUFLEN]; |
| |
| /* added to support 49wg, where data from all 4 ports comes in on 1 EP */ |
| /* and high-speed supported */ |
| struct urb *indat_urb; |
| char indat_buf[INDAT49W_BUFLEN]; |
| |
| /* XXX this one probably will need a lock */ |
| struct urb *glocont_urb; |
| char glocont_buf[GLOCONT_BUFLEN]; |
| char ctrl_buf[8]; // for EP0 control message |
| }; |
| |
| struct keyspan_port_private { |
| /* Keep track of which input & output endpoints to use */ |
| int in_flip; |
| int out_flip; |
| |
| /* Keep duplicate of device details in each port |
| structure as well - simplifies some of the |
| callback functions etc. */ |
| const struct keyspan_device_details *device_details; |
| |
| /* Input endpoints and buffer for this port */ |
| struct urb *in_urbs[2]; |
| char in_buffer[2][64]; |
| /* Output endpoints and buffer for this port */ |
| struct urb *out_urbs[2]; |
| char out_buffer[2][64]; |
| |
| /* Input ack endpoint */ |
| struct urb *inack_urb; |
| char inack_buffer[1]; |
| |
| /* Output control endpoint */ |
| struct urb *outcont_urb; |
| char outcont_buffer[64]; |
| |
| /* Settings for the port */ |
| int baud; |
| int old_baud; |
| unsigned int cflag; |
| unsigned int old_cflag; |
| enum {flow_none, flow_cts, flow_xon} flow_control; |
| int rts_state; /* Handshaking pins (outputs) */ |
| int dtr_state; |
| int cts_state; /* Handshaking pins (inputs) */ |
| int dsr_state; |
| int dcd_state; |
| int ri_state; |
| int break_on; |
| |
| unsigned long tx_start_time[2]; |
| int resend_cont; /* need to resend control packet */ |
| }; |
| |
| |
| /* Include Keyspan message headers. All current Keyspan Adapters |
| make use of one of five message formats which are referred |
| to as USA-26, USA-28, USA-49, USA-90, USA-67 by Keyspan and within this driver. */ |
| #include "keyspan_usa26msg.h" |
| #include "keyspan_usa28msg.h" |
| #include "keyspan_usa49msg.h" |
| #include "keyspan_usa90msg.h" |
| #include "keyspan_usa67msg.h" |
| |
| |
| /* Functions used by new usb-serial code. */ |
| static int __init keyspan_init (void) |
| { |
| int retval; |
| retval = usb_serial_register(&keyspan_pre_device); |
| if (retval) |
| goto failed_pre_device_register; |
| retval = usb_serial_register(&keyspan_1port_device); |
| if (retval) |
| goto failed_1port_device_register; |
| retval = usb_serial_register(&keyspan_2port_device); |
| if (retval) |
| goto failed_2port_device_register; |
| retval = usb_serial_register(&keyspan_4port_device); |
| if (retval) |
| goto failed_4port_device_register; |
| retval = usb_register(&keyspan_driver); |
| if (retval) |
| goto failed_usb_register; |
| |
| info(DRIVER_VERSION ":" DRIVER_DESC); |
| |
| return 0; |
| failed_usb_register: |
| usb_serial_deregister(&keyspan_4port_device); |
| failed_4port_device_register: |
| usb_serial_deregister(&keyspan_2port_device); |
| failed_2port_device_register: |
| usb_serial_deregister(&keyspan_1port_device); |
| failed_1port_device_register: |
| usb_serial_deregister(&keyspan_pre_device); |
| failed_pre_device_register: |
| return retval; |
| } |
| |
| static void __exit keyspan_exit (void) |
| { |
| usb_deregister (&keyspan_driver); |
| usb_serial_deregister (&keyspan_pre_device); |
| usb_serial_deregister (&keyspan_1port_device); |
| usb_serial_deregister (&keyspan_2port_device); |
| usb_serial_deregister (&keyspan_4port_device); |
| } |
| |
| module_init(keyspan_init); |
| module_exit(keyspan_exit); |
| |
| static void keyspan_rx_throttle (struct usb_serial_port *port) |
| { |
| dbg("%s - port %d", __FUNCTION__, port->number); |
| } |
| |
| |
| static void keyspan_rx_unthrottle (struct usb_serial_port *port) |
| { |
| dbg("%s - port %d", __FUNCTION__, port->number); |
| } |
| |
| |
| static void keyspan_break_ctl (struct usb_serial_port *port, int break_state) |
| { |
| struct keyspan_port_private *p_priv; |
| |
| dbg("%s", __FUNCTION__); |
| |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (break_state == -1) |
| p_priv->break_on = 1; |
| else |
| p_priv->break_on = 0; |
| |
| keyspan_send_setup(port, 0); |
| } |
| |
| |
| static void keyspan_set_termios (struct usb_serial_port *port, |
| struct ktermios *old_termios) |
| { |
| int baud_rate, device_port; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| unsigned int cflag; |
| struct tty_struct *tty = port->tty; |
| |
| dbg("%s", __FUNCTION__); |
| |
| p_priv = usb_get_serial_port_data(port); |
| d_details = p_priv->device_details; |
| cflag = tty->termios->c_cflag; |
| device_port = port->number - port->serial->minor; |
| |
| /* Baud rate calculation takes baud rate as an integer |
| so other rates can be generated if desired. */ |
| baud_rate = tty_get_baud_rate(tty); |
| /* If no match or invalid, don't change */ |
| if (d_details->calculate_baud_rate(baud_rate, d_details->baudclk, |
| NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) { |
| /* FIXME - more to do here to ensure rate changes cleanly */ |
| /* FIXME - calcuate exact rate from divisor ? */ |
| p_priv->baud = baud_rate; |
| } else |
| baud_rate = tty_termios_baud_rate(old_termios); |
| |
| tty_encode_baud_rate(tty, baud_rate, baud_rate); |
| /* set CTS/RTS handshake etc. */ |
| p_priv->cflag = cflag; |
| p_priv->flow_control = (cflag & CRTSCTS)? flow_cts: flow_none; |
| |
| /* Mark/Space not supported */ |
| tty->termios->c_cflag &= ~CMSPAR; |
| |
| keyspan_send_setup(port, 0); |
| } |
| |
| static int keyspan_tiocmget(struct usb_serial_port *port, struct file *file) |
| { |
| unsigned int value; |
| struct keyspan_port_private *p_priv; |
| |
| p_priv = usb_get_serial_port_data(port); |
| |
| value = ((p_priv->rts_state) ? TIOCM_RTS : 0) | |
| ((p_priv->dtr_state) ? TIOCM_DTR : 0) | |
| ((p_priv->cts_state) ? TIOCM_CTS : 0) | |
| ((p_priv->dsr_state) ? TIOCM_DSR : 0) | |
| ((p_priv->dcd_state) ? TIOCM_CAR : 0) | |
| ((p_priv->ri_state) ? TIOCM_RNG : 0); |
| |
| return value; |
| } |
| |
| static int keyspan_tiocmset(struct usb_serial_port *port, struct file *file, |
| unsigned int set, unsigned int clear) |
| { |
| struct keyspan_port_private *p_priv; |
| |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (set & TIOCM_RTS) |
| p_priv->rts_state = 1; |
| if (set & TIOCM_DTR) |
| p_priv->dtr_state = 1; |
| |
| if (clear & TIOCM_RTS) |
| p_priv->rts_state = 0; |
| if (clear & TIOCM_DTR) |
| p_priv->dtr_state = 0; |
| keyspan_send_setup(port, 0); |
| return 0; |
| } |
| |
| static int keyspan_ioctl(struct usb_serial_port *port, struct file *file, |
| unsigned int cmd, unsigned long arg) |
| { |
| return -ENOIOCTLCMD; |
| } |
| |
| /* Write function is similar for the four protocols used |
| with only a minor change for usa90 (usa19hs) required */ |
| static int keyspan_write(struct usb_serial_port *port, |
| const unsigned char *buf, int count) |
| { |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| int flip; |
| int left, todo; |
| struct urb *this_urb; |
| int err, maxDataLen, dataOffset; |
| |
| p_priv = usb_get_serial_port_data(port); |
| d_details = p_priv->device_details; |
| |
| if (d_details->msg_format == msg_usa90) { |
| maxDataLen = 64; |
| dataOffset = 0; |
| } else { |
| maxDataLen = 63; |
| dataOffset = 1; |
| } |
| |
| dbg("%s - for port %d (%d chars), flip=%d", |
| __FUNCTION__, port->number, count, p_priv->out_flip); |
| |
| for (left = count; left > 0; left -= todo) { |
| todo = left; |
| if (todo > maxDataLen) |
| todo = maxDataLen; |
| |
| flip = p_priv->out_flip; |
| |
| /* Check we have a valid urb/endpoint before we use it... */ |
| if ((this_urb = p_priv->out_urbs[flip]) == NULL) { |
| /* no bulk out, so return 0 bytes written */ |
| dbg("%s - no output urb :(", __FUNCTION__); |
| return count; |
| } |
| |
| dbg("%s - endpoint %d flip %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe), flip); |
| |
| if (this_urb->status == -EINPROGRESS) { |
| if (time_before(jiffies, p_priv->tx_start_time[flip] + 10 * HZ)) |
| break; |
| usb_unlink_urb(this_urb); |
| break; |
| } |
| |
| /* First byte in buffer is "last flag" (except for usa19hx) - unused so |
| for now so set to zero */ |
| ((char *)this_urb->transfer_buffer)[0] = 0; |
| |
| memcpy (this_urb->transfer_buffer + dataOffset, buf, todo); |
| buf += todo; |
| |
| /* send the data out the bulk port */ |
| this_urb->transfer_buffer_length = todo + dataOffset; |
| |
| this_urb->dev = port->serial->dev; |
| if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { |
| dbg("usb_submit_urb(write bulk) failed (%d)", err); |
| } |
| p_priv->tx_start_time[flip] = jiffies; |
| |
| /* Flip for next time if usa26 or usa28 interface |
| (not used on usa49) */ |
| p_priv->out_flip = (flip + 1) & d_details->outdat_endp_flip; |
| } |
| |
| return count - left; |
| } |
| |
| static void usa26_indat_callback(struct urb *urb) |
| { |
| int i, err; |
| int endpoint; |
| struct usb_serial_port *port; |
| struct tty_struct *tty; |
| unsigned char *data = urb->transfer_buffer; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| endpoint = usb_pipeendpoint(urb->pipe); |
| |
| if (status) { |
| dbg("%s - nonzero status: %x on endpoint %d.", |
| __FUNCTION__, status, endpoint); |
| return; |
| } |
| |
| port = (struct usb_serial_port *) urb->context; |
| tty = port->tty; |
| if (urb->actual_length) { |
| /* 0x80 bit is error flag */ |
| if ((data[0] & 0x80) == 0) { |
| /* no errors on individual bytes, only possible overrun err*/ |
| if (data[0] & RXERROR_OVERRUN) |
| err = TTY_OVERRUN; |
| else err = 0; |
| for (i = 1; i < urb->actual_length ; ++i) { |
| tty_insert_flip_char(tty, data[i], err); |
| } |
| } else { |
| /* some bytes had errors, every byte has status */ |
| dbg("%s - RX error!!!!", __FUNCTION__); |
| for (i = 0; i + 1 < urb->actual_length; i += 2) { |
| int stat = data[i], flag = 0; |
| if (stat & RXERROR_OVERRUN) |
| flag |= TTY_OVERRUN; |
| if (stat & RXERROR_FRAMING) |
| flag |= TTY_FRAME; |
| if (stat & RXERROR_PARITY) |
| flag |= TTY_PARITY; |
| /* XXX should handle break (0x10) */ |
| tty_insert_flip_char(tty, data[i+1], flag); |
| } |
| } |
| tty_flip_buffer_push(tty); |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = port->serial->dev; |
| if (port->open_count) |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| return; |
| } |
| |
| /* Outdat handling is common for all devices */ |
| static void usa2x_outdat_callback(struct urb *urb) |
| { |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| dbg ("%s - urb %d", __FUNCTION__, urb == p_priv->out_urbs[1]); |
| |
| if (port->open_count) |
| usb_serial_port_softint(port); |
| } |
| |
| static void usa26_inack_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| |
| } |
| |
| static void usa26_outcont_callback(struct urb *urb) |
| { |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (p_priv->resend_cont) { |
| dbg ("%s - sending setup", __FUNCTION__); |
| keyspan_usa26_send_setup(port->serial, port, p_priv->resend_cont - 1); |
| } |
| } |
| |
| static void usa26_instat_callback(struct urb *urb) |
| { |
| unsigned char *data = urb->transfer_buffer; |
| struct keyspan_usa26_portStatusMessage *msg; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int old_dcd_state, err; |
| int status = urb->status; |
| |
| serial = (struct usb_serial *) urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| if (urb->actual_length != 9) { |
| dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length); |
| goto exit; |
| } |
| |
| msg = (struct keyspan_usa26_portStatusMessage *)data; |
| |
| #if 0 |
| dbg("%s - port status: port %d cts %d dcd %d dsr %d ri %d toff %d txoff %d rxen %d cr %d", |
| __FUNCTION__, msg->port, msg->hskia_cts, msg->gpia_dcd, msg->dsr, msg->ri, msg->_txOff, |
| msg->_txXoff, msg->rxEnabled, msg->controlResponse); |
| #endif |
| |
| /* Now do something useful with the data */ |
| |
| |
| /* Check port number from message and retrieve private data */ |
| if (msg->port >= serial->num_ports) { |
| dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); |
| goto exit; |
| } |
| port = serial->port[msg->port]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Update handshaking pin state information */ |
| old_dcd_state = p_priv->dcd_state; |
| p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0); |
| p_priv->dsr_state = ((msg->dsr) ? 1 : 0); |
| p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0); |
| p_priv->ri_state = ((msg->ri) ? 1 : 0); |
| |
| if (port->tty && !C_CLOCAL(port->tty) |
| && old_dcd_state != p_priv->dcd_state) { |
| if (old_dcd_state) |
| tty_hangup(port->tty); |
| /* else */ |
| /* wake_up_interruptible(&p_priv->open_wait); */ |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| exit: ; |
| } |
| |
| static void usa26_glocont_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| |
| } |
| |
| |
| static void usa28_indat_callback(struct urb *urb) |
| { |
| int i, err; |
| struct usb_serial_port *port; |
| struct tty_struct *tty; |
| unsigned char *data; |
| struct keyspan_port_private *p_priv; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| data = urb->transfer_buffer; |
| |
| if (urb != p_priv->in_urbs[p_priv->in_flip]) |
| return; |
| |
| do { |
| if (status) { |
| dbg("%s - nonzero status: %x on endpoint %d.", |
| __FUNCTION__, status, usb_pipeendpoint(urb->pipe)); |
| return; |
| } |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| data = urb->transfer_buffer; |
| |
| tty = port->tty; |
| if (urb->actual_length) { |
| for (i = 0; i < urb->actual_length ; ++i) { |
| tty_insert_flip_char(tty, data[i], 0); |
| } |
| tty_flip_buffer_push(tty); |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = port->serial->dev; |
| if (port->open_count) |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| p_priv->in_flip ^= 1; |
| |
| urb = p_priv->in_urbs[p_priv->in_flip]; |
| } while (urb->status != -EINPROGRESS); |
| } |
| |
| static void usa28_inack_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| } |
| |
| static void usa28_outcont_callback(struct urb *urb) |
| { |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (p_priv->resend_cont) { |
| dbg ("%s - sending setup", __FUNCTION__); |
| keyspan_usa28_send_setup(port->serial, port, p_priv->resend_cont - 1); |
| } |
| } |
| |
| static void usa28_instat_callback(struct urb *urb) |
| { |
| int err; |
| unsigned char *data = urb->transfer_buffer; |
| struct keyspan_usa28_portStatusMessage *msg; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int old_dcd_state; |
| int status = urb->status; |
| |
| serial = (struct usb_serial *) urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| |
| if (urb->actual_length != sizeof(struct keyspan_usa28_portStatusMessage)) { |
| dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); |
| goto exit; |
| } |
| |
| /*dbg("%s %x %x %x %x %x %x %x %x %x %x %x %x", __FUNCTION__ |
| data[0], data[1], data[2], data[3], data[4], data[5], |
| data[6], data[7], data[8], data[9], data[10], data[11]);*/ |
| |
| /* Now do something useful with the data */ |
| msg = (struct keyspan_usa28_portStatusMessage *)data; |
| |
| |
| /* Check port number from message and retrieve private data */ |
| if (msg->port >= serial->num_ports) { |
| dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); |
| goto exit; |
| } |
| port = serial->port[msg->port]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Update handshaking pin state information */ |
| old_dcd_state = p_priv->dcd_state; |
| p_priv->cts_state = ((msg->cts) ? 1 : 0); |
| p_priv->dsr_state = ((msg->dsr) ? 1 : 0); |
| p_priv->dcd_state = ((msg->dcd) ? 1 : 0); |
| p_priv->ri_state = ((msg->ri) ? 1 : 0); |
| |
| if (port->tty && !C_CLOCAL(port->tty) |
| && old_dcd_state != p_priv->dcd_state) { |
| if (old_dcd_state) |
| tty_hangup(port->tty); |
| /* else */ |
| /* wake_up_interruptible(&p_priv->open_wait); */ |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| exit: ; |
| } |
| |
| static void usa28_glocont_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| } |
| |
| |
| static void usa49_glocont_callback(struct urb *urb) |
| { |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int i; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| serial = (struct usb_serial *) urb->context; |
| for (i = 0; i < serial->num_ports; ++i) { |
| port = serial->port[i]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (p_priv->resend_cont) { |
| dbg ("%s - sending setup", __FUNCTION__); |
| keyspan_usa49_send_setup(serial, port, p_priv->resend_cont - 1); |
| break; |
| } |
| } |
| } |
| |
| /* This is actually called glostat in the Keyspan |
| doco */ |
| static void usa49_instat_callback(struct urb *urb) |
| { |
| int err; |
| unsigned char *data = urb->transfer_buffer; |
| struct keyspan_usa49_portStatusMessage *msg; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int old_dcd_state; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| serial = (struct usb_serial *) urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| |
| if (urb->actual_length != sizeof(struct keyspan_usa49_portStatusMessage)) { |
| dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); |
| goto exit; |
| } |
| |
| /*dbg(" %x %x %x %x %x %x %x %x %x %x %x", __FUNCTION__, |
| data[0], data[1], data[2], data[3], data[4], data[5], |
| data[6], data[7], data[8], data[9], data[10]);*/ |
| |
| /* Now do something useful with the data */ |
| msg = (struct keyspan_usa49_portStatusMessage *)data; |
| |
| /* Check port number from message and retrieve private data */ |
| if (msg->portNumber >= serial->num_ports) { |
| dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->portNumber); |
| goto exit; |
| } |
| port = serial->port[msg->portNumber]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Update handshaking pin state information */ |
| old_dcd_state = p_priv->dcd_state; |
| p_priv->cts_state = ((msg->cts) ? 1 : 0); |
| p_priv->dsr_state = ((msg->dsr) ? 1 : 0); |
| p_priv->dcd_state = ((msg->dcd) ? 1 : 0); |
| p_priv->ri_state = ((msg->ri) ? 1 : 0); |
| |
| if (port->tty && !C_CLOCAL(port->tty) |
| && old_dcd_state != p_priv->dcd_state) { |
| if (old_dcd_state) |
| tty_hangup(port->tty); |
| /* else */ |
| /* wake_up_interruptible(&p_priv->open_wait); */ |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| exit: ; |
| } |
| |
| static void usa49_inack_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| } |
| |
| static void usa49_indat_callback(struct urb *urb) |
| { |
| int i, err; |
| int endpoint; |
| struct usb_serial_port *port; |
| struct tty_struct *tty; |
| unsigned char *data = urb->transfer_buffer; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| endpoint = usb_pipeendpoint(urb->pipe); |
| |
| if (status) { |
| dbg("%s - nonzero status: %x on endpoint %d.", __FUNCTION__, |
| status, endpoint); |
| return; |
| } |
| |
| port = (struct usb_serial_port *) urb->context; |
| tty = port->tty; |
| if (urb->actual_length) { |
| /* 0x80 bit is error flag */ |
| if ((data[0] & 0x80) == 0) { |
| /* no error on any byte */ |
| for (i = 1; i < urb->actual_length ; ++i) { |
| tty_insert_flip_char(tty, data[i], 0); |
| } |
| } else { |
| /* some bytes had errors, every byte has status */ |
| for (i = 0; i + 1 < urb->actual_length; i += 2) { |
| int stat = data[i], flag = 0; |
| if (stat & RXERROR_OVERRUN) |
| flag |= TTY_OVERRUN; |
| if (stat & RXERROR_FRAMING) |
| flag |= TTY_FRAME; |
| if (stat & RXERROR_PARITY) |
| flag |= TTY_PARITY; |
| /* XXX should handle break (0x10) */ |
| tty_insert_flip_char(tty, data[i+1], flag); |
| } |
| } |
| tty_flip_buffer_push(tty); |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = port->serial->dev; |
| if (port->open_count) |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| } |
| |
| static void usa49wg_indat_callback(struct urb *urb) |
| { |
| int i, len, x, err; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct tty_struct *tty; |
| unsigned char *data = urb->transfer_buffer; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| serial = urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| |
| /* inbound data is in the form P#, len, status, data */ |
| i = 0; |
| len = 0; |
| |
| if (urb->actual_length) { |
| while (i < urb->actual_length) { |
| |
| /* Check port number from message*/ |
| if (data[i] >= serial->num_ports) { |
| dbg ("%s - Unexpected port number %d", |
| __FUNCTION__, data[i]); |
| return; |
| } |
| port = serial->port[data[i++]]; |
| tty = port->tty; |
| len = data[i++]; |
| |
| /* 0x80 bit is error flag */ |
| if ((data[i] & 0x80) == 0) { |
| /* no error on any byte */ |
| i++; |
| for (x = 1; x < len ; ++x) |
| if (port->open_count) |
| tty_insert_flip_char(tty, |
| data[i++], 0); |
| else |
| i++; |
| } else { |
| /* |
| * some bytes had errors, every byte has status |
| */ |
| for (x = 0; x + 1 < len; x += 2) { |
| int stat = data[i], flag = 0; |
| if (stat & RXERROR_OVERRUN) |
| flag |= TTY_OVERRUN; |
| if (stat & RXERROR_FRAMING) |
| flag |= TTY_FRAME; |
| if (stat & RXERROR_PARITY) |
| flag |= TTY_PARITY; |
| /* XXX should handle break (0x10) */ |
| if (port->open_count) |
| tty_insert_flip_char(tty, |
| data[i+1], flag); |
| i += 2; |
| } |
| } |
| if (port->open_count) |
| tty_flip_buffer_push(tty); |
| } |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| |
| err = usb_submit_urb(urb, GFP_ATOMIC); |
| if (err != 0) |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| |
| /* not used, usa-49 doesn't have per-port control endpoints */ |
| static void usa49_outcont_callback(struct urb *urb) |
| { |
| dbg ("%s", __FUNCTION__); |
| } |
| |
| static void usa90_indat_callback(struct urb *urb) |
| { |
| int i, err; |
| int endpoint; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| struct tty_struct *tty; |
| unsigned char *data = urb->transfer_buffer; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| endpoint = usb_pipeendpoint(urb->pipe); |
| |
| if (status) { |
| dbg("%s - nonzero status: %x on endpoint %d.", |
| __FUNCTION__, status, endpoint); |
| return; |
| } |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| |
| tty = port->tty; |
| if (urb->actual_length) { |
| |
| /* if current mode is DMA, looks like usa28 format |
| otherwise looks like usa26 data format */ |
| |
| if (p_priv->baud > 57600) { |
| for (i = 0; i < urb->actual_length ; ++i) |
| tty_insert_flip_char(tty, data[i], 0); |
| } |
| else { |
| |
| /* 0x80 bit is error flag */ |
| if ((data[0] & 0x80) == 0) { |
| /* no errors on individual bytes, only possible overrun err*/ |
| if (data[0] & RXERROR_OVERRUN) |
| err = TTY_OVERRUN; |
| else err = 0; |
| for (i = 1; i < urb->actual_length ; ++i) |
| tty_insert_flip_char(tty, data[i], err); |
| |
| } |
| else { |
| /* some bytes had errors, every byte has status */ |
| dbg("%s - RX error!!!!", __FUNCTION__); |
| for (i = 0; i + 1 < urb->actual_length; i += 2) { |
| int stat = data[i], flag = 0; |
| if (stat & RXERROR_OVERRUN) |
| flag |= TTY_OVERRUN; |
| if (stat & RXERROR_FRAMING) |
| flag |= TTY_FRAME; |
| if (stat & RXERROR_PARITY) |
| flag |= TTY_PARITY; |
| /* XXX should handle break (0x10) */ |
| tty_insert_flip_char(tty, data[i+1], flag); |
| } |
| } |
| } |
| tty_flip_buffer_push(tty); |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = port->serial->dev; |
| if (port->open_count) |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| return; |
| } |
| |
| |
| static void usa90_instat_callback(struct urb *urb) |
| { |
| unsigned char *data = urb->transfer_buffer; |
| struct keyspan_usa90_portStatusMessage *msg; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int old_dcd_state, err; |
| int status = urb->status; |
| |
| serial = (struct usb_serial *) urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| if (urb->actual_length < 14) { |
| dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length); |
| goto exit; |
| } |
| |
| msg = (struct keyspan_usa90_portStatusMessage *)data; |
| |
| /* Now do something useful with the data */ |
| |
| port = serial->port[0]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Update handshaking pin state information */ |
| old_dcd_state = p_priv->dcd_state; |
| p_priv->cts_state = ((msg->cts) ? 1 : 0); |
| p_priv->dsr_state = ((msg->dsr) ? 1 : 0); |
| p_priv->dcd_state = ((msg->dcd) ? 1 : 0); |
| p_priv->ri_state = ((msg->ri) ? 1 : 0); |
| |
| if (port->tty && !C_CLOCAL(port->tty) |
| && old_dcd_state != p_priv->dcd_state) { |
| if (old_dcd_state) |
| tty_hangup(port->tty); |
| /* else */ |
| /* wake_up_interruptible(&p_priv->open_wait); */ |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| exit: |
| ; |
| } |
| |
| static void usa90_outcont_callback(struct urb *urb) |
| { |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| |
| port = (struct usb_serial_port *) urb->context; |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (p_priv->resend_cont) { |
| dbg ("%s - sending setup", __FUNCTION__); |
| keyspan_usa90_send_setup(port->serial, port, p_priv->resend_cont - 1); |
| } |
| } |
| |
| /* Status messages from the 28xg */ |
| static void usa67_instat_callback(struct urb *urb) |
| { |
| int err; |
| unsigned char *data = urb->transfer_buffer; |
| struct keyspan_usa67_portStatusMessage *msg; |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int old_dcd_state; |
| int status = urb->status; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| serial = urb->context; |
| |
| if (status) { |
| dbg("%s - nonzero status: %x", __FUNCTION__, status); |
| return; |
| } |
| |
| if (urb->actual_length != sizeof(struct keyspan_usa67_portStatusMessage)) { |
| dbg("%s - bad length %d", __FUNCTION__, urb->actual_length); |
| return; |
| } |
| |
| |
| /* Now do something useful with the data */ |
| msg = (struct keyspan_usa67_portStatusMessage *)data; |
| |
| /* Check port number from message and retrieve private data */ |
| if (msg->port >= serial->num_ports) { |
| dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port); |
| return; |
| } |
| |
| port = serial->port[msg->port]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Update handshaking pin state information */ |
| old_dcd_state = p_priv->dcd_state; |
| p_priv->cts_state = ((msg->hskia_cts) ? 1 : 0); |
| p_priv->dcd_state = ((msg->gpia_dcd) ? 1 : 0); |
| |
| if (port->tty && !C_CLOCAL(port->tty) |
| && old_dcd_state != p_priv->dcd_state) { |
| if (old_dcd_state) |
| tty_hangup(port->tty); |
| /* else */ |
| /* wake_up_interruptible(&p_priv->open_wait); */ |
| } |
| |
| /* Resubmit urb so we continue receiving */ |
| urb->dev = serial->dev; |
| err = usb_submit_urb(urb, GFP_ATOMIC); |
| if (err != 0) |
| dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err); |
| } |
| |
| static void usa67_glocont_callback(struct urb *urb) |
| { |
| struct usb_serial *serial; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| int i; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| serial = urb->context; |
| for (i = 0; i < serial->num_ports; ++i) { |
| port = serial->port[i]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| if (p_priv->resend_cont) { |
| dbg ("%s - sending setup", __FUNCTION__); |
| keyspan_usa67_send_setup(serial, port, |
| p_priv->resend_cont - 1); |
| break; |
| } |
| } |
| } |
| |
| static int keyspan_write_room (struct usb_serial_port *port) |
| { |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| int flip; |
| int data_len; |
| struct urb *this_urb; |
| |
| dbg("%s", __FUNCTION__); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = p_priv->device_details; |
| |
| if (d_details->msg_format == msg_usa90) |
| data_len = 64; |
| else |
| data_len = 63; |
| |
| flip = p_priv->out_flip; |
| |
| /* Check both endpoints to see if any are available. */ |
| if ((this_urb = p_priv->out_urbs[flip]) != NULL) { |
| if (this_urb->status != -EINPROGRESS) |
| return (data_len); |
| flip = (flip + 1) & d_details->outdat_endp_flip; |
| if ((this_urb = p_priv->out_urbs[flip]) != NULL) |
| if (this_urb->status != -EINPROGRESS) |
| return (data_len); |
| } |
| return (0); |
| } |
| |
| |
| static int keyspan_chars_in_buffer (struct usb_serial_port *port) |
| { |
| return (0); |
| } |
| |
| |
| static int keyspan_open (struct usb_serial_port *port, struct file *filp) |
| { |
| struct keyspan_port_private *p_priv; |
| struct keyspan_serial_private *s_priv; |
| struct usb_serial *serial = port->serial; |
| const struct keyspan_device_details *d_details; |
| int i, err; |
| int baud_rate, device_port; |
| struct urb *urb; |
| unsigned int cflag; |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = p_priv->device_details; |
| |
| dbg("%s - port%d.", __FUNCTION__, port->number); |
| |
| /* Set some sane defaults */ |
| p_priv->rts_state = 1; |
| p_priv->dtr_state = 1; |
| p_priv->baud = 9600; |
| |
| /* force baud and lcr to be set on open */ |
| p_priv->old_baud = 0; |
| p_priv->old_cflag = 0; |
| |
| p_priv->out_flip = 0; |
| p_priv->in_flip = 0; |
| |
| /* Reset low level data toggle and start reading from endpoints */ |
| for (i = 0; i < 2; i++) { |
| if ((urb = p_priv->in_urbs[i]) == NULL) |
| continue; |
| urb->dev = serial->dev; |
| |
| /* make sure endpoint data toggle is synchronized with the device */ |
| |
| usb_clear_halt(urb->dev, urb->pipe); |
| |
| if ((err = usb_submit_urb(urb, GFP_KERNEL)) != 0) { |
| dbg("%s - submit urb %d failed (%d)", __FUNCTION__, i, err); |
| } |
| } |
| |
| /* Reset low level data toggle on out endpoints */ |
| for (i = 0; i < 2; i++) { |
| if ((urb = p_priv->out_urbs[i]) == NULL) |
| continue; |
| urb->dev = serial->dev; |
| /* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), usb_pipeout(urb->pipe), 0); */ |
| } |
| |
| /* get the terminal config for the setup message now so we don't |
| * need to send 2 of them */ |
| |
| cflag = port->tty->termios->c_cflag; |
| device_port = port->number - port->serial->minor; |
| |
| /* Baud rate calculation takes baud rate as an integer |
| so other rates can be generated if desired. */ |
| baud_rate = tty_get_baud_rate(port->tty); |
| /* If no match or invalid, leave as default */ |
| if (baud_rate >= 0 |
| && d_details->calculate_baud_rate(baud_rate, d_details->baudclk, |
| NULL, NULL, NULL, device_port) == KEYSPAN_BAUD_RATE_OK) { |
| p_priv->baud = baud_rate; |
| } |
| |
| /* set CTS/RTS handshake etc. */ |
| p_priv->cflag = cflag; |
| p_priv->flow_control = (cflag & CRTSCTS)? flow_cts: flow_none; |
| |
| keyspan_send_setup(port, 1); |
| //mdelay(100); |
| //keyspan_set_termios(port, NULL); |
| |
| return (0); |
| } |
| |
| static inline void stop_urb(struct urb *urb) |
| { |
| if (urb && urb->status == -EINPROGRESS) |
| usb_kill_urb(urb); |
| } |
| |
| static void keyspan_close(struct usb_serial_port *port, struct file *filp) |
| { |
| int i; |
| struct usb_serial *serial = port->serial; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| |
| dbg("%s", __FUNCTION__); |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| |
| p_priv->rts_state = 0; |
| p_priv->dtr_state = 0; |
| |
| if (serial->dev) { |
| keyspan_send_setup(port, 2); |
| /* pilot-xfer seems to work best with this delay */ |
| mdelay(100); |
| // keyspan_set_termios(port, NULL); |
| } |
| |
| /*while (p_priv->outcont_urb->status == -EINPROGRESS) { |
| dbg("%s - urb in progress", __FUNCTION__); |
| }*/ |
| |
| p_priv->out_flip = 0; |
| p_priv->in_flip = 0; |
| |
| if (serial->dev) { |
| /* Stop reading/writing urbs */ |
| stop_urb(p_priv->inack_urb); |
| /* stop_urb(p_priv->outcont_urb); */ |
| for (i = 0; i < 2; i++) { |
| stop_urb(p_priv->in_urbs[i]); |
| stop_urb(p_priv->out_urbs[i]); |
| } |
| } |
| port->tty = NULL; |
| } |
| |
| |
| /* download the firmware to a pre-renumeration device */ |
| static int keyspan_fake_startup (struct usb_serial *serial) |
| { |
| int response; |
| const struct ezusb_hex_record *record; |
| char *fw_name; |
| |
| dbg("Keyspan startup version %04x product %04x", |
| le16_to_cpu(serial->dev->descriptor.bcdDevice), |
| le16_to_cpu(serial->dev->descriptor.idProduct)); |
| |
| if ((le16_to_cpu(serial->dev->descriptor.bcdDevice) & 0x8000) != 0x8000) { |
| dbg("Firmware already loaded. Quitting."); |
| return(1); |
| } |
| |
| /* Select firmware image on the basis of idProduct */ |
| switch (le16_to_cpu(serial->dev->descriptor.idProduct)) { |
| case keyspan_usa28_pre_product_id: |
| record = &keyspan_usa28_firmware[0]; |
| fw_name = "USA28"; |
| break; |
| |
| case keyspan_usa28x_pre_product_id: |
| record = &keyspan_usa28x_firmware[0]; |
| fw_name = "USA28X"; |
| break; |
| |
| case keyspan_usa28xa_pre_product_id: |
| record = &keyspan_usa28xa_firmware[0]; |
| fw_name = "USA28XA"; |
| break; |
| |
| case keyspan_usa28xb_pre_product_id: |
| record = &keyspan_usa28xb_firmware[0]; |
| fw_name = "USA28XB"; |
| break; |
| |
| case keyspan_usa19_pre_product_id: |
| record = &keyspan_usa19_firmware[0]; |
| fw_name = "USA19"; |
| break; |
| |
| case keyspan_usa19qi_pre_product_id: |
| record = &keyspan_usa19qi_firmware[0]; |
| fw_name = "USA19QI"; |
| break; |
| |
| case keyspan_mpr_pre_product_id: |
| record = &keyspan_mpr_firmware[0]; |
| fw_name = "MPR"; |
| break; |
| |
| case keyspan_usa19qw_pre_product_id: |
| record = &keyspan_usa19qw_firmware[0]; |
| fw_name = "USA19QI"; |
| break; |
| |
| case keyspan_usa18x_pre_product_id: |
| record = &keyspan_usa18x_firmware[0]; |
| fw_name = "USA18X"; |
| break; |
| |
| case keyspan_usa19w_pre_product_id: |
| record = &keyspan_usa19w_firmware[0]; |
| fw_name = "USA19W"; |
| break; |
| |
| case keyspan_usa49w_pre_product_id: |
| record = &keyspan_usa49w_firmware[0]; |
| fw_name = "USA49W"; |
| break; |
| |
| case keyspan_usa49wlc_pre_product_id: |
| record = &keyspan_usa49wlc_firmware[0]; |
| fw_name = "USA49WLC"; |
| break; |
| |
| default: |
| record = NULL; |
| fw_name = "Unknown"; |
| break; |
| } |
| |
| if (record == NULL) { |
| dev_err(&serial->dev->dev, "Required keyspan firmware image (%s) unavailable.\n", fw_name); |
| return(1); |
| } |
| |
| dbg("Uploading Keyspan %s firmware.", fw_name); |
| |
| /* download the firmware image */ |
| response = ezusb_set_reset(serial, 1); |
| |
| while(record->address != 0xffff) { |
| response = ezusb_writememory(serial, record->address, |
| (unsigned char *)record->data, |
| record->data_size, 0xa0); |
| if (response < 0) { |
| dev_err(&serial->dev->dev, "ezusb_writememory failed for Keyspan" |
| "firmware (%d %04X %p %d)\n", |
| response, |
| record->address, record->data, record->data_size); |
| break; |
| } |
| record++; |
| } |
| /* bring device out of reset. Renumeration will occur in a |
| moment and the new device will bind to the real driver */ |
| response = ezusb_set_reset(serial, 0); |
| |
| /* we don't want this device to have a driver assigned to it. */ |
| return (1); |
| } |
| |
| /* Helper functions used by keyspan_setup_urbs */ |
| static struct usb_endpoint_descriptor const *find_ep(struct usb_serial const *serial, |
| int endpoint) |
| { |
| struct usb_host_interface *iface_desc; |
| struct usb_endpoint_descriptor *ep; |
| int i; |
| |
| iface_desc = serial->interface->cur_altsetting; |
| for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) { |
| ep = &iface_desc->endpoint[i].desc; |
| if (ep->bEndpointAddress == endpoint) |
| return ep; |
| } |
| dev_warn(&serial->interface->dev, "found no endpoint descriptor for " |
| "endpoint %x\n", endpoint); |
| return NULL; |
| } |
| |
| static struct urb *keyspan_setup_urb (struct usb_serial *serial, int endpoint, |
| int dir, void *ctx, char *buf, int len, |
| void (*callback)(struct urb *)) |
| { |
| struct urb *urb; |
| struct usb_endpoint_descriptor const *ep_desc; |
| char const *ep_type_name; |
| |
| if (endpoint == -1) |
| return NULL; /* endpoint not needed */ |
| |
| dbg ("%s - alloc for endpoint %d.", __FUNCTION__, endpoint); |
| urb = usb_alloc_urb(0, GFP_KERNEL); /* No ISO */ |
| if (urb == NULL) { |
| dbg ("%s - alloc for endpoint %d failed.", __FUNCTION__, endpoint); |
| return NULL; |
| } |
| |
| if (endpoint == 0) { |
| /* control EP filled in when used */ |
| return urb; |
| } |
| |
| ep_desc = find_ep(serial, endpoint); |
| if (!ep_desc) { |
| /* leak the urb, something's wrong and the callers don't care */ |
| return urb; |
| } |
| if (usb_endpoint_xfer_int(ep_desc)) { |
| ep_type_name = "INT"; |
| usb_fill_int_urb(urb, serial->dev, |
| usb_sndintpipe(serial->dev, endpoint) | dir, |
| buf, len, callback, ctx, |
| ep_desc->bInterval); |
| } else if (usb_endpoint_xfer_bulk(ep_desc)) { |
| ep_type_name = "BULK"; |
| usb_fill_bulk_urb(urb, serial->dev, |
| usb_sndbulkpipe(serial->dev, endpoint) | dir, |
| buf, len, callback, ctx); |
| } else { |
| dev_warn(&serial->interface->dev, |
| "unsupported endpoint type %x\n", |
| ep_desc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK); |
| usb_free_urb(urb); |
| return NULL; |
| } |
| |
| dbg("%s - using urb %p for %s endpoint %x", |
| __func__, urb, ep_type_name, endpoint); |
| return urb; |
| } |
| |
| static struct callbacks { |
| void (*instat_callback)(struct urb *); |
| void (*glocont_callback)(struct urb *); |
| void (*indat_callback)(struct urb *); |
| void (*outdat_callback)(struct urb *); |
| void (*inack_callback)(struct urb *); |
| void (*outcont_callback)(struct urb *); |
| } keyspan_callbacks[] = { |
| { |
| /* msg_usa26 callbacks */ |
| .instat_callback = usa26_instat_callback, |
| .glocont_callback = usa26_glocont_callback, |
| .indat_callback = usa26_indat_callback, |
| .outdat_callback = usa2x_outdat_callback, |
| .inack_callback = usa26_inack_callback, |
| .outcont_callback = usa26_outcont_callback, |
| }, { |
| /* msg_usa28 callbacks */ |
| .instat_callback = usa28_instat_callback, |
| .glocont_callback = usa28_glocont_callback, |
| .indat_callback = usa28_indat_callback, |
| .outdat_callback = usa2x_outdat_callback, |
| .inack_callback = usa28_inack_callback, |
| .outcont_callback = usa28_outcont_callback, |
| }, { |
| /* msg_usa49 callbacks */ |
| .instat_callback = usa49_instat_callback, |
| .glocont_callback = usa49_glocont_callback, |
| .indat_callback = usa49_indat_callback, |
| .outdat_callback = usa2x_outdat_callback, |
| .inack_callback = usa49_inack_callback, |
| .outcont_callback = usa49_outcont_callback, |
| }, { |
| /* msg_usa90 callbacks */ |
| .instat_callback = usa90_instat_callback, |
| .glocont_callback = usa28_glocont_callback, |
| .indat_callback = usa90_indat_callback, |
| .outdat_callback = usa2x_outdat_callback, |
| .inack_callback = usa28_inack_callback, |
| .outcont_callback = usa90_outcont_callback, |
| }, { |
| /* msg_usa67 callbacks */ |
| .instat_callback = usa67_instat_callback, |
| .glocont_callback = usa67_glocont_callback, |
| .indat_callback = usa26_indat_callback, |
| .outdat_callback = usa2x_outdat_callback, |
| .inack_callback = usa26_inack_callback, |
| .outcont_callback = usa26_outcont_callback, |
| } |
| }; |
| |
| /* Generic setup urbs function that uses |
| data in device_details */ |
| static void keyspan_setup_urbs(struct usb_serial *serial) |
| { |
| int i, j; |
| struct keyspan_serial_private *s_priv; |
| const struct keyspan_device_details *d_details; |
| struct usb_serial_port *port; |
| struct keyspan_port_private *p_priv; |
| struct callbacks *cback; |
| int endp; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| d_details = s_priv->device_details; |
| |
| /* Setup values for the various callback routines */ |
| cback = &keyspan_callbacks[d_details->msg_format]; |
| |
| /* Allocate and set up urbs for each one that is in use, |
| starting with instat endpoints */ |
| s_priv->instat_urb = keyspan_setup_urb |
| (serial, d_details->instat_endpoint, USB_DIR_IN, |
| serial, s_priv->instat_buf, INSTAT_BUFLEN, |
| cback->instat_callback); |
| |
| s_priv->indat_urb = keyspan_setup_urb |
| (serial, d_details->indat_endpoint, USB_DIR_IN, |
| serial, s_priv->indat_buf, INDAT49W_BUFLEN, |
| usa49wg_indat_callback); |
| |
| s_priv->glocont_urb = keyspan_setup_urb |
| (serial, d_details->glocont_endpoint, USB_DIR_OUT, |
| serial, s_priv->glocont_buf, GLOCONT_BUFLEN, |
| cback->glocont_callback); |
| |
| /* Setup endpoints for each port specific thing */ |
| for (i = 0; i < d_details->num_ports; i ++) { |
| port = serial->port[i]; |
| p_priv = usb_get_serial_port_data(port); |
| |
| /* Do indat endpoints first, once for each flip */ |
| endp = d_details->indat_endpoints[i]; |
| for (j = 0; j <= d_details->indat_endp_flip; ++j, ++endp) { |
| p_priv->in_urbs[j] = keyspan_setup_urb |
| (serial, endp, USB_DIR_IN, port, |
| p_priv->in_buffer[j], 64, |
| cback->indat_callback); |
| } |
| for (; j < 2; ++j) |
| p_priv->in_urbs[j] = NULL; |
| |
| /* outdat endpoints also have flip */ |
| endp = d_details->outdat_endpoints[i]; |
| for (j = 0; j <= d_details->outdat_endp_flip; ++j, ++endp) { |
| p_priv->out_urbs[j] = keyspan_setup_urb |
| (serial, endp, USB_DIR_OUT, port, |
| p_priv->out_buffer[j], 64, |
| cback->outdat_callback); |
| } |
| for (; j < 2; ++j) |
| p_priv->out_urbs[j] = NULL; |
| |
| /* inack endpoint */ |
| p_priv->inack_urb = keyspan_setup_urb |
| (serial, d_details->inack_endpoints[i], USB_DIR_IN, |
| port, p_priv->inack_buffer, 1, cback->inack_callback); |
| |
| /* outcont endpoint */ |
| p_priv->outcont_urb = keyspan_setup_urb |
| (serial, d_details->outcont_endpoints[i], USB_DIR_OUT, |
| port, p_priv->outcont_buffer, 64, |
| cback->outcont_callback); |
| } |
| |
| } |
| |
| /* usa19 function doesn't require prescaler */ |
| static int keyspan_usa19_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, |
| u8 *rate_low, u8 *prescaler, int portnum) |
| { |
| u32 b16, /* baud rate times 16 (actual rate used internally) */ |
| div, /* divisor */ |
| cnt; /* inverse of divisor (programmed into 8051) */ |
| |
| dbg ("%s - %d.", __FUNCTION__, baud_rate); |
| |
| /* prevent divide by zero... */ |
| if( (b16 = (baud_rate * 16L)) == 0) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| |
| /* Any "standard" rate over 57k6 is marginal on the USA-19 |
| as we run out of divisor resolution. */ |
| if (baud_rate > 57600) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| |
| /* calculate the divisor and the counter (its inverse) */ |
| if( (div = (baudclk / b16)) == 0) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| else { |
| cnt = 0 - div; |
| } |
| |
| if(div > 0xffff) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| |
| /* return the counter values if non-null */ |
| if (rate_low) { |
| *rate_low = (u8) (cnt & 0xff); |
| } |
| if (rate_hi) { |
| *rate_hi = (u8) ((cnt >> 8) & 0xff); |
| } |
| if (rate_low && rate_hi) { |
| dbg ("%s - %d %02x %02x.", __FUNCTION__, baud_rate, *rate_hi, *rate_low); |
| } |
| |
| return (KEYSPAN_BAUD_RATE_OK); |
| } |
| |
| /* usa19hs function doesn't require prescaler */ |
| static int keyspan_usa19hs_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, |
| u8 *rate_low, u8 *prescaler, int portnum) |
| { |
| u32 b16, /* baud rate times 16 (actual rate used internally) */ |
| div; /* divisor */ |
| |
| dbg ("%s - %d.", __FUNCTION__, baud_rate); |
| |
| /* prevent divide by zero... */ |
| if( (b16 = (baud_rate * 16L)) == 0) |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| |
| |
| |
| /* calculate the divisor */ |
| if( (div = (baudclk / b16)) == 0) |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| |
| if(div > 0xffff) |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| |
| /* return the counter values if non-null */ |
| if (rate_low) |
| *rate_low = (u8) (div & 0xff); |
| |
| if (rate_hi) |
| *rate_hi = (u8) ((div >> 8) & 0xff); |
| |
| if (rate_low && rate_hi) |
| dbg ("%s - %d %02x %02x.", __FUNCTION__, baud_rate, *rate_hi, *rate_low); |
| |
| return (KEYSPAN_BAUD_RATE_OK); |
| } |
| |
| static int keyspan_usa19w_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, |
| u8 *rate_low, u8 *prescaler, int portnum) |
| { |
| u32 b16, /* baud rate times 16 (actual rate used internally) */ |
| clk, /* clock with 13/8 prescaler */ |
| div, /* divisor using 13/8 prescaler */ |
| res, /* resulting baud rate using 13/8 prescaler */ |
| diff, /* error using 13/8 prescaler */ |
| smallest_diff; |
| u8 best_prescaler; |
| int i; |
| |
| dbg ("%s - %d.", __FUNCTION__, baud_rate); |
| |
| /* prevent divide by zero */ |
| if( (b16 = baud_rate * 16L) == 0) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| |
| /* Calculate prescaler by trying them all and looking |
| for best fit */ |
| |
| /* start with largest possible difference */ |
| smallest_diff = 0xffffffff; |
| |
| /* 0 is an invalid prescaler, used as a flag */ |
| best_prescaler = 0; |
| |
| for(i = 8; i <= 0xff; ++i) { |
| clk = (baudclk * 8) / (u32) i; |
| |
| if( (div = clk / b16) == 0) { |
| continue; |
| } |
| |
| res = clk / div; |
| diff= (res > b16) ? (res-b16) : (b16-res); |
| |
| if(diff < smallest_diff) { |
| best_prescaler = i; |
| smallest_diff = diff; |
| } |
| } |
| |
| if(best_prescaler == 0) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| |
| clk = (baudclk * 8) / (u32) best_prescaler; |
| div = clk / b16; |
| |
| /* return the divisor and prescaler if non-null */ |
| if (rate_low) { |
| *rate_low = (u8) (div & 0xff); |
| } |
| if (rate_hi) { |
| *rate_hi = (u8) ((div >> 8) & 0xff); |
| } |
| if (prescaler) { |
| *prescaler = best_prescaler; |
| /* dbg("%s - %d %d", __FUNCTION__, *prescaler, div); */ |
| } |
| return (KEYSPAN_BAUD_RATE_OK); |
| } |
| |
| /* USA-28 supports different maximum baud rates on each port */ |
| static int keyspan_usa28_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi, |
| u8 *rate_low, u8 *prescaler, int portnum) |
| { |
| u32 b16, /* baud rate times 16 (actual rate used internally) */ |
| div, /* divisor */ |
| cnt; /* inverse of divisor (programmed into 8051) */ |
| |
| dbg ("%s - %d.", __FUNCTION__, baud_rate); |
| |
| /* prevent divide by zero */ |
| if ((b16 = baud_rate * 16L) == 0) |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| |
| /* calculate the divisor and the counter (its inverse) */ |
| if ((div = (KEYSPAN_USA28_BAUDCLK / b16)) == 0) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| else { |
| cnt = 0 - div; |
| } |
| |
| /* check for out of range, based on portnum, |
| and return result */ |
| if(portnum == 0) { |
| if(div > 0xffff) |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| else { |
| if(portnum == 1) { |
| if(div > 0xff) { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| } |
| else { |
| return (KEYSPAN_INVALID_BAUD_RATE); |
| } |
| } |
| |
| /* return the counter values if not NULL |
| (port 1 will ignore retHi) */ |
| if (rate_low) { |
| *rate_low = (u8) (cnt & 0xff); |
| } |
| if (rate_hi) { |
| *rate_hi = (u8) ((cnt >> 8) & 0xff); |
| } |
| dbg ("%s - %d OK.", __FUNCTION__, baud_rate); |
| return (KEYSPAN_BAUD_RATE_OK); |
| } |
| |
| static int keyspan_usa26_send_setup(struct usb_serial *serial, |
| struct usb_serial_port *port, |
| int reset_port) |
| { |
| struct keyspan_usa26_portControlMessage msg; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| int outcont_urb; |
| struct urb *this_urb; |
| int device_port, err; |
| |
| dbg ("%s reset=%d", __FUNCTION__, reset_port); |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = s_priv->device_details; |
| device_port = port->number - port->serial->minor; |
| |
| outcont_urb = d_details->outcont_endpoints[port->number]; |
| this_urb = p_priv->outcont_urb; |
| |
| dbg("%s - endpoint %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe)); |
| |
| /* Make sure we have an urb then send the message */ |
| if (this_urb == NULL) { |
| dbg("%s - oops no urb.", __FUNCTION__); |
| return -1; |
| } |
| |
| /* Save reset port val for resend. |
| Don't overwrite resend for open/close condition. */ |
| if ((reset_port + 1) > p_priv->resend_cont) |
| p_priv->resend_cont = reset_port + 1; |
| if (this_urb->status == -EINPROGRESS) { |
| /* dbg ("%s - already writing", __FUNCTION__); */ |
| mdelay(5); |
| return(-1); |
| } |
| |
| memset(&msg, 0, sizeof (struct keyspan_usa26_portControlMessage)); |
| |
| /* Only set baud rate if it's changed */ |
| if (p_priv->old_baud != p_priv->baud) { |
| p_priv->old_baud = p_priv->baud; |
| msg.setClocking = 0xff; |
| if (d_details->calculate_baud_rate |
| (p_priv->baud, d_details->baudclk, &msg.baudHi, |
| &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { |
| dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, |
| p_priv->baud); |
| msg.baudLo = 0; |
| msg.baudHi = 125; /* Values for 9600 baud */ |
| msg.prescaler = 10; |
| } |
| msg.setPrescaler = 0xff; |
| } |
| |
| msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; |
| switch (p_priv->cflag & CSIZE) { |
| case CS5: |
| msg.lcr |= USA_DATABITS_5; |
| break; |
| case CS6: |
| msg.lcr |= USA_DATABITS_6; |
| break; |
| case CS7: |
| msg.lcr |= USA_DATABITS_7; |
| break; |
| case CS8: |
| msg.lcr |= USA_DATABITS_8; |
| break; |
| } |
| if (p_priv->cflag & PARENB) { |
| /* note USA_PARITY_NONE == 0 */ |
| msg.lcr |= (p_priv->cflag & PARODD)? |
| USA_PARITY_ODD: USA_PARITY_EVEN; |
| } |
| msg.setLcr = 0xff; |
| |
| msg.ctsFlowControl = (p_priv->flow_control == flow_cts); |
| msg.xonFlowControl = 0; |
| msg.setFlowControl = 0xff; |
| msg.forwardingLength = 16; |
| msg.xonChar = 17; |
| msg.xoffChar = 19; |
| |
| /* Opening port */ |
| if (reset_port == 1) { |
| msg._txOn = 1; |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 1; |
| msg.rxOff = 0; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0xff; |
| } |
| |
| /* Closing port */ |
| else if (reset_port == 2) { |
| msg._txOn = 0; |
| msg._txOff = 1; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 0; |
| msg.rxOff = 1; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0; |
| } |
| |
| /* Sending intermediate configs */ |
| else { |
| msg._txOn = (! p_priv->break_on); |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = (p_priv->break_on); |
| msg.rxOn = 0; |
| msg.rxOff = 0; |
| msg.rxFlush = 0; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0x0; |
| } |
| |
| /* Do handshaking outputs */ |
| msg.setTxTriState_setRts = 0xff; |
| msg.txTriState_rts = p_priv->rts_state; |
| |
| msg.setHskoa_setDtr = 0xff; |
| msg.hskoa_dtr = p_priv->dtr_state; |
| |
| p_priv->resend_cont = 0; |
| memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); |
| |
| /* send the data out the device on control endpoint */ |
| this_urb->transfer_buffer_length = sizeof(msg); |
| |
| this_urb->dev = serial->dev; |
| if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); |
| } |
| #if 0 |
| else { |
| dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __FUNCTION__ |
| outcont_urb, this_urb->transfer_buffer_length, |
| usb_pipeendpoint(this_urb->pipe)); |
| } |
| #endif |
| |
| return (0); |
| } |
| |
| static int keyspan_usa28_send_setup(struct usb_serial *serial, |
| struct usb_serial_port *port, |
| int reset_port) |
| { |
| struct keyspan_usa28_portControlMessage msg; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| struct urb *this_urb; |
| int device_port, err; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = s_priv->device_details; |
| device_port = port->number - port->serial->minor; |
| |
| /* only do something if we have a bulk out endpoint */ |
| if ((this_urb = p_priv->outcont_urb) == NULL) { |
| dbg("%s - oops no urb.", __FUNCTION__); |
| return -1; |
| } |
| |
| /* Save reset port val for resend. |
| Don't overwrite resend for open/close condition. */ |
| if ((reset_port + 1) > p_priv->resend_cont) |
| p_priv->resend_cont = reset_port + 1; |
| if (this_urb->status == -EINPROGRESS) { |
| dbg ("%s already writing", __FUNCTION__); |
| mdelay(5); |
| return(-1); |
| } |
| |
| memset(&msg, 0, sizeof (struct keyspan_usa28_portControlMessage)); |
| |
| msg.setBaudRate = 1; |
| if (d_details->calculate_baud_rate(p_priv->baud, d_details->baudclk, |
| &msg.baudHi, &msg.baudLo, NULL, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { |
| dbg("%s - Invalid baud rate requested %d.", __FUNCTION__, p_priv->baud); |
| msg.baudLo = 0xff; |
| msg.baudHi = 0xb2; /* Values for 9600 baud */ |
| } |
| |
| /* If parity is enabled, we must calculate it ourselves. */ |
| msg.parity = 0; /* XXX for now */ |
| |
| msg.ctsFlowControl = (p_priv->flow_control == flow_cts); |
| msg.xonFlowControl = 0; |
| |
| /* Do handshaking outputs, DTR is inverted relative to RTS */ |
| msg.rts = p_priv->rts_state; |
| msg.dtr = p_priv->dtr_state; |
| |
| msg.forwardingLength = 16; |
| msg.forwardMs = 10; |
| msg.breakThreshold = 45; |
| msg.xonChar = 17; |
| msg.xoffChar = 19; |
| |
| /*msg.returnStatus = 1; |
| msg.resetDataToggle = 0xff;*/ |
| /* Opening port */ |
| if (reset_port == 1) { |
| msg._txOn = 1; |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txForceXoff = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 1; |
| msg.rxOff = 0; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0xff; |
| } |
| /* Closing port */ |
| else if (reset_port == 2) { |
| msg._txOn = 0; |
| msg._txOff = 1; |
| msg.txFlush = 0; |
| msg.txForceXoff = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 0; |
| msg.rxOff = 1; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0; |
| } |
| /* Sending intermediate configs */ |
| else { |
| msg._txOn = (! p_priv->break_on); |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txForceXoff = 0; |
| msg.txBreak = (p_priv->break_on); |
| msg.rxOn = 0; |
| msg.rxOff = 0; |
| msg.rxFlush = 0; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0x0; |
| } |
| |
| p_priv->resend_cont = 0; |
| memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); |
| |
| /* send the data out the device on control endpoint */ |
| this_urb->transfer_buffer_length = sizeof(msg); |
| |
| this_urb->dev = serial->dev; |
| if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - usb_submit_urb(setup) failed", __FUNCTION__); |
| } |
| #if 0 |
| else { |
| dbg("%s - usb_submit_urb(setup) OK %d bytes", __FUNCTION__, |
| this_urb->transfer_buffer_length); |
| } |
| #endif |
| |
| return (0); |
| } |
| |
| static int keyspan_usa49_send_setup(struct usb_serial *serial, |
| struct usb_serial_port *port, |
| int reset_port) |
| { |
| struct keyspan_usa49_portControlMessage msg; |
| struct usb_ctrlrequest *dr = NULL; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| struct urb *this_urb; |
| int err, device_port; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = s_priv->device_details; |
| |
| this_urb = s_priv->glocont_urb; |
| |
| /* Work out which port within the device is being setup */ |
| device_port = port->number - port->serial->minor; |
| |
| dbg("%s - endpoint %d port %d (%d)",__FUNCTION__, usb_pipeendpoint(this_urb->pipe), port->number, device_port); |
| |
| /* Make sure we have an urb then send the message */ |
| if (this_urb == NULL) { |
| dbg("%s - oops no urb for port %d.", __FUNCTION__, port->number); |
| return -1; |
| } |
| |
| /* Save reset port val for resend. |
| Don't overwrite resend for open/close condition. */ |
| if ((reset_port + 1) > p_priv->resend_cont) |
| p_priv->resend_cont = reset_port + 1; |
| |
| if (this_urb->status == -EINPROGRESS) { |
| /* dbg ("%s - already writing", __FUNCTION__); */ |
| mdelay(5); |
| return(-1); |
| } |
| |
| memset(&msg, 0, sizeof (struct keyspan_usa49_portControlMessage)); |
| |
| /*msg.portNumber = port->number;*/ |
| msg.portNumber = device_port; |
| |
| /* Only set baud rate if it's changed */ |
| if (p_priv->old_baud != p_priv->baud) { |
| p_priv->old_baud = p_priv->baud; |
| msg.setClocking = 0xff; |
| if (d_details->calculate_baud_rate |
| (p_priv->baud, d_details->baudclk, &msg.baudHi, |
| &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { |
| dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, |
| p_priv->baud); |
| msg.baudLo = 0; |
| msg.baudHi = 125; /* Values for 9600 baud */ |
| msg.prescaler = 10; |
| } |
| //msg.setPrescaler = 0xff; |
| } |
| |
| msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; |
| switch (p_priv->cflag & CSIZE) { |
| case CS5: |
| msg.lcr |= USA_DATABITS_5; |
| break; |
| case CS6: |
| msg.lcr |= USA_DATABITS_6; |
| break; |
| case CS7: |
| msg.lcr |= USA_DATABITS_7; |
| break; |
| case CS8: |
| msg.lcr |= USA_DATABITS_8; |
| break; |
| } |
| if (p_priv->cflag & PARENB) { |
| /* note USA_PARITY_NONE == 0 */ |
| msg.lcr |= (p_priv->cflag & PARODD)? |
| USA_PARITY_ODD: USA_PARITY_EVEN; |
| } |
| msg.setLcr = 0xff; |
| |
| msg.ctsFlowControl = (p_priv->flow_control == flow_cts); |
| msg.xonFlowControl = 0; |
| msg.setFlowControl = 0xff; |
| |
| msg.forwardingLength = 16; |
| msg.xonChar = 17; |
| msg.xoffChar = 19; |
| |
| /* Opening port */ |
| if (reset_port == 1) { |
| msg._txOn = 1; |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 1; |
| msg.rxOff = 0; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0xff; |
| msg.enablePort = 1; |
| msg.disablePort = 0; |
| } |
| /* Closing port */ |
| else if (reset_port == 2) { |
| msg._txOn = 0; |
| msg._txOff = 1; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 0; |
| msg.rxOff = 1; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0; |
| msg.enablePort = 0; |
| msg.disablePort = 1; |
| } |
| /* Sending intermediate configs */ |
| else { |
| msg._txOn = (! p_priv->break_on); |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = (p_priv->break_on); |
| msg.rxOn = 0; |
| msg.rxOff = 0; |
| msg.rxFlush = 0; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0x0; |
| msg.enablePort = 0; |
| msg.disablePort = 0; |
| } |
| |
| /* Do handshaking outputs */ |
| msg.setRts = 0xff; |
| msg.rts = p_priv->rts_state; |
| |
| msg.setDtr = 0xff; |
| msg.dtr = p_priv->dtr_state; |
| |
| p_priv->resend_cont = 0; |
| |
| /* if the device is a 49wg, we send control message on usb control EP 0 */ |
| |
| if (d_details->product_id == keyspan_usa49wg_product_id) { |
| dr = (void *)(s_priv->ctrl_buf); |
| dr->bRequestType = USB_TYPE_VENDOR | USB_DIR_OUT; |
| dr->bRequest = 0xB0; /* 49wg control message */; |
| dr->wValue = 0; |
| dr->wIndex = 0; |
| dr->wLength = cpu_to_le16(sizeof(msg)); |
| |
| memcpy (s_priv->glocont_buf, &msg, sizeof(msg)); |
| |
| usb_fill_control_urb(this_urb, serial->dev, usb_sndctrlpipe(serial->dev, 0), |
| (unsigned char *)dr, s_priv->glocont_buf, sizeof(msg), |
| usa49_glocont_callback, serial); |
| |
| } else { |
| memcpy(this_urb->transfer_buffer, &msg, sizeof(msg)); |
| |
| /* send the data out the device on control endpoint */ |
| this_urb->transfer_buffer_length = sizeof(msg); |
| |
| this_urb->dev = serial->dev; |
| } |
| if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); |
| } |
| #if 0 |
| else { |
| dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __FUNCTION__, |
| outcont_urb, this_urb->transfer_buffer_length, |
| usb_pipeendpoint(this_urb->pipe)); |
| } |
| #endif |
| |
| return (0); |
| } |
| |
| static int keyspan_usa90_send_setup(struct usb_serial *serial, |
| struct usb_serial_port *port, |
| int reset_port) |
| { |
| struct keyspan_usa90_portControlMessage msg; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| struct urb *this_urb; |
| int err; |
| u8 prescaler; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = s_priv->device_details; |
| |
| /* only do something if we have a bulk out endpoint */ |
| if ((this_urb = p_priv->outcont_urb) == NULL) { |
| dbg("%s - oops no urb.", __FUNCTION__); |
| return -1; |
| } |
| |
| /* Save reset port val for resend. |
| Don't overwrite resend for open/close condition. */ |
| if ((reset_port + 1) > p_priv->resend_cont) |
| p_priv->resend_cont = reset_port + 1; |
| if (this_urb->status == -EINPROGRESS) { |
| dbg ("%s already writing", __FUNCTION__); |
| mdelay(5); |
| return(-1); |
| } |
| |
| memset(&msg, 0, sizeof (struct keyspan_usa90_portControlMessage)); |
| |
| /* Only set baud rate if it's changed */ |
| if (p_priv->old_baud != p_priv->baud) { |
| p_priv->old_baud = p_priv->baud; |
| msg.setClocking = 0x01; |
| if (d_details->calculate_baud_rate |
| (p_priv->baud, d_details->baudclk, &msg.baudHi, |
| &msg.baudLo, &prescaler, 0) == KEYSPAN_INVALID_BAUD_RATE ) { |
| dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, |
| p_priv->baud); |
| p_priv->baud = 9600; |
| d_details->calculate_baud_rate (p_priv->baud, d_details->baudclk, |
| &msg.baudHi, &msg.baudLo, &prescaler, 0); |
| } |
| msg.setRxMode = 1; |
| msg.setTxMode = 1; |
| } |
| |
| /* modes must always be correctly specified */ |
| if (p_priv->baud > 57600) |
| { |
| msg.rxMode = RXMODE_DMA; |
| msg.txMode = TXMODE_DMA; |
| } |
| else |
| { |
| msg.rxMode = RXMODE_BYHAND; |
| msg.txMode = TXMODE_BYHAND; |
| } |
| |
| msg.lcr = (p_priv->cflag & CSTOPB)? STOPBITS_678_2: STOPBITS_5678_1; |
| switch (p_priv->cflag & CSIZE) { |
| case CS5: |
| msg.lcr |= USA_DATABITS_5; |
| break; |
| case CS6: |
| msg.lcr |= USA_DATABITS_6; |
| break; |
| case CS7: |
| msg.lcr |= USA_DATABITS_7; |
| break; |
| case CS8: |
| msg.lcr |= USA_DATABITS_8; |
| break; |
| } |
| if (p_priv->cflag & PARENB) { |
| /* note USA_PARITY_NONE == 0 */ |
| msg.lcr |= (p_priv->cflag & PARODD)? |
| USA_PARITY_ODD: USA_PARITY_EVEN; |
| } |
| if (p_priv->old_cflag != p_priv->cflag) { |
| p_priv->old_cflag = p_priv->cflag; |
| msg.setLcr = 0x01; |
| } |
| |
| if (p_priv->flow_control == flow_cts) |
| msg.txFlowControl = TXFLOW_CTS; |
| msg.setTxFlowControl = 0x01; |
| msg.setRxFlowControl = 0x01; |
| |
| msg.rxForwardingLength = 16; |
| msg.rxForwardingTimeout = 16; |
| msg.txAckSetting = 0; |
| msg.xonChar = 17; |
| msg.xoffChar = 19; |
| |
| /* Opening port */ |
| if (reset_port == 1) { |
| msg.portEnabled = 1; |
| msg.rxFlush = 1; |
| msg.txBreak = (p_priv->break_on); |
| } |
| /* Closing port */ |
| else if (reset_port == 2) { |
| msg.portEnabled = 0; |
| } |
| /* Sending intermediate configs */ |
| else { |
| if (port->open_count) |
| msg.portEnabled = 1; |
| msg.txBreak = (p_priv->break_on); |
| } |
| |
| /* Do handshaking outputs */ |
| msg.setRts = 0x01; |
| msg.rts = p_priv->rts_state; |
| |
| msg.setDtr = 0x01; |
| msg.dtr = p_priv->dtr_state; |
| |
| p_priv->resend_cont = 0; |
| memcpy (this_urb->transfer_buffer, &msg, sizeof(msg)); |
| |
| /* send the data out the device on control endpoint */ |
| this_urb->transfer_buffer_length = sizeof(msg); |
| |
| this_urb->dev = serial->dev; |
| if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) { |
| dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, err); |
| } |
| return (0); |
| } |
| |
| static int keyspan_usa67_send_setup(struct usb_serial *serial, |
| struct usb_serial_port *port, |
| int reset_port) |
| { |
| struct keyspan_usa67_portControlMessage msg; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| struct urb *this_urb; |
| int err, device_port; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| p_priv = usb_get_serial_port_data(port); |
| d_details = s_priv->device_details; |
| |
| this_urb = s_priv->glocont_urb; |
| |
| /* Work out which port within the device is being setup */ |
| device_port = port->number - port->serial->minor; |
| |
| /* Make sure we have an urb then send the message */ |
| if (this_urb == NULL) { |
| dbg("%s - oops no urb for port %d.", __FUNCTION__, |
| port->number); |
| return -1; |
| } |
| |
| /* Save reset port val for resend. |
| Don't overwrite resend for open/close condition. */ |
| if ((reset_port + 1) > p_priv->resend_cont) |
| p_priv->resend_cont = reset_port + 1; |
| if (this_urb->status == -EINPROGRESS) { |
| /* dbg ("%s - already writing", __FUNCTION__); */ |
| mdelay(5); |
| return(-1); |
| } |
| |
| memset(&msg, 0, sizeof(struct keyspan_usa67_portControlMessage)); |
| |
| msg.port = device_port; |
| |
| /* Only set baud rate if it's changed */ |
| if (p_priv->old_baud != p_priv->baud) { |
| p_priv->old_baud = p_priv->baud; |
| msg.setClocking = 0xff; |
| if (d_details->calculate_baud_rate |
| (p_priv->baud, d_details->baudclk, &msg.baudHi, |
| &msg.baudLo, &msg.prescaler, device_port) == KEYSPAN_INVALID_BAUD_RATE ) { |
| dbg("%s - Invalid baud rate %d requested, using 9600.", __FUNCTION__, |
| p_priv->baud); |
| msg.baudLo = 0; |
| msg.baudHi = 125; /* Values for 9600 baud */ |
| msg.prescaler = 10; |
| } |
| msg.setPrescaler = 0xff; |
| } |
| |
| msg.lcr = (p_priv->cflag & CSTOPB) ? STOPBITS_678_2 : STOPBITS_5678_1; |
| switch (p_priv->cflag & CSIZE) { |
| case CS5: |
| msg.lcr |= USA_DATABITS_5; |
| break; |
| case CS6: |
| msg.lcr |= USA_DATABITS_6; |
| break; |
| case CS7: |
| msg.lcr |= USA_DATABITS_7; |
| break; |
| case CS8: |
| msg.lcr |= USA_DATABITS_8; |
| break; |
| } |
| if (p_priv->cflag & PARENB) { |
| /* note USA_PARITY_NONE == 0 */ |
| msg.lcr |= (p_priv->cflag & PARODD)? |
| USA_PARITY_ODD: USA_PARITY_EVEN; |
| } |
| msg.setLcr = 0xff; |
| |
| msg.ctsFlowControl = (p_priv->flow_control == flow_cts); |
| msg.xonFlowControl = 0; |
| msg.setFlowControl = 0xff; |
| msg.forwardingLength = 16; |
| msg.xonChar = 17; |
| msg.xoffChar = 19; |
| |
| if (reset_port == 1) { |
| /* Opening port */ |
| msg._txOn = 1; |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 1; |
| msg.rxOff = 0; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0xff; |
| } else if (reset_port == 2) { |
| /* Closing port */ |
| msg._txOn = 0; |
| msg._txOff = 1; |
| msg.txFlush = 0; |
| msg.txBreak = 0; |
| msg.rxOn = 0; |
| msg.rxOff = 1; |
| msg.rxFlush = 1; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0; |
| } else { |
| /* Sending intermediate configs */ |
| msg._txOn = (! p_priv->break_on); |
| msg._txOff = 0; |
| msg.txFlush = 0; |
| msg.txBreak = (p_priv->break_on); |
| msg.rxOn = 0; |
| msg.rxOff = 0; |
| msg.rxFlush = 0; |
| msg.rxForward = 0; |
| msg.returnStatus = 0; |
| msg.resetDataToggle = 0x0; |
| } |
| |
| /* Do handshaking outputs */ |
| msg.setTxTriState_setRts = 0xff; |
| msg.txTriState_rts = p_priv->rts_state; |
| |
| msg.setHskoa_setDtr = 0xff; |
| msg.hskoa_dtr = p_priv->dtr_state; |
| |
| p_priv->resend_cont = 0; |
| |
| memcpy(this_urb->transfer_buffer, &msg, sizeof(msg)); |
| |
| /* send the data out the device on control endpoint */ |
| this_urb->transfer_buffer_length = sizeof(msg); |
| this_urb->dev = serial->dev; |
| |
| err = usb_submit_urb(this_urb, GFP_ATOMIC); |
| if (err != 0) |
| dbg("%s - usb_submit_urb(setup) failed (%d)", __FUNCTION__, |
| err); |
| return (0); |
| } |
| |
| static void keyspan_send_setup(struct usb_serial_port *port, int reset_port) |
| { |
| struct usb_serial *serial = port->serial; |
| struct keyspan_serial_private *s_priv; |
| const struct keyspan_device_details *d_details; |
| |
| dbg ("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| d_details = s_priv->device_details; |
| |
| switch (d_details->msg_format) { |
| case msg_usa26: |
| keyspan_usa26_send_setup(serial, port, reset_port); |
| break; |
| case msg_usa28: |
| keyspan_usa28_send_setup(serial, port, reset_port); |
| break; |
| case msg_usa49: |
| keyspan_usa49_send_setup(serial, port, reset_port); |
| break; |
| case msg_usa90: |
| keyspan_usa90_send_setup(serial, port, reset_port); |
| break; |
| case msg_usa67: |
| keyspan_usa67_send_setup(serial, port, reset_port); |
| break; |
| } |
| } |
| |
| |
| /* Gets called by the "real" driver (ie once firmware is loaded |
| and renumeration has taken place. */ |
| static int keyspan_startup (struct usb_serial *serial) |
| { |
| int i, err; |
| struct usb_serial_port *port; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| const struct keyspan_device_details *d_details; |
| |
| dbg("%s", __FUNCTION__); |
| |
| for (i = 0; (d_details = keyspan_devices[i]) != NULL; ++i) |
| if (d_details->product_id == le16_to_cpu(serial->dev->descriptor.idProduct)) |
| break; |
| if (d_details == NULL) { |
| dev_err(&serial->dev->dev, "%s - unknown product id %x\n", __FUNCTION__, le16_to_cpu(serial->dev->descriptor.idProduct)); |
| return 1; |
| } |
| |
| /* Setup private data for serial driver */ |
| s_priv = kzalloc(sizeof(struct keyspan_serial_private), GFP_KERNEL); |
| if (!s_priv) { |
| dbg("%s - kmalloc for keyspan_serial_private failed.", __FUNCTION__); |
| return -ENOMEM; |
| } |
| |
| s_priv->device_details = d_details; |
| usb_set_serial_data(serial, s_priv); |
| |
| /* Now setup per port private data */ |
| for (i = 0; i < serial->num_ports; i++) { |
| port = serial->port[i]; |
| p_priv = kzalloc(sizeof(struct keyspan_port_private), GFP_KERNEL); |
| if (!p_priv) { |
| dbg("%s - kmalloc for keyspan_port_private (%d) failed!.", __FUNCTION__, i); |
| return (1); |
| } |
| p_priv->device_details = d_details; |
| usb_set_serial_port_data(port, p_priv); |
| } |
| |
| keyspan_setup_urbs(serial); |
| |
| if (s_priv->instat_urb != NULL) { |
| s_priv->instat_urb->dev = serial->dev; |
| err = usb_submit_urb(s_priv->instat_urb, GFP_KERNEL); |
| if (err != 0) |
| dbg("%s - submit instat urb failed %d", __FUNCTION__, |
| err); |
| } |
| if (s_priv->indat_urb != NULL) { |
| s_priv->indat_urb->dev = serial->dev; |
| err = usb_submit_urb(s_priv->indat_urb, GFP_KERNEL); |
| if (err != 0) |
| dbg("%s - submit indat urb failed %d", __FUNCTION__, |
| err); |
| } |
| |
| return (0); |
| } |
| |
| static void keyspan_shutdown (struct usb_serial *serial) |
| { |
| int i, j; |
| struct usb_serial_port *port; |
| struct keyspan_serial_private *s_priv; |
| struct keyspan_port_private *p_priv; |
| |
| dbg("%s", __FUNCTION__); |
| |
| s_priv = usb_get_serial_data(serial); |
| |
| /* Stop reading/writing urbs */ |
| stop_urb(s_priv->instat_urb); |
| stop_urb(s_priv->glocont_urb); |
| stop_urb(s_priv->indat_urb); |
| for (i = 0; i < serial->num_ports; ++i) { |
| port = serial->port[i]; |
| p_priv = usb_get_serial_port_data(port); |
| stop_urb(p_priv->inack_urb); |
| stop_urb(p_priv->outcont_urb); |
| for (j = 0; j < 2; j++) { |
| stop_urb(p_priv->in_urbs[j]); |
| stop_urb(p_priv->out_urbs[j]); |
| } |
| } |
| |
| /* Now free them */ |
| usb_free_urb(s_priv->instat_urb); |
| usb_free_urb(s_priv->indat_urb); |
| usb_free_urb(s_priv->glocont_urb); |
| for (i = 0; i < serial->num_ports; ++i) { |
| port = serial->port[i]; |
| p_priv = usb_get_serial_port_data(port); |
| usb_free_urb(p_priv->inack_urb); |
| usb_free_urb(p_priv->outcont_urb); |
| for (j = 0; j < 2; j++) { |
| usb_free_urb(p_priv->in_urbs[j]); |
| usb_free_urb(p_priv->out_urbs[j]); |
| } |
| } |
| |
| /* dbg("Freeing serial->private."); */ |
| kfree(s_priv); |
| |
| /* dbg("Freeing port->private."); */ |
| /* Now free per port private data */ |
| for (i = 0; i < serial->num_ports; i++) { |
| port = serial->port[i]; |
| kfree(usb_get_serial_port_data(port)); |
| } |
| } |
| |
| MODULE_AUTHOR( DRIVER_AUTHOR ); |
| MODULE_DESCRIPTION( DRIVER_DESC ); |
| MODULE_LICENSE("GPL"); |
| |
| module_param(debug, bool, S_IRUGO | S_IWUSR); |
| MODULE_PARM_DESC(debug, "Debug enabled or not"); |
| |