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