^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * usb-serial driver for Quatech SSU-100
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * based on ftdi_sio.c and the original serqt_usb.c from Quatech
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/tty.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/tty_driver.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/tty_flip.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/serial.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/usb/serial.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/serial_reg.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #define QT_OPEN_CLOSE_CHANNEL 0xca
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define QT_SET_GET_DEVICE 0xc2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define QT_SET_GET_REGISTER 0xc0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define QT_GET_SET_PREBUF_TRIG_LVL 0xcc
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define QT_SET_ATF 0xcd
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define QT_GET_SET_UART 0xc1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define QT_TRANSFER_IN 0xc0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #define QT_HW_FLOW_CONTROL_MASK 0xc5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define QT_SW_FLOW_CONTROL_MASK 0xc6
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define SERIAL_MSR_MASK 0xf0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define SERIAL_CRTSCTS ((UART_MCR_RTS << 8) | UART_MSR_CTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define SERIAL_EVEN_PARITY (UART_LCR_PARITY | UART_LCR_EPAR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define MAX_BAUD_RATE 460800
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define ATC_DISABLED 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define DUPMODE_BITS 0xc0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define RR_BITS 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define LOOPMODE_BITS 0x41
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define RS232_MODE 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) #define RTSCTS_TO_CONNECTOR 0x40
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define CLKS_X4 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define FULLPWRBIT 0x00000080
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) #define NEXT_BOARD_POWER_BIT 0x00000004
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) #define DRIVER_DESC "Quatech SSU-100 USB to Serial Driver"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) #define USB_VENDOR_ID_QUATECH 0x061d /* Quatech VID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) #define QUATECH_SSU100 0xC020 /* SSU100 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static const struct usb_device_id id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) {USB_DEVICE(USB_VENDOR_ID_QUATECH, QUATECH_SSU100)},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) {} /* Terminating entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) MODULE_DEVICE_TABLE(usb, id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct ssu100_port_private {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) spinlock_t status_lock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) u8 shadowLSR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) u8 shadowMSR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static inline int ssu100_control_msg(struct usb_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) u8 request, u16 data, u16 index)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) request, 0x40, data, index,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) NULL, 0, 300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static inline int ssu100_setdevice(struct usb_device *dev, u8 *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) u16 x = ((u16)(data[1] << 8) | (u16)(data[0]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return ssu100_control_msg(dev, QT_SET_GET_DEVICE, x, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static inline int ssu100_getdevice(struct usb_device *dev, u8 *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) QT_SET_GET_DEVICE, 0xc0, 0, 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) data, 3, 300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) if (ret < 3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) ret = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) static inline int ssu100_getregister(struct usb_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) unsigned short uart,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) unsigned short reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) u8 *data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) QT_SET_GET_REGISTER, 0xc0, reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) uart, data, sizeof(*data), 300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (ret < (int)sizeof(*data)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) if (ret >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) ret = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) static inline int ssu100_setregister(struct usb_device *dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) unsigned short uart,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) unsigned short reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) u16 data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) u16 value = (data << 8) | reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) return usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) QT_SET_GET_REGISTER, 0x40, value, uart,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) NULL, 0, 300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) #define set_mctrl(dev, set) update_mctrl((dev), (set), 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) #define clear_mctrl(dev, clear) update_mctrl((dev), 0, (clear))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /* these do not deal with device that have more than 1 port */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) static inline int update_mctrl(struct usb_device *dev, unsigned int set,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) unsigned int clear)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) unsigned urb_value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (((set | clear) & (TIOCM_DTR | TIOCM_RTS)) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) dev_dbg(&dev->dev, "%s - DTR|RTS not being set|cleared\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) return 0; /* no change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) clear &= ~set; /* 'set' takes precedence over 'clear' */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) urb_value = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) if (set & TIOCM_DTR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) urb_value |= UART_MCR_DTR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (set & TIOCM_RTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) urb_value |= UART_MCR_RTS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) result = ssu100_setregister(dev, 0, UART_MCR, urb_value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) dev_dbg(&dev->dev, "%s Error from MODEM_CTRL urb\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) static int ssu100_initdevice(struct usb_device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) u8 *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) int result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) data = kzalloc(3, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) result = ssu100_getdevice(dev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) dev_dbg(&dev->dev, "%s - get_device failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) data[1] &= ~FULLPWRBIT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) result = ssu100_setdevice(dev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) dev_dbg(&dev->dev, "%s - setdevice failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) result = ssu100_control_msg(dev, QT_GET_SET_PREBUF_TRIG_LVL, 128, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) dev_dbg(&dev->dev, "%s - set prebuffer level failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) result = ssu100_control_msg(dev, QT_SET_ATF, ATC_DISABLED, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) dev_dbg(&dev->dev, "%s - set ATFprebuffer level failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) result = ssu100_getdevice(dev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) dev_dbg(&dev->dev, "%s - get_device failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) data[0] &= ~(RR_BITS | DUPMODE_BITS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) data[0] |= CLKS_X4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) data[1] &= ~(LOOPMODE_BITS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) data[1] |= RS232_MODE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) result = ssu100_setdevice(dev, data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) if (result < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) dev_dbg(&dev->dev, "%s - setdevice failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) out: kfree(data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) static void ssu100_set_termios(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) struct usb_serial_port *port,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) struct ktermios *old_termios)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) struct usb_device *dev = port->serial->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) struct ktermios *termios = &tty->termios;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) u16 baud, divisor, remainder;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) unsigned int cflag = termios->c_cflag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) u16 urb_value = 0; /* will hold the new flags */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) if (cflag & PARENB) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) if (cflag & PARODD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) urb_value |= UART_LCR_PARITY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) urb_value |= SERIAL_EVEN_PARITY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) switch (cflag & CSIZE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) case CS5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) urb_value |= UART_LCR_WLEN5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) case CS6:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) urb_value |= UART_LCR_WLEN6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) case CS7:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) urb_value |= UART_LCR_WLEN7;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) case CS8:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) urb_value |= UART_LCR_WLEN8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) baud = tty_get_baud_rate(tty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if (!baud)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) baud = 9600;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) dev_dbg(&port->dev, "%s - got baud = %d\n", __func__, baud);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) divisor = MAX_BAUD_RATE / baud;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) remainder = MAX_BAUD_RATE % baud;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) if (((remainder * 2) >= baud) && (baud != 110))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) divisor++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) urb_value = urb_value << 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) result = ssu100_control_msg(dev, QT_GET_SET_UART, divisor, urb_value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) dev_dbg(&port->dev, "%s - set uart failed\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) if (cflag & CRTSCTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) result = ssu100_control_msg(dev, QT_HW_FLOW_CONTROL_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) SERIAL_CRTSCTS, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) result = ssu100_control_msg(dev, QT_HW_FLOW_CONTROL_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) dev_dbg(&port->dev, "%s - set HW flow control failed\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) if (I_IXOFF(tty) || I_IXON(tty)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) u16 x = ((u16)(START_CHAR(tty) << 8) | (u16)(STOP_CHAR(tty)));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) result = ssu100_control_msg(dev, QT_SW_FLOW_CONTROL_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) x, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) result = ssu100_control_msg(dev, QT_SW_FLOW_CONTROL_MASK,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 0, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) dev_dbg(&port->dev, "%s - set SW flow control failed\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) static int ssu100_open(struct tty_struct *tty, struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) struct usb_device *dev = port->serial->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) struct ssu100_port_private *priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) u8 *data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) data = kzalloc(2, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) if (!data)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) result = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) QT_OPEN_CLOSE_CHANNEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) QT_TRANSFER_IN, 0x01,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 0, data, 2, 300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) if (result < 2) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) dev_dbg(&port->dev, "%s - open failed %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) if (result >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) result = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) kfree(data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) spin_lock_irqsave(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) priv->shadowLSR = data[0];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) priv->shadowMSR = data[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) spin_unlock_irqrestore(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) kfree(data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) /* set to 9600 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) result = ssu100_control_msg(dev, QT_GET_SET_UART, 0x30, 0x0300);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) if (result < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) dev_dbg(&port->dev, "%s - set uart failed\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) if (tty)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) ssu100_set_termios(tty, port, &tty->termios);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) return usb_serial_generic_open(tty, port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) static int get_serial_info(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) struct serial_struct *ss)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) ss->line = port->minor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) ss->port = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) ss->irq = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) ss->xmit_fifo_size = port->bulk_out_size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) ss->baud_base = 9600;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) ss->close_delay = 5*HZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) ss->closing_wait = 30*HZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) static int ssu100_attach(struct usb_serial *serial)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) return ssu100_initdevice(serial->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) static int ssu100_port_probe(struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) struct ssu100_port_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) priv = kzalloc(sizeof(*priv), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) if (!priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) spin_lock_init(&priv->status_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) usb_set_serial_port_data(port, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) static int ssu100_port_remove(struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) struct ssu100_port_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) kfree(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) static int ssu100_tiocmget(struct tty_struct *tty)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) struct usb_device *dev = port->serial->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) u8 *d;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) int r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) d = kzalloc(2, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (!d)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) r = ssu100_getregister(dev, 0, UART_MCR, d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) if (r < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) goto mget_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) r = ssu100_getregister(dev, 0, UART_MSR, d+1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) if (r < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) goto mget_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) r = (d[0] & UART_MCR_DTR ? TIOCM_DTR : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) (d[0] & UART_MCR_RTS ? TIOCM_RTS : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) (d[1] & UART_MSR_CTS ? TIOCM_CTS : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) (d[1] & UART_MSR_DCD ? TIOCM_CAR : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) (d[1] & UART_MSR_RI ? TIOCM_RI : 0) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) (d[1] & UART_MSR_DSR ? TIOCM_DSR : 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) mget_out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) kfree(d);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) return r;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) static int ssu100_tiocmset(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) unsigned int set, unsigned int clear)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) struct usb_device *dev = port->serial->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) return update_mctrl(dev, set, clear);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) static void ssu100_dtr_rts(struct usb_serial_port *port, int on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) struct usb_device *dev = port->serial->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) /* Disable flow control */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) if (!on) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) if (ssu100_setregister(dev, 0, UART_MCR, 0) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) dev_err(&port->dev, "error from flowcontrol urb\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) /* drop RTS and DTR */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) if (on)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) set_mctrl(dev, TIOCM_DTR | TIOCM_RTS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) clear_mctrl(dev, TIOCM_DTR | TIOCM_RTS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) static void ssu100_update_msr(struct usb_serial_port *port, u8 msr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) struct ssu100_port_private *priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) spin_lock_irqsave(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) priv->shadowMSR = msr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) spin_unlock_irqrestore(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) if (msr & UART_MSR_ANY_DELTA) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) /* update input line counters */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) if (msr & UART_MSR_DCTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) port->icount.cts++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) if (msr & UART_MSR_DDSR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) port->icount.dsr++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) if (msr & UART_MSR_DDCD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) port->icount.dcd++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) if (msr & UART_MSR_TERI)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) port->icount.rng++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) wake_up_interruptible(&port->port.delta_msr_wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) static void ssu100_update_lsr(struct usb_serial_port *port, u8 lsr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) char *tty_flag)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) struct ssu100_port_private *priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) spin_lock_irqsave(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) priv->shadowLSR = lsr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) spin_unlock_irqrestore(&priv->status_lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) *tty_flag = TTY_NORMAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) if (lsr & UART_LSR_BRK_ERROR_BITS) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) /* we always want to update icount, but we only want to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) * update tty_flag for one case */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) if (lsr & UART_LSR_BI) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) port->icount.brk++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) *tty_flag = TTY_BREAK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) usb_serial_handle_break(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) if (lsr & UART_LSR_PE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) port->icount.parity++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) if (*tty_flag == TTY_NORMAL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) *tty_flag = TTY_PARITY;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) if (lsr & UART_LSR_FE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) port->icount.frame++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) if (*tty_flag == TTY_NORMAL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) *tty_flag = TTY_FRAME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) if (lsr & UART_LSR_OE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) port->icount.overrun++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) tty_insert_flip_char(&port->port, 0, TTY_OVERRUN);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) static void ssu100_process_read_urb(struct urb *urb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) struct usb_serial_port *port = urb->context;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) char *packet = urb->transfer_buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) char flag = TTY_NORMAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) u32 len = urb->actual_length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) char *ch;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) if ((len >= 4) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) (packet[0] == 0x1b) && (packet[1] == 0x1b) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) ((packet[2] == 0x00) || (packet[2] == 0x01))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) if (packet[2] == 0x00)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) ssu100_update_lsr(port, packet[3], &flag);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) if (packet[2] == 0x01)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) ssu100_update_msr(port, packet[3]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) len -= 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) ch = packet + 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) ch = packet;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) if (!len)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) return; /* status only */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) if (port->sysrq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) for (i = 0; i < len; i++, ch++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) if (!usb_serial_handle_sysrq_char(port, *ch))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) tty_insert_flip_char(&port->port, *ch, flag);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) tty_insert_flip_string_fixed_flag(&port->port, ch, flag, len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) tty_flip_buffer_push(&port->port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) static struct usb_serial_driver ssu100_device = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) .name = "ssu100",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) .description = DRIVER_DESC,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) .id_table = id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) .num_ports = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) .open = ssu100_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) .attach = ssu100_attach,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) .port_probe = ssu100_port_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) .port_remove = ssu100_port_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) .dtr_rts = ssu100_dtr_rts,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) .process_read_urb = ssu100_process_read_urb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) .tiocmget = ssu100_tiocmget,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) .tiocmset = ssu100_tiocmset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) .tiocmiwait = usb_serial_generic_tiocmiwait,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) .get_icount = usb_serial_generic_get_icount,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) .get_serial = get_serial_info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) .set_termios = ssu100_set_termios,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) static struct usb_serial_driver * const serial_drivers[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) &ssu100_device, NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) module_usb_serial_driver(serial_drivers, id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) MODULE_LICENSE("GPL v2");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags