1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
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
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
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 { }
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 .tiocmget = klsi_105_tiocmget,
93 .port_probe = klsi_105_port_probe,
94 .port_remove = klsi_105_port_remove,
95 .throttle = usb_serial_generic_throttle,
96 .unthrottle = usb_serial_generic_unthrottle,
97 .process_read_urb = klsi_105_process_read_urb,
98 .prepare_write_buffer = klsi_105_prepare_write_buffer,
99};
100
101static struct usb_serial_driver * const serial_drivers[] = {
102 &kl5kusb105d_device, NULL
103};
104
105struct klsi_105_port_settings {
106 u8 pktlen;
107 u8 baudrate;
108 u8 databits;
109 u8 unknown1;
110 u8 unknown2;
111};
112
113struct klsi_105_private {
114 struct klsi_105_port_settings cfg;
115 unsigned long line_state;
116 spinlock_t lock;
117};
118
119
120
121
122
123
124
125#define KLSI_TIMEOUT 5000
126
127static int klsi_105_chg_port_settings(struct usb_serial_port *port,
128 struct klsi_105_port_settings *settings)
129{
130 int rc;
131
132 rc = usb_control_msg(port->serial->dev,
133 usb_sndctrlpipe(port->serial->dev, 0),
134 KL5KUSB105A_SIO_SET_DATA,
135 USB_TYPE_VENDOR | USB_DIR_OUT | USB_RECIP_INTERFACE,
136 0,
137 0,
138 settings,
139 sizeof(struct klsi_105_port_settings),
140 KLSI_TIMEOUT);
141 if (rc < 0)
142 dev_err(&port->dev,
143 "Change port settings failed (error = %d)\n", rc);
144
145 dev_dbg(&port->dev,
146 "pktlen %u, baudrate 0x%02x, databits %u, u1 %u, u2 %u\n",
147 settings->pktlen, settings->baudrate, settings->databits,
148 settings->unknown1, settings->unknown2);
149
150 return rc;
151}
152
153
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
167
168
169
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 status_buf = kmalloc(KLSI_STATUSBUF_LEN, GFP_KERNEL);
179 if (!status_buf)
180 return -ENOMEM;
181
182 status_buf[0] = 0xff;
183 status_buf[1] = 0xff;
184 rc = usb_control_msg(port->serial->dev,
185 usb_rcvctrlpipe(port->serial->dev, 0),
186 KL5KUSB105A_SIO_POLL,
187 USB_TYPE_VENDOR | USB_DIR_IN,
188 0,
189 0,
190 status_buf, KLSI_STATUSBUF_LEN,
191 10000
192 );
193 if (rc != KLSI_STATUSBUF_LEN) {
194 dev_err(&port->dev, "reading line status failed: %d\n", rc);
195 if (rc >= 0)
196 rc = -EIO;
197 } else {
198 status = get_unaligned_le16(status_buf);
199
200 dev_dbg(&port->dev, "read status %02x %02x\n",
201 status_buf[0], status_buf[1]);
202
203 *line_state_p = klsi_105_status2linestate(status);
204 }
205
206 kfree(status_buf);
207 return rc;
208}
209
210
211
212
213
214
215static int klsi_105_port_probe(struct usb_serial_port *port)
216{
217 struct klsi_105_private *priv;
218
219 priv = kmalloc(sizeof(*priv), GFP_KERNEL);
220 if (!priv)
221 return -ENOMEM;
222
223
224 priv->cfg.pktlen = 5;
225 priv->cfg.baudrate = kl5kusb105a_sio_b9600;
226 priv->cfg.databits = kl5kusb105a_dtb_8;
227 priv->cfg.unknown1 = 0;
228 priv->cfg.unknown2 = 1;
229
230 priv->line_state = 0;
231
232 spin_lock_init(&priv->lock);
233
234 usb_set_serial_port_data(port, priv);
235
236 return 0;
237}
238
239static int klsi_105_port_remove(struct usb_serial_port *port)
240{
241 struct klsi_105_private *priv;
242
243 priv = usb_get_serial_port_data(port);
244 kfree(priv);
245
246 return 0;
247}
248
249static int klsi_105_open(struct tty_struct *tty, struct usb_serial_port *port)
250{
251 struct klsi_105_private *priv = usb_get_serial_port_data(port);
252 int retval = 0;
253 int rc;
254 unsigned long line_state;
255 struct klsi_105_port_settings *cfg;
256 unsigned long flags;
257
258
259
260
261
262
263
264
265 cfg = kmalloc(sizeof(*cfg), GFP_KERNEL);
266 if (!cfg)
267 return -ENOMEM;
268
269 cfg->pktlen = 5;
270 cfg->baudrate = kl5kusb105a_sio_b9600;
271 cfg->databits = kl5kusb105a_dtb_8;
272 cfg->unknown1 = 0;
273 cfg->unknown2 = 1;
274 klsi_105_chg_port_settings(port, cfg);
275
276 spin_lock_irqsave(&priv->lock, flags);
277 priv->cfg.pktlen = cfg->pktlen;
278 priv->cfg.baudrate = cfg->baudrate;
279 priv->cfg.databits = cfg->databits;
280 priv->cfg.unknown1 = cfg->unknown1;
281 priv->cfg.unknown2 = cfg->unknown2;
282 spin_unlock_irqrestore(&priv->lock, flags);
283
284
285 rc = usb_serial_generic_open(tty, port);
286 if (rc) {
287 retval = rc;
288 goto err_free_cfg;
289 }
290
291 rc = usb_control_msg(port->serial->dev,
292 usb_sndctrlpipe(port->serial->dev, 0),
293 KL5KUSB105A_SIO_CONFIGURE,
294 USB_TYPE_VENDOR|USB_DIR_OUT|USB_RECIP_INTERFACE,
295 KL5KUSB105A_SIO_CONFIGURE_READ_ON,
296 0,
297 NULL,
298 0,
299 KLSI_TIMEOUT);
300 if (rc < 0) {
301 dev_err(&port->dev, "Enabling read failed (error = %d)\n", rc);
302 retval = rc;
303 goto err_generic_close;
304 } else
305 dev_dbg(&port->dev, "%s - enabled reading\n", __func__);
306
307 rc = klsi_105_get_line_state(port, &line_state);
308 if (rc < 0) {
309 retval = rc;
310 goto err_disable_read;
311 }
312
313 spin_lock_irqsave(&priv->lock, flags);
314 priv->line_state = line_state;
315 spin_unlock_irqrestore(&priv->lock, flags);
316 dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__,
317 line_state);
318
319 return 0;
320
321err_disable_read:
322 usb_control_msg(port->serial->dev,
323 usb_sndctrlpipe(port->serial->dev, 0),
324 KL5KUSB105A_SIO_CONFIGURE,
325 USB_TYPE_VENDOR | USB_DIR_OUT,
326 KL5KUSB105A_SIO_CONFIGURE_READ_OFF,
327 0,
328 NULL, 0,
329 KLSI_TIMEOUT);
330err_generic_close:
331 usb_serial_generic_close(port);
332err_free_cfg:
333 kfree(cfg);
334
335 return retval;
336}
337
338static void klsi_105_close(struct usb_serial_port *port)
339{
340 int rc;
341
342
343 rc = usb_control_msg(port->serial->dev,
344 usb_sndctrlpipe(port->serial->dev, 0),
345 KL5KUSB105A_SIO_CONFIGURE,
346 USB_TYPE_VENDOR | USB_DIR_OUT,
347 KL5KUSB105A_SIO_CONFIGURE_READ_OFF,
348 0,
349 NULL, 0,
350 KLSI_TIMEOUT);
351 if (rc < 0)
352 dev_err(&port->dev, "failed to disable read: %d\n", rc);
353
354
355 usb_serial_generic_close(port);
356}
357
358
359
360
361
362#define KLSI_HDR_LEN 2
363static int klsi_105_prepare_write_buffer(struct usb_serial_port *port,
364 void *dest, size_t size)
365{
366 unsigned char *buf = dest;
367 int count;
368
369 count = kfifo_out_locked(&port->write_fifo, buf + KLSI_HDR_LEN, size,
370 &port->lock);
371 put_unaligned_le16(count, buf);
372
373 return count + KLSI_HDR_LEN;
374}
375
376
377
378static void klsi_105_process_read_urb(struct urb *urb)
379{
380 struct usb_serial_port *port = urb->context;
381 unsigned char *data = urb->transfer_buffer;
382 unsigned len;
383
384
385 if (!urb->actual_length)
386 return;
387
388 if (urb->actual_length <= KLSI_HDR_LEN) {
389 dev_dbg(&port->dev, "%s - malformed packet\n", __func__);
390 return;
391 }
392
393 len = get_unaligned_le16(data);
394 if (len > urb->actual_length - KLSI_HDR_LEN) {
395 dev_dbg(&port->dev, "%s - packet length mismatch\n", __func__);
396 len = urb->actual_length - KLSI_HDR_LEN;
397 }
398
399 tty_insert_flip_string(&port->port, data + KLSI_HDR_LEN, len);
400 tty_flip_buffer_push(&port->port);
401}
402
403static void klsi_105_set_termios(struct tty_struct *tty,
404 struct usb_serial_port *port,
405 struct ktermios *old_termios)
406{
407 struct klsi_105_private *priv = usb_get_serial_port_data(port);
408 struct device *dev = &port->dev;
409 unsigned int iflag = tty->termios.c_iflag;
410 unsigned int old_iflag = old_termios->c_iflag;
411 unsigned int cflag = tty->termios.c_cflag;
412 unsigned int old_cflag = old_termios->c_cflag;
413 struct klsi_105_port_settings *cfg;
414 unsigned long flags;
415 speed_t baud;
416
417 cfg = kmalloc(sizeof(*cfg), GFP_KERNEL);
418 if (!cfg)
419 return;
420
421
422 spin_lock_irqsave(&priv->lock, flags);
423
424
425
426
427 baud = tty_get_baud_rate(tty);
428
429 switch (baud) {
430 case 0:
431 break;
432 case 1200:
433 priv->cfg.baudrate = kl5kusb105a_sio_b1200;
434 break;
435 case 2400:
436 priv->cfg.baudrate = kl5kusb105a_sio_b2400;
437 break;
438 case 4800:
439 priv->cfg.baudrate = kl5kusb105a_sio_b4800;
440 break;
441 case 9600:
442 priv->cfg.baudrate = kl5kusb105a_sio_b9600;
443 break;
444 case 19200:
445 priv->cfg.baudrate = kl5kusb105a_sio_b19200;
446 break;
447 case 38400:
448 priv->cfg.baudrate = kl5kusb105a_sio_b38400;
449 break;
450 case 57600:
451 priv->cfg.baudrate = kl5kusb105a_sio_b57600;
452 break;
453 case 115200:
454 priv->cfg.baudrate = kl5kusb105a_sio_b115200;
455 break;
456 default:
457 dev_dbg(dev, "unsupported baudrate, using 9600\n");
458 priv->cfg.baudrate = kl5kusb105a_sio_b9600;
459 baud = 9600;
460 break;
461 }
462
463
464
465
466
467
468
469
470 tty_encode_baud_rate(tty, baud, baud);
471
472 if ((cflag & CSIZE) != (old_cflag & CSIZE)) {
473
474 switch (cflag & CSIZE) {
475 case CS5:
476 dev_dbg(dev, "%s - 5 bits/byte not supported\n", __func__);
477 spin_unlock_irqrestore(&priv->lock, flags);
478 goto err;
479 case CS6:
480 dev_dbg(dev, "%s - 6 bits/byte not supported\n", __func__);
481 spin_unlock_irqrestore(&priv->lock, flags);
482 goto err;
483 case CS7:
484 priv->cfg.databits = kl5kusb105a_dtb_7;
485 break;
486 case CS8:
487 priv->cfg.databits = kl5kusb105a_dtb_8;
488 break;
489 default:
490 dev_err(dev, "CSIZE was not CS5-CS8, using default of 8\n");
491 priv->cfg.databits = kl5kusb105a_dtb_8;
492 break;
493 }
494 }
495
496
497
498
499 if ((cflag & (PARENB|PARODD)) != (old_cflag & (PARENB|PARODD))
500 || (cflag & CSTOPB) != (old_cflag & CSTOPB)) {
501
502 tty->termios.c_cflag &= ~(PARENB|PARODD|CSTOPB);
503 }
504
505
506
507
508 if ((iflag & IXOFF) != (old_iflag & IXOFF)
509 || (iflag & IXON) != (old_iflag & IXON)
510 || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) {
511
512 tty->termios.c_cflag &= ~CRTSCTS;
513 }
514 memcpy(cfg, &priv->cfg, sizeof(*cfg));
515 spin_unlock_irqrestore(&priv->lock, flags);
516
517
518 klsi_105_chg_port_settings(port, cfg);
519err:
520 kfree(cfg);
521}
522
523static int klsi_105_tiocmget(struct tty_struct *tty)
524{
525 struct usb_serial_port *port = tty->driver_data;
526 struct klsi_105_private *priv = usb_get_serial_port_data(port);
527 unsigned long flags;
528 int rc;
529 unsigned long line_state;
530
531 rc = klsi_105_get_line_state(port, &line_state);
532 if (rc < 0) {
533 dev_err(&port->dev,
534 "Reading line control failed (error = %d)\n", rc);
535
536 return rc;
537 }
538
539 spin_lock_irqsave(&priv->lock, flags);
540 priv->line_state = line_state;
541 spin_unlock_irqrestore(&priv->lock, flags);
542 dev_dbg(&port->dev, "%s - read line state 0x%lx\n", __func__, line_state);
543 return (int)line_state;
544}
545
546module_usb_serial_driver(serial_drivers, id_table);
547
548MODULE_AUTHOR(DRIVER_AUTHOR);
549MODULE_DESCRIPTION(DRIVER_DESC);
550MODULE_LICENSE("GPL");
551