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> | |
40 | #include <linux/init.h> | |
41 | #include <linux/slab.h> | |
42 | #include <linux/tty.h> | |
43 | #include <linux/tty_driver.h> | |
44 | #include <linux/tty_flip.h> | |
45 | #include <linux/module.h> | |
0c265f4e | 46 | #include <linux/uaccess.h> |
fd05e720 | 47 | #include <asm/unaligned.h> |
1da177e4 | 48 | #include <linux/usb.h> |
a969888c | 49 | #include <linux/usb/serial.h> |
1da177e4 LT |
50 | #include "kl5kusb105.h" |
51 | ||
52 | static int debug; | |
53 | ||
54 | /* | |
55 | * Version Information | |
56 | */ | |
60b3013c JH |
57 | #define DRIVER_VERSION "v0.4" |
58 | #define DRIVER_AUTHOR "Utz-Uwe Haus <haus@uuhaus.de>, Johan Hovold <jhovold@gmail.com>" | |
1da177e4 LT |
59 | #define DRIVER_DESC "KLSI KL5KUSB105 chipset USB->Serial Converter driver" |
60 | ||
61 | ||
62 | /* | |
63 | * Function prototypes | |
64 | */ | |
0c265f4e | 65 | static int klsi_105_startup(struct usb_serial *serial); |
f9c99bb8 | 66 | static void klsi_105_release(struct usb_serial *serial); |
a509a7e4 | 67 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port); |
335f8514 | 68 | static void klsi_105_close(struct usb_serial_port *port); |
0c265f4e AC |
69 | static void klsi_105_set_termios(struct tty_struct *tty, |
70 | struct usb_serial_port *port, struct ktermios *old); | |
0c265f4e AC |
71 | static int klsi_105_tiocmget(struct tty_struct *tty, struct file *file); |
72 | static int klsi_105_tiocmset(struct tty_struct *tty, struct file *file, | |
73 | unsigned int set, unsigned int clear); | |
60b3013c JH |
74 | static void klsi_105_process_read_urb(struct urb *urb); |
75 | static int klsi_105_prepare_write_buffer(struct usb_serial_port *port, | |
76 | void *dest, size_t size); | |
1da177e4 LT |
77 | |
78 | /* | |
79 | * All of the device info needed for the KLSI converters. | |
80 | */ | |
7d40d7e8 | 81 | static const struct usb_device_id id_table[] = { |
1da177e4 LT |
82 | { USB_DEVICE(PALMCONNECT_VID, PALMCONNECT_PID) }, |
83 | { USB_DEVICE(KLSI_VID, KLSI_KL5KUSB105D_PID) }, | |
84 | { } /* Terminating entry */ | |
85 | }; | |
86 | ||
0c265f4e | 87 | MODULE_DEVICE_TABLE(usb, id_table); |
1da177e4 LT |
88 | |
89 | static struct usb_driver kl5kusb105d_driver = { | |
1da177e4 LT |
90 | .name = "kl5kusb105d", |
91 | .probe = usb_serial_probe, | |
92 | .disconnect = usb_serial_disconnect, | |
93 | .id_table = id_table, | |
ff8c195f | 94 | .no_dynamic_id = 1, |
1da177e4 LT |
95 | }; |
96 | ||
ea65370d | 97 | static struct usb_serial_driver kl5kusb105d_device = { |
18fcac35 GKH |
98 | .driver = { |
99 | .owner = THIS_MODULE, | |
269bda1c | 100 | .name = "kl5kusb105d", |
18fcac35 | 101 | }, |
ff8c195f JH |
102 | .description = "KL5KUSB105D / PalmConnect", |
103 | .usb_driver = &kl5kusb105d_driver, | |
104 | .id_table = id_table, | |
105 | .num_ports = 1, | |
60b3013c | 106 | .bulk_out_size = 64, |
ff8c195f JH |
107 | .open = klsi_105_open, |
108 | .close = klsi_105_close, | |
ff8c195f JH |
109 | .set_termios = klsi_105_set_termios, |
110 | /*.break_ctl = klsi_105_break_ctl,*/ | |
111 | .tiocmget = klsi_105_tiocmget, | |
112 | .tiocmset = klsi_105_tiocmset, | |
113 | .attach = klsi_105_startup, | |
ff8c195f | 114 | .release = klsi_105_release, |
60b3013c JH |
115 | .throttle = usb_serial_generic_throttle, |
116 | .unthrottle = usb_serial_generic_unthrottle, | |
117 | .process_read_urb = klsi_105_process_read_urb, | |
118 | .prepare_write_buffer = klsi_105_prepare_write_buffer, | |
1da177e4 LT |
119 | }; |
120 | ||
121 | struct klsi_105_port_settings { | |
122 | __u8 pktlen; /* always 5, it seems */ | |
123 | __u8 baudrate; | |
124 | __u8 databits; | |
125 | __u8 unknown1; | |
126 | __u8 unknown2; | |
127 | } __attribute__ ((packed)); | |
128 | ||
1da177e4 LT |
129 | struct klsi_105_private { |
130 | struct klsi_105_port_settings cfg; | |
606d099c | 131 | struct ktermios termios; |
1da177e4 | 132 | unsigned long line_state; /* modem line settings */ |
1da177e4 | 133 | spinlock_t lock; |
1da177e4 LT |
134 | }; |
135 | ||
136 | ||
137 | /* | |
138 | * Handle vendor specific USB requests | |
139 | */ | |
140 | ||
141 | ||
142 | #define KLSI_TIMEOUT 5000 /* default urb timeout */ | |
143 | ||
144 | static int klsi_105_chg_port_settings(struct usb_serial_port *port, | |
145 | struct klsi_105_port_settings *settings) | |
146 | { | |
147 | int rc; | |
148 | ||
0c265f4e AC |
149 | rc = usb_control_msg(port->serial->dev, |
150 | usb_sndctrlpipe(port->serial->dev, 0), | |
151 | KL5KUSB105A_SIO_SET_DATA, | |
152 | USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_INTERFACE, | |
153 | 0, /* value */ | |
154 | 0, /* index */ | |
155 | settings, | |
156 | sizeof(struct klsi_105_port_settings), | |
157 | KLSI_TIMEOUT); | |
1da177e4 | 158 | if (rc < 0) |
194343d9 GKH |
159 | dev_err(&port->dev, |
160 | "Change port settings failed (error = %d)\n", rc); | |
c197a8db GKH |
161 | dev_info(&port->serial->dev->dev, |
162 | "%d byte block, baudrate %x, databits %d, u1 %d, u2 %d\n", | |
163 | settings->pktlen, settings->baudrate, settings->databits, | |
164 | settings->unknown1, settings->unknown2); | |
0c265f4e | 165 | return rc; |
ff8c195f | 166 | } |
1da177e4 LT |
167 | |
168 | /* translate a 16-bit status value from the device to linux's TIO bits */ | |
169 | static unsigned long klsi_105_status2linestate(const __u16 status) | |
170 | { | |
171 | unsigned long res = 0; | |
172 | ||
173 | res = ((status & KL5KUSB105A_DSR) ? TIOCM_DSR : 0) | |
174 | | ((status & KL5KUSB105A_CTS) ? TIOCM_CTS : 0) | |
175 | ; | |
176 | ||
177 | return res; | |
178 | } | |
ff8c195f | 179 | |
0c265f4e | 180 | /* |
1da177e4 | 181 | * Read line control via vendor command and return result through |
0c265f4e | 182 | * *line_state_p |
1da177e4 LT |
183 | */ |
184 | /* It seems that the status buffer has always only 2 bytes length */ | |
185 | #define KLSI_STATUSBUF_LEN 2 | |
186 | static int klsi_105_get_line_state(struct usb_serial_port *port, | |
187 | unsigned long *line_state_p) | |
188 | { | |
189 | int rc; | |
abf492e7 | 190 | u8 *status_buf; |
1da177e4 LT |
191 | __u16 status; |
192 | ||
c197a8db | 193 | dev_info(&port->serial->dev->dev, "sending SIO Poll request\n"); |
abf492e7 JH |
194 | |
195 | status_buf = kmalloc(KLSI_STATUSBUF_LEN, GFP_KERNEL); | |
196 | if (!status_buf) { | |
197 | dev_err(&port->dev, "%s - out of memory for status buffer.\n", | |
198 | __func__); | |
199 | return -ENOMEM; | |
200 | } | |
201 | status_buf[0] = 0xff; | |
202 | status_buf[1] = 0xff; | |
0c265f4e | 203 | rc = usb_control_msg(port->serial->dev, |
1da177e4 LT |
204 | usb_rcvctrlpipe(port->serial->dev, 0), |
205 | KL5KUSB105A_SIO_POLL, | |
0c265f4e | 206 | USB_TYPE_VENDOR | USB_DIR_IN, |
1da177e4 LT |
207 | 0, /* value */ |
208 | 0, /* index */ | |
209 | status_buf, KLSI_STATUSBUF_LEN, | |
210 | 10000 | |
211 | ); | |
212 | if (rc < 0) | |
194343d9 GKH |
213 | dev_err(&port->dev, "Reading line status failed (error = %d)\n", |
214 | rc); | |
1da177e4 | 215 | else { |
bd2c7845 | 216 | status = get_unaligned_le16(status_buf); |
1da177e4 | 217 | |
c197a8db GKH |
218 | dev_info(&port->serial->dev->dev, "read status %x %x", |
219 | status_buf[0], status_buf[1]); | |
1da177e4 LT |
220 | |
221 | *line_state_p = klsi_105_status2linestate(status); | |
222 | } | |
abf492e7 JH |
223 | |
224 | kfree(status_buf); | |
0c265f4e | 225 | return rc; |
1da177e4 LT |
226 | } |
227 | ||
228 | ||
229 | /* | |
230 | * Driver's tty interface functions | |
231 | */ | |
232 | ||
0c265f4e | 233 | static int klsi_105_startup(struct usb_serial *serial) |
1da177e4 LT |
234 | { |
235 | struct klsi_105_private *priv; | |
60b3013c | 236 | int i; |
1da177e4 LT |
237 | |
238 | /* check if we support the product id (see keyspan.c) | |
239 | * FIXME | |
240 | */ | |
241 | ||
242 | /* allocate the private data structure */ | |
0c265f4e | 243 | for (i = 0; i < serial->num_ports; i++) { |
1da177e4 LT |
244 | priv = kmalloc(sizeof(struct klsi_105_private), |
245 | GFP_KERNEL); | |
246 | if (!priv) { | |
441b62c1 | 247 | dbg("%skmalloc for klsi_105_private failed.", __func__); |
9306fff1 ON |
248 | i--; |
249 | goto err_cleanup; | |
1da177e4 LT |
250 | } |
251 | /* set initial values for control structures */ | |
252 | priv->cfg.pktlen = 5; | |
253 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; | |
254 | priv->cfg.databits = kl5kusb105a_dtb_8; | |
255 | priv->cfg.unknown1 = 0; | |
256 | priv->cfg.unknown2 = 1; | |
257 | ||
258 | priv->line_state = 0; | |
259 | ||
1da177e4 LT |
260 | usb_set_serial_port_data(serial->port[i], priv); |
261 | ||
0c265f4e | 262 | spin_lock_init(&priv->lock); |
1da177e4 | 263 | |
421f91d2 | 264 | /* priv->termios is left uninitialized until port opening */ |
1da177e4 LT |
265 | init_waitqueue_head(&serial->port[i]->write_wait); |
266 | } | |
0c265f4e | 267 | |
9306fff1 ON |
268 | return 0; |
269 | ||
270 | err_cleanup: | |
271 | for (; i >= 0; i--) { | |
272 | priv = usb_get_serial_port_data(serial->port[i]); | |
313b0d80 | 273 | kfree(priv); |
9306fff1 ON |
274 | usb_set_serial_port_data(serial->port[i], NULL); |
275 | } | |
276 | return -ENOMEM; | |
ff8c195f | 277 | } |
1da177e4 | 278 | |
f9c99bb8 AS |
279 | static void klsi_105_release(struct usb_serial *serial) |
280 | { | |
281 | int i; | |
282 | ||
283 | dbg("%s", __func__); | |
284 | ||
60b3013c JH |
285 | for (i = 0; i < serial->num_ports; ++i) |
286 | kfree(usb_get_serial_port_data(serial->port[i])); | |
ff8c195f | 287 | } |
1da177e4 | 288 | |
a509a7e4 | 289 | static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port) |
1da177e4 LT |
290 | { |
291 | struct klsi_105_private *priv = usb_get_serial_port_data(port); | |
292 | int retval = 0; | |
293 | int rc; | |
294 | int i; | |
295 | unsigned long line_state; | |
abf492e7 | 296 | struct klsi_105_port_settings *cfg; |
1da177e4 LT |
297 | unsigned long flags; |
298 | ||
441b62c1 | 299 | dbg("%s port %d", __func__, port->number); |
1da177e4 | 300 | |
1da177e4 LT |
301 | /* Do a defined restart: |
302 | * Set up sane default baud rate and send the 'READ_ON' | |
0c265f4e | 303 | * vendor command. |
1da177e4 LT |
304 | * FIXME: set modem line control (how?) |
305 | * Then read the modem line control and store values in | |
306 | * priv->line_state. | |
307 | */ | |
abf492e7 JH |
308 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
309 | if (!cfg) { | |
310 | dev_err(&port->dev, "%s - out of memory for config buffer.\n", | |
311 | __func__); | |
312 | return -ENOMEM; | |
313 | } | |
314 | cfg->pktlen = 5; | |
315 | cfg->baudrate = kl5kusb105a_sio_b9600; | |
316 | cfg->databits = kl5kusb105a_dtb_8; | |
317 | cfg->unknown1 = 0; | |
318 | cfg->unknown2 = 1; | |
319 | klsi_105_chg_port_settings(port, cfg); | |
0c265f4e | 320 | |
1da177e4 | 321 | /* set up termios structure */ |
0c265f4e | 322 | spin_lock_irqsave(&priv->lock, flags); |
95da310e AC |
323 | priv->termios.c_iflag = tty->termios->c_iflag; |
324 | priv->termios.c_oflag = tty->termios->c_oflag; | |
325 | priv->termios.c_cflag = tty->termios->c_cflag; | |
326 | priv->termios.c_lflag = tty->termios->c_lflag; | |
0c265f4e | 327 | for (i = 0; i < NCCS; i++) |
95da310e | 328 | priv->termios.c_cc[i] = tty->termios->c_cc[i]; |
abf492e7 JH |
329 | priv->cfg.pktlen = cfg->pktlen; |
330 | priv->cfg.baudrate = cfg->baudrate; | |
331 | priv->cfg.databits = cfg->databits; | |
332 | priv->cfg.unknown1 = cfg->unknown1; | |
333 | priv->cfg.unknown2 = cfg->unknown2; | |
0c265f4e | 334 | spin_unlock_irqrestore(&priv->lock, flags); |
1da177e4 LT |
335 | |
336 | /* READ_ON and urb submission */ | |
60b3013c | 337 | rc = usb_serial_generic_open(tty, port); |
1da177e4 | 338 | if (rc) { |
1da177e4 LT |
339 | retval = rc; |
340 | goto exit; | |
341 | } | |
342 | ||
343 | rc = usb_control_msg(port->serial->dev, | |
0c265f4e | 344 | usb_sndctrlpipe(port->serial->dev, 0), |
1da177e4 LT |
345 | KL5KUSB105A_SIO_CONFIGURE, |
346 | USB_TYPE_VENDOR|USB_DIR_OUT|USB_RECIP_INTERFACE, | |
347 | KL5KUSB105A_SIO_CONFIGURE_READ_ON, | |
348 | 0, /* index */ | |
349 | NULL, | |
350 | 0, | |
351 | KLSI_TIMEOUT); | |
352 | if (rc < 0) { | |
194343d9 | 353 | dev_err(&port->dev, "Enabling read failed (error = %d)\n", rc); |
1da177e4 | 354 | retval = rc; |
0c265f4e | 355 | } else |
441b62c1 | 356 | dbg("%s - enabled reading", __func__); |
1da177e4 LT |
357 | |
358 | rc = klsi_105_get_line_state(port, &line_state); | |
359 | if (rc >= 0) { | |
0c265f4e | 360 | spin_lock_irqsave(&priv->lock, flags); |
1da177e4 | 361 | priv->line_state = line_state; |
0c265f4e | 362 | spin_unlock_irqrestore(&priv->lock, flags); |
441b62c1 | 363 | dbg("%s - read line state 0x%lx", __func__, line_state); |
1da177e4 LT |
364 | retval = 0; |
365 | } else | |
366 | retval = rc; | |
367 | ||
368 | exit: | |
abf492e7 | 369 | kfree(cfg); |
1da177e4 | 370 | return retval; |
ff8c195f | 371 | } |
1da177e4 | 372 | |
335f8514 | 373 | static void klsi_105_close(struct usb_serial_port *port) |
1da177e4 | 374 | { |
1da177e4 LT |
375 | int rc; |
376 | ||
441b62c1 | 377 | dbg("%s port %d", __func__, port->number); |
1da177e4 | 378 | |
3edbc986 ON |
379 | mutex_lock(&port->serial->disc_mutex); |
380 | if (!port->serial->disconnected) { | |
381 | /* send READ_OFF */ | |
0c265f4e AC |
382 | rc = usb_control_msg(port->serial->dev, |
383 | usb_sndctrlpipe(port->serial->dev, 0), | |
384 | KL5KUSB105A_SIO_CONFIGURE, | |
385 | USB_TYPE_VENDOR | USB_DIR_OUT, | |
386 | KL5KUSB105A_SIO_CONFIGURE_READ_OFF, | |
387 | 0, /* index */ | |
388 | NULL, 0, | |
389 | KLSI_TIMEOUT); | |
3edbc986 | 390 | if (rc < 0) |
194343d9 GKH |
391 | dev_err(&port->dev, |
392 | "Disabling read failed (error = %d)\n", rc); | |
3edbc986 ON |
393 | } |
394 | mutex_unlock(&port->serial->disc_mutex); | |
1da177e4 LT |
395 | |
396 | /* shutdown our bulk reads and writes */ | |
60b3013c JH |
397 | usb_serial_generic_close(port); |
398 | ||
1da177e4 LT |
399 | /* wgg - do I need this? I think so. */ |
400 | usb_kill_urb(port->interrupt_in_urb); | |
ff8c195f | 401 | } |
1da177e4 LT |
402 | |
403 | /* We need to write a complete 64-byte data block and encode the | |
0c265f4e | 404 | * number actually sent in the first double-byte, LSB-order. That |
1da177e4 LT |
405 | * leaves at most 62 bytes of payload. |
406 | */ | |
60b3013c JH |
407 | #define KLSI_HDR_LEN 2 |
408 | static int klsi_105_prepare_write_buffer(struct usb_serial_port *port, | |
409 | void *dest, size_t size) | |
1da177e4 | 410 | { |
60b3013c JH |
411 | unsigned char *buf = dest; |
412 | int count; | |
17c1b35a | 413 | |
60b3013c JH |
414 | count = kfifo_out_locked(&port->write_fifo, buf + KLSI_HDR_LEN, size, |
415 | &port->lock); | |
416 | put_unaligned_le16(count, buf); | |
1da177e4 | 417 | |
60b3013c | 418 | return count + KLSI_HDR_LEN; |
ff8c195f | 419 | } |
1da177e4 | 420 | |
60b3013c JH |
421 | /* The data received is preceded by a length double-byte in LSB-first order. |
422 | */ | |
423 | static void klsi_105_process_read_urb(struct urb *urb) | |
1da177e4 | 424 | { |
cdc97792 | 425 | struct usb_serial_port *port = urb->context; |
1da177e4 | 426 | unsigned char *data = urb->transfer_buffer; |
60b3013c JH |
427 | struct tty_struct *tty; |
428 | unsigned len; | |
1da177e4 | 429 | |
60b3013c JH |
430 | /* empty urbs seem to happen, we ignore them */ |
431 | if (!urb->actual_length) | |
432 | return; | |
1da177e4 | 433 | |
60b3013c JH |
434 | if (urb->actual_length <= KLSI_HDR_LEN) { |
435 | dbg("%s - malformed packet", __func__); | |
17c1b35a GKH |
436 | return; |
437 | } | |
438 | ||
60b3013c JH |
439 | tty = tty_port_tty_get(&port->port); |
440 | if (!tty) | |
441 | return; | |
1da177e4 | 442 | |
60b3013c JH |
443 | len = get_unaligned_le16(data); |
444 | if (len > urb->actual_length - KLSI_HDR_LEN) { | |
445 | dbg("%s - packet length mismatch", __func__); | |
446 | len = urb->actual_length - KLSI_HDR_LEN; | |
1da177e4 | 447 | } |
60b3013c JH |
448 | |
449 | tty_insert_flip_string(tty, data + KLSI_HDR_LEN, len); | |
450 | tty_flip_buffer_push(tty); | |
451 | tty_kref_put(tty); | |
ff8c195f | 452 | } |
1da177e4 | 453 | |
0c265f4e AC |
454 | static void klsi_105_set_termios(struct tty_struct *tty, |
455 | struct usb_serial_port *port, | |
456 | struct ktermios *old_termios) | |
1da177e4 LT |
457 | { |
458 | struct klsi_105_private *priv = usb_get_serial_port_data(port); | |
a5b6f60c | 459 | unsigned int iflag = tty->termios->c_iflag; |
1da177e4 | 460 | unsigned int old_iflag = old_termios->c_iflag; |
a5b6f60c | 461 | unsigned int cflag = tty->termios->c_cflag; |
1da177e4 | 462 | unsigned int old_cflag = old_termios->c_cflag; |
abf492e7 | 463 | struct klsi_105_port_settings *cfg; |
1da177e4 | 464 | unsigned long flags; |
a5b6f60c | 465 | speed_t baud; |
0c265f4e | 466 | |
abf492e7 JH |
467 | cfg = kmalloc(sizeof(*cfg), GFP_KERNEL); |
468 | if (!cfg) { | |
469 | dev_err(&port->dev, "%s - out of memory for config buffer.\n", | |
470 | __func__); | |
471 | return; | |
472 | } | |
473 | ||
1da177e4 | 474 | /* lock while we are modifying the settings */ |
0c265f4e AC |
475 | spin_lock_irqsave(&priv->lock, flags); |
476 | ||
1da177e4 LT |
477 | /* |
478 | * Update baud rate | |
479 | */ | |
a5b6f60c AC |
480 | baud = tty_get_baud_rate(tty); |
481 | ||
0c265f4e AC |
482 | if ((cflag & CBAUD) != (old_cflag & CBAUD)) { |
483 | /* reassert DTR and (maybe) RTS on transition from B0 */ | |
484 | if ((old_cflag & CBAUD) == B0) { | |
441b62c1 | 485 | dbg("%s: baud was B0", __func__); |
1da177e4 LT |
486 | #if 0 |
487 | priv->control_state |= TIOCM_DTR; | |
488 | /* don't set RTS if using hardware flow control */ | |
0c265f4e | 489 | if (!(old_cflag & CRTSCTS)) |
1da177e4 | 490 | priv->control_state |= TIOCM_RTS; |
1da177e4 LT |
491 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
492 | #endif | |
493 | } | |
a5b6f60c | 494 | } |
0c265f4e AC |
495 | switch (baud) { |
496 | case 0: /* handled below */ | |
497 | break; | |
498 | case 1200: | |
499 | priv->cfg.baudrate = kl5kusb105a_sio_b1200; | |
500 | break; | |
501 | case 2400: | |
502 | priv->cfg.baudrate = kl5kusb105a_sio_b2400; | |
503 | break; | |
504 | case 4800: | |
505 | priv->cfg.baudrate = kl5kusb105a_sio_b4800; | |
506 | break; | |
507 | case 9600: | |
508 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; | |
509 | break; | |
510 | case 19200: | |
511 | priv->cfg.baudrate = kl5kusb105a_sio_b19200; | |
512 | break; | |
513 | case 38400: | |
514 | priv->cfg.baudrate = kl5kusb105a_sio_b38400; | |
515 | break; | |
516 | case 57600: | |
517 | priv->cfg.baudrate = kl5kusb105a_sio_b57600; | |
518 | break; | |
519 | case 115200: | |
520 | priv->cfg.baudrate = kl5kusb105a_sio_b115200; | |
521 | break; | |
522 | default: | |
523 | dbg("KLSI USB->Serial converter:" | |
524 | " unsupported baudrate request, using default of 9600"); | |
3f6ff6ef | 525 | priv->cfg.baudrate = kl5kusb105a_sio_b9600; |
0c265f4e AC |
526 | baud = 9600; |
527 | break; | |
a5b6f60c | 528 | } |
0c265f4e | 529 | if ((cflag & CBAUD) == B0) { |
a5b6f60c AC |
530 | dbg("%s: baud is B0", __func__); |
531 | /* Drop RTS and DTR */ | |
532 | /* maybe this should be simulated by sending read | |
533 | * disable and read enable messages? | |
534 | */ | |
535 | ; | |
1da177e4 | 536 | #if 0 |
a5b6f60c | 537 | priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS); |
0c265f4e | 538 | mct_u232_set_modem_ctrl(serial, priv->control_state); |
1da177e4 | 539 | #endif |
1da177e4 | 540 | } |
a5b6f60c | 541 | tty_encode_baud_rate(tty, baud, baud); |
1da177e4 LT |
542 | |
543 | if ((cflag & CSIZE) != (old_cflag & CSIZE)) { | |
544 | /* set the number of data bits */ | |
545 | switch (cflag & CSIZE) { | |
546 | case CS5: | |
441b62c1 | 547 | dbg("%s - 5 bits/byte not supported", __func__); |
0c265f4e | 548 | spin_unlock_irqrestore(&priv->lock, flags); |
abf492e7 | 549 | goto err; |
1da177e4 | 550 | case CS6: |
441b62c1 | 551 | dbg("%s - 6 bits/byte not supported", __func__); |
0c265f4e | 552 | spin_unlock_irqrestore(&priv->lock, flags); |
abf492e7 | 553 | goto err; |
1da177e4 LT |
554 | case CS7: |
555 | priv->cfg.databits = kl5kusb105a_dtb_7; | |
556 | break; | |
557 | case CS8: | |
558 | priv->cfg.databits = kl5kusb105a_dtb_8; | |
559 | break; | |
560 | default: | |
194343d9 GKH |
561 | dev_err(&port->dev, |
562 | "CSIZE was not CS5-CS8, using default of 8\n"); | |
1da177e4 LT |
563 | priv->cfg.databits = kl5kusb105a_dtb_8; |
564 | break; | |
565 | } | |
566 | } | |
567 | ||
568 | /* | |
569 | * Update line control register (LCR) | |
570 | */ | |
571 | if ((cflag & (PARENB|PARODD)) != (old_cflag & (PARENB|PARODD)) | |
0c265f4e | 572 | || (cflag & CSTOPB) != (old_cflag & CSTOPB)) { |
a5b6f60c AC |
573 | /* Not currently supported */ |
574 | tty->termios->c_cflag &= ~(PARENB|PARODD|CSTOPB); | |
1da177e4 LT |
575 | #if 0 |
576 | priv->last_lcr = 0; | |
577 | ||
578 | /* set the parity */ | |
579 | if (cflag & PARENB) | |
580 | priv->last_lcr |= (cflag & PARODD) ? | |
581 | MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN; | |
582 | else | |
583 | priv->last_lcr |= MCT_U232_PARITY_NONE; | |
584 | ||
585 | /* set the number of stop bits */ | |
586 | priv->last_lcr |= (cflag & CSTOPB) ? | |
587 | MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1; | |
588 | ||
589 | mct_u232_set_line_ctrl(serial, priv->last_lcr); | |
590 | #endif | |
591 | ; | |
592 | } | |
1da177e4 LT |
593 | /* |
594 | * Set flow control: well, I do not really now how to handle DTR/RTS. | |
595 | * Just do what we have seen with SniffUSB on Win98. | |
596 | */ | |
0c265f4e | 597 | if ((iflag & IXOFF) != (old_iflag & IXOFF) |
1da177e4 | 598 | || (iflag & IXON) != (old_iflag & IXON) |
0c265f4e | 599 | || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) { |
a5b6f60c AC |
600 | /* Not currently supported */ |
601 | tty->termios->c_cflag &= ~CRTSCTS; | |
1da177e4 LT |
602 | /* Drop DTR/RTS if no flow control otherwise assert */ |
603 | #if 0 | |
0c265f4e | 604 | if ((iflag & IXOFF) || (iflag & IXON) || (cflag & CRTSCTS)) |
1da177e4 LT |
605 | priv->control_state |= TIOCM_DTR | TIOCM_RTS; |
606 | else | |
607 | priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS); | |
608 | mct_u232_set_modem_ctrl(serial, priv->control_state); | |
609 | #endif | |
610 | ; | |
611 | } | |
abf492e7 | 612 | memcpy(cfg, &priv->cfg, sizeof(*cfg)); |
0c265f4e AC |
613 | spin_unlock_irqrestore(&priv->lock, flags); |
614 | ||
1da177e4 | 615 | /* now commit changes to device */ |
abf492e7 JH |
616 | klsi_105_chg_port_settings(port, cfg); |
617 | err: | |
618 | kfree(cfg); | |
ff8c195f | 619 | } |
1da177e4 LT |
620 | |
621 | #if 0 | |
0c265f4e | 622 | static void mct_u232_break_ctl(struct tty_struct *tty, int break_state) |
1da177e4 | 623 | { |
95da310e | 624 | struct usb_serial_port *port = tty->driver_data; |
1da177e4 | 625 | struct usb_serial *serial = port->serial; |
0c265f4e AC |
626 | struct mct_u232_private *priv = |
627 | (struct mct_u232_private *)port->private; | |
1da177e4 LT |
628 | unsigned char lcr = priv->last_lcr; |
629 | ||
441b62c1 | 630 | dbg("%sstate=%d", __func__, break_state); |
1da177e4 | 631 | |
6b447f04 | 632 | /* LOCKING */ |
1da177e4 LT |
633 | if (break_state) |
634 | lcr |= MCT_U232_SET_BREAK; | |
635 | ||
636 | mct_u232_set_line_ctrl(serial, lcr); | |
ff8c195f | 637 | } |
1da177e4 LT |
638 | #endif |
639 | ||
0c265f4e | 640 | static int klsi_105_tiocmget(struct tty_struct *tty, struct file *file) |
1da177e4 | 641 | { |
95da310e | 642 | struct usb_serial_port *port = tty->driver_data; |
1da177e4 LT |
643 | struct klsi_105_private *priv = usb_get_serial_port_data(port); |
644 | unsigned long flags; | |
645 | int rc; | |
646 | unsigned long line_state; | |
441b62c1 | 647 | dbg("%s - request, just guessing", __func__); |
1da177e4 LT |
648 | |
649 | rc = klsi_105_get_line_state(port, &line_state); | |
650 | if (rc < 0) { | |
194343d9 GKH |
651 | dev_err(&port->dev, |
652 | "Reading line control failed (error = %d)\n", rc); | |
1da177e4 LT |
653 | /* better return value? EAGAIN? */ |
654 | return rc; | |
655 | } | |
656 | ||
0c265f4e | 657 | spin_lock_irqsave(&priv->lock, flags); |
1da177e4 | 658 | priv->line_state = line_state; |
0c265f4e | 659 | spin_unlock_irqrestore(&priv->lock, flags); |
441b62c1 | 660 | dbg("%s - read line state 0x%lx", __func__, line_state); |
1da177e4 LT |
661 | return (int)line_state; |
662 | } | |
663 | ||
0c265f4e AC |
664 | static int klsi_105_tiocmset(struct tty_struct *tty, struct file *file, |
665 | unsigned int set, unsigned int clear) | |
1da177e4 LT |
666 | { |
667 | int retval = -EINVAL; | |
0c265f4e | 668 | |
441b62c1 | 669 | dbg("%s", __func__); |
1da177e4 LT |
670 | |
671 | /* if this ever gets implemented, it should be done something like this: | |
672 | struct usb_serial *serial = port->serial; | |
673 | struct klsi_105_private *priv = usb_get_serial_port_data(port); | |
674 | unsigned long flags; | |
675 | int control; | |
676 | ||
677 | spin_lock_irqsave (&priv->lock, flags); | |
678 | if (set & TIOCM_RTS) | |
679 | priv->control_state |= TIOCM_RTS; | |
680 | if (set & TIOCM_DTR) | |
681 | priv->control_state |= TIOCM_DTR; | |
682 | if (clear & TIOCM_RTS) | |
683 | priv->control_state &= ~TIOCM_RTS; | |
684 | if (clear & TIOCM_DTR) | |
685 | priv->control_state &= ~TIOCM_DTR; | |
686 | control = priv->control_state; | |
687 | spin_unlock_irqrestore (&priv->lock, flags); | |
688 | retval = mct_u232_set_modem_ctrl(serial, control); | |
689 | */ | |
690 | return retval; | |
691 | } | |
1da177e4 | 692 | |
1da177e4 | 693 | |
0c265f4e | 694 | static int __init klsi_105_init(void) |
1da177e4 LT |
695 | { |
696 | int retval; | |
697 | retval = usb_serial_register(&kl5kusb105d_device); | |
698 | if (retval) | |
699 | goto failed_usb_serial_register; | |
700 | retval = usb_register(&kl5kusb105d_driver); | |
701 | if (retval) | |
702 | goto failed_usb_register; | |
703 | ||
c197a8db GKH |
704 | printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":" |
705 | DRIVER_DESC "\n"); | |
1da177e4 LT |
706 | return 0; |
707 | failed_usb_register: | |
708 | usb_serial_deregister(&kl5kusb105d_device); | |
709 | failed_usb_serial_register: | |
710 | return retval; | |
711 | } | |
712 | ||
0c265f4e | 713 | static void __exit klsi_105_exit(void) |
1da177e4 | 714 | { |
0c265f4e AC |
715 | usb_deregister(&kl5kusb105d_driver); |
716 | usb_serial_deregister(&kl5kusb105d_device); | |
1da177e4 LT |
717 | } |
718 | ||
719 | ||
0c265f4e AC |
720 | module_init(klsi_105_init); |
721 | module_exit(klsi_105_exit); | |
1da177e4 | 722 | |
0c265f4e AC |
723 | MODULE_AUTHOR(DRIVER_AUTHOR); |
724 | MODULE_DESCRIPTION(DRIVER_DESC); | |
725 | MODULE_LICENSE("GPL"); | |
1da177e4 LT |
726 | |
727 | ||
728 | module_param(debug, bool, S_IRUGO | S_IWUSR); | |
729 | MODULE_PARM_DESC(debug, "enable extensive debugging messages"); |