]>
Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * KLSI KL5KUSB105 chip RS232 converter driver | |
3 | * | |
60b3013c | 4 | * Copyright (C) 2010 Johan Hovold <jhovold@gmail.com> |
1da177e4 LT |
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 | * | |
0c265f4e | 19 | * It seems that KLSI bought some silicon-design information from ScanLogic, |
1da177e4 LT |
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 | |
0c265f4e AC |
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 | |
1da177e4 LT |
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 | ||
1da177e4 LT |
38 | #include <linux/kernel.h> |
39 | #include <linux/errno.h> | |
1da177e4 LT |
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> | |
0c265f4e | 45 | #include <linux/uaccess.h> |
fd05e720 | 46 | #include <asm/unaligned.h> |
1da177e4 | 47 | #include <linux/usb.h> |
a969888c | 48 | #include <linux/usb/serial.h> |
1da177e4 LT |
49 | #include "kl5kusb105.h" |
50 | ||
60b3013c | 51 | #define DRIVER_AUTHOR "Utz-Uwe Haus <haus@uuhaus.de>, Johan Hovold <jhovold@gmail.com>" |
1da177e4 LT |
52 | #define DRIVER_DESC "KLSI KL5KUSB105 chipset USB->Serial Converter driver" |
53 | ||
54 | ||
55 | /* | |
56 | * Function prototypes | |
57 | */ | |
99a6f73c JH |
58 | static int klsi_105_port_probe(struct usb_serial_port *port); |
59 | static int klsi_105_port_remove(struct usb_serial_port *port); | |
a509a7e4 | 60 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port); |
335f8514 | 61 | static void klsi_105_close(struct usb_serial_port *port); |
0c265f4e AC |
62 | static void klsi_105_set_termios(struct tty_struct *tty, |
63 | struct usb_serial_port *port, struct ktermios *old); | |
60b33c13 | 64 | static int klsi_105_tiocmget(struct tty_struct *tty); |
60b3013c JH |
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); | |
1da177e4 LT |
68 | |
69 | /* | |
70 | * All of the device info needed for the KLSI converters. | |
71 | */ | |
7d40d7e8 | 72 | static const struct usb_device_id id_table[] = { |
1da177e4 LT |
73 | { USB_DEVICE(PALMCONNECT_VID, PALMCONNECT_PID) }, |
74 | { USB_DEVICE(KLSI_VID, KLSI_KL5KUSB105D_PID) }, | |
75 | { } /* Terminating entry */ | |
76 | }; | |
77 | ||
0c265f4e | 78 | MODULE_DEVICE_TABLE(usb, id_table); |
1da177e4 | 79 | |
ea65370d | 80 | static struct usb_serial_driver kl5kusb105d_device = { |
18fcac35 GKH |
81 | .driver = { |
82 | .owner = THIS_MODULE, | |
269bda1c | 83 | .name = "kl5kusb105d", |
18fcac35 | 84 | }, |
ff8c195f | 85 | .description = "KL5KUSB105D / PalmConnect", |
ff8c195f JH |
86 | .id_table = id_table, |
87 | .num_ports = 1, | |
60b3013c | 88 | .bulk_out_size = 64, |
ff8c195f JH |
89 | .open = klsi_105_open, |
90 | .close = klsi_105_close, | |
ff8c195f JH |
91 | .set_termios = klsi_105_set_termios, |
92 | /*.break_ctl = klsi_105_break_ctl,*/ | |
93 | .tiocmget = klsi_105_tiocmget, | |
99a6f73c JH |
94 | .port_probe = klsi_105_port_probe, |
95 | .port_remove = klsi_105_port_remove, | |
60b3013c JH |
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, | |
1da177e4 LT |
100 | }; |
101 | ||
4d2a7aff AS |
102 | static struct usb_serial_driver * const serial_drivers[] = { |
103 | &kl5kusb105d_device, NULL | |
104 | }; | |
105 | ||
1da177e4 LT |
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 | ||
1da177e4 LT |
114 | struct klsi_105_private { |
115 | struct klsi_105_port_settings cfg; | |
606d099c | 116 | struct ktermios termios; |
1da177e4 | 117 | unsigned long line_state; /* modem line settings */ |
1da177e4 | 118 | spinlock_t lock; |
1da177e4 LT |
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 | ||
0c265f4e AC |
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); | |
1da177e4 | 143 | if (rc < 0) |
194343d9 GKH |
144 | dev_err(&port->dev, |
145 | "Change port settings failed (error = %d)\n", rc); | |
c197a8db GKH |
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); | |
0c265f4e | 150 | return rc; |
ff8c195f | 151 | } |
1da177e4 LT |
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 | } | |
ff8c195f | 164 | |
0c265f4e | 165 | /* |
1da177e4 | 166 | * Read line control via vendor command and return result through |
0c265f4e | 167 | * *line_state_p |
1da177e4 LT |
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; | |
abf492e7 | 175 | u8 *status_buf; |
1da177e4 LT |
176 | __u16 status; |
177 | ||
c197a8db | 178 | dev_info(&port->serial->dev->dev, "sending SIO Poll request\n"); |
abf492e7 JH |
179 | |
180 | status_buf = kmalloc(KLSI_STATUSBUF_LEN, GFP_KERNEL); | |
10c642d0 | 181 | if (!status_buf) |
abf492e7 | 182 | return -ENOMEM; |
10c642d0 | 183 | |
abf492e7 JH |
184 | status_buf[0] = 0xff; |
185 | status_buf[1] = 0xff; | |
0c265f4e | 186 | rc = usb_control_msg(port->serial->dev, |
1da177e4 LT |
187 | usb_rcvctrlpipe(port->serial->dev, 0), |
188 | KL5KUSB105A_SIO_POLL, | |
0c265f4e | 189 | USB_TYPE_VENDOR | USB_DIR_IN, |
1da177e4 LT |
190 | 0, /* value */ |
191 | 0, /* index */ | |
192 | status_buf, KLSI_STATUSBUF_LEN, | |
193 | 10000 | |
194 | ); | |
195 | if (rc < 0) | |
194343d9 GKH |
196 | dev_err(&port->dev, "Reading line status failed (error = %d)\n", |
197 | rc); | |
1da177e4 | 198 | else { |
bd2c7845 | 199 | status = get_unaligned_le16(status_buf); |
1da177e4 | 200 | |
d9a38a87 | 201 | dev_info(&port->serial->dev->dev, "read status %x %x\n", |
c197a8db | 202 | status_buf[0], status_buf[1]); |
1da177e4 LT |
203 | |
204 | *line_state_p = klsi_105_status2linestate(status); | |
205 | } | |
abf492e7 JH |
206 | |
207 | kfree(status_buf); | |
0c265f4e | 208 | return rc; |
1da177e4 LT |
209 | } |
210 | ||
211 | ||
212 | /* | |
213 | * Driver's tty interface functions | |
214 | */ | |
215 | ||
99a6f73c | 216 | static int klsi_105_port_probe(struct usb_serial_port *port) |
1da177e4 LT |
217 | { |
218 | struct klsi_105_private *priv; | |
1da177e4 | 219 | |
99a6f73c JH |
220 | priv = kmalloc(sizeof(*priv), GFP_KERNEL); |
221 | if (!priv) | |
222 | return -ENOMEM; | |
1da177e4 | 223 | |
99a6f73c JH |
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; | |
1da177e4 | 230 | |
99a6f73c | 231 | priv->line_state = 0; |
1da177e4 | 232 | |
99a6f73c | 233 | spin_lock_init(&priv->lock); |
1da177e4 | 234 | |
99a6f73c | 235 | /* priv->termios is left uninitialized until port opening */ |
1da177e4 | 236 | |
99a6f73c | 237 | usb_set_serial_port_data(port, priv); |
0c265f4e | 238 | |
9306fff1 | 239 | return 0; |
ff8c195f | 240 | } |
1da177e4 | 241 | |
99a6f73c | 242 | static int klsi_105_port_remove(struct usb_serial_port *port) |
f9c99bb8 | 243 | { |
99a6f73c | 244 | struct klsi_105_private *priv; |
f9c99bb8 | 245 | |
99a6f73c JH |
246 | priv = usb_get_serial_port_data(port); |
247 | kfree(priv); | |
248 | ||
249 | return 0; | |
ff8c195f | 250 | } |
1da177e4 | 251 | |
a509a7e4 | 252 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port) |
1da177e4 LT |
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; | |
abf492e7 | 259 | struct klsi_105_port_settings *cfg; |
1da177e4 LT |
260 | unsigned long flags; |
261 | ||
1da177e4 LT |
262 | /* Do a defined restart: |
263 | * Set up sane default baud rate and send the 'READ_ON' | |
0c265f4e | 264 | * vendor command. |
1da177e4 LT |
265 | * FIXME: set modem line control (how?) |
266 | * Then read the modem line control and store values in | |
267 | * priv->line_state. | |
268 | */ | |
abf492e7 | 269 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
10c642d0 | 270 | if (!cfg) |
abf492e7 | 271 | return -ENOMEM; |
10c642d0 | 272 | |
abf492e7 JH |
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); | |
0c265f4e | 279 | |
1da177e4 | 280 | /* set up termios structure */ |
0c265f4e | 281 | spin_lock_irqsave(&priv->lock, flags); |
adc8d746 AC |
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; | |
0c265f4e | 286 | for (i = 0; i < NCCS; i++) |
adc8d746 | 287 | priv->termios.c_cc[i] = tty->termios.c_cc[i]; |
abf492e7 JH |
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; | |
0c265f4e | 293 | spin_unlock_irqrestore(&priv->lock, flags); |
1da177e4 LT |
294 | |
295 | /* READ_ON and urb submission */ | |
60b3013c | 296 | rc = usb_serial_generic_open(tty, port); |
1da177e4 | 297 | if (rc) { |
1da177e4 LT |
298 | retval = rc; |
299 | goto exit; | |
300 | } | |
301 | ||
302 | rc = usb_control_msg(port->serial->dev, | |
0c265f4e | 303 | usb_sndctrlpipe(port->serial->dev, 0), |
1da177e4 LT |
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) { | |
194343d9 | 312 | dev_err(&port->dev, "Enabling read failed (error = %d)\n", rc); |
1da177e4 | 313 | retval = rc; |
0c265f4e | 314 | } else |
1ad7604f | 315 | dev_dbg(&port->dev, "%s - enabled reading\n", __func__); |
1da177e4 LT |
316 | |
317 | rc = klsi_105_get_line_state(port, &line_state); | |
318 | if (rc >= 0) { | |
0c265f4e | 319 | spin_lock_irqsave(&priv->lock, flags); |
1da177e4 | 320 | priv->line_state = line_state; |
0c265f4e | 321 | spin_unlock_irqrestore(&priv->lock, flags); |
1ad7604f | 322 | dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__, line_state); |
1da177e4 LT |
323 | retval = 0; |
324 | } else | |
325 | retval = rc; | |
326 | ||
327 | exit: | |
abf492e7 | 328 | kfree(cfg); |
1da177e4 | 329 | return retval; |
ff8c195f | 330 | } |
1da177e4 | 331 | |
335f8514 | 332 | static void klsi_105_close(struct usb_serial_port *port) |
1da177e4 | 333 | { |
1da177e4 LT |
334 | int rc; |
335 | ||
9fcb2e6e JH |
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); | |
1da177e4 LT |
347 | |
348 | /* shutdown our bulk reads and writes */ | |
60b3013c | 349 | usb_serial_generic_close(port); |
ff8c195f | 350 | } |
1da177e4 LT |
351 | |
352 | /* We need to write a complete 64-byte data block and encode the | |
0c265f4e | 353 | * number actually sent in the first double-byte, LSB-order. That |
1da177e4 LT |
354 | * leaves at most 62 bytes of payload. |
355 | */ | |
60b3013c JH |
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) | |
1da177e4 | 359 | { |
60b3013c JH |
360 | unsigned char *buf = dest; |
361 | int count; | |
17c1b35a | 362 | |
60b3013c JH |
363 | count = kfifo_out_locked(&port->write_fifo, buf + KLSI_HDR_LEN, size, |
364 | &port->lock); | |
365 | put_unaligned_le16(count, buf); | |
1da177e4 | 366 | |
60b3013c | 367 | return count + KLSI_HDR_LEN; |
ff8c195f | 368 | } |
1da177e4 | 369 | |
60b3013c JH |
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) | |
1da177e4 | 373 | { |
cdc97792 | 374 | struct usb_serial_port *port = urb->context; |
1da177e4 | 375 | unsigned char *data = urb->transfer_buffer; |
60b3013c | 376 | unsigned len; |
1da177e4 | 377 | |
60b3013c JH |
378 | /* empty urbs seem to happen, we ignore them */ |
379 | if (!urb->actual_length) | |
380 | return; | |
1da177e4 | 381 | |
60b3013c | 382 | if (urb->actual_length <= KLSI_HDR_LEN) { |
1ad7604f | 383 | dev_dbg(&port->dev, "%s - malformed packet\n", __func__); |
17c1b35a GKH |
384 | return; |
385 | } | |
386 | ||
60b3013c JH |
387 | len = get_unaligned_le16(data); |
388 | if (len > urb->actual_length - KLSI_HDR_LEN) { | |
1ad7604f | 389 | dev_dbg(&port->dev, "%s - packet length mismatch\n", __func__); |
60b3013c | 390 | len = urb->actual_length - KLSI_HDR_LEN; |
1da177e4 | 391 | } |
60b3013c | 392 | |
05c7cd39 | 393 | tty_insert_flip_string(&port->port, data + KLSI_HDR_LEN, len); |
2e124b4a | 394 | tty_flip_buffer_push(&port->port); |
ff8c195f | 395 | } |
1da177e4 | 396 | |
0c265f4e AC |
397 | static void klsi_105_set_termios(struct tty_struct *tty, |
398 | struct usb_serial_port *port, | |
399 | struct ktermios *old_termios) | |
1da177e4 LT |
400 | { |
401 | struct klsi_105_private *priv = usb_get_serial_port_data(port); | |
1ad7604f | 402 | struct device *dev = &port->dev; |
adc8d746 | 403 | unsigned int iflag = tty->termios.c_iflag; |
1da177e4 | 404 | unsigned int old_iflag = old_termios->c_iflag; |
adc8d746 | 405 | unsigned int cflag = tty->termios.c_cflag; |
1da177e4 | 406 | unsigned int old_cflag = old_termios->c_cflag; |
abf492e7 | 407 | struct klsi_105_port_settings *cfg; |
1da177e4 | 408 | unsigned long flags; |
a5b6f60c | 409 | speed_t baud; |
0c265f4e | 410 | |
abf492e7 | 411 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
10c642d0 | 412 | if (!cfg) |
abf492e7 | 413 | return; |
abf492e7 | 414 | |
1da177e4 | 415 | /* lock while we are modifying the settings */ |
0c265f4e AC |
416 | spin_lock_irqsave(&priv->lock, flags); |
417 | ||
1da177e4 LT |
418 | /* |
419 | * Update baud rate | |
420 | */ | |
a5b6f60c AC |
421 | baud = tty_get_baud_rate(tty); |
422 | ||
0c265f4e AC |
423 | if ((cflag & CBAUD) != (old_cflag & CBAUD)) { |
424 | /* reassert DTR and (maybe) RTS on transition from B0 */ | |
425 | if ((old_cflag & CBAUD) == B0) { | |
1ad7604f | 426 | dev_dbg(dev, "%s: baud was B0\n", __func__); |
1da177e4 LT |
427 | #if 0 |
428 | priv->control_state |= TIOCM_DTR; | |
429 | /* don't set RTS if using hardware flow control */ | |
0c265f4e | 430 | if (!(old_cflag & CRTSCTS)) |
1da177e4 | 431 | priv->control_state |= TIOCM_RTS; |
1da177e4 LT |
432 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
433 | #endif | |
434 | } | |
a5b6f60c | 435 | } |
0c265f4e AC |
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: | |
d9a38a87 | 464 | dev_dbg(dev, "unsupported baudrate, using 9600\n"); |
1ad7604f | 465 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; |
0c265f4e AC |
466 | baud = 9600; |
467 | break; | |
a5b6f60c | 468 | } |
0c265f4e | 469 | if ((cflag & CBAUD) == B0) { |
1ad7604f | 470 | dev_dbg(dev, "%s: baud is B0\n", __func__); |
a5b6f60c AC |
471 | /* Drop RTS and DTR */ |
472 | /* maybe this should be simulated by sending read | |
473 | * disable and read enable messages? | |
474 | */ | |
1da177e4 | 475 | #if 0 |
a5b6f60c | 476 | priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS); |
0c265f4e | 477 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
1da177e4 | 478 | #endif |
1da177e4 | 479 | } |
a5b6f60c | 480 | tty_encode_baud_rate(tty, baud, baud); |
1da177e4 LT |
481 | |
482 | if ((cflag & CSIZE) != (old_cflag & CSIZE)) { | |
483 | /* set the number of data bits */ | |
484 | switch (cflag & CSIZE) { | |
485 | case CS5: | |
1ad7604f | 486 | dev_dbg(dev, "%s - 5 bits/byte not supported\n", __func__); |
0c265f4e | 487 | spin_unlock_irqrestore(&priv->lock, flags); |
abf492e7 | 488 | goto err; |
1da177e4 | 489 | case CS6: |
1ad7604f | 490 | dev_dbg(dev, "%s - 6 bits/byte not supported\n", __func__); |
0c265f4e | 491 | spin_unlock_irqrestore(&priv->lock, flags); |
abf492e7 | 492 | goto err; |
1da177e4 LT |
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: | |
1ad7604f | 500 | dev_err(dev, "CSIZE was not CS5-CS8, using default of 8\n"); |
1da177e4 LT |
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)) | |
0c265f4e | 510 | || (cflag & CSTOPB) != (old_cflag & CSTOPB)) { |
a5b6f60c | 511 | /* Not currently supported */ |
adc8d746 | 512 | tty->termios.c_cflag &= ~(PARENB|PARODD|CSTOPB); |
1da177e4 LT |
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 | |
1da177e4 | 529 | } |
1da177e4 LT |
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 | */ | |
0c265f4e | 534 | if ((iflag & IXOFF) != (old_iflag & IXOFF) |
1da177e4 | 535 | || (iflag & IXON) != (old_iflag & IXON) |
0c265f4e | 536 | || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) { |
a5b6f60c | 537 | /* Not currently supported */ |
adc8d746 | 538 | tty->termios.c_cflag &= ~CRTSCTS; |
1da177e4 LT |
539 | /* Drop DTR/RTS if no flow control otherwise assert */ |
540 | #if 0 | |
0c265f4e | 541 | if ((iflag & IXOFF) || (iflag & IXON) || (cflag & CRTSCTS)) |
1da177e4 LT |
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 | |
1da177e4 | 547 | } |
abf492e7 | 548 | memcpy(cfg, &priv->cfg, sizeof(*cfg)); |
0c265f4e AC |
549 | spin_unlock_irqrestore(&priv->lock, flags); |
550 | ||
1da177e4 | 551 | /* now commit changes to device */ |
abf492e7 JH |
552 | klsi_105_chg_port_settings(port, cfg); |
553 | err: | |
554 | kfree(cfg); | |
ff8c195f | 555 | } |
1da177e4 LT |
556 | |
557 | #if 0 | |
0c265f4e | 558 | static void mct_u232_break_ctl(struct tty_struct *tty, int break_state) |
1da177e4 | 559 | { |
95da310e | 560 | struct usb_serial_port *port = tty->driver_data; |
1da177e4 | 561 | struct usb_serial *serial = port->serial; |
0c265f4e AC |
562 | struct mct_u232_private *priv = |
563 | (struct mct_u232_private *)port->private; | |
1da177e4 LT |
564 | unsigned char lcr = priv->last_lcr; |
565 | ||
1ad7604f | 566 | dev_dbg(&port->dev, "%s - state=%d\n", __func__, break_state); |
1da177e4 | 567 | |
6b447f04 | 568 | /* LOCKING */ |
1da177e4 LT |
569 | if (break_state) |
570 | lcr |= MCT_U232_SET_BREAK; | |
571 | ||
572 | mct_u232_set_line_ctrl(serial, lcr); | |
ff8c195f | 573 | } |
1da177e4 LT |
574 | #endif |
575 | ||
60b33c13 | 576 | static int klsi_105_tiocmget(struct tty_struct *tty) |
1da177e4 | 577 | { |
95da310e | 578 | struct usb_serial_port *port = tty->driver_data; |
1da177e4 LT |
579 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
580 | unsigned long flags; | |
581 | int rc; | |
582 | unsigned long line_state; | |
1da177e4 LT |
583 | |
584 | rc = klsi_105_get_line_state(port, &line_state); | |
585 | if (rc < 0) { | |
194343d9 GKH |
586 | dev_err(&port->dev, |
587 | "Reading line control failed (error = %d)\n", rc); | |
1da177e4 LT |
588 | /* better return value? EAGAIN? */ |
589 | return rc; | |
590 | } | |
591 | ||
0c265f4e | 592 | spin_lock_irqsave(&priv->lock, flags); |
1da177e4 | 593 | priv->line_state = line_state; |
0c265f4e | 594 | spin_unlock_irqrestore(&priv->lock, flags); |
1ad7604f | 595 | dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__, line_state); |
1da177e4 LT |
596 | return (int)line_state; |
597 | } | |
598 | ||
68e24113 | 599 | module_usb_serial_driver(serial_drivers, id_table); |
1da177e4 | 600 | |
0c265f4e AC |
601 | MODULE_AUTHOR(DRIVER_AUTHOR); |
602 | MODULE_DESCRIPTION(DRIVER_DESC); | |
603 | MODULE_LICENSE("GPL"); |