Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
| 2 | * KLSI KL5KUSB105 chip RS232 converter driver |
| 3 | * |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 4 | * Copyright (C) 2010 Johan Hovold <jhovold@gmail.com> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 5 | * Copyright (C) 2001 Utz-Uwe Haus <haus@uuhaus.de> |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 2 of the License, or |
| 10 | * (at your option) any later version. |
| 11 | * |
| 12 | * All information about the device was acquired using SniffUSB ans snoopUSB |
| 13 | * on Windows98. |
| 14 | * It was written out of frustration with the PalmConnect USB Serial adapter |
| 15 | * sold by Palm Inc. |
| 16 | * Neither Palm, nor their contractor (MCCI) or their supplier (KLSI) provided |
| 17 | * information that was not already available. |
| 18 | * |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 19 | * It seems that KLSI bought some silicon-design information from ScanLogic, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 20 | * whose SL11R processor is at the core of the KL5KUSB chipset from KLSI. |
| 21 | * KLSI has firmware available for their devices; it is probable that the |
| 22 | * firmware differs from that used by KLSI in their products. If you have an |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 23 | * original KLSI device and can provide some information on it, I would be |
| 24 | * most interested in adding support for it here. If you have any information |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 25 | * on the protocol used (or find errors in my reverse-engineered stuff), please |
| 26 | * let me know. |
| 27 | * |
| 28 | * The code was only tested with a PalmConnect USB adapter; if you |
| 29 | * are adventurous, try it with any KLSI-based device and let me know how it |
| 30 | * breaks so that I can fix it! |
| 31 | */ |
| 32 | |
| 33 | /* TODO: |
| 34 | * check modem line signals |
| 35 | * implement handshaking or decide that we do not support it |
| 36 | */ |
| 37 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | #include <linux/kernel.h> |
| 39 | #include <linux/errno.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | #include <linux/slab.h> |
| 41 | #include <linux/tty.h> |
| 42 | #include <linux/tty_driver.h> |
| 43 | #include <linux/tty_flip.h> |
| 44 | #include <linux/module.h> |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 45 | #include <linux/uaccess.h> |
Al Viro | fd05e72 | 2008-04-28 07:00:16 +0100 | [diff] [blame] | 46 | #include <asm/unaligned.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | #include <linux/usb.h> |
Greg Kroah-Hartman | a969888 | 2006-07-11 21:22:58 -0700 | [diff] [blame] | 48 | #include <linux/usb/serial.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | #include "kl5kusb105.h" |
| 50 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 51 | #define DRIVER_AUTHOR "Utz-Uwe Haus <haus@uuhaus.de>, Johan Hovold <jhovold@gmail.com>" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 | #define DRIVER_DESC "KLSI KL5KUSB105 chipset USB->Serial Converter driver" |
| 53 | |
| 54 | |
| 55 | /* |
| 56 | * Function prototypes |
| 57 | */ |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 58 | static int klsi_105_port_probe(struct usb_serial_port *port); |
| 59 | static int klsi_105_port_remove(struct usb_serial_port *port); |
Alan Cox | a509a7e | 2009-09-19 13:13:26 -0700 | [diff] [blame] | 60 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port); |
Alan Cox | 335f851 | 2009-06-11 12:26:29 +0100 | [diff] [blame] | 61 | static void klsi_105_close(struct usb_serial_port *port); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 62 | static void klsi_105_set_termios(struct tty_struct *tty, |
| 63 | struct usb_serial_port *port, struct ktermios *old); |
Alan Cox | 60b33c1 | 2011-02-14 16:26:14 +0000 | [diff] [blame] | 64 | static int klsi_105_tiocmget(struct tty_struct *tty); |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 65 | static void klsi_105_process_read_urb(struct urb *urb); |
| 66 | static int klsi_105_prepare_write_buffer(struct usb_serial_port *port, |
| 67 | void *dest, size_t size); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 68 | |
| 69 | /* |
| 70 | * All of the device info needed for the KLSI converters. |
| 71 | */ |
Németh Márton | 7d40d7e | 2010-01-10 15:34:24 +0100 | [diff] [blame] | 72 | static const struct usb_device_id id_table[] = { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 73 | { USB_DEVICE(PALMCONNECT_VID, PALMCONNECT_PID) }, |
| 74 | { USB_DEVICE(KLSI_VID, KLSI_KL5KUSB105D_PID) }, |
| 75 | { } /* Terminating entry */ |
| 76 | }; |
| 77 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 78 | MODULE_DEVICE_TABLE(usb, id_table); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 79 | |
Greg Kroah-Hartman | ea65370 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 80 | static struct usb_serial_driver kl5kusb105d_device = { |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 81 | .driver = { |
| 82 | .owner = THIS_MODULE, |
Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 83 | .name = "kl5kusb105d", |
Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 84 | }, |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 85 | .description = "KL5KUSB105D / PalmConnect", |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 86 | .id_table = id_table, |
| 87 | .num_ports = 1, |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 88 | .bulk_out_size = 64, |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 89 | .open = klsi_105_open, |
| 90 | .close = klsi_105_close, |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 91 | .set_termios = klsi_105_set_termios, |
| 92 | /*.break_ctl = klsi_105_break_ctl,*/ |
| 93 | .tiocmget = klsi_105_tiocmget, |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 94 | .port_probe = klsi_105_port_probe, |
| 95 | .port_remove = klsi_105_port_remove, |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 96 | .throttle = usb_serial_generic_throttle, |
| 97 | .unthrottle = usb_serial_generic_unthrottle, |
| 98 | .process_read_urb = klsi_105_process_read_urb, |
| 99 | .prepare_write_buffer = klsi_105_prepare_write_buffer, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | }; |
| 101 | |
Alan Stern | 4d2a7af | 2012-02-23 14:57:09 -0500 | [diff] [blame] | 102 | static struct usb_serial_driver * const serial_drivers[] = { |
| 103 | &kl5kusb105d_device, NULL |
| 104 | }; |
| 105 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | struct klsi_105_port_settings { |
| 107 | __u8 pktlen; /* always 5, it seems */ |
| 108 | __u8 baudrate; |
| 109 | __u8 databits; |
| 110 | __u8 unknown1; |
| 111 | __u8 unknown2; |
| 112 | } __attribute__ ((packed)); |
| 113 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | struct klsi_105_private { |
| 115 | struct klsi_105_port_settings cfg; |
Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 116 | struct ktermios termios; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | unsigned long line_state; /* modem line settings */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 118 | spinlock_t lock; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | }; |
| 120 | |
| 121 | |
| 122 | /* |
| 123 | * Handle vendor specific USB requests |
| 124 | */ |
| 125 | |
| 126 | |
| 127 | #define KLSI_TIMEOUT 5000 /* default urb timeout */ |
| 128 | |
| 129 | static int klsi_105_chg_port_settings(struct usb_serial_port *port, |
| 130 | struct klsi_105_port_settings *settings) |
| 131 | { |
| 132 | int rc; |
| 133 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 134 | rc = usb_control_msg(port->serial->dev, |
| 135 | usb_sndctrlpipe(port->serial->dev, 0), |
| 136 | KL5KUSB105A_SIO_SET_DATA, |
| 137 | USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_INTERFACE, |
| 138 | 0, /* value */ |
| 139 | 0, /* index */ |
| 140 | settings, |
| 141 | sizeof(struct klsi_105_port_settings), |
| 142 | KLSI_TIMEOUT); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 143 | if (rc < 0) |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 144 | dev_err(&port->dev, |
| 145 | "Change port settings failed (error = %d)\n", rc); |
Greg Kroah-Hartman | c197a8d | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 146 | dev_info(&port->serial->dev->dev, |
| 147 | "%d byte block, baudrate %x, databits %d, u1 %d, u2 %d\n", |
| 148 | settings->pktlen, settings->baudrate, settings->databits, |
| 149 | settings->unknown1, settings->unknown2); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 150 | return rc; |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 151 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 152 | |
| 153 | /* translate a 16-bit status value from the device to linux's TIO bits */ |
| 154 | static unsigned long klsi_105_status2linestate(const __u16 status) |
| 155 | { |
| 156 | unsigned long res = 0; |
| 157 | |
| 158 | res = ((status & KL5KUSB105A_DSR) ? TIOCM_DSR : 0) |
| 159 | | ((status & KL5KUSB105A_CTS) ? TIOCM_CTS : 0) |
| 160 | ; |
| 161 | |
| 162 | return res; |
| 163 | } |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 164 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 165 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 166 | * Read line control via vendor command and return result through |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 167 | * *line_state_p |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 168 | */ |
| 169 | /* It seems that the status buffer has always only 2 bytes length */ |
| 170 | #define KLSI_STATUSBUF_LEN 2 |
| 171 | static int klsi_105_get_line_state(struct usb_serial_port *port, |
| 172 | unsigned long *line_state_p) |
| 173 | { |
| 174 | int rc; |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 175 | u8 *status_buf; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 | __u16 status; |
| 177 | |
Greg Kroah-Hartman | c197a8d | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 178 | dev_info(&port->serial->dev->dev, "sending SIO Poll request\n"); |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 179 | |
| 180 | status_buf = kmalloc(KLSI_STATUSBUF_LEN, GFP_KERNEL); |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 181 | if (!status_buf) |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 182 | return -ENOMEM; |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 183 | |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 184 | status_buf[0] = 0xff; |
| 185 | status_buf[1] = 0xff; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 186 | rc = usb_control_msg(port->serial->dev, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 187 | usb_rcvctrlpipe(port->serial->dev, 0), |
| 188 | KL5KUSB105A_SIO_POLL, |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 189 | USB_TYPE_VENDOR | USB_DIR_IN, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 190 | 0, /* value */ |
| 191 | 0, /* index */ |
| 192 | status_buf, KLSI_STATUSBUF_LEN, |
| 193 | 10000 |
| 194 | ); |
| 195 | if (rc < 0) |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 196 | dev_err(&port->dev, "Reading line status failed (error = %d)\n", |
| 197 | rc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 198 | else { |
Harvey Harrison | bd2c784 | 2008-05-01 20:52:57 -0700 | [diff] [blame] | 199 | status = get_unaligned_le16(status_buf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 200 | |
Johan Hovold | d9a38a8 | 2014-03-12 19:09:42 +0100 | [diff] [blame] | 201 | dev_info(&port->serial->dev->dev, "read status %x %x\n", |
Greg Kroah-Hartman | c197a8d | 2008-08-18 13:21:04 -0700 | [diff] [blame] | 202 | status_buf[0], status_buf[1]); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 203 | |
| 204 | *line_state_p = klsi_105_status2linestate(status); |
| 205 | } |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 206 | |
| 207 | kfree(status_buf); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 208 | return rc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 209 | } |
| 210 | |
| 211 | |
| 212 | /* |
| 213 | * Driver's tty interface functions |
| 214 | */ |
| 215 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 216 | static int klsi_105_port_probe(struct usb_serial_port *port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 217 | { |
| 218 | struct klsi_105_private *priv; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 219 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 220 | priv = kmalloc(sizeof(*priv), GFP_KERNEL); |
| 221 | if (!priv) |
| 222 | return -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 223 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 224 | /* set initial values for control structures */ |
| 225 | priv->cfg.pktlen = 5; |
| 226 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; |
| 227 | priv->cfg.databits = kl5kusb105a_dtb_8; |
| 228 | priv->cfg.unknown1 = 0; |
| 229 | priv->cfg.unknown2 = 1; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 230 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 231 | priv->line_state = 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 233 | spin_lock_init(&priv->lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 234 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 235 | /* priv->termios is left uninitialized until port opening */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 236 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 237 | usb_set_serial_port_data(port, priv); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 238 | |
Oliver Neukum | 9306fff | 2007-03-29 11:23:54 +0200 | [diff] [blame] | 239 | return 0; |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 240 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 241 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 242 | static int klsi_105_port_remove(struct usb_serial_port *port) |
Alan Stern | f9c99bb | 2009-06-02 11:53:55 -0400 | [diff] [blame] | 243 | { |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 244 | struct klsi_105_private *priv; |
Alan Stern | f9c99bb | 2009-06-02 11:53:55 -0400 | [diff] [blame] | 245 | |
Johan Hovold | 99a6f73 | 2012-10-17 13:35:01 +0200 | [diff] [blame] | 246 | priv = usb_get_serial_port_data(port); |
| 247 | kfree(priv); |
| 248 | |
| 249 | return 0; |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 250 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 251 | |
Alan Cox | a509a7e | 2009-09-19 13:13:26 -0700 | [diff] [blame] | 252 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 253 | { |
| 254 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
| 255 | int retval = 0; |
| 256 | int rc; |
| 257 | int i; |
| 258 | unsigned long line_state; |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 259 | struct klsi_105_port_settings *cfg; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 260 | unsigned long flags; |
| 261 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 262 | /* Do a defined restart: |
| 263 | * Set up sane default baud rate and send the 'READ_ON' |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 264 | * vendor command. |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 265 | * FIXME: set modem line control (how?) |
| 266 | * Then read the modem line control and store values in |
| 267 | * priv->line_state. |
| 268 | */ |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 269 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 270 | if (!cfg) |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 271 | return -ENOMEM; |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 272 | |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 273 | cfg->pktlen = 5; |
| 274 | cfg->baudrate = kl5kusb105a_sio_b9600; |
| 275 | cfg->databits = kl5kusb105a_dtb_8; |
| 276 | cfg->unknown1 = 0; |
| 277 | cfg->unknown2 = 1; |
| 278 | klsi_105_chg_port_settings(port, cfg); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 279 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 280 | /* set up termios structure */ |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 281 | spin_lock_irqsave(&priv->lock, flags); |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 282 | priv->termios.c_iflag = tty->termios.c_iflag; |
| 283 | priv->termios.c_oflag = tty->termios.c_oflag; |
| 284 | priv->termios.c_cflag = tty->termios.c_cflag; |
| 285 | priv->termios.c_lflag = tty->termios.c_lflag; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 286 | for (i = 0; i < NCCS; i++) |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 287 | priv->termios.c_cc[i] = tty->termios.c_cc[i]; |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 288 | priv->cfg.pktlen = cfg->pktlen; |
| 289 | priv->cfg.baudrate = cfg->baudrate; |
| 290 | priv->cfg.databits = cfg->databits; |
| 291 | priv->cfg.unknown1 = cfg->unknown1; |
| 292 | priv->cfg.unknown2 = cfg->unknown2; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 293 | spin_unlock_irqrestore(&priv->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 294 | |
| 295 | /* READ_ON and urb submission */ |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 296 | rc = usb_serial_generic_open(tty, port); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 297 | if (rc) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 298 | retval = rc; |
| 299 | goto exit; |
| 300 | } |
| 301 | |
| 302 | rc = usb_control_msg(port->serial->dev, |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 303 | usb_sndctrlpipe(port->serial->dev, 0), |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 304 | KL5KUSB105A_SIO_CONFIGURE, |
| 305 | USB_TYPE_VENDOR|USB_DIR_OUT|USB_RECIP_INTERFACE, |
| 306 | KL5KUSB105A_SIO_CONFIGURE_READ_ON, |
| 307 | 0, /* index */ |
| 308 | NULL, |
| 309 | 0, |
| 310 | KLSI_TIMEOUT); |
| 311 | if (rc < 0) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 312 | dev_err(&port->dev, "Enabling read failed (error = %d)\n", rc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 313 | retval = rc; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 314 | } else |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 315 | dev_dbg(&port->dev, "%s - enabled reading\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 316 | |
| 317 | rc = klsi_105_get_line_state(port, &line_state); |
| 318 | if (rc >= 0) { |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 319 | spin_lock_irqsave(&priv->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 320 | priv->line_state = line_state; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 321 | spin_unlock_irqrestore(&priv->lock, flags); |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 322 | dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__, line_state); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 323 | retval = 0; |
| 324 | } else |
| 325 | retval = rc; |
| 326 | |
| 327 | exit: |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 328 | kfree(cfg); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 329 | return retval; |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 330 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 331 | |
Alan Cox | 335f851 | 2009-06-11 12:26:29 +0100 | [diff] [blame] | 332 | static void klsi_105_close(struct usb_serial_port *port) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 333 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 334 | int rc; |
| 335 | |
Johan Hovold | 9fcb2e6 | 2013-03-21 12:37:39 +0100 | [diff] [blame] | 336 | /* send READ_OFF */ |
| 337 | rc = usb_control_msg(port->serial->dev, |
| 338 | usb_sndctrlpipe(port->serial->dev, 0), |
| 339 | KL5KUSB105A_SIO_CONFIGURE, |
| 340 | USB_TYPE_VENDOR | USB_DIR_OUT, |
| 341 | KL5KUSB105A_SIO_CONFIGURE_READ_OFF, |
| 342 | 0, /* index */ |
| 343 | NULL, 0, |
| 344 | KLSI_TIMEOUT); |
| 345 | if (rc < 0) |
| 346 | dev_err(&port->dev, "failed to disable read: %d\n", rc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 347 | |
| 348 | /* shutdown our bulk reads and writes */ |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 349 | usb_serial_generic_close(port); |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 350 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 | |
| 352 | /* We need to write a complete 64-byte data block and encode the |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 353 | * number actually sent in the first double-byte, LSB-order. That |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | * leaves at most 62 bytes of payload. |
| 355 | */ |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 356 | #define KLSI_HDR_LEN 2 |
| 357 | static int klsi_105_prepare_write_buffer(struct usb_serial_port *port, |
| 358 | void *dest, size_t size) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 359 | { |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 360 | unsigned char *buf = dest; |
| 361 | int count; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 362 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 363 | count = kfifo_out_locked(&port->write_fifo, buf + KLSI_HDR_LEN, size, |
| 364 | &port->lock); |
| 365 | put_unaligned_le16(count, buf); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 366 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 367 | return count + KLSI_HDR_LEN; |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 368 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 369 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 370 | /* The data received is preceded by a length double-byte in LSB-first order. |
| 371 | */ |
| 372 | static void klsi_105_process_read_urb(struct urb *urb) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 373 | { |
Ming Lei | cdc9779 | 2008-02-24 18:41:47 +0800 | [diff] [blame] | 374 | struct usb_serial_port *port = urb->context; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | unsigned char *data = urb->transfer_buffer; |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 376 | unsigned len; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 377 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 378 | /* empty urbs seem to happen, we ignore them */ |
| 379 | if (!urb->actual_length) |
| 380 | return; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 382 | if (urb->actual_length <= KLSI_HDR_LEN) { |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 383 | dev_dbg(&port->dev, "%s - malformed packet\n", __func__); |
Greg Kroah-Hartman | 17c1b35 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 384 | return; |
| 385 | } |
| 386 | |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 387 | len = get_unaligned_le16(data); |
| 388 | if (len > urb->actual_length - KLSI_HDR_LEN) { |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 389 | dev_dbg(&port->dev, "%s - packet length mismatch\n", __func__); |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 390 | len = urb->actual_length - KLSI_HDR_LEN; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 391 | } |
Johan Hovold | 60b3013 | 2010-05-19 00:01:40 +0200 | [diff] [blame] | 392 | |
Jiri Slaby | 05c7cd3 | 2013-01-03 15:53:04 +0100 | [diff] [blame] | 393 | tty_insert_flip_string(&port->port, data + KLSI_HDR_LEN, len); |
Jiri Slaby | 2e124b4 | 2013-01-03 15:53:06 +0100 | [diff] [blame] | 394 | tty_flip_buffer_push(&port->port); |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 395 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 396 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 397 | static void klsi_105_set_termios(struct tty_struct *tty, |
| 398 | struct usb_serial_port *port, |
| 399 | struct ktermios *old_termios) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 400 | { |
| 401 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 402 | struct device *dev = &port->dev; |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 403 | unsigned int iflag = tty->termios.c_iflag; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 404 | unsigned int old_iflag = old_termios->c_iflag; |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 405 | unsigned int cflag = tty->termios.c_cflag; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 406 | unsigned int old_cflag = old_termios->c_cflag; |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 407 | struct klsi_105_port_settings *cfg; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 408 | unsigned long flags; |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 409 | speed_t baud; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 410 | |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 411 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
Johan Hovold | 10c642d | 2013-12-29 19:22:56 +0100 | [diff] [blame] | 412 | if (!cfg) |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 413 | return; |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 414 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 415 | /* lock while we are modifying the settings */ |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 416 | spin_lock_irqsave(&priv->lock, flags); |
| 417 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 418 | /* |
| 419 | * Update baud rate |
| 420 | */ |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 421 | baud = tty_get_baud_rate(tty); |
| 422 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 423 | if ((cflag & CBAUD) != (old_cflag & CBAUD)) { |
| 424 | /* reassert DTR and (maybe) RTS on transition from B0 */ |
| 425 | if ((old_cflag & CBAUD) == B0) { |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 426 | dev_dbg(dev, "%s: baud was B0\n", __func__); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 427 | #if 0 |
| 428 | priv->control_state |= TIOCM_DTR; |
| 429 | /* don't set RTS if using hardware flow control */ |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 430 | if (!(old_cflag & CRTSCTS)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | priv->control_state |= TIOCM_RTS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 432 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
| 433 | #endif |
| 434 | } |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 435 | } |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 436 | switch (baud) { |
| 437 | case 0: /* handled below */ |
| 438 | break; |
| 439 | case 1200: |
| 440 | priv->cfg.baudrate = kl5kusb105a_sio_b1200; |
| 441 | break; |
| 442 | case 2400: |
| 443 | priv->cfg.baudrate = kl5kusb105a_sio_b2400; |
| 444 | break; |
| 445 | case 4800: |
| 446 | priv->cfg.baudrate = kl5kusb105a_sio_b4800; |
| 447 | break; |
| 448 | case 9600: |
| 449 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; |
| 450 | break; |
| 451 | case 19200: |
| 452 | priv->cfg.baudrate = kl5kusb105a_sio_b19200; |
| 453 | break; |
| 454 | case 38400: |
| 455 | priv->cfg.baudrate = kl5kusb105a_sio_b38400; |
| 456 | break; |
| 457 | case 57600: |
| 458 | priv->cfg.baudrate = kl5kusb105a_sio_b57600; |
| 459 | break; |
| 460 | case 115200: |
| 461 | priv->cfg.baudrate = kl5kusb105a_sio_b115200; |
| 462 | break; |
| 463 | default: |
Johan Hovold | d9a38a8 | 2014-03-12 19:09:42 +0100 | [diff] [blame] | 464 | dev_dbg(dev, "unsupported baudrate, using 9600\n"); |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 465 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 466 | baud = 9600; |
| 467 | break; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 468 | } |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 469 | if ((cflag & CBAUD) == B0) { |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 470 | dev_dbg(dev, "%s: baud is B0\n", __func__); |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 471 | /* Drop RTS and DTR */ |
| 472 | /* maybe this should be simulated by sending read |
| 473 | * disable and read enable messages? |
| 474 | */ |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 475 | #if 0 |
| 476 | priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 477 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 478 | #endif |
| 479 | } |
| 480 | tty_encode_baud_rate(tty, baud, baud); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | |
| 482 | if ((cflag & CSIZE) != (old_cflag & CSIZE)) { |
| 483 | /* set the number of data bits */ |
| 484 | switch (cflag & CSIZE) { |
| 485 | case CS5: |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 486 | dev_dbg(dev, "%s - 5 bits/byte not supported\n", __func__); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 487 | spin_unlock_irqrestore(&priv->lock, flags); |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 488 | goto err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 489 | case CS6: |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 490 | dev_dbg(dev, "%s - 6 bits/byte not supported\n", __func__); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 491 | spin_unlock_irqrestore(&priv->lock, flags); |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 492 | goto err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 493 | case CS7: |
| 494 | priv->cfg.databits = kl5kusb105a_dtb_7; |
| 495 | break; |
| 496 | case CS8: |
| 497 | priv->cfg.databits = kl5kusb105a_dtb_8; |
| 498 | break; |
| 499 | default: |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 500 | dev_err(dev, "CSIZE was not CS5-CS8, using default of 8\n"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 501 | priv->cfg.databits = kl5kusb105a_dtb_8; |
| 502 | break; |
| 503 | } |
| 504 | } |
| 505 | |
| 506 | /* |
| 507 | * Update line control register (LCR) |
| 508 | */ |
| 509 | if ((cflag & (PARENB|PARODD)) != (old_cflag & (PARENB|PARODD)) |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 510 | || (cflag & CSTOPB) != (old_cflag & CSTOPB)) { |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 511 | /* Not currently supported */ |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 512 | tty->termios.c_cflag &= ~(PARENB|PARODD|CSTOPB); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 513 | #if 0 |
| 514 | priv->last_lcr = 0; |
| 515 | |
| 516 | /* set the parity */ |
| 517 | if (cflag & PARENB) |
| 518 | priv->last_lcr |= (cflag & PARODD) ? |
| 519 | MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN; |
| 520 | else |
| 521 | priv->last_lcr |= MCT_U232_PARITY_NONE; |
| 522 | |
| 523 | /* set the number of stop bits */ |
| 524 | priv->last_lcr |= (cflag & CSTOPB) ? |
| 525 | MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1; |
| 526 | |
| 527 | mct_u232_set_line_ctrl(serial, priv->last_lcr); |
| 528 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 529 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 530 | /* |
| 531 | * Set flow control: well, I do not really now how to handle DTR/RTS. |
| 532 | * Just do what we have seen with SniffUSB on Win98. |
| 533 | */ |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 534 | if ((iflag & IXOFF) != (old_iflag & IXOFF) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 535 | || (iflag & IXON) != (old_iflag & IXON) |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 536 | || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) { |
Alan Cox | a5b6f60 | 2008-04-08 17:16:06 +0100 | [diff] [blame] | 537 | /* Not currently supported */ |
Alan Cox | adc8d74 | 2012-07-14 15:31:47 +0100 | [diff] [blame] | 538 | tty->termios.c_cflag &= ~CRTSCTS; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 539 | /* Drop DTR/RTS if no flow control otherwise assert */ |
| 540 | #if 0 |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 541 | if ((iflag & IXOFF) || (iflag & IXON) || (cflag & CRTSCTS)) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 542 | priv->control_state |= TIOCM_DTR | TIOCM_RTS; |
| 543 | else |
| 544 | priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS); |
| 545 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
| 546 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 547 | } |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 548 | memcpy(cfg, &priv->cfg, sizeof(*cfg)); |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 549 | spin_unlock_irqrestore(&priv->lock, flags); |
| 550 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 551 | /* now commit changes to device */ |
Johan Hovold | abf492e | 2009-12-28 23:01:52 +0100 | [diff] [blame] | 552 | klsi_105_chg_port_settings(port, cfg); |
| 553 | err: |
| 554 | kfree(cfg); |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 555 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 556 | |
| 557 | #if 0 |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 558 | static void mct_u232_break_ctl(struct tty_struct *tty, int break_state) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 559 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 560 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 561 | struct usb_serial *serial = port->serial; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 562 | struct mct_u232_private *priv = |
| 563 | (struct mct_u232_private *)port->private; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 564 | unsigned char lcr = priv->last_lcr; |
| 565 | |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 566 | dev_dbg(&port->dev, "%s - state=%d\n", __func__, break_state); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 567 | |
Alan Cox | 6b447f04 | 2009-01-02 13:48:56 +0000 | [diff] [blame] | 568 | /* LOCKING */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 569 | if (break_state) |
| 570 | lcr |= MCT_U232_SET_BREAK; |
| 571 | |
| 572 | mct_u232_set_line_ctrl(serial, lcr); |
Johan Hovold | ff8c195 | 2010-05-19 00:01:39 +0200 | [diff] [blame] | 573 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 574 | #endif |
| 575 | |
Alan Cox | 60b33c1 | 2011-02-14 16:26:14 +0000 | [diff] [blame] | 576 | static int klsi_105_tiocmget(struct tty_struct *tty) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 577 | { |
Alan Cox | 95da310 | 2008-07-22 11:09:07 +0100 | [diff] [blame] | 578 | struct usb_serial_port *port = tty->driver_data; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 579 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
| 580 | unsigned long flags; |
| 581 | int rc; |
| 582 | unsigned long line_state; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 583 | |
| 584 | rc = klsi_105_get_line_state(port, &line_state); |
| 585 | if (rc < 0) { |
Greg Kroah-Hartman | 194343d | 2008-08-20 16:56:34 -0700 | [diff] [blame] | 586 | dev_err(&port->dev, |
| 587 | "Reading line control failed (error = %d)\n", rc); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 588 | /* better return value? EAGAIN? */ |
| 589 | return rc; |
| 590 | } |
| 591 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 592 | spin_lock_irqsave(&priv->lock, flags); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 593 | priv->line_state = line_state; |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 594 | spin_unlock_irqrestore(&priv->lock, flags); |
Greg Kroah-Hartman | 1ad7604 | 2012-09-14 09:47:43 -0700 | [diff] [blame] | 595 | dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__, line_state); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 596 | return (int)line_state; |
| 597 | } |
| 598 | |
Greg Kroah-Hartman | 68e2411 | 2012-05-08 15:46:14 -0700 | [diff] [blame] | 599 | module_usb_serial_driver(serial_drivers, id_table); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 600 | |
Alan Cox | 0c265f4 | 2008-07-22 11:14:00 +0100 | [diff] [blame] | 601 | MODULE_AUTHOR(DRIVER_AUTHOR); |
| 602 | MODULE_DESCRIPTION(DRIVER_DESC); |
| 603 | MODULE_LICENSE("GPL"); |