]> err.no Git - linux-2.6/blobdiff - drivers/usb/serial/keyspan.c
keyspan: use request_firmware()
[linux-2.6] / drivers / usb / serial / keyspan.c
index e6966f12ed5aacdace21a8d14fe79d649f09e406..11e439b90eacd88a2a89e1a48ee6759e7982ccc0 100644 (file)
 #include <linux/tty_flip.h>
 #include <linux/module.h>
 #include <linux/spinlock.h>
+#include <linux/firmware.h>
+#include <linux/ihex.h>
 #include <asm/uaccess.h>
 #include <linux/usb.h>
 #include <linux/usb/serial.h>
@@ -115,12 +117,13 @@ static int debug;
 /*
  * Version Information
  */
-#define DRIVER_VERSION "v1.1.4"
+#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 {
@@ -129,9 +132,15 @@ struct keyspan_serial_private {
        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 {
@@ -179,12 +188,13 @@ struct keyspan_port_private {
 
        
 /* Include Keyspan message headers.  All current Keyspan Adapters
-   make use of one of four message formats which are referred
-   to as USA-26, USA-28 and USA-49, USA-90 by Keyspan and within this driver. */
+   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. */
@@ -236,13 +246,13 @@ module_exit(keyspan_exit);
 
 static void keyspan_rx_throttle (struct usb_serial_port *port)
 {
-       dbg("%s - port %d", __FUNCTION__, port->number);
+       dbg("%s - port %d", __func__, port->number);
 }
 
 
 static void keyspan_rx_unthrottle (struct usb_serial_port *port)
 {
-       dbg("%s - port %d", __FUNCTION__, port->number);
+       dbg("%s - port %d", __func__, port->number);
 }
 
 
@@ -250,7 +260,7 @@ static void keyspan_break_ctl (struct usb_serial_port *port, int break_state)
 {
        struct keyspan_port_private     *p_priv;
 
-       dbg("%s", __FUNCTION__);
+       dbg("%s", __func__);
 
        p_priv = usb_get_serial_port_data(port);
 
@@ -270,29 +280,35 @@ static void keyspan_set_termios (struct usb_serial_port *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__); 
+       dbg("%s", __func__);
 
        p_priv = usb_get_serial_port_data(port);
        d_details = p_priv->device_details;
-       cflag = port->tty->termios->c_cflag;
+       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(port->tty);
+       baud_rate = tty_get_baud_rate(tty);
        /* If no match or invalid, don't change */              
-       if (baud_rate >= 0
-           && d_details->calculate_baud_rate(baud_rate, d_details->baudclk,
+       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);
 }
 
@@ -363,7 +379,7 @@ static int keyspan_write(struct usb_serial_port *port,
        }
        
        dbg("%s - for port %d (%d chars), flip=%d",
-           __FUNCTION__, port->number, count, p_priv->out_flip);
+           __func__, port->number, count, p_priv->out_flip);
 
        for (left = count; left > 0; left -= todo) {
                todo = left;
@@ -375,11 +391,11 @@ static int keyspan_write(struct usb_serial_port *port,
                /* 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__);
+                       dbg("%s - no output urb :(", __func__);
                        return count;
                }
 
-               dbg("%s - endpoint %d flip %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe), flip);
+               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))
@@ -419,20 +435,21 @@ static void       usa26_indat_callback(struct urb *urb)
        struct usb_serial_port  *port;
        struct tty_struct       *tty;
        unsigned char           *data = urb->transfer_buffer;
+       int status = urb->status;
 
-       dbg ("%s", __FUNCTION__); 
+       dbg ("%s", __func__);
 
        endpoint = usb_pipeendpoint(urb->pipe);
 
-       if (urb->status) {
+       if (status) {
                dbg("%s - nonzero status: %x on endpoint %d.",
-                   __FUNCTION__, urb->status, endpoint);
+                   __func__, status, endpoint);
                return;
        }
 
-       port = (struct usb_serial_port *) urb->context;
+       port =  urb->context;
        tty = port->tty;
-       if (urb->actual_length) {
+       if (tty && urb->actual_length) {
                /* 0x80 bit is error flag */
                if ((data[0] & 0x80) == 0) {
                        /* no errors on individual bytes, only possible overrun err*/
@@ -444,7 +461,7 @@ static void usa26_indat_callback(struct urb *urb)
                        }
                } else {
                        /* some bytes had errors, every byte has status */
-                       dbg("%s - RX error!!!!", __FUNCTION__);
+                       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)
@@ -464,7 +481,7 @@ static void usa26_indat_callback(struct urb *urb)
        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);
+                       dbg("%s - resubmit read urb failed. (%d)", __func__, err);
                }
        return;
 }
@@ -475,9 +492,9 @@ 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;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
-       dbg ("%s - urb %d", __FUNCTION__, urb == p_priv->out_urbs[1]); 
+       dbg ("%s - urb %d", __func__, urb == p_priv->out_urbs[1]);
 
        if (port->open_count)
                usb_serial_port_softint(port);
@@ -485,7 +502,7 @@ static void usa2x_outdat_callback(struct urb *urb)
 
 static void    usa26_inack_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__); 
+       dbg ("%s", __func__);
        
 }
 
@@ -494,11 +511,11 @@ 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;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
 
        if (p_priv->resend_cont) {
-               dbg ("%s - sending setup", __FUNCTION__); 
+               dbg ("%s - sending setup", __func__);
                keyspan_usa26_send_setup(port->serial, port, p_priv->resend_cont - 1);
        }
 }
@@ -511,15 +528,16 @@ static void       usa26_instat_callback(struct urb *urb)
        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;
+       serial =  urb->context;
 
-       if (urb->status) {
-               dbg("%s - nonzero status: %x", __FUNCTION__, urb->status);
+       if (status) {
+               dbg("%s - nonzero status: %x", __func__, status);
                return;
        }
        if (urb->actual_length != 9) {
-               dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length);
+               dbg("%s - %d byte report??", __func__, urb->actual_length);
                goto exit;
        }
 
@@ -527,7 +545,7 @@ static void usa26_instat_callback(struct urb *urb)
 
 #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,
+           __func__, msg->port, msg->hskia_cts, msg->gpia_dcd, msg->dsr, msg->ri, msg->_txOff,
            msg->_txXoff, msg->rxEnabled, msg->controlResponse);
 #endif
 
@@ -536,7 +554,7 @@ static void usa26_instat_callback(struct urb *urb)
 
        /* Check port number from message and retrieve private data */  
        if (msg->port >= serial->num_ports) {
-               dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port);
+               dbg ("%s - Unexpected port number %d", __func__, msg->port);
                goto exit;
        }
        port = serial->port[msg->port];
@@ -560,14 +578,14 @@ static void       usa26_instat_callback(struct urb *urb)
        /* 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);
+               dbg("%s - resubmit read urb failed. (%d)", __func__, err);
        }
 exit: ;
 }
 
 static void    usa26_glocont_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
        
 }
 
@@ -579,10 +597,11 @@ static void usa28_indat_callback(struct urb *urb)
        struct tty_struct       *tty;
        unsigned char           *data;
        struct keyspan_port_private             *p_priv;
+       int status = urb->status;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
-       port = (struct usb_serial_port *) urb->context;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
        data = urb->transfer_buffer;
 
@@ -590,13 +609,13 @@ static void usa28_indat_callback(struct urb *urb)
                return;
 
        do {
-               if (urb->status) {
+               if (status) {
                        dbg("%s - nonzero status: %x on endpoint %d.",
-                           __FUNCTION__, urb->status, usb_pipeendpoint(urb->pipe));
+                           __func__, status, usb_pipeendpoint(urb->pipe));
                        return;
                }
 
-               port = (struct usb_serial_port *) urb->context;
+               port =  urb->context;
                p_priv = usb_get_serial_port_data(port);
                data = urb->transfer_buffer;
 
@@ -612,7 +631,7 @@ static void usa28_indat_callback(struct urb *urb)
                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);
+                               dbg("%s - resubmit read urb failed. (%d)", __func__, err);
                        }
                p_priv->in_flip ^= 1;
 
@@ -622,7 +641,7 @@ static void usa28_indat_callback(struct urb *urb)
 
 static void    usa28_inack_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 }
 
 static void    usa28_outcont_callback(struct urb *urb)
@@ -630,11 +649,11 @@ 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;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
 
        if (p_priv->resend_cont) {
-               dbg ("%s - sending setup", __FUNCTION__);
+               dbg ("%s - sending setup", __func__);
                keyspan_usa28_send_setup(port->serial, port, p_priv->resend_cont - 1);
        }
 }
@@ -648,20 +667,21 @@ static void       usa28_instat_callback(struct urb *urb)
        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;
+       serial =  urb->context;
 
-       if (urb->status) {
-               dbg("%s - nonzero status: %x", __FUNCTION__, urb->status);
+       if (status) {
+               dbg("%s - nonzero status: %x", __func__, status);
                return;
        }
 
        if (urb->actual_length != sizeof(struct keyspan_usa28_portStatusMessage)) {
-               dbg("%s - bad length %d", __FUNCTION__, urb->actual_length);
+               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", __FUNCTION__
+       /*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]);*/
        
@@ -671,7 +691,7 @@ static void usa28_instat_callback(struct urb *urb)
 
                /* Check port number from message and retrieve private data */  
        if (msg->port >= serial->num_ports) {
-               dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->port);
+               dbg ("%s - Unexpected port number %d", __func__, msg->port);
                goto exit;
        }
        port = serial->port[msg->port];
@@ -695,14 +715,14 @@ static void       usa28_instat_callback(struct urb *urb)
                /* 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);
+               dbg("%s - resubmit read urb failed. (%d)", __func__, err);
        }
 exit: ;
 }
 
 static void    usa28_glocont_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 }
 
 
@@ -713,15 +733,15 @@ static void       usa49_glocont_callback(struct urb *urb)
        struct keyspan_port_private *p_priv;
        int i;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
-       serial = (struct usb_serial *) urb->context;
+       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__); 
+                       dbg ("%s - sending setup", __func__);
                        keyspan_usa49_send_setup(serial, port, p_priv->resend_cont - 1);
                        break;
                }
@@ -739,22 +759,23 @@ static void       usa49_instat_callback(struct urb *urb)
        struct usb_serial_port                  *port;
        struct keyspan_port_private             *p_priv;
        int old_dcd_state;
+       int status = urb->status;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
-       serial = (struct usb_serial *) urb->context;
+       serial =  urb->context;
 
-       if (urb->status) {
-               dbg("%s - nonzero status: %x", __FUNCTION__, urb->status);
+       if (status) {
+               dbg("%s - nonzero status: %x", __func__, status);
                return;
        }
 
        if (urb->actual_length != sizeof(struct keyspan_usa49_portStatusMessage)) {
-               dbg("%s - bad length %d", __FUNCTION__, urb->actual_length);
+               dbg("%s - bad length %d", __func__, urb->actual_length);
                goto exit;
        }
 
-       /*dbg(" %x %x %x %x %x %x %x %x %x %x %x", __FUNCTION__, 
+       /*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]);*/
        
@@ -763,7 +784,7 @@ static void usa49_instat_callback(struct urb *urb)
 
                /* Check port number from message and retrieve private data */  
        if (msg->portNumber >= serial->num_ports) {
-               dbg ("%s - Unexpected port number %d", __FUNCTION__, msg->portNumber);
+               dbg ("%s - Unexpected port number %d", __func__, msg->portNumber);
                goto exit;
        }
        port = serial->port[msg->portNumber];
@@ -788,14 +809,14 @@ static void       usa49_instat_callback(struct urb *urb)
        urb->dev = serial->dev;
 
        if ((err = usb_submit_urb(urb, GFP_ATOMIC)) != 0) {
-               dbg("%s - resubmit read urb failed. (%d)", __FUNCTION__, err);
+               dbg("%s - resubmit read urb failed. (%d)", __func__, err);
        }
 exit:  ;
 }
 
 static void    usa49_inack_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 }
 
 static void    usa49_indat_callback(struct urb *urb)
@@ -805,20 +826,21 @@ static void       usa49_indat_callback(struct urb *urb)
        struct usb_serial_port  *port;
        struct tty_struct       *tty;
        unsigned char           *data = urb->transfer_buffer;
+       int status = urb->status;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        endpoint = usb_pipeendpoint(urb->pipe);
 
-       if (urb->status) {
-               dbg("%s - nonzero status: %x on endpoint %d.", __FUNCTION__,
-                   urb->status, endpoint);
+       if (status) {
+               dbg("%s - nonzero status: %x on endpoint %d.", __func__,
+                   status, endpoint);
                return;
        }
 
-       port = (struct usb_serial_port *) urb->context;
+       port =  urb->context;
        tty = port->tty;
-       if (urb->actual_length) {
+       if (tty && urb->actual_length) {
                /* 0x80 bit is error flag */
                if ((data[0] & 0x80) == 0) {
                        /* no error on any byte */
@@ -846,17 +868,94 @@ static void       usa49_indat_callback(struct urb *urb)
        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);
+                       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 = 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)", __func__, err);
 }
 
 /* not used, usa-49 doesn't have per-port control endpoints */
-static void    usa49_outcont_callback(struct urb *urb)
+static void usa49_outcont_callback(struct urb *urb)
 {
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 }
 
-static void    usa90_indat_callback(struct urb *urb)
+static void usa90_indat_callback(struct urb *urb)
 {
        int                     i, err;
        int                     endpoint;
@@ -864,19 +963,19 @@ static void       usa90_indat_callback(struct urb *urb)
        struct keyspan_port_private             *p_priv;
        struct tty_struct       *tty;
        unsigned char           *data = urb->transfer_buffer;
+       int status = urb->status;
 
-       dbg ("%s", __FUNCTION__); 
+       dbg ("%s", __func__);
 
        endpoint = usb_pipeendpoint(urb->pipe);
 
-
-       if (urb->status) {
+       if (status) {
                dbg("%s - nonzero status: %x on endpoint %d.",
-                   __FUNCTION__, urb->status, endpoint);
+                   __func__, status, endpoint);
                return;
        }
 
-       port = (struct usb_serial_port *) urb->context;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
 
        tty = port->tty;
@@ -903,7 +1002,7 @@ static void        usa90_indat_callback(struct urb *urb)
                        } 
                        else {
                        /* some bytes had errors, every byte has status */
-                               dbg("%s - RX error!!!!", __FUNCTION__);
+                               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)
@@ -924,7 +1023,7 @@ static void        usa90_indat_callback(struct urb *urb)
        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);
+                       dbg("%s - resubmit read urb failed. (%d)", __func__, err);
                }
        return;
 }
@@ -938,15 +1037,16 @@ static void      usa90_instat_callback(struct urb *urb)
        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;
+       serial =  urb->context;
 
-       if (urb->status) {
-               dbg("%s - nonzero status: %x", __FUNCTION__, urb->status);
+       if (status) {
+               dbg("%s - nonzero status: %x", __func__, status);
                return;
        }
        if (urb->actual_length < 14) {
-               dbg("%s - %d byte report??", __FUNCTION__, urb->actual_length);
+               dbg("%s - %d byte report??", __func__, urb->actual_length);
                goto exit;
        }
 
@@ -975,7 +1075,7 @@ static void        usa90_instat_callback(struct urb *urb)
        /* 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);
+               dbg("%s - resubmit read urb failed. (%d)", __func__, err);
        }
 exit:
        ;
@@ -986,15 +1086,97 @@ 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;
+       port =  urb->context;
        p_priv = usb_get_serial_port_data(port);
 
        if (p_priv->resend_cont) {
-               dbg ("%s - sending setup", __FUNCTION__); 
+               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 (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)", __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 usb_serial_port *port)
 {
        struct keyspan_port_private     *p_priv;
@@ -1003,10 +1185,11 @@ static int keyspan_write_room (struct usb_serial_port *port)
        int                             data_len;
        struct urb                      *this_urb;
 
-       dbg("%s", __FUNCTION__);
+       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
@@ -1023,13 +1206,13 @@ static int keyspan_write_room (struct usb_serial_port *port)
                        if (this_urb->status != -EINPROGRESS)
                                return (data_len);
        }
-       return (0);
+       return 0;
 }
 
 
 static int keyspan_chars_in_buffer (struct usb_serial_port *port)
 {
-       return (0);
+       return 0;
 }
 
 
@@ -1047,8 +1230,8 @@ static int keyspan_open (struct usb_serial_port *port, struct file *filp)
        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); 
+
+       dbg("%s - port%d.", __func__, port->number);
 
        /* Set some sane defaults */
        p_priv->rts_state = 1;
@@ -1069,11 +1252,11 @@ static int keyspan_open (struct usb_serial_port *port, struct file *filp)
                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);
+                       dbg("%s - submit urb %d failed (%d)", __func__, i, err);
                }
        }
 
@@ -1085,7 +1268,7 @@ static int keyspan_open (struct usb_serial_port *port, struct file *filp)
                /* 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 
+       /* 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;
@@ -1094,7 +1277,7 @@ static int keyspan_open (struct usb_serial_port *port, struct file *filp)
        /* 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 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) {
@@ -1109,7 +1292,7 @@ static int keyspan_open (struct usb_serial_port *port, struct file *filp)
        //mdelay(100);
        //keyspan_set_termios(port, NULL);
 
-       return (0);
+       return 0;
 }
 
 static inline void stop_urb(struct urb *urb)
@@ -1125,7 +1308,7 @@ static void keyspan_close(struct usb_serial_port *port, struct file *filp)
        struct keyspan_serial_private   *s_priv;
        struct keyspan_port_private     *p_priv;
 
-       dbg("%s", __FUNCTION__);
+       dbg("%s", __func__);
        s_priv = usb_get_serial_data(serial);
        p_priv = usb_get_serial_port_data(port);
        
@@ -1140,7 +1323,7 @@ static void keyspan_close(struct usb_serial_port *port, struct file *filp)
        }
 
        /*while (p_priv->outcont_urb->status == -EINPROGRESS) {
-               dbg("%s - urb in progress", __FUNCTION__);
+               dbg("%s - urb in progress", __func__);
        }*/
 
        p_priv->out_flip = 0;
@@ -1158,13 +1341,13 @@ static void keyspan_close(struct usb_serial_port *port, struct file *filp)
        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;
+       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),
@@ -1178,72 +1361,60 @@ static int keyspan_fake_startup (struct usb_serial *serial)
                /* 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";
+               fw_name = "keyspan/usa28.fw";
                break;
 
        case keyspan_usa28x_pre_product_id:
-               record = &keyspan_usa28x_firmware[0];
-               fw_name = "USA28X";
+               fw_name = "keyspan/usa28x.fw";
                break;
 
        case keyspan_usa28xa_pre_product_id:
-               record = &keyspan_usa28xa_firmware[0];
-               fw_name = "USA28XA";
+               fw_name = "keyspan/usa28xa.fw";
                break;
 
        case keyspan_usa28xb_pre_product_id:
-               record = &keyspan_usa28xb_firmware[0];
-               fw_name = "USA28XB";
+               fw_name = "keyspan/usa28xb.fw";
                break;
 
        case keyspan_usa19_pre_product_id:
-               record = &keyspan_usa19_firmware[0];
-               fw_name = "USA19";
+               fw_name = "keyspan/usa19.fw";
                break;
                             
        case keyspan_usa19qi_pre_product_id:
-               record = &keyspan_usa19qi_firmware[0];
-               fw_name = "USA19QI";
+               fw_name = "keyspan/usa19qi.fw";
                break;
                             
        case keyspan_mpr_pre_product_id:
-               record = &keyspan_mpr_firmware[0];
-               fw_name = "MPR";
+               fw_name = "keyspan/mpr.fw";
                break;
 
        case keyspan_usa19qw_pre_product_id:
-               record = &keyspan_usa19qw_firmware[0];
-               fw_name = "USA19QI";
+               fw_name = "keyspan/usa19qw.fw";
                break;
                             
        case keyspan_usa18x_pre_product_id:
-               record = &keyspan_usa18x_firmware[0];
-               fw_name = "USA18X";
+               fw_name = "keyspan/usa18x.fw";
                break;
                             
        case keyspan_usa19w_pre_product_id:
-               record = &keyspan_usa19w_firmware[0];
-               fw_name = "USA19W";
+               fw_name = "keyspan/usa19w.fw";
                break;
                
        case keyspan_usa49w_pre_product_id:
-               record = &keyspan_usa49w_firmware[0];
-               fw_name = "USA49W";
+               fw_name = "keyspan/usa49w.fw";
                break;
 
        case keyspan_usa49wlc_pre_product_id:
-               record = &keyspan_usa49wlc_firmware[0];
-               fw_name = "USA49WLC";
+               fw_name = "keyspan/usa49wlc.fw";
                break;
 
        default:
-               record = NULL;
-               fw_name = "Unknown";
-               break;
+               dev_err(&serial->dev->dev, "Unknown product ID (%04x)\n",
+                       le16_to_cpu(serial->dev->descriptor.idProduct));
+               return 1;
        }
 
-       if (record == NULL) {
+       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);
        }
@@ -1253,19 +1424,22 @@ static int keyspan_fake_startup (struct usb_serial *serial)
                /* download the firmware image */
        response = ezusb_set_reset(serial, 1);
 
-       while(record->address != 0xffff) {
-               response = ezusb_writememory(serial, record->address,
+       record = (const struct ihex_binrec *)fw->data;
+
+       while (record) {
+               response = ezusb_writememory(serial, be32_to_cpu(record->addr),
                                             (unsigned char *)record->data,
-                                            record->data_size, 0xa0);
+                                            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, 
-                               record->address, record->data, record->data_size);
+                               response, be32_to_cpu(record->addr),
+                               record->data, be16_to_cpu(record->len));
                        break;
                }
-               record++;
+               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);
@@ -1304,13 +1478,18 @@ static struct urb *keyspan_setup_urb (struct usb_serial *serial, int endpoint,
        if (endpoint == -1)
                return NULL;            /* endpoint not needed */
 
-       dbg ("%s - alloc for endpoint %d.", __FUNCTION__, endpoint);
+       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.", __FUNCTION__, endpoint);
+               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 */
@@ -1380,6 +1559,14 @@ static struct callbacks {
                .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,
        }
 };
 
@@ -1395,7 +1582,7 @@ static void keyspan_setup_urbs(struct usb_serial *serial)
        struct callbacks                *cback;
        int                             endp;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        s_priv = usb_get_serial_data(serial);
        d_details = s_priv->device_details;
@@ -1410,6 +1597,11 @@ static void keyspan_setup_urbs(struct usb_serial *serial)
                 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,
@@ -1464,7 +1656,7 @@ static int keyspan_usa19_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
                div,    /* divisor */   
                cnt;    /* inverse of divisor (programmed into 8051) */
                
-       dbg ("%s - %d.", __FUNCTION__, baud_rate);
+       dbg ("%s - %d.", __func__, baud_rate);
 
                /* prevent divide by zero...  */
        if( (b16 = (baud_rate * 16L)) == 0) {
@@ -1497,7 +1689,7 @@ static int keyspan_usa19_calc_baud(u32 baud_rate, u32 baudclk, u8 *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);
+               dbg ("%s - %d %02x %02x.", __func__, baud_rate, *rate_hi, *rate_low);
        }
        
        return (KEYSPAN_BAUD_RATE_OK);
@@ -1510,7 +1702,7 @@ static int keyspan_usa19hs_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
        u32     b16,    /* baud rate times 16 (actual rate used internally) */
                        div;    /* divisor */   
                
-       dbg ("%s - %d.", __FUNCTION__, baud_rate);
+       dbg ("%s - %d.", __func__, baud_rate);
 
                /* prevent divide by zero...  */
        if( (b16 = (baud_rate * 16L)) == 0) 
@@ -1533,7 +1725,7 @@ static int keyspan_usa19hs_calc_baud(u32 baud_rate, u32 baudclk, u8 *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);
+               dbg ("%s - %d %02x %02x.", __func__, baud_rate, *rate_hi, *rate_low);
        
        return (KEYSPAN_BAUD_RATE_OK);
 }
@@ -1550,7 +1742,7 @@ static int keyspan_usa19w_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
        u8      best_prescaler;
        int     i;
 
-       dbg ("%s - %d.", __FUNCTION__, baud_rate);
+       dbg ("%s - %d.", __func__, baud_rate);
 
                /* prevent divide by zero */
        if( (b16 = baud_rate * 16L) == 0) {
@@ -1598,7 +1790,7 @@ static int keyspan_usa19w_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
        }
        if (prescaler) {
                *prescaler = best_prescaler;
-               /*  dbg("%s - %d %d", __FUNCTION__, *prescaler, div); */
+               /*  dbg("%s - %d %d", __func__, *prescaler, div); */
        }
        return (KEYSPAN_BAUD_RATE_OK);
 }
@@ -1611,7 +1803,7 @@ static int keyspan_usa28_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
                div,    /* divisor */   
                cnt;    /* inverse of divisor (programmed into 8051) */
 
-       dbg ("%s - %d.", __FUNCTION__, baud_rate);
+       dbg ("%s - %d.", __func__, baud_rate);
 
                /* prevent divide by zero */
        if ((b16 = baud_rate * 16L) == 0)
@@ -1650,7 +1842,7 @@ static int keyspan_usa28_calc_baud(u32 baud_rate, u32 baudclk, u8 *rate_hi,
        if (rate_hi) {
                *rate_hi = (u8) ((cnt >> 8) & 0xff);
        }
-       dbg ("%s - %d OK.", __FUNCTION__, baud_rate);
+       dbg ("%s - %d OK.", __func__, baud_rate);
        return (KEYSPAN_BAUD_RATE_OK);
 }
 
@@ -1666,7 +1858,7 @@ static int keyspan_usa26_send_setup(struct usb_serial *serial,
        struct urb                              *this_urb;
        int                                     device_port, err;
 
-       dbg ("%s reset=%d", __FUNCTION__, reset_port); 
+       dbg ("%s reset=%d", __func__, reset_port);
 
        s_priv = usb_get_serial_data(serial);
        p_priv = usb_get_serial_port_data(port);
@@ -1676,20 +1868,20 @@ static int keyspan_usa26_send_setup(struct usb_serial *serial,
        outcont_urb = d_details->outcont_endpoints[port->number];
        this_urb = p_priv->outcont_urb;
 
-       dbg("%s - endpoint %d", __FUNCTION__, usb_pipeendpoint(this_urb->pipe));
+       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.", __FUNCTION__);
+               dbg("%s - oops no urb.", __func__);
                return -1;
        }
 
        /* Save reset port val for resend.
-       Don't overwrite resend for close condition. */
-       if (p_priv->resend_cont != 3)
+          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__); */
+               /*  dbg ("%s - already writing", __func__); */
                mdelay(5);
                return(-1);
        }
@@ -1703,7 +1895,7 @@ static int keyspan_usa26_send_setup(struct usb_serial *serial,
                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__,
+                       dbg("%s - Invalid baud rate %d requested, using 9600.", __func__,
                            p_priv->baud);
                        msg.baudLo = 0;
                        msg.baudHi = 125;       /* Values for 9600 baud */
@@ -1798,17 +1990,17 @@ static int keyspan_usa26_send_setup(struct usb_serial *serial,
 
        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);
+               dbg("%s - usb_submit_urb(setup) failed (%d)", __func__, err);
        }
 #if 0
        else {
-               dbg("%s - usb_submit_urb(%d) OK %d bytes (end %d)", __FUNCTION__
+               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);
+       return 0;
 }
 
 static int keyspan_usa28_send_setup(struct usb_serial *serial,
@@ -1822,7 +2014,7 @@ static int keyspan_usa28_send_setup(struct usb_serial *serial,
        struct urb                              *this_urb;
        int                                     device_port, err;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        s_priv = usb_get_serial_data(serial);
        p_priv = usb_get_serial_port_data(port);
@@ -1831,16 +2023,16 @@ static int keyspan_usa28_send_setup(struct usb_serial *serial,
 
        /* only do something if we have a bulk out endpoint */
        if ((this_urb = p_priv->outcont_urb) == NULL) {
-               dbg("%s - oops no urb.", __FUNCTION__);
+               dbg("%s - oops no urb.", __func__);
                return -1;
        }
 
        /* Save reset port val for resend.
-          Don't overwrite resend for close condition. */
-       if (p_priv->resend_cont != 3)
+          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__);
+               dbg ("%s already writing", __func__);
                mdelay(5);
                return(-1);
        }
@@ -1850,7 +2042,7 @@ static int keyspan_usa28_send_setup(struct usb_serial *serial,
        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);
+               dbg("%s - Invalid baud rate requested %d.", __func__, p_priv->baud);
                msg.baudLo = 0xff;
                msg.baudHi = 0xb2;      /* Values for 9600 baud */
        }
@@ -1924,56 +2116,56 @@ static int keyspan_usa28_send_setup(struct usb_serial *serial,
 
        this_urb->dev = serial->dev;
        if ((err = usb_submit_urb(this_urb, GFP_ATOMIC)) != 0) {
-               dbg("%s - usb_submit_urb(setup) failed", __FUNCTION__);
+               dbg("%s - usb_submit_urb(setup) failed", __func__);
        }
 #if 0
        else {
-               dbg("%s - usb_submit_urb(setup) OK %d bytes", __FUNCTION__,
+               dbg("%s - usb_submit_urb(setup) OK %d bytes", __func__,
                    this_urb->transfer_buffer_length);
        }
 #endif
 
-       return (0);
+       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 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;
-       int                                     glocont_urb;
        struct urb                              *this_urb;
        int                                     err, device_port;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        s_priv = usb_get_serial_data(serial);
        p_priv = usb_get_serial_port_data(port);
        d_details = s_priv->device_details;
 
-       glocont_urb = d_details->glocont_endpoint;
        this_urb = s_priv->glocont_urb;
 
-               /* Work out which port within the device is being setup */
+       /* 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);
+       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.", __FUNCTION__, port->number);
+               dbg("%s - oops no urb for port %d.", __func__, port->number);
                return -1;
        }
 
        /* Save reset port val for resend.
-          Don't overwrite resend for close condition. */
-       if (p_priv->resend_cont != 3)
+          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__); */
+               /*  dbg ("%s - already writing", __func__); */
                mdelay(5);
                return(-1);
        }
@@ -1990,7 +2182,7 @@ static int keyspan_usa49_send_setup(struct usb_serial *serial,
                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__,
+                       dbg("%s - Invalid baud rate %d requested, using 9600.", __func__,
                            p_priv->baud);
                        msg.baudLo = 0;
                        msg.baudHi = 125;       /* Values for 9600 baud */
@@ -2083,24 +2275,43 @@ static int keyspan_usa49_send_setup(struct usb_serial *serial,
        msg.dtr = p_priv->dtr_state;
                
        p_priv->resend_cont = 0;
-       memcpy (this_urb->transfer_buffer, &msg, sizeof(msg));
+
+       /* 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);
+               /* send the data out the device on control endpoint */
+               this_urb->transfer_buffer_length = sizeof(msg);
 
-       this_urb->dev = serial->dev;
+               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);
+               dbg("%s - usb_submit_urb(setup) failed (%d)", __func__, 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));
+               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);
+       return 0;
 }
 
 static int keyspan_usa90_send_setup(struct usb_serial *serial,
@@ -2115,7 +2326,7 @@ static int keyspan_usa90_send_setup(struct usb_serial *serial,
        int                                     err;
        u8                                              prescaler;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        s_priv = usb_get_serial_data(serial);
        p_priv = usb_get_serial_port_data(port);
@@ -2123,7 +2334,7 @@ static int keyspan_usa90_send_setup(struct usb_serial *serial,
 
        /* only do something if we have a bulk out endpoint */
        if ((this_urb = p_priv->outcont_urb) == NULL) {
-               dbg("%s - oops no urb.", __FUNCTION__);
+               dbg("%s - oops no urb.", __func__);
                return -1;
        }
 
@@ -2132,7 +2343,7 @@ static int keyspan_usa90_send_setup(struct usb_serial *serial,
        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__);
+               dbg ("%s already writing", __func__);
                mdelay(5);
                return(-1);
        }
@@ -2146,7 +2357,7 @@ static int keyspan_usa90_send_setup(struct usb_serial *serial,
                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__,
+                       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, 
@@ -2236,9 +2447,157 @@ static int keyspan_usa90_send_setup(struct usb_serial *serial,
 
        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);
+               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;
        }
-       return (0);
+       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)
@@ -2247,7 +2606,7 @@ static void keyspan_send_setup(struct usb_serial_port *port, int reset_port)
        struct keyspan_serial_private *s_priv;
        const struct keyspan_device_details *d_details;
 
-       dbg ("%s", __FUNCTION__);
+       dbg ("%s", __func__);
 
        s_priv = usb_get_serial_data(serial);
        d_details = s_priv->device_details;
@@ -2265,6 +2624,9 @@ static void keyspan_send_setup(struct usb_serial_port *port, int reset_port)
        case msg_usa90:
                keyspan_usa90_send_setup(serial, port, reset_port);
                break;
+       case msg_usa67:
+               keyspan_usa67_send_setup(serial, port, reset_port);
+               break;
        }
 }
 
@@ -2279,20 +2641,20 @@ static int keyspan_startup (struct usb_serial *serial)
        struct keyspan_port_private     *p_priv;
        const struct keyspan_device_details     *d_details;
 
-       dbg("%s", __FUNCTION__);
+       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", __FUNCTION__, le16_to_cpu(serial->dev->descriptor.idProduct));
+               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.", __FUNCTION__);
+               dbg("%s - kmalloc for keyspan_serial_private failed.", __func__);
                return -ENOMEM;
        }
 
@@ -2304,7 +2666,7 @@ static int keyspan_startup (struct usb_serial *serial)
                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);
+                       dbg("%s - kmalloc for keyspan_port_private (%d) failed!.", __func__, i);
                        return (1);
                }
                p_priv->device_details = d_details;
@@ -2313,12 +2675,22 @@ static int keyspan_startup (struct usb_serial *serial)
 
        keyspan_setup_urbs(serial);
 
-       s_priv->instat_urb->dev = serial->dev;
-       if ((err = usb_submit_urb(s_priv->instat_urb, GFP_KERNEL)) != 0) {
-               dbg("%s - submit instat urb failed %d", __FUNCTION__, err);
+       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);
+       return 0;
 }
 
 static void keyspan_shutdown (struct usb_serial *serial)
@@ -2328,13 +2700,14 @@ static void keyspan_shutdown (struct usb_serial *serial)
        struct keyspan_serial_private   *s_priv;
        struct keyspan_port_private     *p_priv;
 
-       dbg("%s", __FUNCTION__);
+       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);
@@ -2348,6 +2721,7 @@ static void keyspan_shutdown (struct usb_serial *serial)
 
        /* 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];
@@ -2375,6 +2749,19 @@ 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");