|  | /* | 
|  | 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 <linux/firmware.h> | 
|  | #include <linux/ihex.h> | 
|  | #include <linux/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; | 
|  |  | 
|  | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" | 
|  | DRIVER_DESC "\n"); | 
|  |  | 
|  | 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_break_ctl(struct tty_struct *tty, int break_state) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct keyspan_port_private 	*p_priv; | 
|  |  | 
|  | dbg("%s", __func__); | 
|  |  | 
|  | 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 tty_struct *tty, | 
|  | 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; | 
|  |  | 
|  | dbg("%s", __func__); | 
|  |  | 
|  | 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 tty_struct *tty, struct file *file) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct keyspan_port_private *p_priv = usb_get_serial_port_data(port); | 
|  | unsigned int			value; | 
|  |  | 
|  | 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 tty_struct *tty, struct file *file, | 
|  | unsigned int set, unsigned int clear) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct keyspan_port_private *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; | 
|  | } | 
|  |  | 
|  | /* Write function is similar for the four protocols used | 
|  | with only a minor change for usa90 (usa19hs) required */ | 
|  | static int keyspan_write(struct tty_struct *tty, | 
|  | 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", | 
|  | __func__, 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... */ | 
|  | this_urb = p_priv->out_urbs[flip]; | 
|  | if (this_urb == NULL) { | 
|  | /* no bulk out, so return 0 bytes written */ | 
|  | dbg("%s - no output urb :(", __func__); | 
|  | return count; | 
|  | } | 
|  |  | 
|  | dbg("%s - endpoint %d flip %d", | 
|  | __func__, 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; | 
|  | err = usb_submit_urb(this_urb, GFP_ATOMIC); | 
|  | if (err != 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", __func__); | 
|  |  | 
|  | endpoint = usb_pipeendpoint(urb->pipe); | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x on endpoint %d.", | 
|  | __func__, status, endpoint); | 
|  | return; | 
|  | } | 
|  |  | 
|  | port =  urb->context; | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | if (tty && 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!!!!", __func__); | 
|  | 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); | 
|  | } | 
|  | tty_kref_put(tty); | 
|  |  | 
|  | /* Resubmit urb so we continue receiving */ | 
|  | urb->dev = port->serial->dev; | 
|  | if (port->port.count) { | 
|  | err = usb_submit_urb(urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - resubmit read urb failed. (%d)", | 
|  | __func__, 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 =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  | dbg("%s - urb %d", __func__, urb == p_priv->out_urbs[1]); | 
|  |  | 
|  | if (port->port.count) | 
|  | usb_serial_port_softint(port); | 
|  | } | 
|  |  | 
|  | static void	usa26_inack_callback(struct urb *urb) | 
|  | { | 
|  | dbg("%s", __func__); | 
|  |  | 
|  | } | 
|  |  | 
|  | static void	usa26_outcont_callback(struct urb *urb) | 
|  | { | 
|  | struct usb_serial_port *port; | 
|  | struct keyspan_port_private *p_priv; | 
|  |  | 
|  | port =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  |  | 
|  | if (p_priv->resend_cont) { | 
|  | dbg("%s - sending setup", __func__); | 
|  | 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; | 
|  | struct tty_struct			*tty; | 
|  | int old_dcd_state, err; | 
|  | int status = urb->status; | 
|  |  | 
|  | serial =  urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, status); | 
|  | return; | 
|  | } | 
|  | if (urb->actual_length != 9) { | 
|  | dbg("%s - %d byte report??", __func__, 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", | 
|  | __func__, 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", __func__, 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 (old_dcd_state != p_priv->dcd_state) { | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | if (tty && !C_CLOCAL(tty)) | 
|  | tty_hangup(tty); | 
|  | tty_kref_put(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)", __func__, err); | 
|  | exit: ; | 
|  | } | 
|  |  | 
|  | static void	usa26_glocont_callback(struct urb *urb) | 
|  | { | 
|  | dbg("%s", __func__); | 
|  | } | 
|  |  | 
|  |  | 
|  | static void usa28_indat_callback(struct urb *urb) | 
|  | { | 
|  | int                     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", __func__); | 
|  |  | 
|  | 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.", | 
|  | __func__, status, usb_pipeendpoint(urb->pipe)); | 
|  | return; | 
|  | } | 
|  |  | 
|  | port =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  | data = urb->transfer_buffer; | 
|  |  | 
|  | tty =tty_port_tty_get(&port->port); | 
|  | if (tty && urb->actual_length) { | 
|  | tty_insert_flip_string(tty, data, urb->actual_length); | 
|  | tty_flip_buffer_push(tty); | 
|  | } | 
|  | tty_kref_put(tty); | 
|  |  | 
|  | /* Resubmit urb so we continue receiving */ | 
|  | urb->dev = port->serial->dev; | 
|  | if (port->port.count) { | 
|  | err = usb_submit_urb(urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - resubmit read urb failed. (%d)", | 
|  | __func__, 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", __func__); | 
|  | } | 
|  |  | 
|  | static void	usa28_outcont_callback(struct urb *urb) | 
|  | { | 
|  | struct usb_serial_port *port; | 
|  | struct keyspan_port_private *p_priv; | 
|  |  | 
|  | port =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  |  | 
|  | if (p_priv->resend_cont) { | 
|  | dbg("%s - sending setup", __func__); | 
|  | 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; | 
|  | struct tty_struct			*tty; | 
|  | int old_dcd_state; | 
|  | int status = urb->status; | 
|  |  | 
|  | serial =  urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, status); | 
|  | return; | 
|  | } | 
|  |  | 
|  | if (urb->actual_length != sizeof(struct keyspan_usa28_portStatusMessage)) { | 
|  | dbg("%s - bad length %d", __func__, urb->actual_length); | 
|  | goto exit; | 
|  | } | 
|  |  | 
|  | /*dbg("%s %x %x %x %x %x %x %x %x %x %x %x %x", __func__ | 
|  | 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", __func__, 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( old_dcd_state != p_priv->dcd_state && old_dcd_state) { | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | if (tty && !C_CLOCAL(tty)) | 
|  | tty_hangup(tty); | 
|  | tty_kref_put(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)", __func__, err); | 
|  | exit: ; | 
|  | } | 
|  |  | 
|  | static void	usa28_glocont_callback(struct urb *urb) | 
|  | { | 
|  | dbg("%s", __func__); | 
|  | } | 
|  |  | 
|  |  | 
|  | 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", __func__); | 
|  |  | 
|  | 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", __func__); | 
|  | 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", __func__); | 
|  |  | 
|  | serial =  urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, status); | 
|  | return; | 
|  | } | 
|  |  | 
|  | if (urb->actual_length != | 
|  | sizeof(struct keyspan_usa49_portStatusMessage)) { | 
|  | dbg("%s - bad length %d", __func__, urb->actual_length); | 
|  | goto exit; | 
|  | } | 
|  |  | 
|  | /*dbg(" %x %x %x %x %x %x %x %x %x %x %x", __func__, | 
|  | 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", | 
|  | __func__, 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 (old_dcd_state != p_priv->dcd_state && old_dcd_state) { | 
|  | struct tty_struct *tty = tty_port_tty_get(&port->port); | 
|  | if (tty && !C_CLOCAL(tty)) | 
|  | tty_hangup(tty); | 
|  | tty_kref_put(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)", __func__, err); | 
|  | exit:	; | 
|  | } | 
|  |  | 
|  | static void	usa49_inack_callback(struct urb *urb) | 
|  | { | 
|  | dbg("%s", __func__); | 
|  | } | 
|  |  | 
|  | 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", __func__); | 
|  |  | 
|  | endpoint = usb_pipeendpoint(urb->pipe); | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x on endpoint %d.", __func__, | 
|  | status, endpoint); | 
|  | return; | 
|  | } | 
|  |  | 
|  | port =  urb->context; | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | if (tty && urb->actual_length) { | 
|  | /* 0x80 bit is error flag */ | 
|  | if ((data[0] & 0x80) == 0) { | 
|  | /* no error on any byte */ | 
|  | tty_insert_flip_string(tty, data + 1, | 
|  | urb->actual_length - 1); | 
|  | } 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); | 
|  | } | 
|  | tty_kref_put(tty); | 
|  |  | 
|  | /* Resubmit urb so we continue receiving */ | 
|  | urb->dev = port->serial->dev; | 
|  | if (port->port.count) { | 
|  | err = usb_submit_urb(urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - resubmit read urb failed. (%d)", | 
|  | __func__, 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", __func__); | 
|  |  | 
|  | serial = urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, 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", | 
|  | __func__, data[i]); | 
|  | return; | 
|  | } | 
|  | port = serial->port[data[i++]]; | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | 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->port.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->port.count) | 
|  | tty_insert_flip_char(tty, | 
|  | data[i+1], flag); | 
|  | i += 2; | 
|  | } | 
|  | } | 
|  | if (port->port.count) | 
|  | tty_flip_buffer_push(tty); | 
|  | tty_kref_put(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)", __func__, err); | 
|  | } | 
|  |  | 
|  | /* not used, usa-49 doesn't have per-port control endpoints */ | 
|  | static void usa49_outcont_callback(struct urb *urb) | 
|  | { | 
|  | dbg("%s", __func__); | 
|  | } | 
|  |  | 
|  | 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", __func__); | 
|  |  | 
|  | endpoint = usb_pipeendpoint(urb->pipe); | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x on endpoint %d.", | 
|  | __func__, status, endpoint); | 
|  | return; | 
|  | } | 
|  |  | 
|  | port =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  |  | 
|  | if (urb->actual_length) { | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | /* if current mode is DMA, looks like usa28 format | 
|  | otherwise looks like usa26 data format */ | 
|  |  | 
|  | if (p_priv->baud > 57600) | 
|  | tty_insert_flip_string(tty, data, urb->actual_length); | 
|  | 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!!!!", __func__); | 
|  | 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); | 
|  | tty_kref_put(tty); | 
|  | } | 
|  |  | 
|  | /* Resubmit urb so we continue receiving */ | 
|  | urb->dev = port->serial->dev; | 
|  | if (port->port.count) { | 
|  | err = usb_submit_urb(urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - resubmit read urb failed. (%d)", | 
|  | __func__, 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; | 
|  | struct tty_struct			*tty; | 
|  | int old_dcd_state, err; | 
|  | int status = urb->status; | 
|  |  | 
|  | serial =  urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, status); | 
|  | return; | 
|  | } | 
|  | if (urb->actual_length < 14) { | 
|  | dbg("%s - %d byte report??", __func__, 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 (old_dcd_state != p_priv->dcd_state && old_dcd_state) { | 
|  | tty = tty_port_tty_get(&port->port); | 
|  | if (tty && !C_CLOCAL(tty)) | 
|  | tty_hangup(tty); | 
|  | tty_kref_put(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)", __func__, err); | 
|  | exit: | 
|  | ; | 
|  | } | 
|  |  | 
|  | static void	usa90_outcont_callback(struct urb *urb) | 
|  | { | 
|  | struct usb_serial_port *port; | 
|  | struct keyspan_port_private *p_priv; | 
|  |  | 
|  | port =  urb->context; | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  |  | 
|  | if (p_priv->resend_cont) { | 
|  | dbg("%s - sending setup", __func__); | 
|  | 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", __func__); | 
|  |  | 
|  | serial = urb->context; | 
|  |  | 
|  | if (status) { | 
|  | dbg("%s - nonzero status: %x", __func__, status); | 
|  | return; | 
|  | } | 
|  |  | 
|  | if (urb->actual_length != | 
|  | sizeof(struct keyspan_usa67_portStatusMessage)) { | 
|  | dbg("%s - bad length %d", __func__, 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", __func__, 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 (old_dcd_state != p_priv->dcd_state && old_dcd_state) { | 
|  | struct tty_struct *tty = tty_port_tty_get(&port->port); | 
|  | if (tty && !C_CLOCAL(tty)) | 
|  | tty_hangup(tty); | 
|  | tty_kref_put(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)", __func__, 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", __func__); | 
|  |  | 
|  | 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", __func__); | 
|  | keyspan_usa67_send_setup(serial, port, | 
|  | p_priv->resend_cont - 1); | 
|  | break; | 
|  | } | 
|  | } | 
|  | } | 
|  |  | 
|  | static int keyspan_write_room(struct tty_struct *tty) | 
|  | { | 
|  | struct usb_serial_port *port = tty->driver_data; | 
|  | struct keyspan_port_private	*p_priv; | 
|  | const struct keyspan_device_details	*d_details; | 
|  | int				flip; | 
|  | int				data_len; | 
|  | struct urb			*this_urb; | 
|  |  | 
|  | dbg("%s", __func__); | 
|  | p_priv = usb_get_serial_port_data(port); | 
|  | d_details = p_priv->device_details; | 
|  |  | 
|  | /* FIXME: locking */ | 
|  | 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. */ | 
|  | this_urb = p_priv->out_urbs[flip]; | 
|  | if (this_urb != NULL) { | 
|  | if (this_urb->status != -EINPROGRESS) | 
|  | return data_len; | 
|  | flip = (flip + 1) & d_details->outdat_endp_flip; | 
|  | this_urb = p_priv->out_urbs[flip]; | 
|  | if (this_urb != NULL) { | 
|  | if (this_urb->status != -EINPROGRESS) | 
|  | return data_len; | 
|  | } | 
|  | } | 
|  | return 0; | 
|  | } | 
|  |  | 
|  |  | 
|  | static int keyspan_open(struct tty_struct *tty, | 
|  | 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 = 0; | 
|  |  | 
|  | 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.", __func__, 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++) { | 
|  | urb = p_priv->in_urbs[i]; | 
|  | if (urb == NULL) | 
|  | continue; | 
|  | urb->dev = serial->dev; | 
|  |  | 
|  | /* make sure endpoint data toggle is synchronized | 
|  | with the device */ | 
|  | usb_clear_halt(urb->dev, urb->pipe); | 
|  | err = usb_submit_urb(urb, GFP_KERNEL); | 
|  | if (err != 0) | 
|  | dbg("%s - submit urb %d failed (%d)", | 
|  | __func__, i, err); | 
|  | } | 
|  |  | 
|  | /* Reset low level data toggle on out endpoints */ | 
|  | for (i = 0; i < 2; i++) { | 
|  | urb = p_priv->out_urbs[i]; | 
|  | if (urb == 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 */ | 
|  |  | 
|  | device_port = port->number - port->serial->minor; | 
|  | if (tty) { | 
|  | cflag = tty->termios->c_cflag; | 
|  | /* 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, 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 tty_struct *tty, | 
|  | 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", __func__); | 
|  | 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", __func__); | 
|  | }*/ | 
|  |  | 
|  | 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]); | 
|  | } | 
|  | } | 
|  | tty_port_tty_set(&port->port, NULL); | 
|  | } | 
|  |  | 
|  | /* download the firmware to a pre-renumeration device */ | 
|  | static int keyspan_fake_startup(struct usb_serial *serial) | 
|  | { | 
|  | int 				response; | 
|  | const struct ihex_binrec 	*record; | 
|  | char				*fw_name; | 
|  | const struct firmware		*fw; | 
|  |  | 
|  | 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: | 
|  | fw_name = "keyspan/usa28.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa28x_pre_product_id: | 
|  | fw_name = "keyspan/usa28x.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa28xa_pre_product_id: | 
|  | fw_name = "keyspan/usa28xa.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa28xb_pre_product_id: | 
|  | fw_name = "keyspan/usa28xb.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa19_pre_product_id: | 
|  | fw_name = "keyspan/usa19.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa19qi_pre_product_id: | 
|  | fw_name = "keyspan/usa19qi.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_mpr_pre_product_id: | 
|  | fw_name = "keyspan/mpr.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa19qw_pre_product_id: | 
|  | fw_name = "keyspan/usa19qw.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa18x_pre_product_id: | 
|  | fw_name = "keyspan/usa18x.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa19w_pre_product_id: | 
|  | fw_name = "keyspan/usa19w.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa49w_pre_product_id: | 
|  | fw_name = "keyspan/usa49w.fw"; | 
|  | break; | 
|  |  | 
|  | case keyspan_usa49wlc_pre_product_id: | 
|  | fw_name = "keyspan/usa49wlc.fw"; | 
|  | break; | 
|  |  | 
|  | default: | 
|  | dev_err(&serial->dev->dev, "Unknown product ID (%04x)\n", | 
|  | le16_to_cpu(serial->dev->descriptor.idProduct)); | 
|  | return 1; | 
|  | } | 
|  |  | 
|  | if (request_ihex_firmware(&fw, fw_name, &serial->dev->dev)) { | 
|  | 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); | 
|  |  | 
|  | record = (const struct ihex_binrec *)fw->data; | 
|  |  | 
|  | while (record) { | 
|  | response = ezusb_writememory(serial, be32_to_cpu(record->addr), | 
|  | (unsigned char *)record->data, | 
|  | be16_to_cpu(record->len), 0xa0); | 
|  | if (response < 0) { | 
|  | dev_err(&serial->dev->dev, "ezusb_writememory failed for Keyspan firmware (%d %04X %p %d)\n", | 
|  | response, be32_to_cpu(record->addr), | 
|  | record->data, be16_to_cpu(record->len)); | 
|  | break; | 
|  | } | 
|  | record = ihex_next_binrec(record); | 
|  | } | 
|  | release_firmware(fw); | 
|  | /* 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.", __func__, endpoint); | 
|  | urb = usb_alloc_urb(0, GFP_KERNEL);		/* No ISO */ | 
|  | if (urb == NULL) { | 
|  | dbg("%s - alloc for endpoint %d failed.", __func__, 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", | 
|  | usb_endpoint_type(ep_desc)); | 
|  | 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", __func__); | 
|  |  | 
|  | 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.", __func__, baud_rate); | 
|  |  | 
|  | /* prevent divide by zero...  */ | 
|  | b16 = baud_rate * 16L; | 
|  | if (b16 == 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) */ | 
|  | div = baudclk / b16; | 
|  | if (div == 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.", | 
|  | __func__, 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.", __func__, baud_rate); | 
|  |  | 
|  | /* prevent divide by zero...  */ | 
|  | b16 = baud_rate * 16L; | 
|  | if (b16 == 0) | 
|  | return KEYSPAN_INVALID_BAUD_RATE; | 
|  |  | 
|  | /* calculate the divisor */ | 
|  | div = baudclk / b16; | 
|  | if (div == 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.", | 
|  | __func__, 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.", __func__, baud_rate); | 
|  |  | 
|  | /* prevent divide by zero */ | 
|  | b16 = baud_rate * 16L; | 
|  | if (b16 == 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; | 
|  |  | 
|  | div = clk / b16; | 
|  | if (div == 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", __func__, *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.", __func__, baud_rate); | 
|  |  | 
|  | /* prevent divide by zero */ | 
|  | b16 = baud_rate * 16L; | 
|  | if (b16 == 0) | 
|  | return KEYSPAN_INVALID_BAUD_RATE; | 
|  |  | 
|  | /* calculate the divisor and the counter (its inverse) */ | 
|  | div = KEYSPAN_USA28_BAUDCLK / b16; | 
|  | if (div == 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.", __func__, 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", __func__, 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", __func__, usb_pipeendpoint(this_urb->pipe)); | 
|  |  | 
|  | /* Make sure we have an urb then send the message */ | 
|  | if (this_urb == NULL) { | 
|  | dbg("%s - oops no urb.", __func__); | 
|  | 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", __func__); */ | 
|  | 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.", | 
|  | __func__, 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; | 
|  | err = usb_submit_urb(this_urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - usb_submit_urb(setup) failed (%d)", __func__, err); | 
|  | #if 0 | 
|  | else { | 
|  | dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __func__ | 
|  | 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", __func__); | 
|  |  | 
|  | 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 */ | 
|  | this_urb = p_priv->outcont_urb; | 
|  | if (this_urb == NULL) { | 
|  | dbg("%s - oops no urb.", __func__); | 
|  | 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", __func__); | 
|  | 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.", | 
|  | __func__, 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; | 
|  | err = usb_submit_urb(this_urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - usb_submit_urb(setup) failed", __func__); | 
|  | #if 0 | 
|  | else { | 
|  | dbg("%s - usb_submit_urb(setup) OK %d bytes", __func__, | 
|  | 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", __func__); | 
|  |  | 
|  | 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)", | 
|  | __func__, 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.", __func__, 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", __func__); */ | 
|  | 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.", | 
|  | __func__, 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; | 
|  | } | 
|  | err = usb_submit_urb(this_urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - usb_submit_urb(setup) failed (%d)", __func__, err); | 
|  | #if 0 | 
|  | else { | 
|  | dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __func__, | 
|  | 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", __func__); | 
|  |  | 
|  | 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 */ | 
|  | this_urb = p_priv->outcont_urb; | 
|  | if (this_urb == NULL) { | 
|  | dbg("%s - oops no urb.", __func__); | 
|  | 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", __func__); | 
|  | 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.", | 
|  | __func__, 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->port.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; | 
|  | err = usb_submit_urb(this_urb, GFP_ATOMIC); | 
|  | if (err != 0) | 
|  | dbg("%s - usb_submit_urb(setup) failed (%d)", __func__, 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", __func__); | 
|  |  | 
|  | 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.", __func__, | 
|  | 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", __func__); */ | 
|  | 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.", | 
|  | __func__, 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)", __func__, | 
|  | 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", __func__); | 
|  |  | 
|  | 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", __func__); | 
|  |  | 
|  | 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", | 
|  | __func__, 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.", | 
|  | __func__); | 
|  | 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!.", __func__, 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", __func__, | 
|  | 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", __func__, | 
|  | 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", __func__); | 
|  |  | 
|  | 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_FIRMWARE("keyspan/usa28.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa28x.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa28xa.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa28xb.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa19.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa19qi.fw"); | 
|  | MODULE_FIRMWARE("keyspan/mpr.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa19qw.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa18x.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa19w.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa49w.fw"); | 
|  | MODULE_FIRMWARE("keyspan/usa49wlc.fw"); | 
|  |  | 
|  | module_param(debug, bool, S_IRUGO | S_IWUSR); | 
|  | MODULE_PARM_DESC(debug, "Debug enabled or not"); | 
|  |  |