2 * Copyright 2007, Frank A Kingswood <frank@kingswood-consulting.co.uk>
3 * Copyright 2007, Werner Cornelius <werner@cornelius-consult.de>
4 * Copyright 2009, Boris Hajduk <boris@hajduk.org>
6 * ch341.c implements a serial port driver for the Winchiphead CH341.
8 * The CH341 device can be used to implement an RS232 asynchronous
9 * serial port, an IEEE-1284 parallel printer port or a memory-like
10 * interface. In all cases the CH341 supports an I2C interface as well.
11 * This driver only supports the asynchronous serial interface.
13 * This program is free software; you can redistribute it and/or
14 * modify it under the terms of the GNU General Public License version
15 * 2 as published by the Free Software Foundation.
18 #include <linux/kernel.h>
19 #include <linux/init.h>
20 #include <linux/tty.h>
21 #include <linux/module.h>
22 #include <linux/usb.h>
23 #include <linux/usb/serial.h>
24 #include <linux/serial.h>
26 #define DEFAULT_BAUD_RATE 9600
27 #define DEFAULT_TIMEOUT 1000
29 /* flags for IO-Bits */
30 #define CH341_BIT_RTS (1 << 6)
31 #define CH341_BIT_DTR (1 << 5)
33 /******************************/
34 /* interrupt pipe definitions */
35 /******************************/
36 /* always 4 interrupt bytes */
37 /* first irq byte normally 0x08 */
38 /* second irq byte base 0x7d + below */
39 /* third irq byte base 0x94 + below */
40 /* fourth irq byte normally 0xee */
42 /* second interrupt byte */
43 #define CH341_MULT_STAT 0x04 /* multiple status since last interrupt event */
45 /* status returned in third interrupt answer byte, inverted in data
47 #define CH341_BIT_CTS 0x01
48 #define CH341_BIT_DSR 0x02
49 #define CH341_BIT_RI 0x04
50 #define CH341_BIT_DCD 0x08
51 #define CH341_BITS_MODEM_STAT 0x0f /* all bits */
53 /*******************************/
54 /* baudrate calculation factor */
55 /*******************************/
56 #define CH341_BAUDBASE_FACTOR 1532620800
57 #define CH341_BAUDBASE_DIVMAX 3
59 /* Break support - the information used to implement this was gleaned from
60 * the Net/FreeBSD uchcom.c driver by Takanori Watanabe. Domo arigato.
63 #define CH341_REQ_WRITE_REG 0x9A
64 #define CH341_REQ_READ_REG 0x95
65 #define CH341_REG_BREAK1 0x05
66 #define CH341_REG_BREAK2 0x18
67 #define CH341_NBREAK_BITS_REG1 0x01
68 #define CH341_NBREAK_BITS_REG2 0x40
73 static struct usb_device_id id_table
[] = {
74 { USB_DEVICE(0x4348, 0x5523) },
75 { USB_DEVICE(0x1a86, 0x7523) },
76 { USB_DEVICE(0x1a86, 0x5523) },
79 MODULE_DEVICE_TABLE(usb
, id_table
);
81 struct ch341_private
{
82 spinlock_t lock
; /* access lock */
83 wait_queue_head_t delta_msr_wait
; /* wait queue for modem status */
84 unsigned baud_rate
; /* set baud rate */
85 u8 line_control
; /* set line control value RTS/DTR */
86 u8 line_status
; /* active status of modem control inputs */
87 u8 multi_status_change
; /* status changed multiple since last call */
90 static int ch341_control_out(struct usb_device
*dev
, u8 request
,
94 dbg("ch341_control_out(%02x,%02x,%04x,%04x)", USB_DIR_OUT
|0x40,
95 (int)request
, (int)value
, (int)index
);
97 r
= usb_control_msg(dev
, usb_sndctrlpipe(dev
, 0), request
,
98 USB_TYPE_VENDOR
| USB_RECIP_DEVICE
| USB_DIR_OUT
,
99 value
, index
, NULL
, 0, DEFAULT_TIMEOUT
);
104 static int ch341_control_in(struct usb_device
*dev
,
105 u8 request
, u16 value
, u16 index
,
106 char *buf
, unsigned bufsize
)
109 dbg("ch341_control_in(%02x,%02x,%04x,%04x,%p,%u)", USB_DIR_IN
|0x40,
110 (int)request
, (int)value
, (int)index
, buf
, (int)bufsize
);
112 r
= usb_control_msg(dev
, usb_rcvctrlpipe(dev
, 0), request
,
113 USB_TYPE_VENDOR
| USB_RECIP_DEVICE
| USB_DIR_IN
,
114 value
, index
, buf
, bufsize
, DEFAULT_TIMEOUT
);
118 static int ch341_set_baudrate(struct usb_device
*dev
,
119 struct ch341_private
*priv
)
123 unsigned long factor
;
126 dbg("ch341_set_baudrate(%d)", priv
->baud_rate
);
128 if (!priv
->baud_rate
)
130 factor
= (CH341_BAUDBASE_FACTOR
/ priv
->baud_rate
);
131 divisor
= CH341_BAUDBASE_DIVMAX
;
133 while ((factor
> 0xfff0) && divisor
) {
141 factor
= 0x10000 - factor
;
142 a
= (factor
& 0xff00) | divisor
;
145 r
= ch341_control_out(dev
, 0x9a, 0x1312, a
);
147 r
= ch341_control_out(dev
, 0x9a, 0x0f2c, b
);
152 static int ch341_set_handshake(struct usb_device
*dev
, u8 control
)
154 dbg("ch341_set_handshake(0x%02x)", control
);
155 return ch341_control_out(dev
, 0xa4, ~control
, 0);
158 static int ch341_get_status(struct usb_device
*dev
, struct ch341_private
*priv
)
162 const unsigned size
= 8;
165 dbg("ch341_get_status()");
167 buffer
= kmalloc(size
, GFP_KERNEL
);
171 r
= ch341_control_in(dev
, 0x95, 0x0706, 0, buffer
, size
);
175 /* setup the private status if available */
178 spin_lock_irqsave(&priv
->lock
, flags
);
179 priv
->line_status
= (~(*buffer
)) & CH341_BITS_MODEM_STAT
;
180 priv
->multi_status_change
= 0;
181 spin_unlock_irqrestore(&priv
->lock
, flags
);
189 /* -------------------------------------------------------------------------- */
191 static int ch341_configure(struct usb_device
*dev
, struct ch341_private
*priv
)
195 const unsigned size
= 8;
197 dbg("ch341_configure()");
199 buffer
= kmalloc(size
, GFP_KERNEL
);
203 /* expect two bytes 0x27 0x00 */
204 r
= ch341_control_in(dev
, 0x5f, 0, 0, buffer
, size
);
208 r
= ch341_control_out(dev
, 0xa1, 0, 0);
212 r
= ch341_set_baudrate(dev
, priv
);
216 /* expect two bytes 0x56 0x00 */
217 r
= ch341_control_in(dev
, 0x95, 0x2518, 0, buffer
, size
);
221 r
= ch341_control_out(dev
, 0x9a, 0x2518, 0x0050);
225 /* expect 0xff 0xee */
226 r
= ch341_get_status(dev
, priv
);
230 r
= ch341_control_out(dev
, 0xa1, 0x501f, 0xd90a);
234 r
= ch341_set_baudrate(dev
, priv
);
238 r
= ch341_set_handshake(dev
, priv
->line_control
);
242 /* expect 0x9f 0xee */
243 r
= ch341_get_status(dev
, priv
);
249 /* allocate private data */
250 static int ch341_attach(struct usb_serial
*serial
)
252 struct ch341_private
*priv
;
255 dbg("ch341_attach()");
258 priv
= kzalloc(sizeof(struct ch341_private
), GFP_KERNEL
);
262 spin_lock_init(&priv
->lock
);
263 init_waitqueue_head(&priv
->delta_msr_wait
);
264 priv
->baud_rate
= DEFAULT_BAUD_RATE
;
265 priv
->line_control
= CH341_BIT_RTS
| CH341_BIT_DTR
;
267 r
= ch341_configure(serial
->dev
, priv
);
271 usb_set_serial_port_data(serial
->port
[0], priv
);
278 static int ch341_carrier_raised(struct usb_serial_port
*port
)
280 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
281 if (priv
->line_status
& CH341_BIT_DCD
)
286 static void ch341_dtr_rts(struct usb_serial_port
*port
, int on
)
288 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
291 dbg("%s - port %d", __func__
, port
->number
);
292 /* drop DTR and RTS */
293 spin_lock_irqsave(&priv
->lock
, flags
);
295 priv
->line_control
|= CH341_BIT_RTS
| CH341_BIT_DTR
;
297 priv
->line_control
&= ~(CH341_BIT_RTS
| CH341_BIT_DTR
);
298 spin_unlock_irqrestore(&priv
->lock
, flags
);
299 ch341_set_handshake(port
->serial
->dev
, priv
->line_control
);
300 wake_up_interruptible(&priv
->delta_msr_wait
);
303 static void ch341_close(struct usb_serial_port
*port
)
305 dbg("%s - port %d", __func__
, port
->number
);
307 /* shutdown our urbs */
308 dbg("%s - shutting down urbs", __func__
);
309 usb_kill_urb(port
->write_urb
);
310 usb_kill_urb(port
->read_urb
);
311 usb_kill_urb(port
->interrupt_in_urb
);
315 /* open this device, set default parameters */
316 static int ch341_open(struct tty_struct
*tty
, struct usb_serial_port
*port
)
318 struct usb_serial
*serial
= port
->serial
;
319 struct ch341_private
*priv
= usb_get_serial_port_data(serial
->port
[0]);
324 priv
->baud_rate
= DEFAULT_BAUD_RATE
;
326 r
= ch341_configure(serial
->dev
, priv
);
330 r
= ch341_set_handshake(serial
->dev
, priv
->line_control
);
334 r
= ch341_set_baudrate(serial
->dev
, priv
);
338 dbg("%s - submitting interrupt urb", __func__
);
339 port
->interrupt_in_urb
->dev
= serial
->dev
;
340 r
= usb_submit_urb(port
->interrupt_in_urb
, GFP_KERNEL
);
342 dev_err(&port
->dev
, "%s - failed submitting interrupt urb,"
343 " error %d\n", __func__
, r
);
348 r
= usb_serial_generic_open(tty
, port
);
353 /* Old_termios contains the original termios settings and
354 * tty->termios contains the new setting to be used.
356 static void ch341_set_termios(struct tty_struct
*tty
,
357 struct usb_serial_port
*port
, struct ktermios
*old_termios
)
359 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
363 dbg("ch341_set_termios()");
365 baud_rate
= tty_get_baud_rate(tty
);
367 priv
->baud_rate
= baud_rate
;
370 spin_lock_irqsave(&priv
->lock
, flags
);
371 priv
->line_control
|= (CH341_BIT_DTR
| CH341_BIT_RTS
);
372 spin_unlock_irqrestore(&priv
->lock
, flags
);
373 ch341_set_baudrate(port
->serial
->dev
, priv
);
375 spin_lock_irqsave(&priv
->lock
, flags
);
376 priv
->line_control
&= ~(CH341_BIT_DTR
| CH341_BIT_RTS
);
377 spin_unlock_irqrestore(&priv
->lock
, flags
);
380 ch341_set_handshake(port
->serial
->dev
, priv
->line_control
);
383 * (cflag & CSIZE) : data bits [5, 8]
384 * (cflag & PARENB) : parity {NONE, EVEN, ODD}
385 * (cflag & CSTOPB) : stop bits [1, 2]
389 static void ch341_break_ctl(struct tty_struct
*tty
, int break_state
)
391 const uint16_t ch341_break_reg
=
392 CH341_REG_BREAK1
| ((uint16_t) CH341_REG_BREAK2
<< 8);
393 struct usb_serial_port
*port
= tty
->driver_data
;
395 uint16_t reg_contents
;
396 uint8_t break_reg
[2];
398 dbg("%s()", __func__
);
400 r
= ch341_control_in(port
->serial
->dev
, CH341_REQ_READ_REG
,
401 ch341_break_reg
, 0, break_reg
, sizeof(break_reg
));
403 printk(KERN_WARNING
"%s: USB control read error whilst getting"
404 " break register contents.\n", __FILE__
);
407 dbg("%s - initial ch341 break register contents - reg1: %x, reg2: %x",
408 __func__
, break_reg
[0], break_reg
[1]);
409 if (break_state
!= 0) {
410 dbg("%s - Enter break state requested", __func__
);
411 break_reg
[0] &= ~CH341_NBREAK_BITS_REG1
;
412 break_reg
[1] &= ~CH341_NBREAK_BITS_REG2
;
414 dbg("%s - Leave break state requested", __func__
);
415 break_reg
[0] |= CH341_NBREAK_BITS_REG1
;
416 break_reg
[1] |= CH341_NBREAK_BITS_REG2
;
418 dbg("%s - New ch341 break register contents - reg1: %x, reg2: %x",
419 __func__
, break_reg
[0], break_reg
[1]);
420 reg_contents
= (uint16_t)break_reg
[0] | ((uint16_t)break_reg
[1] << 8);
421 r
= ch341_control_out(port
->serial
->dev
, CH341_REQ_WRITE_REG
,
422 ch341_break_reg
, reg_contents
);
424 printk(KERN_WARNING
"%s: USB control write error whilst setting"
425 " break register contents.\n", __FILE__
);
428 static int ch341_tiocmset(struct tty_struct
*tty
, struct file
*file
,
429 unsigned int set
, unsigned int clear
)
431 struct usb_serial_port
*port
= tty
->driver_data
;
432 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
436 spin_lock_irqsave(&priv
->lock
, flags
);
438 priv
->line_control
|= CH341_BIT_RTS
;
440 priv
->line_control
|= CH341_BIT_DTR
;
441 if (clear
& TIOCM_RTS
)
442 priv
->line_control
&= ~CH341_BIT_RTS
;
443 if (clear
& TIOCM_DTR
)
444 priv
->line_control
&= ~CH341_BIT_DTR
;
445 control
= priv
->line_control
;
446 spin_unlock_irqrestore(&priv
->lock
, flags
);
448 return ch341_set_handshake(port
->serial
->dev
, control
);
451 static void ch341_read_int_callback(struct urb
*urb
)
453 struct usb_serial_port
*port
= (struct usb_serial_port
*) urb
->context
;
454 unsigned char *data
= urb
->transfer_buffer
;
455 unsigned int actual_length
= urb
->actual_length
;
458 dbg("%s (%d)", __func__
, port
->number
);
460 switch (urb
->status
) {
467 /* this urb is terminated, clean up */
468 dbg("%s - urb shutting down with status: %d", __func__
,
472 dbg("%s - nonzero urb status received: %d", __func__
,
477 usb_serial_debug_data(debug
, &port
->dev
, __func__
,
478 urb
->actual_length
, urb
->transfer_buffer
);
480 if (actual_length
>= 4) {
481 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
483 u8 prev_line_status
= priv
->line_status
;
485 spin_lock_irqsave(&priv
->lock
, flags
);
486 priv
->line_status
= (~(data
[2])) & CH341_BITS_MODEM_STAT
;
487 if ((data
[1] & CH341_MULT_STAT
))
488 priv
->multi_status_change
= 1;
489 spin_unlock_irqrestore(&priv
->lock
, flags
);
491 if ((priv
->line_status
^ prev_line_status
) & CH341_BIT_DCD
) {
492 struct tty_struct
*tty
= tty_port_tty_get(&port
->port
);
494 usb_serial_handle_dcd_change(port
, tty
,
495 priv
->line_status
& CH341_BIT_DCD
);
499 wake_up_interruptible(&priv
->delta_msr_wait
);
503 status
= usb_submit_urb(urb
, GFP_ATOMIC
);
505 dev_err(&urb
->dev
->dev
,
506 "%s - usb_submit_urb failed with result %d\n",
510 static int wait_modem_info(struct usb_serial_port
*port
, unsigned int arg
)
512 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
519 spin_lock_irqsave(&priv
->lock
, flags
);
520 prevstatus
= priv
->line_status
;
521 priv
->multi_status_change
= 0;
522 spin_unlock_irqrestore(&priv
->lock
, flags
);
524 while (!multi_change
) {
525 interruptible_sleep_on(&priv
->delta_msr_wait
);
526 /* see if a signal did it */
527 if (signal_pending(current
))
530 spin_lock_irqsave(&priv
->lock
, flags
);
531 status
= priv
->line_status
;
532 multi_change
= priv
->multi_status_change
;
533 spin_unlock_irqrestore(&priv
->lock
, flags
);
535 changed
= prevstatus
^ status
;
537 if (((arg
& TIOCM_RNG
) && (changed
& CH341_BIT_RI
)) ||
538 ((arg
& TIOCM_DSR
) && (changed
& CH341_BIT_DSR
)) ||
539 ((arg
& TIOCM_CD
) && (changed
& CH341_BIT_DCD
)) ||
540 ((arg
& TIOCM_CTS
) && (changed
& CH341_BIT_CTS
))) {
549 /*static int ch341_ioctl(struct usb_serial_port *port, struct file *file,*/
550 static int ch341_ioctl(struct tty_struct
*tty
, struct file
*file
,
551 unsigned int cmd
, unsigned long arg
)
553 struct usb_serial_port
*port
= tty
->driver_data
;
554 dbg("%s (%d) cmd = 0x%04x", __func__
, port
->number
, cmd
);
558 dbg("%s (%d) TIOCMIWAIT", __func__
, port
->number
);
559 return wait_modem_info(port
, arg
);
562 dbg("%s not supported = 0x%04x", __func__
, cmd
);
569 static int ch341_tiocmget(struct tty_struct
*tty
, struct file
*file
)
571 struct usb_serial_port
*port
= tty
->driver_data
;
572 struct ch341_private
*priv
= usb_get_serial_port_data(port
);
578 dbg("%s (%d)", __func__
, port
->number
);
580 spin_lock_irqsave(&priv
->lock
, flags
);
581 mcr
= priv
->line_control
;
582 status
= priv
->line_status
;
583 spin_unlock_irqrestore(&priv
->lock
, flags
);
585 result
= ((mcr
& CH341_BIT_DTR
) ? TIOCM_DTR
: 0)
586 | ((mcr
& CH341_BIT_RTS
) ? TIOCM_RTS
: 0)
587 | ((status
& CH341_BIT_CTS
) ? TIOCM_CTS
: 0)
588 | ((status
& CH341_BIT_DSR
) ? TIOCM_DSR
: 0)
589 | ((status
& CH341_BIT_RI
) ? TIOCM_RI
: 0)
590 | ((status
& CH341_BIT_DCD
) ? TIOCM_CD
: 0);
592 dbg("%s - result = %x", __func__
, result
);
598 static int ch341_reset_resume(struct usb_interface
*intf
)
600 struct usb_device
*dev
= interface_to_usbdev(intf
);
601 struct usb_serial
*serial
= NULL
;
602 struct ch341_private
*priv
;
604 serial
= usb_get_intfdata(intf
);
605 priv
= usb_get_serial_port_data(serial
->port
[0]);
607 /*reconfigure ch341 serial port after bus-reset*/
608 ch341_configure(dev
, priv
);
610 usb_serial_resume(intf
);
615 static struct usb_driver ch341_driver
= {
617 .probe
= usb_serial_probe
,
618 .disconnect
= usb_serial_disconnect
,
619 .suspend
= usb_serial_suspend
,
620 .resume
= usb_serial_resume
,
621 .reset_resume
= ch341_reset_resume
,
622 .id_table
= id_table
,
624 .supports_autosuspend
= 1,
627 static struct usb_serial_driver ch341_device
= {
629 .owner
= THIS_MODULE
,
630 .name
= "ch341-uart",
632 .id_table
= id_table
,
633 .usb_driver
= &ch341_driver
,
636 .dtr_rts
= ch341_dtr_rts
,
637 .carrier_raised
= ch341_carrier_raised
,
638 .close
= ch341_close
,
639 .ioctl
= ch341_ioctl
,
640 .set_termios
= ch341_set_termios
,
641 .break_ctl
= ch341_break_ctl
,
642 .tiocmget
= ch341_tiocmget
,
643 .tiocmset
= ch341_tiocmset
,
644 .read_int_callback
= ch341_read_int_callback
,
645 .attach
= ch341_attach
,
648 static int __init
ch341_init(void)
652 retval
= usb_serial_register(&ch341_device
);
655 retval
= usb_register(&ch341_driver
);
657 usb_serial_deregister(&ch341_device
);
661 static void __exit
ch341_exit(void)
663 usb_deregister(&ch341_driver
);
664 usb_serial_deregister(&ch341_device
);
667 module_init(ch341_init
);
668 module_exit(ch341_exit
);
669 MODULE_LICENSE("GPL");
671 module_param(debug
, bool, S_IRUGO
| S_IWUSR
);
672 MODULE_PARM_DESC(debug
, "Debug enabled or not");