16ce76104SFrank A Kingswood /* 26ce76104SFrank A Kingswood * Copyright 2007, Frank A Kingswood <frank@kingswood-consulting.co.uk> 3664d5df9SWerner Cornelius * Copyright 2007, Werner Cornelius <werner@cornelius-consult.de> 4664d5df9SWerner Cornelius * Copyright 2009, Boris Hajduk <boris@hajduk.org> 56ce76104SFrank A Kingswood * 66ce76104SFrank A Kingswood * ch341.c implements a serial port driver for the Winchiphead CH341. 76ce76104SFrank A Kingswood * 86ce76104SFrank A Kingswood * The CH341 device can be used to implement an RS232 asynchronous 96ce76104SFrank A Kingswood * serial port, an IEEE-1284 parallel printer port or a memory-like 106ce76104SFrank A Kingswood * interface. In all cases the CH341 supports an I2C interface as well. 116ce76104SFrank A Kingswood * This driver only supports the asynchronous serial interface. 126ce76104SFrank A Kingswood * 136ce76104SFrank A Kingswood * This program is free software; you can redistribute it and/or 146ce76104SFrank A Kingswood * modify it under the terms of the GNU General Public License version 156ce76104SFrank A Kingswood * 2 as published by the Free Software Foundation. 166ce76104SFrank A Kingswood */ 176ce76104SFrank A Kingswood 186ce76104SFrank A Kingswood #include <linux/kernel.h> 196ce76104SFrank A Kingswood #include <linux/tty.h> 206ce76104SFrank A Kingswood #include <linux/module.h> 215a0e3ad6STejun Heo #include <linux/slab.h> 226ce76104SFrank A Kingswood #include <linux/usb.h> 236ce76104SFrank A Kingswood #include <linux/usb/serial.h> 246ce76104SFrank A Kingswood #include <linux/serial.h> 255be796f0SJohan Hovold #include <asm/unaligned.h> 266ce76104SFrank A Kingswood 27664d5df9SWerner Cornelius #define DEFAULT_BAUD_RATE 9600 286ce76104SFrank A Kingswood #define DEFAULT_TIMEOUT 1000 296ce76104SFrank A Kingswood 30664d5df9SWerner Cornelius /* flags for IO-Bits */ 31664d5df9SWerner Cornelius #define CH341_BIT_RTS (1 << 6) 32664d5df9SWerner Cornelius #define CH341_BIT_DTR (1 << 5) 33664d5df9SWerner Cornelius 34664d5df9SWerner Cornelius /******************************/ 35664d5df9SWerner Cornelius /* interrupt pipe definitions */ 36664d5df9SWerner Cornelius /******************************/ 37664d5df9SWerner Cornelius /* always 4 interrupt bytes */ 38664d5df9SWerner Cornelius /* first irq byte normally 0x08 */ 39664d5df9SWerner Cornelius /* second irq byte base 0x7d + below */ 40664d5df9SWerner Cornelius /* third irq byte base 0x94 + below */ 41664d5df9SWerner Cornelius /* fourth irq byte normally 0xee */ 42664d5df9SWerner Cornelius 43664d5df9SWerner Cornelius /* second interrupt byte */ 44664d5df9SWerner Cornelius #define CH341_MULT_STAT 0x04 /* multiple status since last interrupt event */ 45664d5df9SWerner Cornelius 46664d5df9SWerner Cornelius /* status returned in third interrupt answer byte, inverted in data 47664d5df9SWerner Cornelius from irq */ 48664d5df9SWerner Cornelius #define CH341_BIT_CTS 0x01 49664d5df9SWerner Cornelius #define CH341_BIT_DSR 0x02 50664d5df9SWerner Cornelius #define CH341_BIT_RI 0x04 51664d5df9SWerner Cornelius #define CH341_BIT_DCD 0x08 52664d5df9SWerner Cornelius #define CH341_BITS_MODEM_STAT 0x0f /* all bits */ 53664d5df9SWerner Cornelius 54664d5df9SWerner Cornelius /*******************************/ 55664d5df9SWerner Cornelius /* baudrate calculation factor */ 56664d5df9SWerner Cornelius /*******************************/ 57664d5df9SWerner Cornelius #define CH341_BAUDBASE_FACTOR 1532620800 58664d5df9SWerner Cornelius #define CH341_BAUDBASE_DIVMAX 3 59664d5df9SWerner Cornelius 60492896f0STim Small /* Break support - the information used to implement this was gleaned from 61492896f0STim Small * the Net/FreeBSD uchcom.c driver by Takanori Watanabe. Domo arigato. 62492896f0STim Small */ 63492896f0STim Small 646fde8d29SAidan Thornton #define CH341_REQ_READ_VERSION 0x5F 65492896f0STim Small #define CH341_REQ_WRITE_REG 0x9A 66492896f0STim Small #define CH341_REQ_READ_REG 0x95 676fde8d29SAidan Thornton #define CH341_REQ_SERIAL_INIT 0xA1 686fde8d29SAidan Thornton #define CH341_REQ_MODEM_CTRL 0xA4 69492896f0STim Small 706fde8d29SAidan Thornton #define CH341_REG_BREAK 0x05 716fde8d29SAidan Thornton #define CH341_REG_LCR 0x18 726fde8d29SAidan Thornton #define CH341_NBREAK_BITS 0x01 736fde8d29SAidan Thornton 746fde8d29SAidan Thornton #define CH341_LCR_ENABLE_RX 0x80 756fde8d29SAidan Thornton #define CH341_LCR_ENABLE_TX 0x40 766fde8d29SAidan Thornton #define CH341_LCR_MARK_SPACE 0x20 776fde8d29SAidan Thornton #define CH341_LCR_PAR_EVEN 0x10 786fde8d29SAidan Thornton #define CH341_LCR_ENABLE_PAR 0x08 796fde8d29SAidan Thornton #define CH341_LCR_STOP_BITS_2 0x04 806fde8d29SAidan Thornton #define CH341_LCR_CS8 0x03 816fde8d29SAidan Thornton #define CH341_LCR_CS7 0x02 826fde8d29SAidan Thornton #define CH341_LCR_CS6 0x01 836fde8d29SAidan Thornton #define CH341_LCR_CS5 0x00 84492896f0STim Small 857d40d7e8SNémeth Márton static const struct usb_device_id id_table[] = { 866ce76104SFrank A Kingswood { USB_DEVICE(0x4348, 0x5523) }, 8782078234SMichael F. Robbins { USB_DEVICE(0x1a86, 0x7523) }, 88d0781383Swangyanqing { USB_DEVICE(0x1a86, 0x5523) }, 896ce76104SFrank A Kingswood { }, 906ce76104SFrank A Kingswood }; 916ce76104SFrank A Kingswood MODULE_DEVICE_TABLE(usb, id_table); 926ce76104SFrank A Kingswood 936ce76104SFrank A Kingswood struct ch341_private { 94664d5df9SWerner Cornelius spinlock_t lock; /* access lock */ 95664d5df9SWerner Cornelius unsigned baud_rate; /* set baud rate */ 96beea33d4SJohan Hovold u8 mcr; 97e8024460SJohan Hovold u8 msr; 983cca8624SJohan Hovold u8 lcr; 996ce76104SFrank A Kingswood }; 1006ce76104SFrank A Kingswood 101aa91def4SNicolas PLANEL static void ch341_set_termios(struct tty_struct *tty, 102aa91def4SNicolas PLANEL struct usb_serial_port *port, 103aa91def4SNicolas PLANEL struct ktermios *old_termios); 104aa91def4SNicolas PLANEL 1056ce76104SFrank A Kingswood static int ch341_control_out(struct usb_device *dev, u8 request, 1066ce76104SFrank A Kingswood u16 value, u16 index) 1076ce76104SFrank A Kingswood { 1086ce76104SFrank A Kingswood int r; 10979cbeeafSGreg Kroah-Hartman 11091e0efcdSJohan Hovold dev_dbg(&dev->dev, "%s - (%02x,%04x,%04x)\n", __func__, 11191e0efcdSJohan Hovold request, value, index); 1126ce76104SFrank A Kingswood 1136ce76104SFrank A Kingswood r = usb_control_msg(dev, usb_sndctrlpipe(dev, 0), request, 1146ce76104SFrank A Kingswood USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_OUT, 1156ce76104SFrank A Kingswood value, index, NULL, 0, DEFAULT_TIMEOUT); 1162d5a9c72SJohan Hovold if (r < 0) 1172d5a9c72SJohan Hovold dev_err(&dev->dev, "failed to send control message: %d\n", r); 1186ce76104SFrank A Kingswood 1196ce76104SFrank A Kingswood return r; 1206ce76104SFrank A Kingswood } 1216ce76104SFrank A Kingswood 1226ce76104SFrank A Kingswood static int ch341_control_in(struct usb_device *dev, 1236ce76104SFrank A Kingswood u8 request, u16 value, u16 index, 1246ce76104SFrank A Kingswood char *buf, unsigned bufsize) 1256ce76104SFrank A Kingswood { 1266ce76104SFrank A Kingswood int r; 12779cbeeafSGreg Kroah-Hartman 12891e0efcdSJohan Hovold dev_dbg(&dev->dev, "%s - (%02x,%04x,%04x,%u)\n", __func__, 12991e0efcdSJohan Hovold request, value, index, bufsize); 1306ce76104SFrank A Kingswood 1316ce76104SFrank A Kingswood r = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), request, 1326ce76104SFrank A Kingswood USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_DIR_IN, 1336ce76104SFrank A Kingswood value, index, buf, bufsize, DEFAULT_TIMEOUT); 1342d5a9c72SJohan Hovold if (r < bufsize) { 1352d5a9c72SJohan Hovold if (r >= 0) { 1362d5a9c72SJohan Hovold dev_err(&dev->dev, 1372d5a9c72SJohan Hovold "short control message received (%d < %u)\n", 1382d5a9c72SJohan Hovold r, bufsize); 1392d5a9c72SJohan Hovold r = -EIO; 1402d5a9c72SJohan Hovold } 1412d5a9c72SJohan Hovold 1422d5a9c72SJohan Hovold dev_err(&dev->dev, "failed to receive control message: %d\n", 1432d5a9c72SJohan Hovold r); 1446ce76104SFrank A Kingswood return r; 1456ce76104SFrank A Kingswood } 1466ce76104SFrank A Kingswood 1472d5a9c72SJohan Hovold return 0; 1482d5a9c72SJohan Hovold } 1492d5a9c72SJohan Hovold 15055fa15b5SJohan Hovold static int ch341_set_baudrate_lcr(struct usb_device *dev, 15155fa15b5SJohan Hovold struct ch341_private *priv, u8 lcr) 1526ce76104SFrank A Kingswood { 1534e46c410SAidan Thornton short a; 1546ce76104SFrank A Kingswood int r; 155664d5df9SWerner Cornelius unsigned long factor; 156664d5df9SWerner Cornelius short divisor; 1576ce76104SFrank A Kingswood 158664d5df9SWerner Cornelius if (!priv->baud_rate) 1596ce76104SFrank A Kingswood return -EINVAL; 160664d5df9SWerner Cornelius factor = (CH341_BAUDBASE_FACTOR / priv->baud_rate); 161664d5df9SWerner Cornelius divisor = CH341_BAUDBASE_DIVMAX; 162664d5df9SWerner Cornelius 163664d5df9SWerner Cornelius while ((factor > 0xfff0) && divisor) { 164664d5df9SWerner Cornelius factor >>= 3; 165664d5df9SWerner Cornelius divisor--; 1666ce76104SFrank A Kingswood } 1676ce76104SFrank A Kingswood 168664d5df9SWerner Cornelius if (factor > 0xfff0) 169664d5df9SWerner Cornelius return -EINVAL; 170664d5df9SWerner Cornelius 171664d5df9SWerner Cornelius factor = 0x10000 - factor; 172664d5df9SWerner Cornelius a = (factor & 0xff00) | divisor; 173664d5df9SWerner Cornelius 17455fa15b5SJohan Hovold /* 17555fa15b5SJohan Hovold * CH341A buffers data until a full endpoint-size packet (32 bytes) 17655fa15b5SJohan Hovold * has been received unless bit 7 is set. 17755fa15b5SJohan Hovold */ 17855fa15b5SJohan Hovold a |= BIT(7); 17955fa15b5SJohan Hovold 18055fa15b5SJohan Hovold r = ch341_control_out(dev, CH341_REQ_WRITE_REG, 0x1312, a); 18155fa15b5SJohan Hovold if (r) 18255fa15b5SJohan Hovold return r; 18355fa15b5SJohan Hovold 18455fa15b5SJohan Hovold r = ch341_control_out(dev, CH341_REQ_WRITE_REG, 0x2518, lcr); 18555fa15b5SJohan Hovold if (r) 18655fa15b5SJohan Hovold return r; 1876ce76104SFrank A Kingswood 1886ce76104SFrank A Kingswood return r; 1896ce76104SFrank A Kingswood } 1906ce76104SFrank A Kingswood 191664d5df9SWerner Cornelius static int ch341_set_handshake(struct usb_device *dev, u8 control) 1926ce76104SFrank A Kingswood { 1936fde8d29SAidan Thornton return ch341_control_out(dev, CH341_REQ_MODEM_CTRL, ~control, 0); 1946ce76104SFrank A Kingswood } 1956ce76104SFrank A Kingswood 196664d5df9SWerner Cornelius static int ch341_get_status(struct usb_device *dev, struct ch341_private *priv) 1976ce76104SFrank A Kingswood { 1982d5a9c72SJohan Hovold const unsigned int size = 2; 1996ce76104SFrank A Kingswood char *buffer; 2006ce76104SFrank A Kingswood int r; 201664d5df9SWerner Cornelius unsigned long flags; 2026ce76104SFrank A Kingswood 2036ce76104SFrank A Kingswood buffer = kmalloc(size, GFP_KERNEL); 2046ce76104SFrank A Kingswood if (!buffer) 2056ce76104SFrank A Kingswood return -ENOMEM; 2066ce76104SFrank A Kingswood 2076fde8d29SAidan Thornton r = ch341_control_in(dev, CH341_REQ_READ_REG, 0x0706, 0, buffer, size); 2086ce76104SFrank A Kingswood if (r < 0) 2096ce76104SFrank A Kingswood goto out; 2106ce76104SFrank A Kingswood 211664d5df9SWerner Cornelius spin_lock_irqsave(&priv->lock, flags); 212e8024460SJohan Hovold priv->msr = (~(*buffer)) & CH341_BITS_MODEM_STAT; 213664d5df9SWerner Cornelius spin_unlock_irqrestore(&priv->lock, flags); 2146ce76104SFrank A Kingswood 2156ce76104SFrank A Kingswood out: kfree(buffer); 2166ce76104SFrank A Kingswood return r; 2176ce76104SFrank A Kingswood } 2186ce76104SFrank A Kingswood 2196ce76104SFrank A Kingswood /* -------------------------------------------------------------------------- */ 2206ce76104SFrank A Kingswood 22193b6497dSAdrian Bunk static int ch341_configure(struct usb_device *dev, struct ch341_private *priv) 2226ce76104SFrank A Kingswood { 2232d5a9c72SJohan Hovold const unsigned int size = 2; 2246ce76104SFrank A Kingswood char *buffer; 2256ce76104SFrank A Kingswood int r; 2266ce76104SFrank A Kingswood 2276ce76104SFrank A Kingswood buffer = kmalloc(size, GFP_KERNEL); 2286ce76104SFrank A Kingswood if (!buffer) 2296ce76104SFrank A Kingswood return -ENOMEM; 2306ce76104SFrank A Kingswood 2316ce76104SFrank A Kingswood /* expect two bytes 0x27 0x00 */ 2326fde8d29SAidan Thornton r = ch341_control_in(dev, CH341_REQ_READ_VERSION, 0, 0, buffer, size); 2336ce76104SFrank A Kingswood if (r < 0) 2346ce76104SFrank A Kingswood goto out; 235a98b6900SAidan Thornton dev_dbg(&dev->dev, "Chip version: 0x%02x\n", buffer[0]); 2366ce76104SFrank A Kingswood 2376fde8d29SAidan Thornton r = ch341_control_out(dev, CH341_REQ_SERIAL_INIT, 0, 0); 2386ce76104SFrank A Kingswood if (r < 0) 2396ce76104SFrank A Kingswood goto out; 2406ce76104SFrank A Kingswood 24155fa15b5SJohan Hovold r = ch341_set_baudrate_lcr(dev, priv, priv->lcr); 2426ce76104SFrank A Kingswood if (r < 0) 2436ce76104SFrank A Kingswood goto out; 2446ce76104SFrank A Kingswood 245beea33d4SJohan Hovold r = ch341_set_handshake(dev, priv->mcr); 2466ce76104SFrank A Kingswood 2476ce76104SFrank A Kingswood out: kfree(buffer); 2486ce76104SFrank A Kingswood return r; 2496ce76104SFrank A Kingswood } 2506ce76104SFrank A Kingswood 251456c5be5SJohan Hovold static int ch341_port_probe(struct usb_serial_port *port) 2526ce76104SFrank A Kingswood { 2536ce76104SFrank A Kingswood struct ch341_private *priv; 2546ce76104SFrank A Kingswood int r; 2556ce76104SFrank A Kingswood 2566ce76104SFrank A Kingswood priv = kzalloc(sizeof(struct ch341_private), GFP_KERNEL); 2576ce76104SFrank A Kingswood if (!priv) 2586ce76104SFrank A Kingswood return -ENOMEM; 2596ce76104SFrank A Kingswood 260664d5df9SWerner Cornelius spin_lock_init(&priv->lock); 2616ce76104SFrank A Kingswood priv->baud_rate = DEFAULT_BAUD_RATE; 262*7c61b0d5SJohan Hovold /* 263*7c61b0d5SJohan Hovold * Some CH340 devices appear unable to change the initial LCR 264*7c61b0d5SJohan Hovold * settings, so set a sane 8N1 default. 265*7c61b0d5SJohan Hovold */ 266*7c61b0d5SJohan Hovold priv->lcr = CH341_LCR_ENABLE_RX | CH341_LCR_ENABLE_TX | CH341_LCR_CS8; 2676ce76104SFrank A Kingswood 268456c5be5SJohan Hovold r = ch341_configure(port->serial->dev, priv); 2696ce76104SFrank A Kingswood if (r < 0) 2706ce76104SFrank A Kingswood goto error; 2716ce76104SFrank A Kingswood 272456c5be5SJohan Hovold usb_set_serial_port_data(port, priv); 2736ce76104SFrank A Kingswood return 0; 2746ce76104SFrank A Kingswood 2756ce76104SFrank A Kingswood error: kfree(priv); 2766ce76104SFrank A Kingswood return r; 2776ce76104SFrank A Kingswood } 2786ce76104SFrank A Kingswood 279456c5be5SJohan Hovold static int ch341_port_remove(struct usb_serial_port *port) 280456c5be5SJohan Hovold { 281456c5be5SJohan Hovold struct ch341_private *priv; 282456c5be5SJohan Hovold 283456c5be5SJohan Hovold priv = usb_get_serial_port_data(port); 284456c5be5SJohan Hovold kfree(priv); 285456c5be5SJohan Hovold 286456c5be5SJohan Hovold return 0; 287456c5be5SJohan Hovold } 288456c5be5SJohan Hovold 289335f8514SAlan Cox static int ch341_carrier_raised(struct usb_serial_port *port) 290335f8514SAlan Cox { 291335f8514SAlan Cox struct ch341_private *priv = usb_get_serial_port_data(port); 292e8024460SJohan Hovold if (priv->msr & CH341_BIT_DCD) 293335f8514SAlan Cox return 1; 294335f8514SAlan Cox return 0; 295335f8514SAlan Cox } 296335f8514SAlan Cox 297335f8514SAlan Cox static void ch341_dtr_rts(struct usb_serial_port *port, int on) 298664d5df9SWerner Cornelius { 299664d5df9SWerner Cornelius struct ch341_private *priv = usb_get_serial_port_data(port); 300664d5df9SWerner Cornelius unsigned long flags; 301664d5df9SWerner Cornelius 302335f8514SAlan Cox /* drop DTR and RTS */ 303335f8514SAlan Cox spin_lock_irqsave(&priv->lock, flags); 304335f8514SAlan Cox if (on) 305beea33d4SJohan Hovold priv->mcr |= CH341_BIT_RTS | CH341_BIT_DTR; 306335f8514SAlan Cox else 307beea33d4SJohan Hovold priv->mcr &= ~(CH341_BIT_RTS | CH341_BIT_DTR); 308335f8514SAlan Cox spin_unlock_irqrestore(&priv->lock, flags); 309beea33d4SJohan Hovold ch341_set_handshake(port->serial->dev, priv->mcr); 310335f8514SAlan Cox } 311335f8514SAlan Cox 312335f8514SAlan Cox static void ch341_close(struct usb_serial_port *port) 313335f8514SAlan Cox { 314f26788daSJohan Hovold usb_serial_generic_close(port); 315664d5df9SWerner Cornelius usb_kill_urb(port->interrupt_in_urb); 316664d5df9SWerner Cornelius } 317664d5df9SWerner Cornelius 318664d5df9SWerner Cornelius 3196ce76104SFrank A Kingswood /* open this device, set default parameters */ 320a509a7e4SAlan Cox static int ch341_open(struct tty_struct *tty, struct usb_serial_port *port) 3216ce76104SFrank A Kingswood { 322456c5be5SJohan Hovold struct ch341_private *priv = usb_get_serial_port_data(port); 3236ce76104SFrank A Kingswood int r; 3246ce76104SFrank A Kingswood 325aa91def4SNicolas PLANEL if (tty) 326aa91def4SNicolas PLANEL ch341_set_termios(tty, port, NULL); 3276ce76104SFrank A Kingswood 328d9a38a87SJohan Hovold dev_dbg(&port->dev, "%s - submitting interrupt urb\n", __func__); 329664d5df9SWerner Cornelius r = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL); 330664d5df9SWerner Cornelius if (r) { 331d9a38a87SJohan Hovold dev_err(&port->dev, "%s - failed to submit interrupt urb: %d\n", 332d9a38a87SJohan Hovold __func__, r); 333f2950b78SJohan Hovold return r; 334664d5df9SWerner Cornelius } 335664d5df9SWerner Cornelius 336a0467a96SJohan Hovold r = ch341_get_status(port->serial->dev, priv); 337a0467a96SJohan Hovold if (r < 0) { 338a0467a96SJohan Hovold dev_err(&port->dev, "failed to read modem status: %d\n", r); 339a0467a96SJohan Hovold goto err_kill_interrupt_urb; 340a0467a96SJohan Hovold } 341a0467a96SJohan Hovold 342a509a7e4SAlan Cox r = usb_serial_generic_open(tty, port); 343f2950b78SJohan Hovold if (r) 344f2950b78SJohan Hovold goto err_kill_interrupt_urb; 3456ce76104SFrank A Kingswood 346f2950b78SJohan Hovold return 0; 347f2950b78SJohan Hovold 348f2950b78SJohan Hovold err_kill_interrupt_urb: 349f2950b78SJohan Hovold usb_kill_urb(port->interrupt_in_urb); 350f2950b78SJohan Hovold 351f2950b78SJohan Hovold return r; 3526ce76104SFrank A Kingswood } 3536ce76104SFrank A Kingswood 3546ce76104SFrank A Kingswood /* Old_termios contains the original termios settings and 3556ce76104SFrank A Kingswood * tty->termios contains the new setting to be used. 3566ce76104SFrank A Kingswood */ 35795da310eSAlan Cox static void ch341_set_termios(struct tty_struct *tty, 35895da310eSAlan Cox struct usb_serial_port *port, struct ktermios *old_termios) 3596ce76104SFrank A Kingswood { 3606ce76104SFrank A Kingswood struct ch341_private *priv = usb_get_serial_port_data(port); 3616ce76104SFrank A Kingswood unsigned baud_rate; 362664d5df9SWerner Cornelius unsigned long flags; 363448b6dc5SJohan Hovold u8 lcr; 3644e46c410SAidan Thornton int r; 3654e46c410SAidan Thornton 3664e46c410SAidan Thornton /* redundant changes may cause the chip to lose bytes */ 3674e46c410SAidan Thornton if (old_termios && !tty_termios_hw_change(&tty->termios, old_termios)) 3684e46c410SAidan Thornton return; 3696ce76104SFrank A Kingswood 3706ce76104SFrank A Kingswood baud_rate = tty_get_baud_rate(tty); 3716ce76104SFrank A Kingswood 372448b6dc5SJohan Hovold lcr = CH341_LCR_ENABLE_RX | CH341_LCR_ENABLE_TX; 373664d5df9SWerner Cornelius 374ba781bdfSAidan Thornton switch (C_CSIZE(tty)) { 375ba781bdfSAidan Thornton case CS5: 376448b6dc5SJohan Hovold lcr |= CH341_LCR_CS5; 377ba781bdfSAidan Thornton break; 378ba781bdfSAidan Thornton case CS6: 379448b6dc5SJohan Hovold lcr |= CH341_LCR_CS6; 380ba781bdfSAidan Thornton break; 381ba781bdfSAidan Thornton case CS7: 382448b6dc5SJohan Hovold lcr |= CH341_LCR_CS7; 383ba781bdfSAidan Thornton break; 384ba781bdfSAidan Thornton case CS8: 385448b6dc5SJohan Hovold lcr |= CH341_LCR_CS8; 386ba781bdfSAidan Thornton break; 387ba781bdfSAidan Thornton } 388ba781bdfSAidan Thornton 389ba781bdfSAidan Thornton if (C_PARENB(tty)) { 390448b6dc5SJohan Hovold lcr |= CH341_LCR_ENABLE_PAR; 391ba781bdfSAidan Thornton if (C_PARODD(tty) == 0) 392448b6dc5SJohan Hovold lcr |= CH341_LCR_PAR_EVEN; 393ba781bdfSAidan Thornton if (C_CMSPAR(tty)) 394448b6dc5SJohan Hovold lcr |= CH341_LCR_MARK_SPACE; 395ba781bdfSAidan Thornton } 396ba781bdfSAidan Thornton 397ba781bdfSAidan Thornton if (C_CSTOPB(tty)) 398448b6dc5SJohan Hovold lcr |= CH341_LCR_STOP_BITS_2; 3994e46c410SAidan Thornton 400664d5df9SWerner Cornelius if (baud_rate) { 401a20047f3SJohan Hovold priv->baud_rate = baud_rate; 402a20047f3SJohan Hovold 403448b6dc5SJohan Hovold r = ch341_set_baudrate_lcr(port->serial->dev, priv, lcr); 4044e46c410SAidan Thornton if (r < 0 && old_termios) { 4054e46c410SAidan Thornton priv->baud_rate = tty_termios_baud_rate(old_termios); 4064e46c410SAidan Thornton tty_termios_copy_hw(&tty->termios, old_termios); 4073cca8624SJohan Hovold } else if (r == 0) { 408448b6dc5SJohan Hovold priv->lcr = lcr; 4094e46c410SAidan Thornton } 4106ce76104SFrank A Kingswood } 4116ce76104SFrank A Kingswood 412030ee7aeSJohan Hovold spin_lock_irqsave(&priv->lock, flags); 413030ee7aeSJohan Hovold if (C_BAUD(tty) == B0) 414beea33d4SJohan Hovold priv->mcr &= ~(CH341_BIT_DTR | CH341_BIT_RTS); 415030ee7aeSJohan Hovold else if (old_termios && (old_termios->c_cflag & CBAUD) == B0) 416beea33d4SJohan Hovold priv->mcr |= (CH341_BIT_DTR | CH341_BIT_RTS); 417030ee7aeSJohan Hovold spin_unlock_irqrestore(&priv->lock, flags); 4186ce76104SFrank A Kingswood 419beea33d4SJohan Hovold ch341_set_handshake(port->serial->dev, priv->mcr); 420664d5df9SWerner Cornelius } 42173f59308SAlan Cox 422492896f0STim Small static void ch341_break_ctl(struct tty_struct *tty, int break_state) 423492896f0STim Small { 424492896f0STim Small const uint16_t ch341_break_reg = 4256fde8d29SAidan Thornton ((uint16_t) CH341_REG_LCR << 8) | CH341_REG_BREAK; 426492896f0STim Small struct usb_serial_port *port = tty->driver_data; 427492896f0STim Small int r; 428492896f0STim Small uint16_t reg_contents; 429f2b5cc83SJohan Hovold uint8_t *break_reg; 430492896f0STim Small 431f2b5cc83SJohan Hovold break_reg = kmalloc(2, GFP_KERNEL); 43210c642d0SJohan Hovold if (!break_reg) 433f2b5cc83SJohan Hovold return; 434f2b5cc83SJohan Hovold 435492896f0STim Small r = ch341_control_in(port->serial->dev, CH341_REQ_READ_REG, 436f2b5cc83SJohan Hovold ch341_break_reg, 0, break_reg, 2); 437492896f0STim Small if (r < 0) { 4386a9b15feSJohan Hovold dev_err(&port->dev, "%s - USB control read error (%d)\n", 4396a9b15feSJohan Hovold __func__, r); 440f2b5cc83SJohan Hovold goto out; 441492896f0STim Small } 44279cbeeafSGreg Kroah-Hartman dev_dbg(&port->dev, "%s - initial ch341 break register contents - reg1: %x, reg2: %x\n", 443492896f0STim Small __func__, break_reg[0], break_reg[1]); 444492896f0STim Small if (break_state != 0) { 44579cbeeafSGreg Kroah-Hartman dev_dbg(&port->dev, "%s - Enter break state requested\n", __func__); 4466fde8d29SAidan Thornton break_reg[0] &= ~CH341_NBREAK_BITS; 4476fde8d29SAidan Thornton break_reg[1] &= ~CH341_LCR_ENABLE_TX; 448492896f0STim Small } else { 44979cbeeafSGreg Kroah-Hartman dev_dbg(&port->dev, "%s - Leave break state requested\n", __func__); 4506fde8d29SAidan Thornton break_reg[0] |= CH341_NBREAK_BITS; 4516fde8d29SAidan Thornton break_reg[1] |= CH341_LCR_ENABLE_TX; 452492896f0STim Small } 45379cbeeafSGreg Kroah-Hartman dev_dbg(&port->dev, "%s - New ch341 break register contents - reg1: %x, reg2: %x\n", 454492896f0STim Small __func__, break_reg[0], break_reg[1]); 4555be796f0SJohan Hovold reg_contents = get_unaligned_le16(break_reg); 456492896f0STim Small r = ch341_control_out(port->serial->dev, CH341_REQ_WRITE_REG, 457492896f0STim Small ch341_break_reg, reg_contents); 458492896f0STim Small if (r < 0) 4596a9b15feSJohan Hovold dev_err(&port->dev, "%s - USB control write error (%d)\n", 4606a9b15feSJohan Hovold __func__, r); 461f2b5cc83SJohan Hovold out: 462f2b5cc83SJohan Hovold kfree(break_reg); 463492896f0STim Small } 464492896f0STim Small 46520b9d177SAlan Cox static int ch341_tiocmset(struct tty_struct *tty, 466664d5df9SWerner Cornelius unsigned int set, unsigned int clear) 467664d5df9SWerner Cornelius { 468664d5df9SWerner Cornelius struct usb_serial_port *port = tty->driver_data; 469664d5df9SWerner Cornelius struct ch341_private *priv = usb_get_serial_port_data(port); 470664d5df9SWerner Cornelius unsigned long flags; 471664d5df9SWerner Cornelius u8 control; 472664d5df9SWerner Cornelius 473664d5df9SWerner Cornelius spin_lock_irqsave(&priv->lock, flags); 474664d5df9SWerner Cornelius if (set & TIOCM_RTS) 475beea33d4SJohan Hovold priv->mcr |= CH341_BIT_RTS; 476664d5df9SWerner Cornelius if (set & TIOCM_DTR) 477beea33d4SJohan Hovold priv->mcr |= CH341_BIT_DTR; 478664d5df9SWerner Cornelius if (clear & TIOCM_RTS) 479beea33d4SJohan Hovold priv->mcr &= ~CH341_BIT_RTS; 480664d5df9SWerner Cornelius if (clear & TIOCM_DTR) 481beea33d4SJohan Hovold priv->mcr &= ~CH341_BIT_DTR; 482beea33d4SJohan Hovold control = priv->mcr; 483664d5df9SWerner Cornelius spin_unlock_irqrestore(&priv->lock, flags); 484664d5df9SWerner Cornelius 485664d5df9SWerner Cornelius return ch341_set_handshake(port->serial->dev, control); 486664d5df9SWerner Cornelius } 487664d5df9SWerner Cornelius 488e8024460SJohan Hovold static void ch341_update_status(struct usb_serial_port *port, 489ac035628SJohan Hovold unsigned char *data, size_t len) 490ac035628SJohan Hovold { 491ac035628SJohan Hovold struct ch341_private *priv = usb_get_serial_port_data(port); 492b770081fSJohan Hovold struct tty_struct *tty; 493ac035628SJohan Hovold unsigned long flags; 494b770081fSJohan Hovold u8 status; 495b770081fSJohan Hovold u8 delta; 496ac035628SJohan Hovold 497ac035628SJohan Hovold if (len < 4) 498ac035628SJohan Hovold return; 499ac035628SJohan Hovold 500b770081fSJohan Hovold status = ~data[2] & CH341_BITS_MODEM_STAT; 501b770081fSJohan Hovold 502ac035628SJohan Hovold spin_lock_irqsave(&priv->lock, flags); 503e8024460SJohan Hovold delta = status ^ priv->msr; 504e8024460SJohan Hovold priv->msr = status; 505ac035628SJohan Hovold spin_unlock_irqrestore(&priv->lock, flags); 506ac035628SJohan Hovold 507fd74b0b1SJohan Hovold if (data[1] & CH341_MULT_STAT) 508fd74b0b1SJohan Hovold dev_dbg(&port->dev, "%s - multiple status change\n", __func__); 509fd74b0b1SJohan Hovold 510d984fe91SJohan Hovold if (!delta) 511d984fe91SJohan Hovold return; 512d984fe91SJohan Hovold 5135e409a26SJohan Hovold if (delta & CH341_BIT_CTS) 5145e409a26SJohan Hovold port->icount.cts++; 5155e409a26SJohan Hovold if (delta & CH341_BIT_DSR) 5165e409a26SJohan Hovold port->icount.dsr++; 5175e409a26SJohan Hovold if (delta & CH341_BIT_RI) 5185e409a26SJohan Hovold port->icount.rng++; 519b770081fSJohan Hovold if (delta & CH341_BIT_DCD) { 5205e409a26SJohan Hovold port->icount.dcd++; 521b770081fSJohan Hovold tty = tty_port_tty_get(&port->port); 522b770081fSJohan Hovold if (tty) { 523ac035628SJohan Hovold usb_serial_handle_dcd_change(port, tty, 524b770081fSJohan Hovold status & CH341_BIT_DCD); 525ac035628SJohan Hovold tty_kref_put(tty); 526ac035628SJohan Hovold } 527b770081fSJohan Hovold } 528ac035628SJohan Hovold 529ac035628SJohan Hovold wake_up_interruptible(&port->port.delta_msr_wait); 530ac035628SJohan Hovold } 531ac035628SJohan Hovold 532664d5df9SWerner Cornelius static void ch341_read_int_callback(struct urb *urb) 533664d5df9SWerner Cornelius { 534271ec2d2SJohan Hovold struct usb_serial_port *port = urb->context; 535664d5df9SWerner Cornelius unsigned char *data = urb->transfer_buffer; 536271ec2d2SJohan Hovold unsigned int len = urb->actual_length; 537664d5df9SWerner Cornelius int status; 538664d5df9SWerner Cornelius 539664d5df9SWerner Cornelius switch (urb->status) { 540664d5df9SWerner Cornelius case 0: 541664d5df9SWerner Cornelius /* success */ 542664d5df9SWerner Cornelius break; 543664d5df9SWerner Cornelius case -ECONNRESET: 544664d5df9SWerner Cornelius case -ENOENT: 545664d5df9SWerner Cornelius case -ESHUTDOWN: 546664d5df9SWerner Cornelius /* this urb is terminated, clean up */ 547271ec2d2SJohan Hovold dev_dbg(&urb->dev->dev, "%s - urb shutting down: %d\n", 54879cbeeafSGreg Kroah-Hartman __func__, urb->status); 549664d5df9SWerner Cornelius return; 550664d5df9SWerner Cornelius default: 551271ec2d2SJohan Hovold dev_dbg(&urb->dev->dev, "%s - nonzero urb status: %d\n", 55279cbeeafSGreg Kroah-Hartman __func__, urb->status); 553664d5df9SWerner Cornelius goto exit; 554664d5df9SWerner Cornelius } 555664d5df9SWerner Cornelius 556271ec2d2SJohan Hovold usb_serial_debug_data(&port->dev, __func__, len, data); 557e8024460SJohan Hovold ch341_update_status(port, data, len); 558664d5df9SWerner Cornelius exit: 559664d5df9SWerner Cornelius status = usb_submit_urb(urb, GFP_ATOMIC); 560271ec2d2SJohan Hovold if (status) { 561271ec2d2SJohan Hovold dev_err(&urb->dev->dev, "%s - usb_submit_urb failed: %d\n", 562664d5df9SWerner Cornelius __func__, status); 563664d5df9SWerner Cornelius } 564271ec2d2SJohan Hovold } 565664d5df9SWerner Cornelius 56660b33c13SAlan Cox static int ch341_tiocmget(struct tty_struct *tty) 567664d5df9SWerner Cornelius { 568664d5df9SWerner Cornelius struct usb_serial_port *port = tty->driver_data; 569664d5df9SWerner Cornelius struct ch341_private *priv = usb_get_serial_port_data(port); 570664d5df9SWerner Cornelius unsigned long flags; 571664d5df9SWerner Cornelius u8 mcr; 572664d5df9SWerner Cornelius u8 status; 573664d5df9SWerner Cornelius unsigned int result; 574664d5df9SWerner Cornelius 575664d5df9SWerner Cornelius spin_lock_irqsave(&priv->lock, flags); 576beea33d4SJohan Hovold mcr = priv->mcr; 577e8024460SJohan Hovold status = priv->msr; 578664d5df9SWerner Cornelius spin_unlock_irqrestore(&priv->lock, flags); 579664d5df9SWerner Cornelius 580664d5df9SWerner Cornelius result = ((mcr & CH341_BIT_DTR) ? TIOCM_DTR : 0) 581664d5df9SWerner Cornelius | ((mcr & CH341_BIT_RTS) ? TIOCM_RTS : 0) 582664d5df9SWerner Cornelius | ((status & CH341_BIT_CTS) ? TIOCM_CTS : 0) 583664d5df9SWerner Cornelius | ((status & CH341_BIT_DSR) ? TIOCM_DSR : 0) 584664d5df9SWerner Cornelius | ((status & CH341_BIT_RI) ? TIOCM_RI : 0) 585664d5df9SWerner Cornelius | ((status & CH341_BIT_DCD) ? TIOCM_CD : 0); 586664d5df9SWerner Cornelius 58779cbeeafSGreg Kroah-Hartman dev_dbg(&port->dev, "%s - result = %x\n", __func__, result); 588664d5df9SWerner Cornelius 589664d5df9SWerner Cornelius return result; 5906ce76104SFrank A Kingswood } 5916ce76104SFrank A Kingswood 592622b80cfSGreg Kroah-Hartman static int ch341_reset_resume(struct usb_serial *serial) 5931ded7ea4SMing Lei { 594ce5e2928SJohan Hovold struct usb_serial_port *port = serial->port[0]; 595ce5e2928SJohan Hovold struct ch341_private *priv = usb_get_serial_port_data(port); 596ce5e2928SJohan Hovold int ret; 5971ded7ea4SMing Lei 5981ded7ea4SMing Lei /* reconfigure ch341 serial port after bus-reset */ 5992bfd1c96SGreg Kroah-Hartman ch341_configure(serial->dev, priv); 6001ded7ea4SMing Lei 601ce5e2928SJohan Hovold if (tty_port_initialized(&port->port)) { 602ce5e2928SJohan Hovold ret = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO); 603ce5e2928SJohan Hovold if (ret) { 604ce5e2928SJohan Hovold dev_err(&port->dev, "failed to submit interrupt urb: %d\n", 605ce5e2928SJohan Hovold ret); 606ce5e2928SJohan Hovold return ret; 607ce5e2928SJohan Hovold } 608a0467a96SJohan Hovold 609a0467a96SJohan Hovold ret = ch341_get_status(port->serial->dev, priv); 610a0467a96SJohan Hovold if (ret < 0) { 611a0467a96SJohan Hovold dev_err(&port->dev, "failed to read modem status: %d\n", 612a0467a96SJohan Hovold ret); 613a0467a96SJohan Hovold } 614ce5e2928SJohan Hovold } 615ce5e2928SJohan Hovold 616ce5e2928SJohan Hovold return usb_serial_generic_resume(serial); 6171ded7ea4SMing Lei } 6181ded7ea4SMing Lei 6196ce76104SFrank A Kingswood static struct usb_serial_driver ch341_device = { 6206ce76104SFrank A Kingswood .driver = { 6216ce76104SFrank A Kingswood .owner = THIS_MODULE, 6226ce76104SFrank A Kingswood .name = "ch341-uart", 6236ce76104SFrank A Kingswood }, 6246ce76104SFrank A Kingswood .id_table = id_table, 6256ce76104SFrank A Kingswood .num_ports = 1, 6266ce76104SFrank A Kingswood .open = ch341_open, 627335f8514SAlan Cox .dtr_rts = ch341_dtr_rts, 628335f8514SAlan Cox .carrier_raised = ch341_carrier_raised, 629664d5df9SWerner Cornelius .close = ch341_close, 6306ce76104SFrank A Kingswood .set_termios = ch341_set_termios, 631492896f0STim Small .break_ctl = ch341_break_ctl, 632664d5df9SWerner Cornelius .tiocmget = ch341_tiocmget, 633664d5df9SWerner Cornelius .tiocmset = ch341_tiocmset, 6345e409a26SJohan Hovold .tiocmiwait = usb_serial_generic_tiocmiwait, 635664d5df9SWerner Cornelius .read_int_callback = ch341_read_int_callback, 636456c5be5SJohan Hovold .port_probe = ch341_port_probe, 637456c5be5SJohan Hovold .port_remove = ch341_port_remove, 6381c1eaba8SGreg Kroah-Hartman .reset_resume = ch341_reset_resume, 6396ce76104SFrank A Kingswood }; 6406ce76104SFrank A Kingswood 64108a4f6bcSAlan Stern static struct usb_serial_driver * const serial_drivers[] = { 64208a4f6bcSAlan Stern &ch341_device, NULL 64308a4f6bcSAlan Stern }; 64408a4f6bcSAlan Stern 64568e24113SGreg Kroah-Hartman module_usb_serial_driver(serial_drivers, id_table); 6466ce76104SFrank A Kingswood 6476ce76104SFrank A Kingswood MODULE_LICENSE("GPL"); 648