1ee467a1fSAndrew Lunn /* 2ee467a1fSAndrew Lunn * mxuport.c - MOXA UPort series driver 3ee467a1fSAndrew Lunn * 4ee467a1fSAndrew Lunn * Copyright (c) 2006 Moxa Technologies Co., Ltd. 5ee467a1fSAndrew Lunn * Copyright (c) 2013 Andrew Lunn <andrew@lunn.ch> 6ee467a1fSAndrew Lunn * 7ee467a1fSAndrew Lunn * This program is free software; you can redistribute it and/or modify 8ee467a1fSAndrew Lunn * it under the terms of the GNU General Public License as published by 9ee467a1fSAndrew Lunn * the Free Software Foundation; either version 2 of the License, or 10ee467a1fSAndrew Lunn * (at your option) any later version. 11ee467a1fSAndrew Lunn * 12ee467a1fSAndrew Lunn * Supports the following Moxa USB to serial converters: 13ee467a1fSAndrew Lunn * 2 ports : UPort 1250, UPort 1250I 14ee467a1fSAndrew Lunn * 4 ports : UPort 1410, UPort 1450, UPort 1450I 15ee467a1fSAndrew Lunn * 8 ports : UPort 1610-8, UPort 1650-8 16ee467a1fSAndrew Lunn * 16 ports : UPort 1610-16, UPort 1650-16 17ee467a1fSAndrew Lunn */ 18ee467a1fSAndrew Lunn 19ee467a1fSAndrew Lunn #include <linux/kernel.h> 20ee467a1fSAndrew Lunn #include <linux/module.h> 21ee467a1fSAndrew Lunn #include <linux/firmware.h> 22ee467a1fSAndrew Lunn #include <linux/init.h> 23ee467a1fSAndrew Lunn #include <linux/jiffies.h> 24ee467a1fSAndrew Lunn #include <linux/serial.h> 25ee467a1fSAndrew Lunn #include <linux/serial_reg.h> 26ee467a1fSAndrew Lunn #include <linux/slab.h> 27ee467a1fSAndrew Lunn #include <linux/tty.h> 28ee467a1fSAndrew Lunn #include <linux/tty_driver.h> 29ee467a1fSAndrew Lunn #include <linux/tty_flip.h> 30ee467a1fSAndrew Lunn #include <linux/uaccess.h> 31ee467a1fSAndrew Lunn #include <linux/usb.h> 32ee467a1fSAndrew Lunn #include <linux/usb/serial.h> 33ee467a1fSAndrew Lunn #include <asm/unaligned.h> 34ee467a1fSAndrew Lunn 35ee467a1fSAndrew Lunn /* Definitions for the vendor ID and device ID */ 36ee467a1fSAndrew Lunn #define MX_USBSERIAL_VID 0x110A 37ee467a1fSAndrew Lunn #define MX_UPORT1250_PID 0x1250 38ee467a1fSAndrew Lunn #define MX_UPORT1251_PID 0x1251 39ee467a1fSAndrew Lunn #define MX_UPORT1410_PID 0x1410 40ee467a1fSAndrew Lunn #define MX_UPORT1450_PID 0x1450 41ee467a1fSAndrew Lunn #define MX_UPORT1451_PID 0x1451 42ee467a1fSAndrew Lunn #define MX_UPORT1618_PID 0x1618 43ee467a1fSAndrew Lunn #define MX_UPORT1658_PID 0x1658 44ee467a1fSAndrew Lunn #define MX_UPORT1613_PID 0x1613 45ee467a1fSAndrew Lunn #define MX_UPORT1653_PID 0x1653 46ee467a1fSAndrew Lunn 47ee467a1fSAndrew Lunn /* Definitions for USB info */ 48ee467a1fSAndrew Lunn #define HEADER_SIZE 4 49ee467a1fSAndrew Lunn #define EVENT_LENGTH 8 50ee467a1fSAndrew Lunn #define DOWN_BLOCK_SIZE 64 51ee467a1fSAndrew Lunn 52ee467a1fSAndrew Lunn /* Definitions for firmware info */ 53ee467a1fSAndrew Lunn #define VER_ADDR_1 0x20 54ee467a1fSAndrew Lunn #define VER_ADDR_2 0x24 55ee467a1fSAndrew Lunn #define VER_ADDR_3 0x28 56ee467a1fSAndrew Lunn 57ee467a1fSAndrew Lunn /* Definitions for USB vendor request */ 58ee467a1fSAndrew Lunn #define RQ_VENDOR_NONE 0x00 59ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_BAUD 0x01 /* Set baud rate */ 60ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_LINE 0x02 /* Set line status */ 61ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_CHARS 0x03 /* Set Xon/Xoff chars */ 62ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_RTS 0x04 /* Set RTS */ 63ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_DTR 0x05 /* Set DTR */ 64ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_XONXOFF 0x06 /* Set auto Xon/Xoff */ 65ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_RX_HOST_EN 0x07 /* Set RX host enable */ 66ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_OPEN 0x08 /* Set open/close port */ 67ee467a1fSAndrew Lunn #define RQ_VENDOR_PURGE 0x09 /* Purge Rx/Tx buffer */ 68ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_MCR 0x0A /* Set MCR register */ 69ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_BREAK 0x0B /* Set Break signal */ 70ee467a1fSAndrew Lunn 71ee467a1fSAndrew Lunn #define RQ_VENDOR_START_FW_DOWN 0x0C /* Start firmware download */ 72ee467a1fSAndrew Lunn #define RQ_VENDOR_STOP_FW_DOWN 0x0D /* Stop firmware download */ 73ee467a1fSAndrew Lunn #define RQ_VENDOR_QUERY_FW_READY 0x0E /* Query if new firmware ready */ 74ee467a1fSAndrew Lunn 75ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_FIFO_DISABLE 0x0F /* Set fifo disable */ 76ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_INTERFACE 0x10 /* Set interface */ 77ee467a1fSAndrew Lunn #define RQ_VENDOR_SET_HIGH_PERFOR 0x11 /* Set hi-performance */ 78ee467a1fSAndrew Lunn 79ee467a1fSAndrew Lunn #define RQ_VENDOR_ERASE_BLOCK 0x12 /* Erase flash block */ 80ee467a1fSAndrew Lunn #define RQ_VENDOR_WRITE_PAGE 0x13 /* Write flash page */ 81ee467a1fSAndrew Lunn #define RQ_VENDOR_PREPARE_WRITE 0x14 /* Prepare write flash */ 82ee467a1fSAndrew Lunn #define RQ_VENDOR_CONFIRM_WRITE 0x15 /* Confirm write flash */ 83ee467a1fSAndrew Lunn #define RQ_VENDOR_LOCATE 0x16 /* Locate the device */ 84ee467a1fSAndrew Lunn 85ee467a1fSAndrew Lunn #define RQ_VENDOR_START_ROM_DOWN 0x17 /* Start firmware download */ 86ee467a1fSAndrew Lunn #define RQ_VENDOR_ROM_DATA 0x18 /* Rom file data */ 87ee467a1fSAndrew Lunn #define RQ_VENDOR_STOP_ROM_DOWN 0x19 /* Stop firmware download */ 88ee467a1fSAndrew Lunn #define RQ_VENDOR_FW_DATA 0x20 /* Firmware data */ 89ee467a1fSAndrew Lunn 90ee467a1fSAndrew Lunn #define RQ_VENDOR_RESET_DEVICE 0x23 /* Try to reset the device */ 91ee467a1fSAndrew Lunn #define RQ_VENDOR_QUERY_FW_CONFIG 0x24 92ee467a1fSAndrew Lunn 93ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_VERSION 0x81 /* Get firmware version */ 94ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_PAGE 0x82 /* Read flash page */ 95ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_ROM_PROC 0x83 /* Get ROM process state */ 96ee467a1fSAndrew Lunn 97ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_INQUEUE 0x84 /* Data in input buffer */ 98ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_OUTQUEUE 0x85 /* Data in output buffer */ 99ee467a1fSAndrew Lunn 100ee467a1fSAndrew Lunn #define RQ_VENDOR_GET_MSR 0x86 /* Get modem status register */ 101ee467a1fSAndrew Lunn 102ee467a1fSAndrew Lunn /* Definitions for UPort event type */ 103ee467a1fSAndrew Lunn #define UPORT_EVENT_NONE 0 /* None */ 104ee467a1fSAndrew Lunn #define UPORT_EVENT_TXBUF_THRESHOLD 1 /* Tx buffer threshold */ 105ee467a1fSAndrew Lunn #define UPORT_EVENT_SEND_NEXT 2 /* Send next */ 106ee467a1fSAndrew Lunn #define UPORT_EVENT_MSR 3 /* Modem status */ 107ee467a1fSAndrew Lunn #define UPORT_EVENT_LSR 4 /* Line status */ 108ee467a1fSAndrew Lunn #define UPORT_EVENT_MCR 5 /* Modem control */ 109ee467a1fSAndrew Lunn 110ee467a1fSAndrew Lunn /* Definitions for serial event type */ 111ee467a1fSAndrew Lunn #define SERIAL_EV_CTS 0x0008 /* CTS changed state */ 112ee467a1fSAndrew Lunn #define SERIAL_EV_DSR 0x0010 /* DSR changed state */ 113ee467a1fSAndrew Lunn #define SERIAL_EV_RLSD 0x0020 /* RLSD changed state */ 114ee467a1fSAndrew Lunn 115ee467a1fSAndrew Lunn /* Definitions for modem control event type */ 116ee467a1fSAndrew Lunn #define SERIAL_EV_XOFF 0x40 /* XOFF received */ 117ee467a1fSAndrew Lunn 118ee467a1fSAndrew Lunn /* Definitions for line control of communication */ 119ee467a1fSAndrew Lunn #define MX_WORDLENGTH_5 5 120ee467a1fSAndrew Lunn #define MX_WORDLENGTH_6 6 121ee467a1fSAndrew Lunn #define MX_WORDLENGTH_7 7 122ee467a1fSAndrew Lunn #define MX_WORDLENGTH_8 8 123ee467a1fSAndrew Lunn 124ee467a1fSAndrew Lunn #define MX_PARITY_NONE 0 125ee467a1fSAndrew Lunn #define MX_PARITY_ODD 1 126ee467a1fSAndrew Lunn #define MX_PARITY_EVEN 2 127ee467a1fSAndrew Lunn #define MX_PARITY_MARK 3 128ee467a1fSAndrew Lunn #define MX_PARITY_SPACE 4 129ee467a1fSAndrew Lunn 130ee467a1fSAndrew Lunn #define MX_STOP_BITS_1 0 131ee467a1fSAndrew Lunn #define MX_STOP_BITS_1_5 1 132ee467a1fSAndrew Lunn #define MX_STOP_BITS_2 2 133ee467a1fSAndrew Lunn 134ee467a1fSAndrew Lunn #define MX_RTS_DISABLE 0x0 135ee467a1fSAndrew Lunn #define MX_RTS_ENABLE 0x1 136ee467a1fSAndrew Lunn #define MX_RTS_HW 0x2 137ee467a1fSAndrew Lunn #define MX_RTS_NO_CHANGE 0x3 /* Flag, not valid register value*/ 138ee467a1fSAndrew Lunn 139ee467a1fSAndrew Lunn #define MX_INT_RS232 0 140ee467a1fSAndrew Lunn #define MX_INT_2W_RS485 1 141ee467a1fSAndrew Lunn #define MX_INT_RS422 2 142ee467a1fSAndrew Lunn #define MX_INT_4W_RS485 3 143ee467a1fSAndrew Lunn 144ee467a1fSAndrew Lunn /* Definitions for holding reason */ 145ee467a1fSAndrew Lunn #define MX_WAIT_FOR_CTS 0x0001 146ee467a1fSAndrew Lunn #define MX_WAIT_FOR_DSR 0x0002 147ee467a1fSAndrew Lunn #define MX_WAIT_FOR_DCD 0x0004 148ee467a1fSAndrew Lunn #define MX_WAIT_FOR_XON 0x0008 149ee467a1fSAndrew Lunn #define MX_WAIT_FOR_START_TX 0x0010 150ee467a1fSAndrew Lunn #define MX_WAIT_FOR_UNTHROTTLE 0x0020 151ee467a1fSAndrew Lunn #define MX_WAIT_FOR_LOW_WATER 0x0040 152ee467a1fSAndrew Lunn #define MX_WAIT_FOR_SEND_NEXT 0x0080 153ee467a1fSAndrew Lunn 154ee467a1fSAndrew Lunn #define MX_UPORT_2_PORT BIT(0) 155ee467a1fSAndrew Lunn #define MX_UPORT_4_PORT BIT(1) 156ee467a1fSAndrew Lunn #define MX_UPORT_8_PORT BIT(2) 157ee467a1fSAndrew Lunn #define MX_UPORT_16_PORT BIT(3) 158ee467a1fSAndrew Lunn 159ee467a1fSAndrew Lunn /* This structure holds all of the local port information */ 160ee467a1fSAndrew Lunn struct mxuport_port { 161ee467a1fSAndrew Lunn u8 mcr_state; /* Last MCR state */ 162ee467a1fSAndrew Lunn u8 msr_state; /* Last MSR state */ 163ee467a1fSAndrew Lunn struct mutex mutex; /* Protects mcr_state */ 164ee467a1fSAndrew Lunn spinlock_t spinlock; /* Protects msr_state */ 165ee467a1fSAndrew Lunn }; 166ee467a1fSAndrew Lunn 167ee467a1fSAndrew Lunn /* Table of devices that work with this driver */ 168ee467a1fSAndrew Lunn static const struct usb_device_id mxuport_idtable[] = { 169ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1250_PID), 170ee467a1fSAndrew Lunn .driver_info = MX_UPORT_2_PORT }, 171ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1251_PID), 172ee467a1fSAndrew Lunn .driver_info = MX_UPORT_2_PORT }, 173ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1410_PID), 174ee467a1fSAndrew Lunn .driver_info = MX_UPORT_4_PORT }, 175ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1450_PID), 176ee467a1fSAndrew Lunn .driver_info = MX_UPORT_4_PORT }, 177ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1451_PID), 178ee467a1fSAndrew Lunn .driver_info = MX_UPORT_4_PORT }, 179ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1618_PID), 180ee467a1fSAndrew Lunn .driver_info = MX_UPORT_8_PORT }, 181ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1658_PID), 182ee467a1fSAndrew Lunn .driver_info = MX_UPORT_8_PORT }, 183ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1613_PID), 184ee467a1fSAndrew Lunn .driver_info = MX_UPORT_16_PORT }, 185ee467a1fSAndrew Lunn { USB_DEVICE(MX_USBSERIAL_VID, MX_UPORT1653_PID), 186ee467a1fSAndrew Lunn .driver_info = MX_UPORT_16_PORT }, 187ee467a1fSAndrew Lunn {} /* Terminating entry */ 188ee467a1fSAndrew Lunn }; 189ee467a1fSAndrew Lunn 190ee467a1fSAndrew Lunn MODULE_DEVICE_TABLE(usb, mxuport_idtable); 191ee467a1fSAndrew Lunn 192ee467a1fSAndrew Lunn /* 193ee467a1fSAndrew Lunn * Add a four byte header containing the port number and the number of 194ee467a1fSAndrew Lunn * bytes of data in the message. Return the number of bytes in the 195ee467a1fSAndrew Lunn * buffer. 196ee467a1fSAndrew Lunn */ 197ee467a1fSAndrew Lunn static int mxuport_prepare_write_buffer(struct usb_serial_port *port, 198ee467a1fSAndrew Lunn void *dest, size_t size) 199ee467a1fSAndrew Lunn { 200ee467a1fSAndrew Lunn u8 *buf = dest; 201ee467a1fSAndrew Lunn int count; 202ee467a1fSAndrew Lunn 203ee467a1fSAndrew Lunn count = kfifo_out_locked(&port->write_fifo, buf + HEADER_SIZE, 204ee467a1fSAndrew Lunn size - HEADER_SIZE, 205ee467a1fSAndrew Lunn &port->lock); 206ee467a1fSAndrew Lunn 207ee467a1fSAndrew Lunn put_unaligned_be16(port->port_number, buf); 208ee467a1fSAndrew Lunn put_unaligned_be16(count, buf + 2); 209ee467a1fSAndrew Lunn 210ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - size %zd count %d\n", __func__, 211ee467a1fSAndrew Lunn size, count); 212ee467a1fSAndrew Lunn 213ee467a1fSAndrew Lunn return count + HEADER_SIZE; 214ee467a1fSAndrew Lunn } 215ee467a1fSAndrew Lunn 216ee467a1fSAndrew Lunn /* Read the given buffer in from the control pipe. */ 217ee467a1fSAndrew Lunn static int mxuport_recv_ctrl_urb(struct usb_serial *serial, 218ee467a1fSAndrew Lunn u8 request, u16 value, u16 index, 219ee467a1fSAndrew Lunn u8 *data, size_t size) 220ee467a1fSAndrew Lunn { 221ee467a1fSAndrew Lunn int status; 222ee467a1fSAndrew Lunn 223ee467a1fSAndrew Lunn status = usb_control_msg(serial->dev, 224ee467a1fSAndrew Lunn usb_rcvctrlpipe(serial->dev, 0), 225ee467a1fSAndrew Lunn request, 226ee467a1fSAndrew Lunn (USB_DIR_IN | USB_TYPE_VENDOR | 227ee467a1fSAndrew Lunn USB_RECIP_DEVICE), value, index, 228ee467a1fSAndrew Lunn data, size, 229ee467a1fSAndrew Lunn USB_CTRL_GET_TIMEOUT); 230ee467a1fSAndrew Lunn if (status < 0) { 231ee467a1fSAndrew Lunn dev_err(&serial->interface->dev, 232ee467a1fSAndrew Lunn "%s - usb_control_msg failed (%d)\n", 233ee467a1fSAndrew Lunn __func__, status); 234ee467a1fSAndrew Lunn return status; 235ee467a1fSAndrew Lunn } 236ee467a1fSAndrew Lunn 237ee467a1fSAndrew Lunn if (status != size) { 238ee467a1fSAndrew Lunn dev_err(&serial->interface->dev, 239ee467a1fSAndrew Lunn "%s - short read (%d / %zd)\n", 240ee467a1fSAndrew Lunn __func__, status, size); 241ee467a1fSAndrew Lunn return -EIO; 242ee467a1fSAndrew Lunn } 243ee467a1fSAndrew Lunn 244ee467a1fSAndrew Lunn return status; 245ee467a1fSAndrew Lunn } 246ee467a1fSAndrew Lunn 247ee467a1fSAndrew Lunn /* Write the given buffer out to the control pipe. */ 248ee467a1fSAndrew Lunn static int mxuport_send_ctrl_data_urb(struct usb_serial *serial, 249ee467a1fSAndrew Lunn u8 request, 250ee467a1fSAndrew Lunn u16 value, u16 index, 251ee467a1fSAndrew Lunn u8 *data, size_t size) 252ee467a1fSAndrew Lunn { 253ee467a1fSAndrew Lunn int status; 254ee467a1fSAndrew Lunn 255ee467a1fSAndrew Lunn status = usb_control_msg(serial->dev, 256ee467a1fSAndrew Lunn usb_sndctrlpipe(serial->dev, 0), 257ee467a1fSAndrew Lunn request, 258ee467a1fSAndrew Lunn (USB_DIR_OUT | USB_TYPE_VENDOR | 259ee467a1fSAndrew Lunn USB_RECIP_DEVICE), value, index, 260ee467a1fSAndrew Lunn data, size, 261ee467a1fSAndrew Lunn USB_CTRL_SET_TIMEOUT); 262ee467a1fSAndrew Lunn if (status < 0) { 263ee467a1fSAndrew Lunn dev_err(&serial->interface->dev, 264ee467a1fSAndrew Lunn "%s - usb_control_msg failed (%d)\n", 265ee467a1fSAndrew Lunn __func__, status); 266ee467a1fSAndrew Lunn return status; 267ee467a1fSAndrew Lunn } 268ee467a1fSAndrew Lunn 269ee467a1fSAndrew Lunn if (status != size) { 270ee467a1fSAndrew Lunn dev_err(&serial->interface->dev, 271ee467a1fSAndrew Lunn "%s - short write (%d / %zd)\n", 272ee467a1fSAndrew Lunn __func__, status, size); 273ee467a1fSAndrew Lunn return -EIO; 274ee467a1fSAndrew Lunn } 275ee467a1fSAndrew Lunn 276ee467a1fSAndrew Lunn return 0; 277ee467a1fSAndrew Lunn } 278ee467a1fSAndrew Lunn 279ee467a1fSAndrew Lunn /* Send a vendor request without any data */ 280ee467a1fSAndrew Lunn static int mxuport_send_ctrl_urb(struct usb_serial *serial, 281ee467a1fSAndrew Lunn u8 request, u16 value, u16 index) 282ee467a1fSAndrew Lunn { 283ee467a1fSAndrew Lunn return mxuport_send_ctrl_data_urb(serial, request, value, index, 284ee467a1fSAndrew Lunn NULL, 0); 285ee467a1fSAndrew Lunn } 286ee467a1fSAndrew Lunn 287ee467a1fSAndrew Lunn /* 288ee467a1fSAndrew Lunn * mxuport_throttle - throttle function of driver 289ee467a1fSAndrew Lunn * 290ee467a1fSAndrew Lunn * This function is called by the tty driver when it wants to stop the 291ee467a1fSAndrew Lunn * data being read from the port. Since all the data comes over one 292ee467a1fSAndrew Lunn * bulk in endpoint, we cannot stop submitting urbs by setting 293ee467a1fSAndrew Lunn * port->throttle. Instead tell the device to stop sending us data for 294ee467a1fSAndrew Lunn * the port. 295ee467a1fSAndrew Lunn */ 296ee467a1fSAndrew Lunn static void mxuport_throttle(struct tty_struct *tty) 297ee467a1fSAndrew Lunn { 298ee467a1fSAndrew Lunn struct usb_serial_port *port = tty->driver_data; 299ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 300ee467a1fSAndrew Lunn 301ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s\n", __func__); 302ee467a1fSAndrew Lunn 303ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RX_HOST_EN, 304ee467a1fSAndrew Lunn 0, port->port_number); 305ee467a1fSAndrew Lunn } 306ee467a1fSAndrew Lunn 307ee467a1fSAndrew Lunn /* 308ee467a1fSAndrew Lunn * mxuport_unthrottle - unthrottle function of driver 309ee467a1fSAndrew Lunn * 310ee467a1fSAndrew Lunn * This function is called by the tty driver when it wants to resume 311ee467a1fSAndrew Lunn * the data being read from the port. Tell the device it can resume 312ee467a1fSAndrew Lunn * sending us received data from the port. 313ee467a1fSAndrew Lunn */ 314ee467a1fSAndrew Lunn static void mxuport_unthrottle(struct tty_struct *tty) 315ee467a1fSAndrew Lunn { 316ee467a1fSAndrew Lunn 317ee467a1fSAndrew Lunn struct usb_serial_port *port = tty->driver_data; 318ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 319ee467a1fSAndrew Lunn 320ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s\n", __func__); 321ee467a1fSAndrew Lunn 322ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RX_HOST_EN, 323ee467a1fSAndrew Lunn 1, port->port_number); 324ee467a1fSAndrew Lunn } 325ee467a1fSAndrew Lunn 326ee467a1fSAndrew Lunn /* 327ee467a1fSAndrew Lunn * Processes one chunk of data received for a port. Mostly a copy of 328ee467a1fSAndrew Lunn * usb_serial_generic_process_read_urb(). 329ee467a1fSAndrew Lunn */ 330ee467a1fSAndrew Lunn static void mxuport_process_read_urb_data(struct usb_serial_port *port, 331ee467a1fSAndrew Lunn char *data, int size) 332ee467a1fSAndrew Lunn { 333ee467a1fSAndrew Lunn int i; 334ee467a1fSAndrew Lunn 335ee467a1fSAndrew Lunn if (!port->port.console || !port->sysrq) { 336ee467a1fSAndrew Lunn tty_insert_flip_string(&port->port, data, size); 337ee467a1fSAndrew Lunn } else { 338ee467a1fSAndrew Lunn for (i = 0; i < size; i++, data++) { 339ee467a1fSAndrew Lunn if (!usb_serial_handle_sysrq_char(port, *data)) 340ee467a1fSAndrew Lunn tty_insert_flip_char(&port->port, *data, 341ee467a1fSAndrew Lunn TTY_NORMAL); 342ee467a1fSAndrew Lunn } 343ee467a1fSAndrew Lunn } 344ee467a1fSAndrew Lunn tty_flip_buffer_push(&port->port); 345ee467a1fSAndrew Lunn } 346ee467a1fSAndrew Lunn 347ee467a1fSAndrew Lunn static void mxuport_msr_event(struct usb_serial_port *port, u8 buf[4]) 348ee467a1fSAndrew Lunn { 349ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 350ee467a1fSAndrew Lunn u8 rcv_msr_hold = buf[2] & 0xF0; 351ee467a1fSAndrew Lunn u16 rcv_msr_event = get_unaligned_be16(buf); 352ee467a1fSAndrew Lunn unsigned long flags; 353ee467a1fSAndrew Lunn 354ee467a1fSAndrew Lunn if (rcv_msr_event == 0) 355ee467a1fSAndrew Lunn return; 356ee467a1fSAndrew Lunn 357ee467a1fSAndrew Lunn /* Update MSR status */ 358ee467a1fSAndrew Lunn spin_lock_irqsave(&mxport->spinlock, flags); 359ee467a1fSAndrew Lunn 360ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - current MSR status = 0x%x\n", 361ee467a1fSAndrew Lunn __func__, mxport->msr_state); 362ee467a1fSAndrew Lunn 363ee467a1fSAndrew Lunn if (rcv_msr_hold & UART_MSR_CTS) { 364ee467a1fSAndrew Lunn mxport->msr_state |= UART_MSR_CTS; 365ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - CTS high\n", __func__); 366ee467a1fSAndrew Lunn } else { 367ee467a1fSAndrew Lunn mxport->msr_state &= ~UART_MSR_CTS; 368ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - CTS low\n", __func__); 369ee467a1fSAndrew Lunn } 370ee467a1fSAndrew Lunn 371ee467a1fSAndrew Lunn if (rcv_msr_hold & UART_MSR_DSR) { 372ee467a1fSAndrew Lunn mxport->msr_state |= UART_MSR_DSR; 373ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DSR high\n", __func__); 374ee467a1fSAndrew Lunn } else { 375ee467a1fSAndrew Lunn mxport->msr_state &= ~UART_MSR_DSR; 376ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DSR low\n", __func__); 377ee467a1fSAndrew Lunn } 378ee467a1fSAndrew Lunn 379ee467a1fSAndrew Lunn if (rcv_msr_hold & UART_MSR_DCD) { 380ee467a1fSAndrew Lunn mxport->msr_state |= UART_MSR_DCD; 381ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DCD high\n", __func__); 382ee467a1fSAndrew Lunn } else { 383ee467a1fSAndrew Lunn mxport->msr_state &= ~UART_MSR_DCD; 384ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DCD low\n", __func__); 385ee467a1fSAndrew Lunn } 386ee467a1fSAndrew Lunn spin_unlock_irqrestore(&mxport->spinlock, flags); 387ee467a1fSAndrew Lunn 388ee467a1fSAndrew Lunn if (rcv_msr_event & 389ee467a1fSAndrew Lunn (SERIAL_EV_CTS | SERIAL_EV_DSR | SERIAL_EV_RLSD)) { 390ee467a1fSAndrew Lunn 391ee467a1fSAndrew Lunn if (rcv_msr_event & SERIAL_EV_CTS) { 392ee467a1fSAndrew Lunn port->icount.cts++; 393ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - CTS change\n", __func__); 394ee467a1fSAndrew Lunn } 395ee467a1fSAndrew Lunn 396ee467a1fSAndrew Lunn if (rcv_msr_event & SERIAL_EV_DSR) { 397ee467a1fSAndrew Lunn port->icount.dsr++; 398ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DSR change\n", __func__); 399ee467a1fSAndrew Lunn } 400ee467a1fSAndrew Lunn 401ee467a1fSAndrew Lunn if (rcv_msr_event & SERIAL_EV_RLSD) { 402ee467a1fSAndrew Lunn port->icount.dcd++; 403ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - DCD change\n", __func__); 404ee467a1fSAndrew Lunn } 405ee467a1fSAndrew Lunn wake_up_interruptible(&port->port.delta_msr_wait); 406ee467a1fSAndrew Lunn } 407ee467a1fSAndrew Lunn } 408ee467a1fSAndrew Lunn 409ee467a1fSAndrew Lunn static void mxuport_lsr_event(struct usb_serial_port *port, u8 buf[4]) 410ee467a1fSAndrew Lunn { 411ee467a1fSAndrew Lunn u8 lsr_event = buf[2]; 412ee467a1fSAndrew Lunn 413ee467a1fSAndrew Lunn if (lsr_event & UART_LSR_BI) { 414ee467a1fSAndrew Lunn port->icount.brk++; 415ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - break error\n", __func__); 416ee467a1fSAndrew Lunn } 417ee467a1fSAndrew Lunn 418ee467a1fSAndrew Lunn if (lsr_event & UART_LSR_FE) { 419ee467a1fSAndrew Lunn port->icount.frame++; 420ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - frame error\n", __func__); 421ee467a1fSAndrew Lunn } 422ee467a1fSAndrew Lunn 423ee467a1fSAndrew Lunn if (lsr_event & UART_LSR_PE) { 424ee467a1fSAndrew Lunn port->icount.parity++; 425ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - parity error\n", __func__); 426ee467a1fSAndrew Lunn } 427ee467a1fSAndrew Lunn 428ee467a1fSAndrew Lunn if (lsr_event & UART_LSR_OE) { 429ee467a1fSAndrew Lunn port->icount.overrun++; 430ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - overrun error\n", __func__); 431ee467a1fSAndrew Lunn } 432ee467a1fSAndrew Lunn } 433ee467a1fSAndrew Lunn 434ee467a1fSAndrew Lunn /* 435ee467a1fSAndrew Lunn * When something interesting happens, modem control lines XON/XOFF 436ee467a1fSAndrew Lunn * etc, the device sends an event. Process these events. 437ee467a1fSAndrew Lunn */ 438ee467a1fSAndrew Lunn static void mxuport_process_read_urb_event(struct usb_serial_port *port, 439ee467a1fSAndrew Lunn u8 buf[4], u32 event) 440ee467a1fSAndrew Lunn { 441ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - receive event : %04x\n", __func__, event); 442ee467a1fSAndrew Lunn 443ee467a1fSAndrew Lunn switch (event) { 444ee467a1fSAndrew Lunn case UPORT_EVENT_SEND_NEXT: 445ee467a1fSAndrew Lunn /* 446ee467a1fSAndrew Lunn * Sent as part of the flow control on device buffers. 447ee467a1fSAndrew Lunn * Not currently used. 448ee467a1fSAndrew Lunn */ 449ee467a1fSAndrew Lunn break; 450ee467a1fSAndrew Lunn case UPORT_EVENT_MSR: 451ee467a1fSAndrew Lunn mxuport_msr_event(port, buf); 452ee467a1fSAndrew Lunn break; 453ee467a1fSAndrew Lunn case UPORT_EVENT_LSR: 454ee467a1fSAndrew Lunn mxuport_lsr_event(port, buf); 455ee467a1fSAndrew Lunn break; 456ee467a1fSAndrew Lunn case UPORT_EVENT_MCR: 457ee467a1fSAndrew Lunn /* 458ee467a1fSAndrew Lunn * Event to indicate a change in XON/XOFF from the 459ee467a1fSAndrew Lunn * peer. Currently not used. We just continue 460ee467a1fSAndrew Lunn * sending the device data and it will buffer it if 461ee467a1fSAndrew Lunn * needed. This event could be used for flow control 462ee467a1fSAndrew Lunn * between the host and the device. 463ee467a1fSAndrew Lunn */ 464ee467a1fSAndrew Lunn break; 465ee467a1fSAndrew Lunn default: 466ee467a1fSAndrew Lunn dev_dbg(&port->dev, "Unexpected event\n"); 467ee467a1fSAndrew Lunn break; 468ee467a1fSAndrew Lunn } 469ee467a1fSAndrew Lunn } 470ee467a1fSAndrew Lunn 471ee467a1fSAndrew Lunn /* 472ee467a1fSAndrew Lunn * One URB can contain data for multiple ports. Demultiplex the data, 473ee467a1fSAndrew Lunn * checking the port exists, is opened and the message is valid. 474ee467a1fSAndrew Lunn */ 475ee467a1fSAndrew Lunn static void mxuport_process_read_urb_demux_data(struct urb *urb) 476ee467a1fSAndrew Lunn { 477ee467a1fSAndrew Lunn struct usb_serial_port *port = urb->context; 478ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 479ee467a1fSAndrew Lunn u8 *data = urb->transfer_buffer; 480ee467a1fSAndrew Lunn u8 *end = data + urb->actual_length; 481ee467a1fSAndrew Lunn struct usb_serial_port *demux_port; 482ee467a1fSAndrew Lunn u8 *ch; 483ee467a1fSAndrew Lunn u16 rcv_port; 484ee467a1fSAndrew Lunn u16 rcv_len; 485ee467a1fSAndrew Lunn 486ee467a1fSAndrew Lunn while (data < end) { 487ee467a1fSAndrew Lunn if (data + HEADER_SIZE > end) { 488ee467a1fSAndrew Lunn dev_warn(&port->dev, "%s - message with short header\n", 489ee467a1fSAndrew Lunn __func__); 490ee467a1fSAndrew Lunn return; 491ee467a1fSAndrew Lunn } 492ee467a1fSAndrew Lunn 493ee467a1fSAndrew Lunn rcv_port = get_unaligned_be16(data); 494ee467a1fSAndrew Lunn if (rcv_port >= serial->num_ports) { 495ee467a1fSAndrew Lunn dev_warn(&port->dev, "%s - message for invalid port\n", 496ee467a1fSAndrew Lunn __func__); 497ee467a1fSAndrew Lunn return; 498ee467a1fSAndrew Lunn } 499ee467a1fSAndrew Lunn 500ee467a1fSAndrew Lunn demux_port = serial->port[rcv_port]; 501ee467a1fSAndrew Lunn rcv_len = get_unaligned_be16(data + 2); 502ee467a1fSAndrew Lunn if (!rcv_len || data + HEADER_SIZE + rcv_len > end) { 503ee467a1fSAndrew Lunn dev_warn(&port->dev, "%s - short data\n", __func__); 504ee467a1fSAndrew Lunn return; 505ee467a1fSAndrew Lunn } 506ee467a1fSAndrew Lunn 507ee467a1fSAndrew Lunn if (test_bit(ASYNCB_INITIALIZED, &demux_port->port.flags)) { 508ee467a1fSAndrew Lunn ch = data + HEADER_SIZE; 509ee467a1fSAndrew Lunn mxuport_process_read_urb_data(demux_port, ch, rcv_len); 510ee467a1fSAndrew Lunn } else { 511ee467a1fSAndrew Lunn dev_dbg(&demux_port->dev, "%s - data for closed port\n", 512ee467a1fSAndrew Lunn __func__); 513ee467a1fSAndrew Lunn } 514ee467a1fSAndrew Lunn data += HEADER_SIZE + rcv_len; 515ee467a1fSAndrew Lunn } 516ee467a1fSAndrew Lunn } 517ee467a1fSAndrew Lunn 518ee467a1fSAndrew Lunn /* 519ee467a1fSAndrew Lunn * One URB can contain events for multiple ports. Demultiplex the event, 520ee467a1fSAndrew Lunn * checking the port exists, and is opened. 521ee467a1fSAndrew Lunn */ 522ee467a1fSAndrew Lunn static void mxuport_process_read_urb_demux_event(struct urb *urb) 523ee467a1fSAndrew Lunn { 524ee467a1fSAndrew Lunn struct usb_serial_port *port = urb->context; 525ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 526ee467a1fSAndrew Lunn u8 *data = urb->transfer_buffer; 527ee467a1fSAndrew Lunn u8 *end = data + urb->actual_length; 528ee467a1fSAndrew Lunn struct usb_serial_port *demux_port; 529ee467a1fSAndrew Lunn u8 *ch; 530ee467a1fSAndrew Lunn u16 rcv_port; 531ee467a1fSAndrew Lunn u16 rcv_event; 532ee467a1fSAndrew Lunn 533ee467a1fSAndrew Lunn while (data < end) { 534ee467a1fSAndrew Lunn if (data + EVENT_LENGTH > end) { 535ee467a1fSAndrew Lunn dev_warn(&port->dev, "%s - message with short event\n", 536ee467a1fSAndrew Lunn __func__); 537ee467a1fSAndrew Lunn return; 538ee467a1fSAndrew Lunn } 539ee467a1fSAndrew Lunn 540ee467a1fSAndrew Lunn rcv_port = get_unaligned_be16(data); 541ee467a1fSAndrew Lunn if (rcv_port >= serial->num_ports) { 542ee467a1fSAndrew Lunn dev_warn(&port->dev, "%s - message for invalid port\n", 543ee467a1fSAndrew Lunn __func__); 544ee467a1fSAndrew Lunn return; 545ee467a1fSAndrew Lunn } 546ee467a1fSAndrew Lunn 547ee467a1fSAndrew Lunn demux_port = serial->port[rcv_port]; 548ee467a1fSAndrew Lunn if (test_bit(ASYNCB_INITIALIZED, &demux_port->port.flags)) { 549ee467a1fSAndrew Lunn ch = data + HEADER_SIZE; 550ee467a1fSAndrew Lunn rcv_event = get_unaligned_be16(data + 2); 551ee467a1fSAndrew Lunn mxuport_process_read_urb_event(demux_port, ch, 552ee467a1fSAndrew Lunn rcv_event); 553ee467a1fSAndrew Lunn } else { 554ee467a1fSAndrew Lunn dev_dbg(&demux_port->dev, 555ee467a1fSAndrew Lunn "%s - event for closed port\n", __func__); 556ee467a1fSAndrew Lunn } 557ee467a1fSAndrew Lunn data += EVENT_LENGTH; 558ee467a1fSAndrew Lunn } 559ee467a1fSAndrew Lunn } 560ee467a1fSAndrew Lunn 561ee467a1fSAndrew Lunn /* 562ee467a1fSAndrew Lunn * This is called when we have received data on the bulk in 563ee467a1fSAndrew Lunn * endpoint. Depending on which port it was received on, it can 564ee467a1fSAndrew Lunn * contain serial data or events. 565ee467a1fSAndrew Lunn */ 566ee467a1fSAndrew Lunn static void mxuport_process_read_urb(struct urb *urb) 567ee467a1fSAndrew Lunn { 568ee467a1fSAndrew Lunn struct usb_serial_port *port = urb->context; 569ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 570ee467a1fSAndrew Lunn 571ee467a1fSAndrew Lunn if (port == serial->port[0]) 572ee467a1fSAndrew Lunn mxuport_process_read_urb_demux_data(urb); 573ee467a1fSAndrew Lunn 574ee467a1fSAndrew Lunn if (port == serial->port[1]) 575ee467a1fSAndrew Lunn mxuport_process_read_urb_demux_event(urb); 576ee467a1fSAndrew Lunn } 577ee467a1fSAndrew Lunn 578ee467a1fSAndrew Lunn /* 579ee467a1fSAndrew Lunn * Ask the device how many bytes it has queued to be sent out. If 580ee467a1fSAndrew Lunn * there are none, return true. 581ee467a1fSAndrew Lunn */ 582ee467a1fSAndrew Lunn static bool mxuport_tx_empty(struct usb_serial_port *port) 583ee467a1fSAndrew Lunn { 584ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 585ee467a1fSAndrew Lunn bool is_empty = true; 586ee467a1fSAndrew Lunn u32 txlen; 587ee467a1fSAndrew Lunn u8 *len_buf; 588ee467a1fSAndrew Lunn int err; 589ee467a1fSAndrew Lunn 590ee467a1fSAndrew Lunn len_buf = kzalloc(4, GFP_KERNEL); 591ee467a1fSAndrew Lunn if (!len_buf) 592ee467a1fSAndrew Lunn goto out; 593ee467a1fSAndrew Lunn 594ee467a1fSAndrew Lunn err = mxuport_recv_ctrl_urb(serial, RQ_VENDOR_GET_OUTQUEUE, 0, 595ee467a1fSAndrew Lunn port->port_number, len_buf, 4); 596ee467a1fSAndrew Lunn if (err < 0) 597ee467a1fSAndrew Lunn goto out; 598ee467a1fSAndrew Lunn 599ee467a1fSAndrew Lunn txlen = get_unaligned_be32(len_buf); 600ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - tx len = %u\n", __func__, txlen); 601ee467a1fSAndrew Lunn 602ee467a1fSAndrew Lunn if (txlen != 0) 603ee467a1fSAndrew Lunn is_empty = false; 604ee467a1fSAndrew Lunn 605ee467a1fSAndrew Lunn out: 606ee467a1fSAndrew Lunn kfree(len_buf); 607ee467a1fSAndrew Lunn return is_empty; 608ee467a1fSAndrew Lunn } 609ee467a1fSAndrew Lunn 610ee467a1fSAndrew Lunn static int mxuport_set_mcr(struct usb_serial_port *port, u8 mcr_state) 611ee467a1fSAndrew Lunn { 612ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 613ee467a1fSAndrew Lunn int err; 614ee467a1fSAndrew Lunn 615ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - %02x\n", __func__, mcr_state); 616ee467a1fSAndrew Lunn 617ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_MCR, 618ee467a1fSAndrew Lunn mcr_state, port->port_number); 619ee467a1fSAndrew Lunn if (err) 620ee467a1fSAndrew Lunn dev_err(&port->dev, "%s - failed to change MCR\n", __func__); 621ee467a1fSAndrew Lunn 622ee467a1fSAndrew Lunn return err; 623ee467a1fSAndrew Lunn } 624ee467a1fSAndrew Lunn 625ee467a1fSAndrew Lunn static int mxuport_set_dtr(struct usb_serial_port *port, int on) 626ee467a1fSAndrew Lunn { 627ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 628ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 629ee467a1fSAndrew Lunn int err; 630ee467a1fSAndrew Lunn 631ee467a1fSAndrew Lunn mutex_lock(&mxport->mutex); 632ee467a1fSAndrew Lunn 633ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_DTR, 634ee467a1fSAndrew Lunn !!on, port->port_number); 635ee467a1fSAndrew Lunn if (!err) { 636ee467a1fSAndrew Lunn if (on) 637ee467a1fSAndrew Lunn mxport->mcr_state |= UART_MCR_DTR; 638ee467a1fSAndrew Lunn else 639ee467a1fSAndrew Lunn mxport->mcr_state &= ~UART_MCR_DTR; 640ee467a1fSAndrew Lunn } 641ee467a1fSAndrew Lunn 642ee467a1fSAndrew Lunn mutex_unlock(&mxport->mutex); 643ee467a1fSAndrew Lunn 644ee467a1fSAndrew Lunn return err; 645ee467a1fSAndrew Lunn } 646ee467a1fSAndrew Lunn 647ee467a1fSAndrew Lunn static int mxuport_set_rts(struct usb_serial_port *port, u8 state) 648ee467a1fSAndrew Lunn { 649ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 650ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 651ee467a1fSAndrew Lunn int err; 652ee467a1fSAndrew Lunn u8 mcr_state; 653ee467a1fSAndrew Lunn 654ee467a1fSAndrew Lunn mutex_lock(&mxport->mutex); 655ee467a1fSAndrew Lunn mcr_state = mxport->mcr_state; 656ee467a1fSAndrew Lunn 657ee467a1fSAndrew Lunn switch (state) { 658ee467a1fSAndrew Lunn case MX_RTS_DISABLE: 659ee467a1fSAndrew Lunn mcr_state &= ~UART_MCR_RTS; 660ee467a1fSAndrew Lunn break; 661ee467a1fSAndrew Lunn case MX_RTS_ENABLE: 662ee467a1fSAndrew Lunn mcr_state |= UART_MCR_RTS; 663ee467a1fSAndrew Lunn break; 664ee467a1fSAndrew Lunn case MX_RTS_HW: 665ee467a1fSAndrew Lunn /* 666ee467a1fSAndrew Lunn * Do not update mxport->mcr_state when doing hardware 667ee467a1fSAndrew Lunn * flow control. 668ee467a1fSAndrew Lunn */ 669ee467a1fSAndrew Lunn break; 670ee467a1fSAndrew Lunn default: 671ee467a1fSAndrew Lunn /* 672ee467a1fSAndrew Lunn * Should not happen, but somebody might try passing 673ee467a1fSAndrew Lunn * MX_RTS_NO_CHANGE, which is not valid. 674ee467a1fSAndrew Lunn */ 675ee467a1fSAndrew Lunn err = -EINVAL; 676ee467a1fSAndrew Lunn goto out; 677ee467a1fSAndrew Lunn } 678ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RTS, 679ee467a1fSAndrew Lunn state, port->port_number); 680ee467a1fSAndrew Lunn if (!err) 681ee467a1fSAndrew Lunn mxport->mcr_state = mcr_state; 682ee467a1fSAndrew Lunn 683ee467a1fSAndrew Lunn out: 684ee467a1fSAndrew Lunn mutex_unlock(&mxport->mutex); 685ee467a1fSAndrew Lunn 686ee467a1fSAndrew Lunn return err; 687ee467a1fSAndrew Lunn } 688ee467a1fSAndrew Lunn 689ee467a1fSAndrew Lunn static void mxuport_dtr_rts(struct usb_serial_port *port, int on) 690ee467a1fSAndrew Lunn { 691ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 692ee467a1fSAndrew Lunn u8 mcr_state; 693ee467a1fSAndrew Lunn int err; 694ee467a1fSAndrew Lunn 695ee467a1fSAndrew Lunn mutex_lock(&mxport->mutex); 696ee467a1fSAndrew Lunn mcr_state = mxport->mcr_state; 697ee467a1fSAndrew Lunn 698ee467a1fSAndrew Lunn if (on) 699ee467a1fSAndrew Lunn mcr_state |= (UART_MCR_RTS | UART_MCR_DTR); 700ee467a1fSAndrew Lunn else 701ee467a1fSAndrew Lunn mcr_state &= ~(UART_MCR_RTS | UART_MCR_DTR); 702ee467a1fSAndrew Lunn 703ee467a1fSAndrew Lunn err = mxuport_set_mcr(port, mcr_state); 704ee467a1fSAndrew Lunn if (!err) 705ee467a1fSAndrew Lunn mxport->mcr_state = mcr_state; 706ee467a1fSAndrew Lunn 707ee467a1fSAndrew Lunn mutex_unlock(&mxport->mutex); 708ee467a1fSAndrew Lunn } 709ee467a1fSAndrew Lunn 710ee467a1fSAndrew Lunn static int mxuport_tiocmset(struct tty_struct *tty, unsigned int set, 711ee467a1fSAndrew Lunn unsigned int clear) 712ee467a1fSAndrew Lunn { 713ee467a1fSAndrew Lunn struct usb_serial_port *port = tty->driver_data; 714ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 715ee467a1fSAndrew Lunn int err; 716ee467a1fSAndrew Lunn u8 mcr_state; 717ee467a1fSAndrew Lunn 718ee467a1fSAndrew Lunn mutex_lock(&mxport->mutex); 719ee467a1fSAndrew Lunn mcr_state = mxport->mcr_state; 720ee467a1fSAndrew Lunn 721ee467a1fSAndrew Lunn if (set & TIOCM_RTS) 722ee467a1fSAndrew Lunn mcr_state |= UART_MCR_RTS; 723ee467a1fSAndrew Lunn 724ee467a1fSAndrew Lunn if (set & TIOCM_DTR) 725ee467a1fSAndrew Lunn mcr_state |= UART_MCR_DTR; 726ee467a1fSAndrew Lunn 727ee467a1fSAndrew Lunn if (clear & TIOCM_RTS) 728ee467a1fSAndrew Lunn mcr_state &= ~UART_MCR_RTS; 729ee467a1fSAndrew Lunn 730ee467a1fSAndrew Lunn if (clear & TIOCM_DTR) 731ee467a1fSAndrew Lunn mcr_state &= ~UART_MCR_DTR; 732ee467a1fSAndrew Lunn 733ee467a1fSAndrew Lunn err = mxuport_set_mcr(port, mcr_state); 734ee467a1fSAndrew Lunn if (!err) 735ee467a1fSAndrew Lunn mxport->mcr_state = mcr_state; 736ee467a1fSAndrew Lunn 737ee467a1fSAndrew Lunn mutex_unlock(&mxport->mutex); 738ee467a1fSAndrew Lunn 739ee467a1fSAndrew Lunn return err; 740ee467a1fSAndrew Lunn } 741ee467a1fSAndrew Lunn 742ee467a1fSAndrew Lunn static int mxuport_tiocmget(struct tty_struct *tty) 743ee467a1fSAndrew Lunn { 744ee467a1fSAndrew Lunn struct mxuport_port *mxport; 745ee467a1fSAndrew Lunn struct usb_serial_port *port = tty->driver_data; 746ee467a1fSAndrew Lunn unsigned int result; 747ee467a1fSAndrew Lunn unsigned long flags; 748ee467a1fSAndrew Lunn unsigned int msr; 749ee467a1fSAndrew Lunn unsigned int mcr; 750ee467a1fSAndrew Lunn 751ee467a1fSAndrew Lunn mxport = usb_get_serial_port_data(port); 752ee467a1fSAndrew Lunn 753ee467a1fSAndrew Lunn mutex_lock(&mxport->mutex); 754ee467a1fSAndrew Lunn spin_lock_irqsave(&mxport->spinlock, flags); 755ee467a1fSAndrew Lunn 756ee467a1fSAndrew Lunn msr = mxport->msr_state; 757ee467a1fSAndrew Lunn mcr = mxport->mcr_state; 758ee467a1fSAndrew Lunn 759ee467a1fSAndrew Lunn spin_unlock_irqrestore(&mxport->spinlock, flags); 760ee467a1fSAndrew Lunn mutex_unlock(&mxport->mutex); 761ee467a1fSAndrew Lunn 762ee467a1fSAndrew Lunn result = (((mcr & UART_MCR_DTR) ? TIOCM_DTR : 0) | /* 0x002 */ 763ee467a1fSAndrew Lunn ((mcr & UART_MCR_RTS) ? TIOCM_RTS : 0) | /* 0x004 */ 764ee467a1fSAndrew Lunn ((msr & UART_MSR_CTS) ? TIOCM_CTS : 0) | /* 0x020 */ 765ee467a1fSAndrew Lunn ((msr & UART_MSR_DCD) ? TIOCM_CAR : 0) | /* 0x040 */ 766ee467a1fSAndrew Lunn ((msr & UART_MSR_RI) ? TIOCM_RI : 0) | /* 0x080 */ 767ee467a1fSAndrew Lunn ((msr & UART_MSR_DSR) ? TIOCM_DSR : 0)); /* 0x100 */ 768ee467a1fSAndrew Lunn 769ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - 0x%04x\n", __func__, result); 770ee467a1fSAndrew Lunn 771ee467a1fSAndrew Lunn return result; 772ee467a1fSAndrew Lunn } 773ee467a1fSAndrew Lunn 774ee467a1fSAndrew Lunn static int mxuport_set_termios_flow(struct tty_struct *tty, 775ee467a1fSAndrew Lunn struct ktermios *old_termios, 776ee467a1fSAndrew Lunn struct usb_serial_port *port, 777ee467a1fSAndrew Lunn struct usb_serial *serial) 778ee467a1fSAndrew Lunn { 779ee467a1fSAndrew Lunn u8 xon = START_CHAR(tty); 780ee467a1fSAndrew Lunn u8 xoff = STOP_CHAR(tty); 781ee467a1fSAndrew Lunn int enable; 782ee467a1fSAndrew Lunn int err; 783ee467a1fSAndrew Lunn u8 *buf; 784ee467a1fSAndrew Lunn u8 rts; 785ee467a1fSAndrew Lunn 786ee467a1fSAndrew Lunn buf = kmalloc(2, GFP_KERNEL); 787ee467a1fSAndrew Lunn if (!buf) 788ee467a1fSAndrew Lunn return -ENOMEM; 789ee467a1fSAndrew Lunn 790ee467a1fSAndrew Lunn /* S/W flow control settings */ 791ee467a1fSAndrew Lunn if (I_IXOFF(tty) || I_IXON(tty)) { 792ee467a1fSAndrew Lunn enable = 1; 793ee467a1fSAndrew Lunn buf[0] = xon; 794ee467a1fSAndrew Lunn buf[1] = xoff; 795ee467a1fSAndrew Lunn 796ee467a1fSAndrew Lunn err = mxuport_send_ctrl_data_urb(serial, RQ_VENDOR_SET_CHARS, 797ee467a1fSAndrew Lunn 0, port->port_number, 798ee467a1fSAndrew Lunn buf, 2); 799ee467a1fSAndrew Lunn if (err) 800ee467a1fSAndrew Lunn goto out; 801ee467a1fSAndrew Lunn 802ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - XON = 0x%02x, XOFF = 0x%02x\n", 803ee467a1fSAndrew Lunn __func__, xon, xoff); 804ee467a1fSAndrew Lunn } else { 805ee467a1fSAndrew Lunn enable = 0; 806ee467a1fSAndrew Lunn } 807ee467a1fSAndrew Lunn 808ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_XONXOFF, 809ee467a1fSAndrew Lunn enable, port->port_number); 810ee467a1fSAndrew Lunn if (err) 811ee467a1fSAndrew Lunn goto out; 812ee467a1fSAndrew Lunn 813ee467a1fSAndrew Lunn rts = MX_RTS_NO_CHANGE; 814ee467a1fSAndrew Lunn 815ee467a1fSAndrew Lunn /* H/W flow control settings */ 816ee467a1fSAndrew Lunn if (!old_termios || 817ee467a1fSAndrew Lunn C_CRTSCTS(tty) != (old_termios->c_cflag & CRTSCTS)) { 818ee467a1fSAndrew Lunn if (C_CRTSCTS(tty)) 819ee467a1fSAndrew Lunn rts = MX_RTS_HW; 820ee467a1fSAndrew Lunn else 821ee467a1fSAndrew Lunn rts = MX_RTS_ENABLE; 822ee467a1fSAndrew Lunn } 823ee467a1fSAndrew Lunn 824ee467a1fSAndrew Lunn if (C_BAUD(tty)) { 825ee467a1fSAndrew Lunn if (old_termios && (old_termios->c_cflag & CBAUD) == B0) { 826ee467a1fSAndrew Lunn /* Raise DTR and RTS */ 827ee467a1fSAndrew Lunn if (C_CRTSCTS(tty)) 828ee467a1fSAndrew Lunn rts = MX_RTS_HW; 829ee467a1fSAndrew Lunn else 830ee467a1fSAndrew Lunn rts = MX_RTS_ENABLE; 831ee467a1fSAndrew Lunn mxuport_set_dtr(port, 1); 832ee467a1fSAndrew Lunn } 833ee467a1fSAndrew Lunn } else { 834ee467a1fSAndrew Lunn /* Drop DTR and RTS */ 835ee467a1fSAndrew Lunn rts = MX_RTS_DISABLE; 836ee467a1fSAndrew Lunn mxuport_set_dtr(port, 0); 837ee467a1fSAndrew Lunn } 838ee467a1fSAndrew Lunn 839ee467a1fSAndrew Lunn if (rts != MX_RTS_NO_CHANGE) 840ee467a1fSAndrew Lunn err = mxuport_set_rts(port, rts); 841ee467a1fSAndrew Lunn 842ee467a1fSAndrew Lunn out: 843ee467a1fSAndrew Lunn kfree(buf); 844ee467a1fSAndrew Lunn return err; 845ee467a1fSAndrew Lunn } 846ee467a1fSAndrew Lunn 847ee467a1fSAndrew Lunn static void mxuport_set_termios(struct tty_struct *tty, 848ee467a1fSAndrew Lunn struct usb_serial_port *port, 849ee467a1fSAndrew Lunn struct ktermios *old_termios) 850ee467a1fSAndrew Lunn { 851ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 852ee467a1fSAndrew Lunn u8 *buf; 853ee467a1fSAndrew Lunn u8 data_bits; 854ee467a1fSAndrew Lunn u8 stop_bits; 855ee467a1fSAndrew Lunn u8 parity; 856ee467a1fSAndrew Lunn int baud; 857ee467a1fSAndrew Lunn int err; 858ee467a1fSAndrew Lunn 859ee467a1fSAndrew Lunn if (old_termios && 860ee467a1fSAndrew Lunn !tty_termios_hw_change(&tty->termios, old_termios) && 861ee467a1fSAndrew Lunn tty->termios.c_iflag == old_termios->c_iflag) { 862ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - nothing to change\n", __func__); 863ee467a1fSAndrew Lunn return; 864ee467a1fSAndrew Lunn } 865ee467a1fSAndrew Lunn 866ee467a1fSAndrew Lunn buf = kmalloc(4, GFP_KERNEL); 867ee467a1fSAndrew Lunn if (!buf) 868ee467a1fSAndrew Lunn return; 869ee467a1fSAndrew Lunn 870ee467a1fSAndrew Lunn /* Set data bit of termios */ 871ee467a1fSAndrew Lunn switch (C_CSIZE(tty)) { 872ee467a1fSAndrew Lunn case CS5: 873ee467a1fSAndrew Lunn data_bits = MX_WORDLENGTH_5; 874ee467a1fSAndrew Lunn break; 875ee467a1fSAndrew Lunn case CS6: 876ee467a1fSAndrew Lunn data_bits = MX_WORDLENGTH_6; 877ee467a1fSAndrew Lunn break; 878ee467a1fSAndrew Lunn case CS7: 879ee467a1fSAndrew Lunn data_bits = MX_WORDLENGTH_7; 880ee467a1fSAndrew Lunn break; 881ee467a1fSAndrew Lunn case CS8: 882ee467a1fSAndrew Lunn default: 883ee467a1fSAndrew Lunn data_bits = MX_WORDLENGTH_8; 884ee467a1fSAndrew Lunn break; 885ee467a1fSAndrew Lunn } 886ee467a1fSAndrew Lunn 887ee467a1fSAndrew Lunn /* Set parity of termios */ 888ee467a1fSAndrew Lunn if (C_PARENB(tty)) { 889ee467a1fSAndrew Lunn if (C_CMSPAR(tty)) { 890ee467a1fSAndrew Lunn if (C_PARODD(tty)) 891ee467a1fSAndrew Lunn parity = MX_PARITY_MARK; 892ee467a1fSAndrew Lunn else 893ee467a1fSAndrew Lunn parity = MX_PARITY_SPACE; 894ee467a1fSAndrew Lunn } else { 895ee467a1fSAndrew Lunn if (C_PARODD(tty)) 896ee467a1fSAndrew Lunn parity = MX_PARITY_ODD; 897ee467a1fSAndrew Lunn else 898ee467a1fSAndrew Lunn parity = MX_PARITY_EVEN; 899ee467a1fSAndrew Lunn } 900ee467a1fSAndrew Lunn } else { 901ee467a1fSAndrew Lunn parity = MX_PARITY_NONE; 902ee467a1fSAndrew Lunn } 903ee467a1fSAndrew Lunn 904ee467a1fSAndrew Lunn /* Set stop bit of termios */ 905ee467a1fSAndrew Lunn if (C_CSTOPB(tty)) 906ee467a1fSAndrew Lunn stop_bits = MX_STOP_BITS_2; 907ee467a1fSAndrew Lunn else 908ee467a1fSAndrew Lunn stop_bits = MX_STOP_BITS_1; 909ee467a1fSAndrew Lunn 910ee467a1fSAndrew Lunn buf[0] = data_bits; 911ee467a1fSAndrew Lunn buf[1] = parity; 912ee467a1fSAndrew Lunn buf[2] = stop_bits; 913ee467a1fSAndrew Lunn buf[3] = 0; 914ee467a1fSAndrew Lunn 915ee467a1fSAndrew Lunn err = mxuport_send_ctrl_data_urb(serial, RQ_VENDOR_SET_LINE, 916ee467a1fSAndrew Lunn 0, port->port_number, buf, 4); 917ee467a1fSAndrew Lunn if (err) 918ee467a1fSAndrew Lunn goto out; 919ee467a1fSAndrew Lunn 920ee467a1fSAndrew Lunn err = mxuport_set_termios_flow(tty, old_termios, port, serial); 921ee467a1fSAndrew Lunn if (err) 922ee467a1fSAndrew Lunn goto out; 923ee467a1fSAndrew Lunn 924ee467a1fSAndrew Lunn baud = tty_get_baud_rate(tty); 925ee467a1fSAndrew Lunn if (!baud) 926ee467a1fSAndrew Lunn baud = 9600; 927ee467a1fSAndrew Lunn 928ee467a1fSAndrew Lunn /* Note: Little Endian */ 929ee467a1fSAndrew Lunn put_unaligned_le32(baud, buf); 930ee467a1fSAndrew Lunn 931ee467a1fSAndrew Lunn err = mxuport_send_ctrl_data_urb(serial, RQ_VENDOR_SET_BAUD, 932ee467a1fSAndrew Lunn 0, port->port_number, 933ee467a1fSAndrew Lunn buf, 4); 934ee467a1fSAndrew Lunn if (err) 935ee467a1fSAndrew Lunn goto out; 936ee467a1fSAndrew Lunn 937ee467a1fSAndrew Lunn dev_dbg(&port->dev, "baud_rate : %d\n", baud); 938ee467a1fSAndrew Lunn dev_dbg(&port->dev, "data_bits : %d\n", data_bits); 939ee467a1fSAndrew Lunn dev_dbg(&port->dev, "parity : %d\n", parity); 940ee467a1fSAndrew Lunn dev_dbg(&port->dev, "stop_bits : %d\n", stop_bits); 941ee467a1fSAndrew Lunn 942ee467a1fSAndrew Lunn out: 943ee467a1fSAndrew Lunn kfree(buf); 944ee467a1fSAndrew Lunn } 945ee467a1fSAndrew Lunn 946ee467a1fSAndrew Lunn /* 947ee467a1fSAndrew Lunn * Determine how many ports this device has dynamically. It will be 948ee467a1fSAndrew Lunn * called after the probe() callback is called, but before attach(). 949ee467a1fSAndrew Lunn */ 950ee467a1fSAndrew Lunn static int mxuport_calc_num_ports(struct usb_serial *serial) 951ee467a1fSAndrew Lunn { 952ee467a1fSAndrew Lunn unsigned long features = (unsigned long)usb_get_serial_data(serial); 953ee467a1fSAndrew Lunn 954ee467a1fSAndrew Lunn if (features & MX_UPORT_2_PORT) 955ee467a1fSAndrew Lunn return 2; 956ee467a1fSAndrew Lunn if (features & MX_UPORT_4_PORT) 957ee467a1fSAndrew Lunn return 4; 958ee467a1fSAndrew Lunn if (features & MX_UPORT_8_PORT) 959ee467a1fSAndrew Lunn return 8; 960ee467a1fSAndrew Lunn if (features & MX_UPORT_16_PORT) 961ee467a1fSAndrew Lunn return 16; 962ee467a1fSAndrew Lunn 963ee467a1fSAndrew Lunn return 0; 964ee467a1fSAndrew Lunn } 965ee467a1fSAndrew Lunn 966ee467a1fSAndrew Lunn /* Get the version of the firmware currently running. */ 967ee467a1fSAndrew Lunn static int mxuport_get_fw_version(struct usb_serial *serial, u32 *version) 968ee467a1fSAndrew Lunn { 969ee467a1fSAndrew Lunn u8 *ver_buf; 970ee467a1fSAndrew Lunn int err; 971ee467a1fSAndrew Lunn 972ee467a1fSAndrew Lunn ver_buf = kzalloc(4, GFP_KERNEL); 973ee467a1fSAndrew Lunn if (!ver_buf) 974ee467a1fSAndrew Lunn return -ENOMEM; 975ee467a1fSAndrew Lunn 976ee467a1fSAndrew Lunn /* Get firmware version from SDRAM */ 977ee467a1fSAndrew Lunn err = mxuport_recv_ctrl_urb(serial, RQ_VENDOR_GET_VERSION, 0, 0, 978ee467a1fSAndrew Lunn ver_buf, 4); 979ee467a1fSAndrew Lunn if (err != 4) { 980ee467a1fSAndrew Lunn err = -EIO; 981ee467a1fSAndrew Lunn goto out; 982ee467a1fSAndrew Lunn } 983ee467a1fSAndrew Lunn 984ee467a1fSAndrew Lunn *version = (ver_buf[0] << 16) | (ver_buf[1] << 8) | ver_buf[2]; 985ee467a1fSAndrew Lunn err = 0; 986ee467a1fSAndrew Lunn out: 987ee467a1fSAndrew Lunn kfree(ver_buf); 988ee467a1fSAndrew Lunn return err; 989ee467a1fSAndrew Lunn } 990ee467a1fSAndrew Lunn 991ee467a1fSAndrew Lunn /* Given a firmware blob, download it to the device. */ 992ee467a1fSAndrew Lunn static int mxuport_download_fw(struct usb_serial *serial, 993ee467a1fSAndrew Lunn const struct firmware *fw_p) 994ee467a1fSAndrew Lunn { 995ee467a1fSAndrew Lunn u8 *fw_buf; 996ee467a1fSAndrew Lunn size_t txlen; 997ee467a1fSAndrew Lunn size_t fwidx; 998ee467a1fSAndrew Lunn int err; 999ee467a1fSAndrew Lunn 1000ee467a1fSAndrew Lunn fw_buf = kmalloc(DOWN_BLOCK_SIZE, GFP_KERNEL); 1001ee467a1fSAndrew Lunn if (!fw_buf) 1002ee467a1fSAndrew Lunn return -ENOMEM; 1003ee467a1fSAndrew Lunn 1004ee467a1fSAndrew Lunn dev_dbg(&serial->interface->dev, "Starting firmware download...\n"); 1005ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_START_FW_DOWN, 0, 0); 1006ee467a1fSAndrew Lunn if (err) 1007ee467a1fSAndrew Lunn goto out; 1008ee467a1fSAndrew Lunn 1009ee467a1fSAndrew Lunn fwidx = 0; 1010ee467a1fSAndrew Lunn do { 1011ee467a1fSAndrew Lunn txlen = min_t(size_t, (fw_p->size - fwidx), DOWN_BLOCK_SIZE); 1012ee467a1fSAndrew Lunn 1013ee467a1fSAndrew Lunn memcpy(fw_buf, &fw_p->data[fwidx], txlen); 1014ee467a1fSAndrew Lunn err = mxuport_send_ctrl_data_urb(serial, RQ_VENDOR_FW_DATA, 1015ee467a1fSAndrew Lunn 0, 0, fw_buf, txlen); 1016ee467a1fSAndrew Lunn if (err) { 1017ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_STOP_FW_DOWN, 1018ee467a1fSAndrew Lunn 0, 0); 1019ee467a1fSAndrew Lunn goto out; 1020ee467a1fSAndrew Lunn } 1021ee467a1fSAndrew Lunn 1022ee467a1fSAndrew Lunn fwidx += txlen; 1023ee467a1fSAndrew Lunn usleep_range(1000, 2000); 1024ee467a1fSAndrew Lunn 1025ee467a1fSAndrew Lunn } while (fwidx < fw_p->size); 1026ee467a1fSAndrew Lunn 1027ee467a1fSAndrew Lunn msleep(1000); 1028ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_STOP_FW_DOWN, 0, 0); 1029ee467a1fSAndrew Lunn if (err) 1030ee467a1fSAndrew Lunn goto out; 1031ee467a1fSAndrew Lunn 1032ee467a1fSAndrew Lunn msleep(1000); 1033ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_QUERY_FW_READY, 0, 0); 1034ee467a1fSAndrew Lunn 1035ee467a1fSAndrew Lunn out: 1036ee467a1fSAndrew Lunn kfree(fw_buf); 1037ee467a1fSAndrew Lunn return err; 1038ee467a1fSAndrew Lunn } 1039ee467a1fSAndrew Lunn 1040ee467a1fSAndrew Lunn static int mxuport_probe(struct usb_serial *serial, 1041ee467a1fSAndrew Lunn const struct usb_device_id *id) 1042ee467a1fSAndrew Lunn { 1043ee467a1fSAndrew Lunn u16 productid = le16_to_cpu(serial->dev->descriptor.idProduct); 1044ee467a1fSAndrew Lunn const struct firmware *fw_p = NULL; 1045ee467a1fSAndrew Lunn u32 version; 1046ee467a1fSAndrew Lunn int local_ver; 1047ee467a1fSAndrew Lunn char buf[32]; 1048ee467a1fSAndrew Lunn int err; 1049ee467a1fSAndrew Lunn 1050ee467a1fSAndrew Lunn /* Load our firmware */ 1051ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_QUERY_FW_CONFIG, 0, 0); 1052ee467a1fSAndrew Lunn if (err) { 1053ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_RESET_DEVICE, 0, 0); 1054ee467a1fSAndrew Lunn return err; 1055ee467a1fSAndrew Lunn } 1056ee467a1fSAndrew Lunn 1057ee467a1fSAndrew Lunn err = mxuport_get_fw_version(serial, &version); 1058ee467a1fSAndrew Lunn if (err < 0) 1059ee467a1fSAndrew Lunn return err; 1060ee467a1fSAndrew Lunn 1061ee467a1fSAndrew Lunn dev_dbg(&serial->interface->dev, "Device firmware version v%x.%x.%x\n", 1062ee467a1fSAndrew Lunn (version & 0xff0000) >> 16, 1063ee467a1fSAndrew Lunn (version & 0xff00) >> 8, 1064ee467a1fSAndrew Lunn (version & 0xff)); 1065ee467a1fSAndrew Lunn 1066ee467a1fSAndrew Lunn snprintf(buf, sizeof(buf) - 1, "moxa/moxa-%04x.fw", productid); 1067ee467a1fSAndrew Lunn 1068ee467a1fSAndrew Lunn err = request_firmware(&fw_p, buf, &serial->interface->dev); 1069ee467a1fSAndrew Lunn if (err) { 1070ee467a1fSAndrew Lunn dev_warn(&serial->interface->dev, "Firmware %s not found\n", 1071ee467a1fSAndrew Lunn buf); 1072ee467a1fSAndrew Lunn 1073ee467a1fSAndrew Lunn /* Use the firmware already in the device */ 1074ee467a1fSAndrew Lunn err = 0; 1075ee467a1fSAndrew Lunn } else { 1076ee467a1fSAndrew Lunn local_ver = ((fw_p->data[VER_ADDR_1] << 16) | 1077ee467a1fSAndrew Lunn (fw_p->data[VER_ADDR_2] << 8) | 1078ee467a1fSAndrew Lunn fw_p->data[VER_ADDR_3]); 1079ee467a1fSAndrew Lunn dev_dbg(&serial->interface->dev, 1080ee467a1fSAndrew Lunn "Available firmware version v%x.%x.%x\n", 1081ee467a1fSAndrew Lunn fw_p->data[VER_ADDR_1], fw_p->data[VER_ADDR_2], 1082ee467a1fSAndrew Lunn fw_p->data[VER_ADDR_3]); 1083ee467a1fSAndrew Lunn if (local_ver > version) { 1084ee467a1fSAndrew Lunn err = mxuport_download_fw(serial, fw_p); 1085ee467a1fSAndrew Lunn if (err) 1086ee467a1fSAndrew Lunn goto out; 1087ee467a1fSAndrew Lunn err = mxuport_get_fw_version(serial, &version); 1088ee467a1fSAndrew Lunn if (err < 0) 1089ee467a1fSAndrew Lunn goto out; 1090ee467a1fSAndrew Lunn } 1091ee467a1fSAndrew Lunn } 1092ee467a1fSAndrew Lunn 1093ee467a1fSAndrew Lunn dev_info(&serial->interface->dev, 1094ee467a1fSAndrew Lunn "Using device firmware version v%x.%x.%x\n", 1095ee467a1fSAndrew Lunn (version & 0xff0000) >> 16, 1096ee467a1fSAndrew Lunn (version & 0xff00) >> 8, 1097ee467a1fSAndrew Lunn (version & 0xff)); 1098ee467a1fSAndrew Lunn 1099ee467a1fSAndrew Lunn /* 1100ee467a1fSAndrew Lunn * Contains the features of this hardware. Store away for 1101ee467a1fSAndrew Lunn * later use, eg, number of ports. 1102ee467a1fSAndrew Lunn */ 1103ee467a1fSAndrew Lunn usb_set_serial_data(serial, (void *)id->driver_info); 1104ee467a1fSAndrew Lunn out: 1105ee467a1fSAndrew Lunn if (fw_p) 1106ee467a1fSAndrew Lunn release_firmware(fw_p); 1107ee467a1fSAndrew Lunn return err; 1108ee467a1fSAndrew Lunn } 1109ee467a1fSAndrew Lunn 1110ee467a1fSAndrew Lunn 1111ee467a1fSAndrew Lunn static int mxuport_port_probe(struct usb_serial_port *port) 1112ee467a1fSAndrew Lunn { 1113ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 1114ee467a1fSAndrew Lunn struct mxuport_port *mxport; 1115ee467a1fSAndrew Lunn int err; 1116ee467a1fSAndrew Lunn 1117ee467a1fSAndrew Lunn mxport = devm_kzalloc(&port->dev, sizeof(struct mxuport_port), 1118ee467a1fSAndrew Lunn GFP_KERNEL); 1119ee467a1fSAndrew Lunn if (!mxport) 1120ee467a1fSAndrew Lunn return -ENOMEM; 1121ee467a1fSAndrew Lunn 1122ee467a1fSAndrew Lunn mutex_init(&mxport->mutex); 1123ee467a1fSAndrew Lunn spin_lock_init(&mxport->spinlock); 1124ee467a1fSAndrew Lunn 1125ee467a1fSAndrew Lunn /* Set the port private data */ 1126ee467a1fSAndrew Lunn usb_set_serial_port_data(port, mxport); 1127ee467a1fSAndrew Lunn 1128ee467a1fSAndrew Lunn /* Set FIFO (Enable) */ 1129ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_FIFO_DISABLE, 1130ee467a1fSAndrew Lunn 0, port->port_number); 1131ee467a1fSAndrew Lunn if (err) 1132ee467a1fSAndrew Lunn return err; 1133ee467a1fSAndrew Lunn 1134ee467a1fSAndrew Lunn /* Set transmission mode (Hi-Performance) */ 1135ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_HIGH_PERFOR, 1136ee467a1fSAndrew Lunn 0, port->port_number); 1137ee467a1fSAndrew Lunn if (err) 1138ee467a1fSAndrew Lunn return err; 1139ee467a1fSAndrew Lunn 1140ee467a1fSAndrew Lunn /* Set interface (RS-232) */ 1141ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_INTERFACE, 1142ee467a1fSAndrew Lunn MX_INT_RS232, 1143ee467a1fSAndrew Lunn port->port_number); 1144ee467a1fSAndrew Lunn if (err) 1145ee467a1fSAndrew Lunn return err; 1146ee467a1fSAndrew Lunn 1147ee467a1fSAndrew Lunn return 0; 1148ee467a1fSAndrew Lunn } 1149ee467a1fSAndrew Lunn 1150ee467a1fSAndrew Lunn static int mxuport_alloc_write_urb(struct usb_serial *serial, 1151ee467a1fSAndrew Lunn struct usb_serial_port *port, 1152ee467a1fSAndrew Lunn struct usb_serial_port *port0, 1153ee467a1fSAndrew Lunn int j) 1154ee467a1fSAndrew Lunn { 1155ee467a1fSAndrew Lunn struct usb_device *dev = interface_to_usbdev(serial->interface); 1156ee467a1fSAndrew Lunn 1157ee467a1fSAndrew Lunn set_bit(j, &port->write_urbs_free); 1158ee467a1fSAndrew Lunn port->write_urbs[j] = usb_alloc_urb(0, GFP_KERNEL); 1159ee467a1fSAndrew Lunn if (!port->write_urbs[j]) 1160ee467a1fSAndrew Lunn return -ENOMEM; 1161ee467a1fSAndrew Lunn 1162ee467a1fSAndrew Lunn port->bulk_out_buffers[j] = kmalloc(port0->bulk_out_size, GFP_KERNEL); 1163ee467a1fSAndrew Lunn if (!port->bulk_out_buffers[j]) 1164ee467a1fSAndrew Lunn return -ENOMEM; 1165ee467a1fSAndrew Lunn 1166ee467a1fSAndrew Lunn usb_fill_bulk_urb(port->write_urbs[j], dev, 1167ee467a1fSAndrew Lunn usb_sndbulkpipe(dev, port->bulk_out_endpointAddress), 1168ee467a1fSAndrew Lunn port->bulk_out_buffers[j], 1169ee467a1fSAndrew Lunn port->bulk_out_size, 1170ee467a1fSAndrew Lunn serial->type->write_bulk_callback, 1171ee467a1fSAndrew Lunn port); 1172ee467a1fSAndrew Lunn return 0; 1173ee467a1fSAndrew Lunn } 1174ee467a1fSAndrew Lunn 1175ee467a1fSAndrew Lunn 1176ee467a1fSAndrew Lunn static int mxuport_alloc_write_urbs(struct usb_serial *serial, 1177ee467a1fSAndrew Lunn struct usb_serial_port *port, 1178ee467a1fSAndrew Lunn struct usb_serial_port *port0) 1179ee467a1fSAndrew Lunn { 1180ee467a1fSAndrew Lunn int j; 1181ee467a1fSAndrew Lunn int ret; 1182ee467a1fSAndrew Lunn 1183ee467a1fSAndrew Lunn for (j = 0; j < ARRAY_SIZE(port->write_urbs); ++j) { 1184ee467a1fSAndrew Lunn ret = mxuport_alloc_write_urb(serial, port, port0, j); 1185ee467a1fSAndrew Lunn if (ret) 1186ee467a1fSAndrew Lunn return ret; 1187ee467a1fSAndrew Lunn } 1188ee467a1fSAndrew Lunn return 0; 1189ee467a1fSAndrew Lunn } 1190ee467a1fSAndrew Lunn 1191ee467a1fSAndrew Lunn 1192ee467a1fSAndrew Lunn static int mxuport_attach(struct usb_serial *serial) 1193ee467a1fSAndrew Lunn { 1194ee467a1fSAndrew Lunn struct usb_serial_port *port0 = serial->port[0]; 1195ee467a1fSAndrew Lunn struct usb_serial_port *port1 = serial->port[1]; 1196ee467a1fSAndrew Lunn struct usb_serial_port *port; 1197ee467a1fSAndrew Lunn int err; 1198ee467a1fSAndrew Lunn int i; 1199ee467a1fSAndrew Lunn int j; 1200ee467a1fSAndrew Lunn 1201ee467a1fSAndrew Lunn /* 1202ee467a1fSAndrew Lunn * Throw away all but the first allocated write URBs so we can 1203ee467a1fSAndrew Lunn * set them up again to fit the multiplexing scheme. 1204ee467a1fSAndrew Lunn */ 1205ee467a1fSAndrew Lunn for (i = 1; i < serial->num_bulk_out; ++i) { 1206ee467a1fSAndrew Lunn port = serial->port[i]; 1207ee467a1fSAndrew Lunn for (j = 0; j < ARRAY_SIZE(port->write_urbs); ++j) { 1208ee467a1fSAndrew Lunn usb_free_urb(port->write_urbs[j]); 1209ee467a1fSAndrew Lunn kfree(port->bulk_out_buffers[j]); 1210ee467a1fSAndrew Lunn port->write_urbs[j] = NULL; 1211ee467a1fSAndrew Lunn port->bulk_out_buffers[j] = NULL; 1212ee467a1fSAndrew Lunn } 1213ee467a1fSAndrew Lunn port->write_urbs_free = 0; 1214ee467a1fSAndrew Lunn } 1215ee467a1fSAndrew Lunn 1216ee467a1fSAndrew Lunn /* 1217ee467a1fSAndrew Lunn * All write data is sent over the first bulk out endpoint, 1218ee467a1fSAndrew Lunn * with an added header to indicate the port. Allocate URBs 1219ee467a1fSAndrew Lunn * for each port to the first bulk out endpoint. 1220ee467a1fSAndrew Lunn */ 1221ee467a1fSAndrew Lunn for (i = 1; i < serial->num_ports; ++i) { 1222ee467a1fSAndrew Lunn port = serial->port[i]; 1223ee467a1fSAndrew Lunn port->bulk_out_size = port0->bulk_out_size; 1224ee467a1fSAndrew Lunn port->bulk_out_endpointAddress = 1225ee467a1fSAndrew Lunn port0->bulk_out_endpointAddress; 1226ee467a1fSAndrew Lunn 1227ee467a1fSAndrew Lunn err = mxuport_alloc_write_urbs(serial, port, port0); 1228ee467a1fSAndrew Lunn if (err) 1229ee467a1fSAndrew Lunn return err; 1230ee467a1fSAndrew Lunn 1231ee467a1fSAndrew Lunn port->write_urb = port->write_urbs[0]; 1232ee467a1fSAndrew Lunn port->bulk_out_buffer = port->bulk_out_buffers[0]; 1233ee467a1fSAndrew Lunn 1234ee467a1fSAndrew Lunn /* 1235ee467a1fSAndrew Lunn * Ensure each port has a fifo. The framework only 1236ee467a1fSAndrew Lunn * allocates a fifo to ports with a bulk out endpoint, 1237ee467a1fSAndrew Lunn * where as we need one for every port. 1238ee467a1fSAndrew Lunn */ 1239ee467a1fSAndrew Lunn if (!kfifo_initialized(&port->write_fifo)) { 1240ee467a1fSAndrew Lunn err = kfifo_alloc(&port->write_fifo, PAGE_SIZE, 1241ee467a1fSAndrew Lunn GFP_KERNEL); 1242ee467a1fSAndrew Lunn if (err) 1243ee467a1fSAndrew Lunn return err; 1244ee467a1fSAndrew Lunn } 1245ee467a1fSAndrew Lunn } 1246ee467a1fSAndrew Lunn 1247ee467a1fSAndrew Lunn /* 1248ee467a1fSAndrew Lunn * All data from the ports is received on the first bulk in 1249ee467a1fSAndrew Lunn * endpoint, with a multiplex header. The second bulk in is 1250ee467a1fSAndrew Lunn * used for events. 1251ee467a1fSAndrew Lunn * 1252ee467a1fSAndrew Lunn * Start to read from the device. 1253ee467a1fSAndrew Lunn */ 1254ee467a1fSAndrew Lunn err = usb_serial_generic_submit_read_urbs(port0, GFP_KERNEL); 1255ee467a1fSAndrew Lunn if (err) 1256ee467a1fSAndrew Lunn return err; 1257ee467a1fSAndrew Lunn 1258ee467a1fSAndrew Lunn err = usb_serial_generic_submit_read_urbs(port1, GFP_KERNEL); 1259ee467a1fSAndrew Lunn if (err) { 1260ee467a1fSAndrew Lunn usb_serial_generic_close(port0); 1261ee467a1fSAndrew Lunn return err; 1262ee467a1fSAndrew Lunn } 1263ee467a1fSAndrew Lunn 1264ee467a1fSAndrew Lunn return 0; 1265ee467a1fSAndrew Lunn } 1266ee467a1fSAndrew Lunn 1267ee467a1fSAndrew Lunn static int mxuport_open(struct tty_struct *tty, struct usb_serial_port *port) 1268ee467a1fSAndrew Lunn { 1269ee467a1fSAndrew Lunn struct mxuport_port *mxport = usb_get_serial_port_data(port); 1270ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 1271ee467a1fSAndrew Lunn int err; 1272ee467a1fSAndrew Lunn 1273ee467a1fSAndrew Lunn /* Set receive host (enable) */ 1274ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RX_HOST_EN, 1275ee467a1fSAndrew Lunn 1, port->port_number); 1276ee467a1fSAndrew Lunn if (err) 1277ee467a1fSAndrew Lunn return err; 1278ee467a1fSAndrew Lunn 1279ee467a1fSAndrew Lunn err = mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_OPEN, 1280ee467a1fSAndrew Lunn 1, port->port_number); 1281ee467a1fSAndrew Lunn if (err) { 1282ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RX_HOST_EN, 1283ee467a1fSAndrew Lunn 0, port->port_number); 1284ee467a1fSAndrew Lunn return err; 1285ee467a1fSAndrew Lunn } 1286ee467a1fSAndrew Lunn 1287ee467a1fSAndrew Lunn /* Initial port termios */ 1288ee467a1fSAndrew Lunn mxuport_set_termios(tty, port, NULL); 1289ee467a1fSAndrew Lunn 1290ee467a1fSAndrew Lunn /* 1291ee467a1fSAndrew Lunn * TODO: use RQ_VENDOR_GET_MSR, once we know what it 1292ee467a1fSAndrew Lunn * returns. 1293ee467a1fSAndrew Lunn */ 1294ee467a1fSAndrew Lunn mxport->msr_state = 0; 1295ee467a1fSAndrew Lunn 1296ee467a1fSAndrew Lunn return err; 1297ee467a1fSAndrew Lunn } 1298ee467a1fSAndrew Lunn 1299ee467a1fSAndrew Lunn static void mxuport_close(struct usb_serial_port *port) 1300ee467a1fSAndrew Lunn { 1301ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 1302ee467a1fSAndrew Lunn 1303ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_OPEN, 0, 1304ee467a1fSAndrew Lunn port->port_number); 1305ee467a1fSAndrew Lunn 1306ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_RX_HOST_EN, 0, 1307ee467a1fSAndrew Lunn port->port_number); 1308ee467a1fSAndrew Lunn } 1309ee467a1fSAndrew Lunn 1310ee467a1fSAndrew Lunn /* Send a break to the port. */ 1311ee467a1fSAndrew Lunn static void mxuport_break_ctl(struct tty_struct *tty, int break_state) 1312ee467a1fSAndrew Lunn { 1313ee467a1fSAndrew Lunn struct usb_serial_port *port = tty->driver_data; 1314ee467a1fSAndrew Lunn struct usb_serial *serial = port->serial; 1315ee467a1fSAndrew Lunn int enable; 1316ee467a1fSAndrew Lunn 1317ee467a1fSAndrew Lunn if (break_state == -1) { 1318ee467a1fSAndrew Lunn enable = 1; 1319ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - sending break\n", __func__); 1320ee467a1fSAndrew Lunn } else { 1321ee467a1fSAndrew Lunn enable = 0; 1322ee467a1fSAndrew Lunn dev_dbg(&port->dev, "%s - clearing break\n", __func__); 1323ee467a1fSAndrew Lunn } 1324ee467a1fSAndrew Lunn 1325ee467a1fSAndrew Lunn mxuport_send_ctrl_urb(serial, RQ_VENDOR_SET_BREAK, 1326ee467a1fSAndrew Lunn enable, port->port_number); 1327ee467a1fSAndrew Lunn } 1328ee467a1fSAndrew Lunn 1329ee467a1fSAndrew Lunn static int mxuport_resume(struct usb_serial *serial) 1330ee467a1fSAndrew Lunn { 1331ee467a1fSAndrew Lunn struct usb_serial_port *port; 1332ee467a1fSAndrew Lunn int c = 0; 1333ee467a1fSAndrew Lunn int i; 1334ee467a1fSAndrew Lunn int r; 1335ee467a1fSAndrew Lunn 1336ee467a1fSAndrew Lunn for (i = 0; i < 2; i++) { 1337ee467a1fSAndrew Lunn port = serial->port[i]; 1338ee467a1fSAndrew Lunn 1339ee467a1fSAndrew Lunn r = usb_serial_generic_submit_read_urbs(port, GFP_NOIO); 1340ee467a1fSAndrew Lunn if (r < 0) 1341ee467a1fSAndrew Lunn c++; 1342ee467a1fSAndrew Lunn } 1343ee467a1fSAndrew Lunn 1344ee467a1fSAndrew Lunn for (i = 0; i < serial->num_ports; i++) { 1345ee467a1fSAndrew Lunn port = serial->port[i]; 1346ee467a1fSAndrew Lunn if (!test_bit(ASYNCB_INITIALIZED, &port->port.flags)) 1347ee467a1fSAndrew Lunn continue; 1348ee467a1fSAndrew Lunn 1349ee467a1fSAndrew Lunn r = usb_serial_generic_write_start(port, GFP_NOIO); 1350ee467a1fSAndrew Lunn if (r < 0) 1351ee467a1fSAndrew Lunn c++; 1352ee467a1fSAndrew Lunn } 1353ee467a1fSAndrew Lunn 1354ee467a1fSAndrew Lunn return c ? -EIO : 0; 1355ee467a1fSAndrew Lunn } 1356ee467a1fSAndrew Lunn 1357ee467a1fSAndrew Lunn static struct usb_serial_driver mxuport_device = { 1358ee467a1fSAndrew Lunn .driver = { 1359ee467a1fSAndrew Lunn .owner = THIS_MODULE, 1360ee467a1fSAndrew Lunn .name = "mxuport", 1361ee467a1fSAndrew Lunn }, 1362ee467a1fSAndrew Lunn .description = "MOXA UPort", 1363ee467a1fSAndrew Lunn .id_table = mxuport_idtable, 1364ee467a1fSAndrew Lunn .num_ports = 0, 1365ee467a1fSAndrew Lunn .probe = mxuport_probe, 1366ee467a1fSAndrew Lunn .port_probe = mxuport_port_probe, 1367ee467a1fSAndrew Lunn .attach = mxuport_attach, 1368ee467a1fSAndrew Lunn .calc_num_ports = mxuport_calc_num_ports, 1369ee467a1fSAndrew Lunn .open = mxuport_open, 1370ee467a1fSAndrew Lunn .close = mxuport_close, 1371ee467a1fSAndrew Lunn .set_termios = mxuport_set_termios, 1372ee467a1fSAndrew Lunn .break_ctl = mxuport_break_ctl, 1373ee467a1fSAndrew Lunn .tx_empty = mxuport_tx_empty, 1374ee467a1fSAndrew Lunn .tiocmiwait = usb_serial_generic_tiocmiwait, 1375ee467a1fSAndrew Lunn .get_icount = usb_serial_generic_get_icount, 1376ee467a1fSAndrew Lunn .throttle = mxuport_throttle, 1377ee467a1fSAndrew Lunn .unthrottle = mxuport_unthrottle, 1378ee467a1fSAndrew Lunn .tiocmget = mxuport_tiocmget, 1379ee467a1fSAndrew Lunn .tiocmset = mxuport_tiocmset, 1380ee467a1fSAndrew Lunn .dtr_rts = mxuport_dtr_rts, 1381ee467a1fSAndrew Lunn .process_read_urb = mxuport_process_read_urb, 1382ee467a1fSAndrew Lunn .prepare_write_buffer = mxuport_prepare_write_buffer, 1383ee467a1fSAndrew Lunn .resume = mxuport_resume, 1384ee467a1fSAndrew Lunn }; 1385ee467a1fSAndrew Lunn 1386ee467a1fSAndrew Lunn static struct usb_serial_driver *const serial_drivers[] = { 1387ee467a1fSAndrew Lunn &mxuport_device, NULL 1388ee467a1fSAndrew Lunn }; 1389ee467a1fSAndrew Lunn 1390ee467a1fSAndrew Lunn module_usb_serial_driver(serial_drivers, mxuport_idtable); 1391ee467a1fSAndrew Lunn 1392ee467a1fSAndrew Lunn MODULE_AUTHOR("Andrew Lunn <andrew@lunn.ch>"); 1393ee467a1fSAndrew Lunn MODULE_AUTHOR("<support@moxa.com>"); 1394ee467a1fSAndrew Lunn MODULE_LICENSE("GPL"); 1395