2 * KLSI KL5KUSB105 chip RS232 converter driver
4 * Copyright (C) 2001 Utz-Uwe Haus <haus@uuhaus.de>
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * All information about the device was acquired using SniffUSB ans snoopUSB
13 * It was written out of frustration with the PalmConnect USB Serial adapter
15 * Neither Palm, nor their contractor (MCCI) or their supplier (KLSI) provided
16 * information that was not already available.
18 * It seems that KLSI bought some silicon-design information from ScanLogic,
19 * whose SL11R processor is at the core of the KL5KUSB chipset from KLSI.
20 * KLSI has firmware available for their devices; it is probable that the
21 * firmware differs from that used by KLSI in their products. If you have an
22 * original KLSI device and can provide some information on it, I would be
23 * most interested in adding support for it here. If you have any information
24 * on the protocol used (or find errors in my reverse-engineered stuff), please
27 * The code was only tested with a PalmConnect USB adapter; if you
28 * are adventurous, try it with any KLSI-based device and let me know how it
29 * breaks so that I can fix it!
33 * check modem line signals
34 * implement handshaking or decide that we do not support it
38 * 0.3a - implemented pools of write URBs
39 * 0.3 - alpha version for public testing
40 * 0.2 - TIOCMGET works, so autopilot(1) can be used!
41 * 0.1 - can be used to to pilot-xfer -p /dev/ttyUSB0 -l
43 * The driver skeleton is mainly based on mct_u232.c and various other
44 * pieces of code shamelessly copied from the drivers/usb/serial/ directory.
48 #include <linux/config.h>
49 #include <linux/kernel.h>
50 #include <linux/errno.h>
51 #include <linux/init.h>
52 #include <linux/slab.h>
53 #include <linux/tty.h>
54 #include <linux/tty_driver.h>
55 #include <linux/tty_flip.h>
56 #include <linux/module.h>
57 #include <asm/uaccess.h>
58 #include <linux/usb.h>
59 #include "usb-serial.h"
60 #include "kl5kusb105.h"
67 #define DRIVER_VERSION "v0.3a"
68 #define DRIVER_AUTHOR "Utz-Uwe Haus <haus@uuhaus.de>"
69 #define DRIVER_DESC "KLSI KL5KUSB105 chipset USB->Serial Converter driver"
75 static int klsi_105_startup (struct usb_serial
*serial
);
76 static void klsi_105_shutdown (struct usb_serial
*serial
);
77 static int klsi_105_open (struct usb_serial_port
*port
,
79 static void klsi_105_close (struct usb_serial_port
*port
,
81 static int klsi_105_write (struct usb_serial_port
*port
,
82 const unsigned char *buf
,
84 static void klsi_105_write_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
);
85 static int klsi_105_chars_in_buffer (struct usb_serial_port
*port
);
86 static int klsi_105_write_room (struct usb_serial_port
*port
);
88 static void klsi_105_read_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
);
89 static void klsi_105_set_termios (struct usb_serial_port
*port
,
90 struct termios
* old
);
91 static int klsi_105_ioctl (struct usb_serial_port
*port
,
95 static void klsi_105_throttle (struct usb_serial_port
*port
);
96 static void klsi_105_unthrottle (struct usb_serial_port
*port
);
98 static void klsi_105_break_ctl (struct usb_serial_port *port,
101 static int klsi_105_tiocmget (struct usb_serial_port
*port
,
103 static int klsi_105_tiocmset (struct usb_serial_port
*port
,
104 struct file
*file
, unsigned int set
,
108 * All of the device info needed for the KLSI converters.
110 static struct usb_device_id id_table
[] = {
111 { USB_DEVICE(PALMCONNECT_VID
, PALMCONNECT_PID
) },
112 { USB_DEVICE(KLSI_VID
, KLSI_KL5KUSB105D_PID
) },
113 { } /* Terminating entry */
116 MODULE_DEVICE_TABLE (usb
, id_table
);
118 static struct usb_driver kl5kusb105d_driver
= {
119 .owner
= THIS_MODULE
,
120 .name
= "kl5kusb105d",
121 .probe
= usb_serial_probe
,
122 .disconnect
= usb_serial_disconnect
,
123 .id_table
= id_table
,
126 static struct usb_serial_device_type kl5kusb105d_device
= {
127 .owner
= THIS_MODULE
,
128 .name
= "KL5KUSB105D / PalmConnect",
129 .short_name
= "kl5kusb105d",
130 .id_table
= id_table
,
131 .num_interrupt_in
= 1,
135 .open
= klsi_105_open
,
136 .close
= klsi_105_close
,
137 .write
= klsi_105_write
,
138 .write_bulk_callback
= klsi_105_write_bulk_callback
,
139 .chars_in_buffer
= klsi_105_chars_in_buffer
,
140 .write_room
= klsi_105_write_room
,
141 .read_bulk_callback
=klsi_105_read_bulk_callback
,
142 .ioctl
= klsi_105_ioctl
,
143 .set_termios
= klsi_105_set_termios
,
144 /*.break_ctl = klsi_105_break_ctl,*/
145 .tiocmget
= klsi_105_tiocmget
,
146 .tiocmset
= klsi_105_tiocmset
,
147 .attach
= klsi_105_startup
,
148 .shutdown
= klsi_105_shutdown
,
149 .throttle
= klsi_105_throttle
,
150 .unthrottle
= klsi_105_unthrottle
,
153 struct klsi_105_port_settings
{
154 __u8 pktlen
; /* always 5, it seems */
159 } __attribute__ ((packed
));
161 /* we implement a pool of NUM_URBS urbs per usb_serial */
163 #define URB_TRANSFER_BUFFER_SIZE 64
164 struct klsi_105_private
{
165 struct klsi_105_port_settings cfg
;
166 struct termios termios
;
167 unsigned long line_state
; /* modem line settings */
169 struct urb
* write_urb_pool
[NUM_URBS
];
171 unsigned long bytes_in
;
172 unsigned long bytes_out
;
177 * Handle vendor specific USB requests
181 #define KLSI_TIMEOUT 5000 /* default urb timeout */
183 static int klsi_105_chg_port_settings(struct usb_serial_port
*port
,
184 struct klsi_105_port_settings
*settings
)
188 rc
= usb_control_msg(port
->serial
->dev
,
189 usb_sndctrlpipe(port
->serial
->dev
, 0),
190 KL5KUSB105A_SIO_SET_DATA
,
191 USB_TYPE_VENDOR
| USB_DIR_OUT
| USB_RECIP_INTERFACE
,
195 sizeof(struct klsi_105_port_settings
),
198 err("Change port settings failed (error = %d)", rc
);
199 info("%s - %d byte block, baudrate %x, databits %d, u1 %d, u2 %d",
202 settings
->baudrate
, settings
->databits
,
203 settings
->unknown1
, settings
->unknown2
);
205 } /* klsi_105_chg_port_settings */
207 /* translate a 16-bit status value from the device to linux's TIO bits */
208 static unsigned long klsi_105_status2linestate(const __u16 status
)
210 unsigned long res
= 0;
212 res
= ((status
& KL5KUSB105A_DSR
) ? TIOCM_DSR
: 0)
213 | ((status
& KL5KUSB105A_CTS
) ? TIOCM_CTS
: 0)
219 * Read line control via vendor command and return result through
222 /* It seems that the status buffer has always only 2 bytes length */
223 #define KLSI_STATUSBUF_LEN 2
224 static int klsi_105_get_line_state(struct usb_serial_port
*port
,
225 unsigned long *line_state_p
)
228 __u8 status_buf
[KLSI_STATUSBUF_LEN
] = { -1,-1};
231 info("%s - sending SIO Poll request", __FUNCTION__
);
232 rc
= usb_control_msg(port
->serial
->dev
,
233 usb_rcvctrlpipe(port
->serial
->dev
, 0),
234 KL5KUSB105A_SIO_POLL
,
235 USB_TYPE_VENDOR
| USB_DIR_IN
,
238 status_buf
, KLSI_STATUSBUF_LEN
,
242 err("Reading line status failed (error = %d)", rc
);
244 status
= status_buf
[0] + (status_buf
[1]<<8);
246 info("%s - read status %x %x", __FUNCTION__
,
247 status_buf
[0], status_buf
[1]);
249 *line_state_p
= klsi_105_status2linestate(status
);
257 * Driver's tty interface functions
260 static int klsi_105_startup (struct usb_serial
*serial
)
262 struct klsi_105_private
*priv
;
265 /* check if we support the product id (see keyspan.c)
269 /* allocate the private data structure */
270 for (i
=0; i
<serial
->num_ports
; i
++) {
272 priv
= kmalloc(sizeof(struct klsi_105_private
),
275 dbg("%skmalloc for klsi_105_private failed.", __FUNCTION__
);
278 /* set initial values for control structures */
279 priv
->cfg
.pktlen
= 5;
280 priv
->cfg
.baudrate
= kl5kusb105a_sio_b9600
;
281 priv
->cfg
.databits
= kl5kusb105a_dtb_8
;
282 priv
->cfg
.unknown1
= 0;
283 priv
->cfg
.unknown2
= 1;
285 priv
->line_state
= 0;
289 usb_set_serial_port_data(serial
->port
[i
], priv
);
291 spin_lock_init (&priv
->lock
);
292 for (j
=0; j
<NUM_URBS
; j
++) {
293 struct urb
* urb
= usb_alloc_urb(0, GFP_KERNEL
);
295 priv
->write_urb_pool
[j
] = urb
;
297 err("No more urbs???");
301 urb
->transfer_buffer
= NULL
;
302 urb
->transfer_buffer
= kmalloc (URB_TRANSFER_BUFFER_SIZE
,
304 if (!urb
->transfer_buffer
) {
305 err("%s - out of memory for urb buffers.", __FUNCTION__
);
310 /* priv->termios is left uninitalized until port opening */
311 init_waitqueue_head(&serial
->port
[i
]->write_wait
);
315 } /* klsi_105_startup */
318 static void klsi_105_shutdown (struct usb_serial
*serial
)
322 dbg("%s", __FUNCTION__
);
324 /* stop reads and writes on all ports */
325 for (i
=0; i
< serial
->num_ports
; ++i
) {
326 struct klsi_105_private
*priv
= usb_get_serial_port_data(serial
->port
[i
]);
330 /* kill our write urb pool */
332 struct urb
**write_urbs
= priv
->write_urb_pool
;
333 spin_lock_irqsave(&priv
->lock
,flags
);
335 for (j
= 0; j
< NUM_URBS
; j
++) {
337 /* FIXME - uncomment the following
338 * usb_kill_urb call when the host
339 * controllers get fixed to set
340 * urb->dev = NULL after the urb is
341 * finished. Otherwise this call
343 /* usb_kill_urb(write_urbs[j]); */
344 if (write_urbs
[j
]->transfer_buffer
)
345 kfree(write_urbs
[j
]->transfer_buffer
);
346 usb_free_urb (write_urbs
[j
]);
350 spin_unlock_irqrestore (&priv
->lock
, flags
);
353 usb_set_serial_port_data(serial
->port
[i
], NULL
);
356 } /* klsi_105_shutdown */
358 static int klsi_105_open (struct usb_serial_port
*port
, struct file
*filp
)
360 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
364 unsigned long line_state
;
365 struct klsi_105_port_settings cfg
;
368 dbg("%s port %d", __FUNCTION__
, port
->number
);
370 /* force low_latency on so that our tty_push actually forces
372 * port->tty->low_latency = 1; */
374 /* Do a defined restart:
375 * Set up sane default baud rate and send the 'READ_ON'
377 * FIXME: set modem line control (how?)
378 * Then read the modem line control and store values in
382 cfg
.baudrate
= kl5kusb105a_sio_b9600
;
383 cfg
.databits
= kl5kusb105a_dtb_8
;
386 klsi_105_chg_port_settings(port
, &cfg
);
388 /* set up termios structure */
389 spin_lock_irqsave (&priv
->lock
, flags
);
390 priv
->termios
.c_iflag
= port
->tty
->termios
->c_iflag
;
391 priv
->termios
.c_oflag
= port
->tty
->termios
->c_oflag
;
392 priv
->termios
.c_cflag
= port
->tty
->termios
->c_cflag
;
393 priv
->termios
.c_lflag
= port
->tty
->termios
->c_lflag
;
394 for (i
=0; i
<NCCS
; i
++)
395 priv
->termios
.c_cc
[i
] = port
->tty
->termios
->c_cc
[i
];
396 priv
->cfg
.pktlen
= cfg
.pktlen
;
397 priv
->cfg
.baudrate
= cfg
.baudrate
;
398 priv
->cfg
.databits
= cfg
.databits
;
399 priv
->cfg
.unknown1
= cfg
.unknown1
;
400 priv
->cfg
.unknown2
= cfg
.unknown2
;
401 spin_unlock_irqrestore (&priv
->lock
, flags
);
403 /* READ_ON and urb submission */
404 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
405 usb_rcvbulkpipe(port
->serial
->dev
,
406 port
->bulk_in_endpointAddress
),
407 port
->read_urb
->transfer_buffer
,
408 port
->read_urb
->transfer_buffer_length
,
409 klsi_105_read_bulk_callback
,
412 rc
= usb_submit_urb(port
->read_urb
, GFP_KERNEL
);
414 err("%s - failed submitting read urb, error %d", __FUNCTION__
, rc
);
419 rc
= usb_control_msg(port
->serial
->dev
,
420 usb_sndctrlpipe(port
->serial
->dev
,0),
421 KL5KUSB105A_SIO_CONFIGURE
,
422 USB_TYPE_VENDOR
|USB_DIR_OUT
|USB_RECIP_INTERFACE
,
423 KL5KUSB105A_SIO_CONFIGURE_READ_ON
,
429 err("Enabling read failed (error = %d)", rc
);
432 dbg("%s - enabled reading", __FUNCTION__
);
434 rc
= klsi_105_get_line_state(port
, &line_state
);
436 spin_lock_irqsave (&priv
->lock
, flags
);
437 priv
->line_state
= line_state
;
438 spin_unlock_irqrestore (&priv
->lock
, flags
);
439 dbg("%s - read line state 0x%lx", __FUNCTION__
, line_state
);
446 } /* klsi_105_open */
449 static void klsi_105_close (struct usb_serial_port
*port
, struct file
*filp
)
451 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
454 dbg("%s port %d", __FUNCTION__
, port
->number
);
457 rc
= usb_control_msg (port
->serial
->dev
,
458 usb_sndctrlpipe(port
->serial
->dev
, 0),
459 KL5KUSB105A_SIO_CONFIGURE
,
460 USB_TYPE_VENDOR
| USB_DIR_OUT
,
461 KL5KUSB105A_SIO_CONFIGURE_READ_OFF
,
466 err("Disabling read failed (error = %d)", rc
);
468 /* shutdown our bulk reads and writes */
469 usb_kill_urb(port
->write_urb
);
470 usb_kill_urb(port
->read_urb
);
471 /* unlink our write pool */
473 /* wgg - do I need this? I think so. */
474 usb_kill_urb(port
->interrupt_in_urb
);
475 info("kl5kusb105 port stats: %ld bytes in, %ld bytes out", priv
->bytes_in
, priv
->bytes_out
);
476 } /* klsi_105_close */
479 /* We need to write a complete 64-byte data block and encode the
480 * number actually sent in the first double-byte, LSB-order. That
481 * leaves at most 62 bytes of payload.
483 #define KLSI_105_DATA_OFFSET 2 /* in the bulk urb data block */
486 static int klsi_105_write (struct usb_serial_port
*port
,
487 const unsigned char *buf
, int count
)
489 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
493 dbg("%s - port %d", __FUNCTION__
, port
->number
);
496 /* try to find a free urb (write 0 bytes if none) */
497 struct urb
*urb
= NULL
;
500 /* since the pool is per-port we might not need the spin lock !? */
501 spin_lock_irqsave (&priv
->lock
, flags
);
502 for (i
=0; i
<NUM_URBS
; i
++) {
503 if (priv
->write_urb_pool
[i
]->status
!= -EINPROGRESS
) {
504 urb
= priv
->write_urb_pool
[i
];
505 dbg("%s - using pool URB %d", __FUNCTION__
, i
);
509 spin_unlock_irqrestore (&priv
->lock
, flags
);
512 dbg("%s - no more free urbs", __FUNCTION__
);
516 if (urb
->transfer_buffer
== NULL
) {
517 urb
->transfer_buffer
= kmalloc (URB_TRANSFER_BUFFER_SIZE
, GFP_ATOMIC
);
518 if (urb
->transfer_buffer
== NULL
) {
519 err("%s - no more kernel memory...", __FUNCTION__
);
524 size
= min (count
, port
->bulk_out_size
- KLSI_105_DATA_OFFSET
);
525 size
= min (size
, URB_TRANSFER_BUFFER_SIZE
- KLSI_105_DATA_OFFSET
);
527 memcpy (urb
->transfer_buffer
+ KLSI_105_DATA_OFFSET
, buf
, size
);
529 /* write payload size into transfer buffer */
530 ((__u8
*)urb
->transfer_buffer
)[0] = (__u8
) (size
& 0xFF);
531 ((__u8
*)urb
->transfer_buffer
)[1] = (__u8
) ((size
& 0xFF00)>>8);
534 usb_fill_bulk_urb(urb
, port
->serial
->dev
,
535 usb_sndbulkpipe(port
->serial
->dev
,
536 port
->bulk_out_endpointAddress
),
537 urb
->transfer_buffer
,
538 URB_TRANSFER_BUFFER_SIZE
,
539 klsi_105_write_bulk_callback
,
542 /* send the data out the bulk port */
543 result
= usb_submit_urb(urb
, GFP_ATOMIC
);
545 err("%s - failed submitting write urb, error %d", __FUNCTION__
, result
);
553 /* lockless, but it's for debug info only... */
554 priv
->bytes_out
+=bytes_sent
;
556 return bytes_sent
; /* that's how much we wrote */
557 } /* klsi_105_write */
559 static void klsi_105_write_bulk_callback ( struct urb
*urb
, struct pt_regs
*regs
)
561 struct usb_serial_port
*port
= (struct usb_serial_port
*)urb
->context
;
563 dbg("%s - port %d", __FUNCTION__
, port
->number
);
566 dbg("%s - nonzero write bulk status received: %d", __FUNCTION__
,
571 /* from generic_write_bulk_callback */
572 schedule_work(&port
->work
);
573 } /* klsi_105_write_bulk_completion_callback */
576 /* return number of characters currently in the writing process */
577 static int klsi_105_chars_in_buffer (struct usb_serial_port
*port
)
582 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
584 spin_lock_irqsave (&priv
->lock
, flags
);
586 for (i
= 0; i
< NUM_URBS
; ++i
) {
587 if (priv
->write_urb_pool
[i
]->status
== -EINPROGRESS
) {
588 chars
+= URB_TRANSFER_BUFFER_SIZE
;
592 spin_unlock_irqrestore (&priv
->lock
, flags
);
594 dbg("%s - returns %d", __FUNCTION__
, chars
);
598 static int klsi_105_write_room (struct usb_serial_port
*port
)
603 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
605 spin_lock_irqsave (&priv
->lock
, flags
);
606 for (i
= 0; i
< NUM_URBS
; ++i
) {
607 if (priv
->write_urb_pool
[i
]->status
!= -EINPROGRESS
) {
608 room
+= URB_TRANSFER_BUFFER_SIZE
;
612 spin_unlock_irqrestore (&priv
->lock
, flags
);
614 dbg("%s - returns %d", __FUNCTION__
, room
);
620 static void klsi_105_read_bulk_callback (struct urb
*urb
, struct pt_regs
*regs
)
622 struct usb_serial_port
*port
= (struct usb_serial_port
*)urb
->context
;
623 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
624 struct tty_struct
*tty
;
625 unsigned char *data
= urb
->transfer_buffer
;
628 dbg("%s - port %d", __FUNCTION__
, port
->number
);
630 /* The urb might have been killed. */
632 dbg("%s - nonzero read bulk status received: %d", __FUNCTION__
,
637 /* The data received is again preceded by a length double-byte in LSB-
638 * first order (see klsi_105_write() )
640 if (urb
->actual_length
== 0) {
641 /* empty urbs seem to happen, we ignore them */
642 /* dbg("%s - emtpy URB", __FUNCTION__); */
644 } else if (urb
->actual_length
<= 2) {
645 dbg("%s - size %d URB not understood", __FUNCTION__
,
647 usb_serial_debug_data(debug
, &port
->dev
, __FUNCTION__
,
648 urb
->actual_length
, data
);
651 int bytes_sent
= ((__u8
*) data
)[0] +
652 ((unsigned int) ((__u8
*) data
)[1] << 8);
654 /* we should immediately resubmit the URB, before attempting
655 * to pass the data on to the tty layer. But that needs locking
656 * against re-entry an then mixed-up data because of
657 * intermixed tty_flip_buffer_push()s
660 usb_serial_debug_data(debug
, &port
->dev
, __FUNCTION__
,
661 urb
->actual_length
, data
);
663 if (bytes_sent
+ 2 > urb
->actual_length
) {
664 dbg("%s - trying to read more data than available"
665 " (%d vs. %d)", __FUNCTION__
,
666 bytes_sent
+2, urb
->actual_length
);
667 /* cap at implied limit */
668 bytes_sent
= urb
->actual_length
- 2;
671 for (i
= 2; i
< 2+bytes_sent
; i
++) {
672 /* if we insert more than TTY_FLIPBUF_SIZE characters,
674 if(tty
->flip
.count
>= TTY_FLIPBUF_SIZE
) {
675 tty_flip_buffer_push(tty
);
677 /* this doesn't actually push the data through unless
678 * tty->low_latency is set */
679 tty_insert_flip_char(tty
, ((__u8
*) data
)[i
], 0);
681 tty_flip_buffer_push(tty
);
683 /* again lockless, but debug info only */
684 priv
->bytes_in
+= bytes_sent
;
686 /* Continue trying to always read */
687 usb_fill_bulk_urb(port
->read_urb
, port
->serial
->dev
,
688 usb_rcvbulkpipe(port
->serial
->dev
,
689 port
->bulk_in_endpointAddress
),
690 port
->read_urb
->transfer_buffer
,
691 port
->read_urb
->transfer_buffer_length
,
692 klsi_105_read_bulk_callback
,
694 rc
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
696 err("%s - failed resubmitting read urb, error %d", __FUNCTION__
, rc
);
697 } /* klsi_105_read_bulk_callback */
700 static void klsi_105_set_termios (struct usb_serial_port
*port
,
701 struct termios
*old_termios
)
703 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
704 unsigned int iflag
= port
->tty
->termios
->c_iflag
;
705 unsigned int old_iflag
= old_termios
->c_iflag
;
706 unsigned int cflag
= port
->tty
->termios
->c_cflag
;
707 unsigned int old_cflag
= old_termios
->c_cflag
;
708 struct klsi_105_port_settings cfg
;
711 /* lock while we are modifying the settings */
712 spin_lock_irqsave (&priv
->lock
, flags
);
717 if( (cflag
& CBAUD
) != (old_cflag
& CBAUD
) ) {
718 /* reassert DTR and (maybe) RTS on transition from B0 */
719 if( (old_cflag
& CBAUD
) == B0
) {
720 dbg("%s: baud was B0", __FUNCTION__
);
722 priv
->control_state
|= TIOCM_DTR
;
723 /* don't set RTS if using hardware flow control */
724 if (!(old_cflag
& CRTSCTS
)) {
725 priv
->control_state
|= TIOCM_RTS
;
727 mct_u232_set_modem_ctrl(serial
, priv
->control_state
);
731 switch(cflag
& CBAUD
) {
732 case B0
: /* handled below */
734 case B1200
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b1200
;
736 case B2400
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b2400
;
738 case B4800
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b4800
;
740 case B9600
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b9600
;
742 case B19200
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b19200
;
744 case B38400
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b38400
;
746 case B57600
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b57600
;
748 case B115200
: priv
->cfg
.baudrate
= kl5kusb105a_sio_b115200
;
751 err("KLSI USB->Serial converter:"
752 " unsupported baudrate request, using default"
754 priv
->cfg
.baudrate
= kl5kusb105a_sio_b9600
;
757 if ((cflag
& CBAUD
) == B0
) {
758 dbg("%s: baud is B0", __FUNCTION__
);
759 /* Drop RTS and DTR */
760 /* maybe this should be simulated by sending read
761 * disable and read enable messages?
765 priv
->control_state
&= ~(TIOCM_DTR
| TIOCM_RTS
);
766 mct_u232_set_modem_ctrl(serial
, priv
->control_state
);
771 if ((cflag
& CSIZE
) != (old_cflag
& CSIZE
)) {
772 /* set the number of data bits */
773 switch (cflag
& CSIZE
) {
775 dbg("%s - 5 bits/byte not supported", __FUNCTION__
);
776 spin_unlock_irqrestore (&priv
->lock
, flags
);
779 dbg("%s - 6 bits/byte not supported", __FUNCTION__
);
780 spin_unlock_irqrestore (&priv
->lock
, flags
);
783 priv
->cfg
.databits
= kl5kusb105a_dtb_7
;
786 priv
->cfg
.databits
= kl5kusb105a_dtb_8
;
789 err("CSIZE was not CS5-CS8, using default of 8");
790 priv
->cfg
.databits
= kl5kusb105a_dtb_8
;
796 * Update line control register (LCR)
798 if ((cflag
& (PARENB
|PARODD
)) != (old_cflag
& (PARENB
|PARODD
))
799 || (cflag
& CSTOPB
) != (old_cflag
& CSTOPB
) ) {
806 priv
->last_lcr
|= (cflag
& PARODD
) ?
807 MCT_U232_PARITY_ODD
: MCT_U232_PARITY_EVEN
;
809 priv
->last_lcr
|= MCT_U232_PARITY_NONE
;
811 /* set the number of stop bits */
812 priv
->last_lcr
|= (cflag
& CSTOPB
) ?
813 MCT_U232_STOP_BITS_2
: MCT_U232_STOP_BITS_1
;
815 mct_u232_set_line_ctrl(serial
, priv
->last_lcr
);
821 * Set flow control: well, I do not really now how to handle DTR/RTS.
822 * Just do what we have seen with SniffUSB on Win98.
824 if( (iflag
& IXOFF
) != (old_iflag
& IXOFF
)
825 || (iflag
& IXON
) != (old_iflag
& IXON
)
826 || (cflag
& CRTSCTS
) != (old_cflag
& CRTSCTS
) ) {
828 /* Drop DTR/RTS if no flow control otherwise assert */
830 if ((iflag
& IXOFF
) || (iflag
& IXON
) || (cflag
& CRTSCTS
) )
831 priv
->control_state
|= TIOCM_DTR
| TIOCM_RTS
;
833 priv
->control_state
&= ~(TIOCM_DTR
| TIOCM_RTS
);
834 mct_u232_set_modem_ctrl(serial
, priv
->control_state
);
838 memcpy (&cfg
, &priv
->cfg
, sizeof(cfg
));
839 spin_unlock_irqrestore (&priv
->lock
, flags
);
841 /* now commit changes to device */
842 klsi_105_chg_port_settings(port
, &cfg
);
843 } /* klsi_105_set_termios */
847 static void mct_u232_break_ctl( struct usb_serial_port
*port
, int break_state
)
849 struct usb_serial
*serial
= port
->serial
;
850 struct mct_u232_private
*priv
= (struct mct_u232_private
*)port
->private;
851 unsigned char lcr
= priv
->last_lcr
;
853 dbg("%sstate=%d", __FUNCTION__
, break_state
);
856 lcr
|= MCT_U232_SET_BREAK
;
858 mct_u232_set_line_ctrl(serial
, lcr
);
859 } /* mct_u232_break_ctl */
862 static int klsi_105_tiocmget (struct usb_serial_port
*port
, struct file
*file
)
864 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
867 unsigned long line_state
;
868 dbg("%s - request, just guessing", __FUNCTION__
);
870 rc
= klsi_105_get_line_state(port
, &line_state
);
872 err("Reading line control failed (error = %d)", rc
);
873 /* better return value? EAGAIN? */
877 spin_lock_irqsave (&priv
->lock
, flags
);
878 priv
->line_state
= line_state
;
879 spin_unlock_irqrestore (&priv
->lock
, flags
);
880 dbg("%s - read line state 0x%lx", __FUNCTION__
, line_state
);
881 return (int)line_state
;
884 static int klsi_105_tiocmset (struct usb_serial_port
*port
, struct file
*file
,
885 unsigned int set
, unsigned int clear
)
887 int retval
= -EINVAL
;
889 dbg("%s", __FUNCTION__
);
891 /* if this ever gets implemented, it should be done something like this:
892 struct usb_serial *serial = port->serial;
893 struct klsi_105_private *priv = usb_get_serial_port_data(port);
897 spin_lock_irqsave (&priv->lock, flags);
899 priv->control_state |= TIOCM_RTS;
901 priv->control_state |= TIOCM_DTR;
902 if (clear & TIOCM_RTS)
903 priv->control_state &= ~TIOCM_RTS;
904 if (clear & TIOCM_DTR)
905 priv->control_state &= ~TIOCM_DTR;
906 control = priv->control_state;
907 spin_unlock_irqrestore (&priv->lock, flags);
908 retval = mct_u232_set_modem_ctrl(serial, control);
913 static int klsi_105_ioctl (struct usb_serial_port
*port
, struct file
* file
,
914 unsigned int cmd
, unsigned long arg
)
916 struct klsi_105_private
*priv
= usb_get_serial_port_data(port
);
917 void __user
*user_arg
= (void __user
*)arg
;
919 dbg("%scmd=0x%x", __FUNCTION__
, cmd
);
921 /* Based on code from acm.c and others */
924 /* wait for any of the 4 modem inputs (DCD,RI,DSR,CTS)*/
926 dbg("%s - TIOCMIWAIT not handled", __FUNCTION__
);
929 /* return count of modemline transitions */
931 dbg("%s - TIOCGICOUNT not handled", __FUNCTION__
);
934 /* return current info to caller */
935 dbg("%s - TCGETS data faked/incomplete", __FUNCTION__
);
937 if (!access_ok(VERIFY_WRITE
, user_arg
, sizeof(struct termios
)))
940 if (kernel_termios_to_user_termios((struct termios __user
*)arg
,
945 /* set port termios to the one given by the user */
946 dbg("%s - TCSETS not handled", __FUNCTION__
);
948 if (!access_ok(VERIFY_READ
, user_arg
, sizeof(struct termios
)))
951 if (user_termios_to_kernel_termios(&priv
->termios
,
952 (struct termios __user
*)arg
))
954 klsi_105_set_termios(port
, &priv
->termios
);
957 /* set port termios and try to wait for completion of last
959 /* We guess here. If there are not too many write urbs
960 * outstanding, we lie. */
961 /* what is the right way to wait here? schedule() ? */
963 while (klsi_105_chars_in_buffer(port) > (NUM_URBS / 4 ) * URB_TRANSFER_BUFFER_SIZE)
969 dbg("%s: arg not supported - 0x%04x", __FUNCTION__
,cmd
);
970 return(-ENOIOCTLCMD
);
974 } /* klsi_105_ioctl */
976 static void klsi_105_throttle (struct usb_serial_port
*port
)
978 dbg("%s - port %d", __FUNCTION__
, port
->number
);
979 usb_kill_urb(port
->read_urb
);
982 static void klsi_105_unthrottle (struct usb_serial_port
*port
)
986 dbg("%s - port %d", __FUNCTION__
, port
->number
);
988 port
->read_urb
->dev
= port
->serial
->dev
;
989 result
= usb_submit_urb(port
->read_urb
, GFP_ATOMIC
);
991 err("%s - failed submitting read urb, error %d", __FUNCTION__
,
997 static int __init
klsi_105_init (void)
1000 retval
= usb_serial_register(&kl5kusb105d_device
);
1002 goto failed_usb_serial_register
;
1003 retval
= usb_register(&kl5kusb105d_driver
);
1005 goto failed_usb_register
;
1007 info(DRIVER_DESC
" " DRIVER_VERSION
);
1009 failed_usb_register
:
1010 usb_serial_deregister(&kl5kusb105d_device
);
1011 failed_usb_serial_register
:
1016 static void __exit
klsi_105_exit (void)
1018 usb_deregister (&kl5kusb105d_driver
);
1019 usb_serial_deregister (&kl5kusb105d_device
);
1023 module_init (klsi_105_init
);
1024 module_exit (klsi_105_exit
);
1026 MODULE_AUTHOR( DRIVER_AUTHOR
);
1027 MODULE_DESCRIPTION( DRIVER_DESC
);
1028 MODULE_LICENSE("GPL");
1031 module_param(debug
, bool, S_IRUGO
| S_IWUSR
);
1032 MODULE_PARM_DESC(debug
, "enable extensive debugging messages");
1034 /* vim: set sts=8 ts=8 sw=8: */