^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) * KOBIL USB Smart Card Terminal Driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2002 KOBIL Systems GmbH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Author: Thomas Wahrenbruch
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Contact: linuxusb@kobil.de
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) * This program is largely derived from work by the linux-usb group
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * and associated source files. Please see the usb/serial files for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * individual credits and copyrights.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) * Thanks to Greg Kroah-Hartman (greg@kroah.com) for his help and
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) * patience.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) * Supported readers: USB TWIN, KAAN Standard Plus and SecOVID Reader Plus
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) * (Adapter K), B1 Professional and KAAN Professional (Adapter B)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #include <linux/tty.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <linux/tty_driver.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #include <linux/tty_flip.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include <linux/spinlock.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #include <linux/usb/serial.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #include <linux/ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #include "kobil_sct.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define DRIVER_AUTHOR "KOBIL Systems GmbH - http://www.kobil.com"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define DRIVER_DESC "KOBIL USB Smart Card Terminal Driver (experimental)"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define KOBIL_VENDOR_ID 0x0D46
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define KOBIL_ADAPTER_B_PRODUCT_ID 0x2011
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) #define KOBIL_ADAPTER_K_PRODUCT_ID 0x2012
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) #define KOBIL_USBTWIN_PRODUCT_ID 0x0078
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) #define KOBIL_KAAN_SIM_PRODUCT_ID 0x0081
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) #define KOBIL_TIMEOUT 500
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) #define KOBIL_BUF_LENGTH 300
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) /* Function prototypes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) static int kobil_port_probe(struct usb_serial_port *probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) static int kobil_port_remove(struct usb_serial_port *probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) static void kobil_close(struct usb_serial_port *port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) const unsigned char *buf, int count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static int kobil_write_room(struct tty_struct *tty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) static int kobil_ioctl(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) unsigned int cmd, unsigned long arg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) static int kobil_tiocmget(struct tty_struct *tty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) static int kobil_tiocmset(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) unsigned int set, unsigned int clear);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) static void kobil_read_int_callback(struct urb *urb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) static void kobil_write_int_callback(struct urb *urb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) static void kobil_set_termios(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) struct usb_serial_port *port, struct ktermios *old);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) static void kobil_init_termios(struct tty_struct *tty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) static const struct usb_device_id id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_B_PRODUCT_ID) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_K_PRODUCT_ID) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_USBTWIN_PRODUCT_ID) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_KAAN_SIM_PRODUCT_ID) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) { } /* Terminating entry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) MODULE_DEVICE_TABLE(usb, id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) static struct usb_serial_driver kobil_device = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) .name = "kobil",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) .description = "KOBIL USB smart card terminal",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) .id_table = id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) .num_ports = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) .num_interrupt_out = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) .port_probe = kobil_port_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) .port_remove = kobil_port_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) .ioctl = kobil_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) .set_termios = kobil_set_termios,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) .init_termios = kobil_init_termios,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) .tiocmget = kobil_tiocmget,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) .tiocmset = kobil_tiocmset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) .open = kobil_open,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) .close = kobil_close,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) .write = kobil_write,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) .write_room = kobil_write_room,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) .read_int_callback = kobil_read_int_callback,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) .write_int_callback = kobil_write_int_callback,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) static struct usb_serial_driver * const serial_drivers[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) &kobil_device, NULL
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) struct kobil_private {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) unsigned char buf[KOBIL_BUF_LENGTH]; /* buffer for the APDU to send */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) int filled; /* index of the last char in buf */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) int cur_pos; /* index of the next char to send in buf */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) __u16 device_type;
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) static int kobil_port_probe(struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) struct usb_serial *serial = port->serial;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) priv = kmalloc(sizeof(struct kobil_private), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) if (!priv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) priv->filled = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) priv->cur_pos = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) priv->device_type = le16_to_cpu(serial->dev->descriptor.idProduct);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) switch (priv->device_type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) case KOBIL_ADAPTER_B_PRODUCT_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) dev_dbg(&serial->dev->dev, "KOBIL B1 PRO / KAAN PRO detected\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) case KOBIL_ADAPTER_K_PRODUCT_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) dev_dbg(&serial->dev->dev, "KOBIL KAAN Standard Plus / SecOVID Reader Plus detected\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) case KOBIL_USBTWIN_PRODUCT_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) dev_dbg(&serial->dev->dev, "KOBIL USBTWIN detected\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) case KOBIL_KAAN_SIM_PRODUCT_ID:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) dev_dbg(&serial->dev->dev, "KOBIL KAAN SIM detected\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) usb_set_serial_port_data(port, priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) static int kobil_port_remove(struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) kfree(priv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) static void kobil_init_termios(struct tty_struct *tty)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) /* Default to echo off and other sane device settings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) tty->termios.c_lflag = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) tty->termios.c_iflag &= ~(ISIG | ICANON | ECHO | IEXTEN | XCASE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) tty->termios.c_iflag |= IGNBRK | IGNPAR | IXOFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) /* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) tty->termios.c_oflag &= ~ONLCR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) struct device *dev = &port->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) int result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) unsigned char *transfer_buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) int transfer_buffer_length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) /* allocate memory for transfer buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) if (!transfer_buffer)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) /* get hardware version */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) usb_rcvctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) SUSBCRequest_GetMisc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) SUSBCR_MSC_GetHWVersion,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) transfer_buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) transfer_buffer_length,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) dev_dbg(dev, "%s - Send get_HW_version URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) if (result >= 3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) dev_dbg(dev, "Hardware version: %i.%i.%i\n", transfer_buffer[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) transfer_buffer[1], transfer_buffer[2]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) /* get firmware version */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) usb_rcvctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) SUSBCRequest_GetMisc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) SUSBCR_MSC_GetFWVersion,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) transfer_buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) transfer_buffer_length,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) dev_dbg(dev, "%s - Send get_FW_version URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) if (result >= 3) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) dev_dbg(dev, "Firmware version: %i.%i.%i\n", transfer_buffer[0],
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) transfer_buffer[1], transfer_buffer[2]);
^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) if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) /* Setting Baudrate, Parity and Stopbits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) SUSBCRequest_SetBaudRateParityAndStopBits,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) SUSBCR_SBR_9600 | SUSBCR_SPASB_EvenParity |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) SUSBCR_SPASB_1StopBit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) dev_dbg(dev, "%s - Send set_baudrate URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) /* reset all queues */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) SUSBCRequest_Misc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) SUSBCR_MSC_ResetAllQueues,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) dev_dbg(dev, "%s - Send reset_all_queues URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) /* start reading (Adapter B 'cause PNP string) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) dev_dbg(dev, "%s - Send read URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) kfree(transfer_buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^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) static void kobil_close(struct usb_serial_port *port)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) /* FIXME: Add rts/dtr methods */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) usb_kill_urb(port->interrupt_out_urb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) usb_kill_urb(port->interrupt_in_urb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) static void kobil_read_int_callback(struct urb *urb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) struct usb_serial_port *port = urb->context;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) unsigned char *data = urb->transfer_buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) int status = urb->status;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) if (status) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) dev_dbg(&port->dev, "%s - Read int status not zero: %d\n", __func__, status);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) if (urb->actual_length) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) usb_serial_debug_data(&port->dev, __func__, urb->actual_length,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) tty_insert_flip_string(&port->port, data, urb->actual_length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) tty_flip_buffer_push(&port->port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) dev_dbg(&port->dev, "%s - Send read URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) static void kobil_write_int_callback(struct urb *urb)
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) const unsigned char *buf, int count)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) int length = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) int result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) int todo = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) if (count == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) dev_dbg(&port->dev, "%s - write request of 0 bytes\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) if (count > (KOBIL_BUF_LENGTH - priv->filled)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) dev_dbg(&port->dev, "%s - Error: write request bigger than buffer size\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) /* Copy data to buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) memcpy(priv->buf + priv->filled, buf, count);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) usb_serial_debug_data(&port->dev, __func__, count, priv->buf + priv->filled);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) priv->filled = priv->filled + count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) /* only send complete block. TWIN, KAAN SIM and adapter K
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) use the same protocol. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) if (((priv->device_type != KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 2) && (priv->filled >= (priv->buf[1] + 3))) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 3) && (priv->filled >= (priv->buf[2] + 4)))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) /* stop reading (except TWIN and KAAN SIM) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) if ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) || (priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) usb_kill_urb(port->interrupt_in_urb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) todo = priv->filled - priv->cur_pos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) while (todo > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) /* max 8 byte in one urb (endpoint size) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) length = min(todo, port->interrupt_out_size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) /* copy data to transfer buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) memcpy(port->interrupt_out_buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) priv->buf + priv->cur_pos, length);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) port->interrupt_out_urb->transfer_buffer_length = length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) priv->cur_pos = priv->cur_pos + length;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) result = usb_submit_urb(port->interrupt_out_urb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) dev_dbg(&port->dev, "%s - Send write URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) todo = priv->filled - priv->cur_pos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) if (todo > 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) msleep(24);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) priv->filled = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) priv->cur_pos = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) /* start reading (except TWIN and KAAN SIM) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) result = usb_submit_urb(port->interrupt_in_urb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) GFP_ATOMIC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) dev_dbg(&port->dev, "%s - Send read URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) return count;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) static int kobil_write_room(struct tty_struct *tty)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) /* FIXME */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) return 8;
^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)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) static int kobil_tiocmget(struct tty_struct *tty)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) unsigned char *transfer_buffer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) int transfer_buffer_length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) /* This device doesn't support ioctl calls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) /* allocate memory for transfer buffer */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) if (!transfer_buffer)
^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) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) usb_rcvctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) SUSBCRequest_GetStatusLineState,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) transfer_buffer,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) transfer_buffer_length,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) KOBIL_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) dev_dbg(&port->dev, "Send get_status_line_state URB returns: %i\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (result < 1) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) if (result >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) result = -EIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) goto out_free;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) dev_dbg(&port->dev, "Statusline: %02x\n", transfer_buffer[0]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) result = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) result = TIOCM_DSR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) out_free:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) kfree(transfer_buffer);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) return result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) static int kobil_tiocmset(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) unsigned int set, unsigned int clear)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) struct device *dev = &port->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) int dtr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) int rts = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) /* FIXME: locking ? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) /* This device doesn't support ioctl calls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) if (set & TIOCM_RTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) rts = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) if (set & TIOCM_DTR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) dtr = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) if (clear & TIOCM_RTS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) rts = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) if (clear & TIOCM_DTR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) dtr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) if (dtr != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) dev_dbg(dev, "%s - Setting DTR\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) dev_dbg(dev, "%s - Clearing DTR\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) SUSBCRequest_SetStatusLinesOrQueues,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) ((dtr != 0) ? SUSBCR_SSL_SETDTR : SUSBCR_SSL_CLRDTR),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) KOBIL_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) if (rts != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) dev_dbg(dev, "%s - Setting RTS\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) dev_dbg(dev, "%s - Clearing RTS\n", __func__);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) SUSBCRequest_SetStatusLinesOrQueues,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) ((rts != 0) ? SUSBCR_SSL_SETRTS : SUSBCR_SSL_CLRRTS),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) KOBIL_TIMEOUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) dev_dbg(dev, "%s - Send set_status_line URB returns: %i\n", __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) return (result < 0) ? result : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) static void kobil_set_termios(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) struct usb_serial_port *port, struct ktermios *old)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) struct kobil_private *priv;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) unsigned short urb_val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) int c_cflag = tty->termios.c_cflag;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) speed_t speed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) /* This device doesn't support ioctl calls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) tty_termios_copy_hw(&tty->termios, old);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) return;
^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) speed = tty_get_baud_rate(tty);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) switch (speed) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) case 1200:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) urb_val = SUSBCR_SBR_1200;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) speed = 9600;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) case 9600:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) urb_val = SUSBCR_SBR_9600;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) SUSBCR_SPASB_1StopBit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) if (c_cflag & PARENB) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) if (c_cflag & PARODD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) urb_val |= SUSBCR_SPASB_OddParity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) urb_val |= SUSBCR_SPASB_EvenParity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) } else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) urb_val |= SUSBCR_SPASB_NoParity;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) tty->termios.c_cflag &= ~CMSPAR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) tty_encode_baud_rate(tty, speed, speed);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) SUSBCRequest_SetBaudRateParityAndStopBits,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) urb_val,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) if (result) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) dev_err(&port->dev, "failed to update line settings: %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) static int kobil_ioctl(struct tty_struct *tty,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) struct usb_serial_port *port = tty->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) struct kobil_private *priv = usb_get_serial_port_data(port);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) int result;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) /* This device doesn't support ioctl calls */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) return -ENOIOCTLCMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) case TCFLSH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) result = usb_control_msg(port->serial->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) usb_sndctrlpipe(port->serial->dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) SUSBCRequest_Misc,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) SUSBCR_MSC_ResetAllQueues,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) NULL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) KOBIL_TIMEOUT
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) );
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) dev_dbg(&port->dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) "%s - Send reset_all_queues (FLUSH) URB returns: %i\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) __func__, result);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) return (result < 0) ? -EIO: 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) return -ENOIOCTLCMD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) module_usb_serial_driver(serial_drivers, id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) MODULE_AUTHOR(DRIVER_AUTHOR);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) MODULE_DESCRIPTION(DRIVER_DESC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags