[mirror_ubuntu-bionic-kernel.git] / drivers / usb / serial / spcp8x5.c

/*
 * spcp8x5 USB to serial adaptor driver
 *
 * Copyright (C) 2010 Johan Hovold (jhovold@gmail.com)
 * Copyright (C) 2006 Linxb (xubin.lin@worldplus.com.cn)
 * Copyright (C) 2006 S1 Corp.
 *
 * Original driver for 2.6.10 pl2303 driver by
 *   Greg Kroah-Hartman (greg@kroah.com)
 * Changes for 2.6.20 by Harald Klein <hari@vt100.at>
 *
 *	This program is free software; you can redistribute it and/or modify
 *	it under the terms of the GNU General Public License as published by
 *	the Free Software Foundation; either version 2 of the License, or
 *	(at your option) any later version.
 *
 *
 */
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/spinlock.h>
#include <linux/usb.h>
#include <linux/usb/serial.h>

#define DRIVER_DESC 	"SPCP8x5 USB to serial adaptor driver"

#define SPCP8x5_007_VID		0x04FC
#define SPCP8x5_007_PID		0x0201
#define SPCP8x5_008_VID		0x04fc
#define SPCP8x5_008_PID		0x0235
#define SPCP8x5_PHILIPS_VID	0x0471
#define SPCP8x5_PHILIPS_PID	0x081e
#define SPCP8x5_INTERMATIC_VID	0x04FC
#define SPCP8x5_INTERMATIC_PID	0x0204
#define SPCP8x5_835_VID		0x04fc
#define SPCP8x5_835_PID		0x0231

static const struct usb_device_id id_table[] = {
	{ USB_DEVICE(SPCP8x5_PHILIPS_VID , SPCP8x5_PHILIPS_PID)},
	{ USB_DEVICE(SPCP8x5_INTERMATIC_VID, SPCP8x5_INTERMATIC_PID)},
	{ USB_DEVICE(SPCP8x5_835_VID, SPCP8x5_835_PID)},
	{ USB_DEVICE(SPCP8x5_008_VID, SPCP8x5_008_PID)},
	{ USB_DEVICE(SPCP8x5_007_VID, SPCP8x5_007_PID)},
	{ }					/* Terminating entry */
};
MODULE_DEVICE_TABLE(usb, id_table);

struct spcp8x5_usb_ctrl_arg {
	u8 	type;
	u8	cmd;
	u8	cmd_type;
	u16	value;
	u16	index;
	u16	length;
};


/* spcp8x5 spec register define */
#define MCR_CONTROL_LINE_RTS		0x02
#define MCR_CONTROL_LINE_DTR		0x01
#define MCR_DTR				0x01
#define MCR_RTS				0x02

#define MSR_STATUS_LINE_DCD		0x80
#define MSR_STATUS_LINE_RI		0x40
#define MSR_STATUS_LINE_DSR		0x20
#define MSR_STATUS_LINE_CTS		0x10

/* verdor command here , we should define myself */
#define SET_DEFAULT			0x40
#define SET_DEFAULT_TYPE		0x20

#define SET_UART_FORMAT			0x40
#define SET_UART_FORMAT_TYPE		0x21
#define SET_UART_FORMAT_SIZE_5		0x00
#define SET_UART_FORMAT_SIZE_6		0x01
#define SET_UART_FORMAT_SIZE_7		0x02
#define SET_UART_FORMAT_SIZE_8		0x03
#define SET_UART_FORMAT_STOP_1		0x00
#define SET_UART_FORMAT_STOP_2		0x04
#define SET_UART_FORMAT_PAR_NONE	0x00
#define SET_UART_FORMAT_PAR_ODD		0x10
#define SET_UART_FORMAT_PAR_EVEN	0x30
#define SET_UART_FORMAT_PAR_MASK	0xD0
#define SET_UART_FORMAT_PAR_SPACE	0x90

#define GET_UART_STATUS_TYPE		0xc0
#define GET_UART_STATUS			0x22
#define GET_UART_STATUS_MSR		0x06

#define SET_UART_STATUS			0x40
#define SET_UART_STATUS_TYPE		0x23
#define SET_UART_STATUS_MCR		0x0004
#define SET_UART_STATUS_MCR_DTR		0x01
#define SET_UART_STATUS_MCR_RTS		0x02
#define SET_UART_STATUS_MCR_LOOP	0x10

#define SET_WORKING_MODE		0x40
#define SET_WORKING_MODE_TYPE		0x24
#define SET_WORKING_MODE_U2C		0x00
#define SET_WORKING_MODE_RS485		0x01
#define SET_WORKING_MODE_PDMA		0x02
#define SET_WORKING_MODE_SPP		0x03

#define SET_FLOWCTL_CHAR		0x40
#define SET_FLOWCTL_CHAR_TYPE		0x25

#define GET_VERSION			0xc0
#define GET_VERSION_TYPE		0x26

#define SET_REGISTER			0x40
#define SET_REGISTER_TYPE		0x27

#define	GET_REGISTER			0xc0
#define GET_REGISTER_TYPE		0x28

#define SET_RAM				0x40
#define SET_RAM_TYPE			0x31

#define GET_RAM				0xc0
#define GET_RAM_TYPE			0x32

/* how come ??? */
#define UART_STATE			0x08
#define UART_STATE_TRANSIENT_MASK	0x75
#define UART_DCD			0x01
#define UART_DSR			0x02
#define UART_BREAK_ERROR		0x04
#define UART_RING			0x08
#define UART_FRAME_ERROR		0x10
#define UART_PARITY_ERROR		0x20
#define UART_OVERRUN_ERROR		0x40
#define UART_CTS			0x80

enum spcp8x5_type {
	SPCP825_007_TYPE,
	SPCP825_008_TYPE,
	SPCP825_PHILIP_TYPE,
	SPCP825_INTERMATIC_TYPE,
	SPCP835_TYPE,
};

struct spcp8x5_private {
	spinlock_t 	lock;
	enum spcp8x5_type	type;
	wait_queue_head_t	delta_msr_wait;
	u8 			line_control;
	u8 			line_status;
};

static int spcp8x5_port_probe(struct usb_serial_port *port)
{
	struct usb_serial *serial = port->serial;
	struct spcp8x5_private *priv;
	enum spcp8x5_type type = SPCP825_007_TYPE;
	u16 product = le16_to_cpu(serial->dev->descriptor.idProduct);

	if (product == 0x0201)
		type = SPCP825_007_TYPE;
	else if (product == 0x0231)
		type = SPCP835_TYPE;
	else if (product == 0x0235)
		type = SPCP825_008_TYPE;
	else if (product == 0x0204)
		type = SPCP825_INTERMATIC_TYPE;
	else if (product == 0x0471 &&
		 serial->dev->descriptor.idVendor == cpu_to_le16(0x081e))
		type = SPCP825_PHILIP_TYPE;
	dev_dbg(&serial->dev->dev, "device type = %d\n", (int)type);

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	spin_lock_init(&priv->lock);
	init_waitqueue_head(&priv->delta_msr_wait);
	priv->type = type;

	usb_set_serial_port_data(port , priv);

	return 0;
}

static int spcp8x5_port_remove(struct usb_serial_port *port)
{
	struct spcp8x5_private *priv;

	priv = usb_get_serial_port_data(port);
	kfree(priv);

	return 0;
}

/* set the modem control line of the device.
 * NOTE spcp825-007 not supported this */
static int spcp8x5_set_ctrlLine(struct usb_device *dev, u8 value,
				enum spcp8x5_type type)
{
	int retval;
	u8 mcr = 0 ;

	if (type == SPCP825_007_TYPE)
		return -EPERM;

	mcr = (unsigned short)value;
	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
				 SET_UART_STATUS_TYPE, SET_UART_STATUS,
				 mcr, 0x04, NULL, 0, 100);
	if (retval != 0)
		dev_dbg(&dev->dev, "usb_control_msg return %#x\n", retval);
	return retval;
}

/* get the modem status register of the device
 * NOTE spcp825-007 not supported this */
static int spcp8x5_get_msr(struct usb_device *dev, u8 *status,
			   enum spcp8x5_type type)
{
	u8 *status_buffer;
	int ret;

	/* I return Permited not support here but seem inval device
	 * is more fix */
	if (type == SPCP825_007_TYPE)
		return -EPERM;
	if (status == NULL)
		return -EINVAL;

	status_buffer = kmalloc(1, GFP_KERNEL);
	if (!status_buffer)
		return -ENOMEM;
	status_buffer[0] = status[0];

	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
			      GET_UART_STATUS, GET_UART_STATUS_TYPE,
			      0, GET_UART_STATUS_MSR, status_buffer, 1, 100);
	if (ret < 0)
		dev_dbg(&dev->dev, "Get MSR = 0x%p failed (error = %d)",
			status_buffer, ret);

	dev_dbg(&dev->dev, "0xc0:0x22:0:6  %d - 0x%p ", ret, status_buffer);
	status[0] = status_buffer[0];
	kfree(status_buffer);

	return ret;
}

/* select the work mode.
 * NOTE this function not supported by spcp825-007 */
static void spcp8x5_set_workMode(struct usb_device *dev, u16 value,
				 u16 index, enum spcp8x5_type type)
{
	int ret;

	/* I return Permited not support here but seem inval device
	 * is more fix */
	if (type == SPCP825_007_TYPE)
		return;

	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
			      SET_WORKING_MODE_TYPE, SET_WORKING_MODE,
			      value, index, NULL, 0, 100);
	dev_dbg(&dev->dev, "value = %#x , index = %#x\n", value, index);
	if (ret < 0)
		dev_dbg(&dev->dev,
			"RTSCTS usb_control_msg(enable flowctrl) = %d\n", ret);
}

static int spcp8x5_carrier_raised(struct usb_serial_port *port)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	if (priv->line_status & MSR_STATUS_LINE_DCD)
		return 1;
	return 0;
}

static void spcp8x5_dtr_rts(struct usb_serial_port *port, int on)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	unsigned long flags;
	u8 control;

	spin_lock_irqsave(&priv->lock, flags);
	if (on)
		priv->line_control = MCR_CONTROL_LINE_DTR
						| MCR_CONTROL_LINE_RTS;
	else
		priv->line_control &= ~ (MCR_CONTROL_LINE_DTR
						| MCR_CONTROL_LINE_RTS);
	control = priv->line_control;
	spin_unlock_irqrestore(&priv->lock, flags);
	spcp8x5_set_ctrlLine(port->serial->dev, control , priv->type);
}

static void spcp8x5_init_termios(struct tty_struct *tty)
{
	/* for the 1st time call this function */
	tty->termios = tty_std_termios;
	tty->termios.c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL;
	tty->termios.c_ispeed = 115200;
	tty->termios.c_ospeed = 115200;
}

/* set the serial param for transfer. we should check if we really need to
 * transfer. if we set flow control we should do this too. */
static void spcp8x5_set_termios(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios)
{
	struct usb_serial *serial = port->serial;
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	unsigned long flags;
	unsigned int cflag = tty->termios.c_cflag;
	unsigned int old_cflag = old_termios->c_cflag;
	unsigned short uartdata;
	unsigned char buf[2] = {0, 0};
	int baud;
	int i;
	u8 control;


	/* check that they really want us to change something */
	if (!tty_termios_hw_change(&tty->termios, old_termios))
		return;

	/* set DTR/RTS active */
	spin_lock_irqsave(&priv->lock, flags);
	control = priv->line_control;
	if ((old_cflag & CBAUD) == B0) {
		priv->line_control |= MCR_DTR;
		if (!(old_cflag & CRTSCTS))
			priv->line_control |= MCR_RTS;
	}
	if (control != priv->line_control) {
		control = priv->line_control;
		spin_unlock_irqrestore(&priv->lock, flags);
		spcp8x5_set_ctrlLine(serial->dev, control , priv->type);
	} else {
		spin_unlock_irqrestore(&priv->lock, flags);
	}

	/* Set Baud Rate */
	baud = tty_get_baud_rate(tty);
	switch (baud) {
	case 300:	buf[0] = 0x00;	break;
	case 600:	buf[0] = 0x01;	break;
	case 1200:	buf[0] = 0x02;	break;
	case 2400:	buf[0] = 0x03;	break;
	case 4800:	buf[0] = 0x04;	break;
	case 9600:	buf[0] = 0x05;	break;
	case 19200:	buf[0] = 0x07;	break;
	case 38400:	buf[0] = 0x09;	break;
	case 57600:	buf[0] = 0x0a;	break;
	case 115200:	buf[0] = 0x0b;	break;
	case 230400:	buf[0] = 0x0c;	break;
	case 460800:	buf[0] = 0x0d;	break;
	case 921600:	buf[0] = 0x0e;	break;
/*	case 1200000:	buf[0] = 0x0f;	break; */
/*	case 2400000:	buf[0] = 0x10;	break; */
	case 3000000:	buf[0] = 0x11;	break;
/*	case 6000000:	buf[0] = 0x12;	break; */
	case 0:
	case 1000000:
			buf[0] = 0x0b;	break;
	default:
		dev_err(&port->dev, "spcp825 driver does not support the "
			"baudrate requested, using default of 9600.\n");
	}

	/* Set Data Length : 00:5bit, 01:6bit, 10:7bit, 11:8bit */
	if (cflag & CSIZE) {
		switch (cflag & CSIZE) {
		case CS5:
			buf[1] |= SET_UART_FORMAT_SIZE_5;
			break;
		case CS6:
			buf[1] |= SET_UART_FORMAT_SIZE_6;
			break;
		case CS7:
			buf[1] |= SET_UART_FORMAT_SIZE_7;
			break;
		default:
		case CS8:
			buf[1] |= SET_UART_FORMAT_SIZE_8;
			break;
		}
	}

	/* Set Stop bit2 : 0:1bit 1:2bit */
	buf[1] |= (cflag & CSTOPB) ? SET_UART_FORMAT_STOP_2 :
				     SET_UART_FORMAT_STOP_1;

	/* Set Parity bit3-4 01:Odd 11:Even */
	if (cflag & PARENB) {
		buf[1] |= (cflag & PARODD) ?
		SET_UART_FORMAT_PAR_ODD : SET_UART_FORMAT_PAR_EVEN ;
	} else
		buf[1] |= SET_UART_FORMAT_PAR_NONE;

	uartdata = buf[0] | buf[1]<<8;

	i = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
			    SET_UART_FORMAT_TYPE, SET_UART_FORMAT,
			    uartdata, 0, NULL, 0, 100);
	if (i < 0)
		dev_err(&port->dev, "Set UART format %#x failed (error = %d)\n",
			uartdata, i);
	dev_dbg(&port->dev, "0x21:0x40:0:0  %d\n", i);

	if (cflag & CRTSCTS) {
		/* enable hardware flow control */
		spcp8x5_set_workMode(serial->dev, 0x000a,
				     SET_WORKING_MODE_U2C, priv->type);
	}
}

/* open the serial port. do some usb system call. set termios and get the line
 * status of the device. */
static int spcp8x5_open(struct tty_struct *tty, struct usb_serial_port *port)
{
	struct ktermios tmp_termios;
	struct usb_serial *serial = port->serial;
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	int ret;
	unsigned long flags;
	u8 status = 0x30;
	/* status 0x30 means DSR and CTS = 1 other CDC RI and delta = 0 */

	usb_clear_halt(serial->dev, port->write_urb->pipe);
	usb_clear_halt(serial->dev, port->read_urb->pipe);

	ret = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
			      0x09, 0x00,
			      0x01, 0x00, NULL, 0x00, 100);
	if (ret)
		return ret;

	spcp8x5_set_ctrlLine(serial->dev, priv->line_control , priv->type);

	/* Setup termios */
	if (tty)
		spcp8x5_set_termios(tty, port, &tmp_termios);

	spcp8x5_get_msr(serial->dev, &status, priv->type);

	/* may be we should update uart status here but now we did not do */
	spin_lock_irqsave(&priv->lock, flags);
	priv->line_status = status & 0xf0 ;
	spin_unlock_irqrestore(&priv->lock, flags);

	port->port.drain_delay = 256;

	return usb_serial_generic_open(tty, port);
}

static void spcp8x5_process_read_urb(struct urb *urb)
{
	struct usb_serial_port *port = urb->context;
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
	unsigned long flags;
	u8 status;
	char tty_flag;

	/* get tty_flag from status */
	tty_flag = TTY_NORMAL;

	spin_lock_irqsave(&priv->lock, flags);
	status = priv->line_status;
	priv->line_status &= ~UART_STATE_TRANSIENT_MASK;
	spin_unlock_irqrestore(&priv->lock, flags);
	/* wake up the wait for termios */
	wake_up_interruptible(&priv->delta_msr_wait);

	if (!urb->actual_length)
		return;

	tty = tty_port_tty_get(&port->port);
	if (!tty)
		return;

	if (status & UART_STATE_TRANSIENT_MASK) {
		/* break takes precedence over parity, which takes precedence
		 * over framing errors */
		if (status & UART_BREAK_ERROR)
			tty_flag = TTY_BREAK;
		else if (status & UART_PARITY_ERROR)
			tty_flag = TTY_PARITY;
		else if (status & UART_FRAME_ERROR)
			tty_flag = TTY_FRAME;
		dev_dbg(&port->dev, "tty_flag = %d\n", tty_flag);

		/* overrun is special, not associated with a char */
		if (status & UART_OVERRUN_ERROR)
			tty_insert_flip_char(&port->port, 0, TTY_OVERRUN);

		if (status & UART_DCD)
			usb_serial_handle_dcd_change(port, tty,
				   priv->line_status & MSR_STATUS_LINE_DCD);
	}

	tty_insert_flip_string_fixed_flag(&port->port, data, tty_flag,
							urb->actual_length);
	tty_flip_buffer_push(tty);
	tty_kref_put(tty);
}

static int spcp8x5_wait_modem_info(struct usb_serial_port *port,
				   unsigned int arg)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	unsigned long flags;
	unsigned int prevstatus;
	unsigned int status;
	unsigned int changed;

	spin_lock_irqsave(&priv->lock, flags);
	prevstatus = priv->line_status;
	spin_unlock_irqrestore(&priv->lock, flags);

	while (1) {
		/* wake up in bulk read */
		interruptible_sleep_on(&priv->delta_msr_wait);

		/* see if a signal did it */
		if (signal_pending(current))
			return -ERESTARTSYS;

		spin_lock_irqsave(&priv->lock, flags);
		status = priv->line_status;
		spin_unlock_irqrestore(&priv->lock, flags);

		changed = prevstatus^status;

		if (((arg & TIOCM_RNG) && (changed & MSR_STATUS_LINE_RI)) ||
		    ((arg & TIOCM_DSR) && (changed & MSR_STATUS_LINE_DSR)) ||
		    ((arg & TIOCM_CD)  && (changed & MSR_STATUS_LINE_DCD)) ||
		    ((arg & TIOCM_CTS) && (changed & MSR_STATUS_LINE_CTS)))
			return 0;

		prevstatus = status;
	}
	/* NOTREACHED */
	return 0;
}

static int spcp8x5_ioctl(struct tty_struct *tty,
			 unsigned int cmd, unsigned long arg)
{
	struct usb_serial_port *port = tty->driver_data;

	dev_dbg(&port->dev, "%s (%d) cmd = 0x%04x\n", __func__,
		port->number, cmd);

	switch (cmd) {
	case TIOCMIWAIT:
		dev_dbg(&port->dev, "%s (%d) TIOCMIWAIT\n", __func__,
			port->number);
		return spcp8x5_wait_modem_info(port, arg);

	default:
		dev_dbg(&port->dev, "%s not supported = 0x%04x", __func__,
			cmd);
		break;
	}

	return -ENOIOCTLCMD;
}

static int spcp8x5_tiocmset(struct tty_struct *tty,
			    unsigned int set, unsigned int clear)
{
	struct usb_serial_port *port = tty->driver_data;
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	unsigned long flags;
	u8 control;

	spin_lock_irqsave(&priv->lock, flags);
	if (set & TIOCM_RTS)
		priv->line_control |= MCR_RTS;
	if (set & TIOCM_DTR)
		priv->line_control |= MCR_DTR;
	if (clear & TIOCM_RTS)
		priv->line_control &= ~MCR_RTS;
	if (clear & TIOCM_DTR)
		priv->line_control &= ~MCR_DTR;
	control = priv->line_control;
	spin_unlock_irqrestore(&priv->lock, flags);

	return spcp8x5_set_ctrlLine(port->serial->dev, control , priv->type);
}

static int spcp8x5_tiocmget(struct tty_struct *tty)
{
	struct usb_serial_port *port = tty->driver_data;
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	unsigned long flags;
	unsigned int mcr;
	unsigned int status;
	unsigned int result;

	spin_lock_irqsave(&priv->lock, flags);
	mcr = priv->line_control;
	status = priv->line_status;
	spin_unlock_irqrestore(&priv->lock, flags);

	result = ((mcr & MCR_DTR)			? TIOCM_DTR : 0)
		  | ((mcr & MCR_RTS)			? TIOCM_RTS : 0)
		  | ((status & MSR_STATUS_LINE_CTS)	? TIOCM_CTS : 0)
		  | ((status & MSR_STATUS_LINE_DSR)	? TIOCM_DSR : 0)
		  | ((status & MSR_STATUS_LINE_RI)	? TIOCM_RI  : 0)
		  | ((status & MSR_STATUS_LINE_DCD)	? TIOCM_CD  : 0);

	return result;
}

/* All of the device info needed for the spcp8x5 SIO serial converter */
static struct usb_serial_driver spcp8x5_device = {
	.driver = {
		.owner =	THIS_MODULE,
		.name =		"SPCP8x5",
	},
	.id_table		= id_table,
	.num_ports		= 1,
	.open 			= spcp8x5_open,
	.dtr_rts		= spcp8x5_dtr_rts,
	.carrier_raised		= spcp8x5_carrier_raised,
	.set_termios 		= spcp8x5_set_termios,
	.init_termios		= spcp8x5_init_termios,
	.ioctl 			= spcp8x5_ioctl,
	.tiocmget 		= spcp8x5_tiocmget,
	.tiocmset 		= spcp8x5_tiocmset,
	.port_probe		= spcp8x5_port_probe,
	.port_remove		= spcp8x5_port_remove,
	.process_read_urb	= spcp8x5_process_read_urb,
};

static struct usb_serial_driver * const serial_drivers[] = {
	&spcp8x5_device, NULL
};

module_usb_serial_driver(serial_drivers, id_table);

MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");
Commit	Line	Data
619a6f1d GKH	1	/*
	2	* spcp8x5 USB to serial adaptor driver
	3	*
fa993ca8	4	* Copyright (C) 2010 Johan Hovold (jhovold@gmail.com)
619a6f1d GKH	5	* Copyright (C) 2006 Linxb (xubin.lin@worldplus.com.cn)
	6	* Copyright (C) 2006 S1 Corp.
	7	*
	8	* Original driver for 2.6.10 pl2303 driver by
	9	* Greg Kroah-Hartman (greg@kroah.com)
	10	* Changes for 2.6.20 by Harald Klein <hari@vt100.at>
	11	*
	12	* This program is free software; you can redistribute it and/or modify
	13	* it under the terms of the GNU General Public License as published by
	14	* the Free Software Foundation; either version 2 of the License, or
	15	* (at your option) any later version.
	16	*
	17	*
	18	*/
	19	#include <linux/kernel.h>
	20	#include <linux/errno.h>
	21	#include <linux/init.h>
	22	#include <linux/slab.h>
	23	#include <linux/tty.h>
	24	#include <linux/tty_driver.h>
	25	#include <linux/tty_flip.h>
	26	#include <linux/module.h>
	27	#include <linux/spinlock.h>
	28	#include <linux/usb.h>
	29	#include <linux/usb/serial.h>
	30
619a6f1d GKH	31	#define DRIVER_DESC "SPCP8x5 USB to serial adaptor driver"
619a6f1d GKH	32
619a6f1d GKH	33	#define SPCP8x5_007_VID 0x04FC
	34	#define SPCP8x5_007_PID 0x0201
	35	#define SPCP8x5_008_VID 0x04fc
	36	#define SPCP8x5_008_PID 0x0235
	37	#define SPCP8x5_PHILIPS_VID 0x0471
	38	#define SPCP8x5_PHILIPS_PID 0x081e
	39	#define SPCP8x5_INTERMATIC_VID 0x04FC
	40	#define SPCP8x5_INTERMATIC_PID 0x0204
	41	#define SPCP8x5_835_VID 0x04fc
	42	#define SPCP8x5_835_PID 0x0231
	43
7d40d7e8	44	static const struct usb_device_id id_table[] = {
619a6f1d GKH	45	{ USB_DEVICE(SPCP8x5_PHILIPS_VID , SPCP8x5_PHILIPS_PID)},
	46	{ USB_DEVICE(SPCP8x5_INTERMATIC_VID, SPCP8x5_INTERMATIC_PID)},
	47	{ USB_DEVICE(SPCP8x5_835_VID, SPCP8x5_835_PID)},
	48	{ USB_DEVICE(SPCP8x5_008_VID, SPCP8x5_008_PID)},
	49	{ USB_DEVICE(SPCP8x5_007_VID, SPCP8x5_007_PID)},
	50	{ } /* Terminating entry */
	51	};
	52	MODULE_DEVICE_TABLE(usb, id_table);
	53
	54	struct spcp8x5_usb_ctrl_arg {
	55	u8 type;
	56	u8 cmd;
	57	u8 cmd_type;
	58	u16 value;
	59	u16 index;
	60	u16 length;
	61	};
	62
619a6f1d GKH	63
	64	/* spcp8x5 spec register define */
	65	#define MCR_CONTROL_LINE_RTS 0x02
	66	#define MCR_CONTROL_LINE_DTR 0x01
	67	#define MCR_DTR 0x01
	68	#define MCR_RTS 0x02
	69
	70	#define MSR_STATUS_LINE_DCD 0x80
	71	#define MSR_STATUS_LINE_RI 0x40
	72	#define MSR_STATUS_LINE_DSR 0x20
	73	#define MSR_STATUS_LINE_CTS 0x10
	74
	75	/* verdor command here , we should define myself */
	76	#define SET_DEFAULT 0x40
	77	#define SET_DEFAULT_TYPE 0x20
	78
	79	#define SET_UART_FORMAT 0x40
	80	#define SET_UART_FORMAT_TYPE 0x21
	81	#define SET_UART_FORMAT_SIZE_5 0x00
	82	#define SET_UART_FORMAT_SIZE_6 0x01
	83	#define SET_UART_FORMAT_SIZE_7 0x02
	84	#define SET_UART_FORMAT_SIZE_8 0x03
	85	#define SET_UART_FORMAT_STOP_1 0x00
	86	#define SET_UART_FORMAT_STOP_2 0x04
	87	#define SET_UART_FORMAT_PAR_NONE 0x00
	88	#define SET_UART_FORMAT_PAR_ODD 0x10
	89	#define SET_UART_FORMAT_PAR_EVEN 0x30
	90	#define SET_UART_FORMAT_PAR_MASK 0xD0
	91	#define SET_UART_FORMAT_PAR_SPACE 0x90
	92
	93	#define GET_UART_STATUS_TYPE 0xc0
	94	#define GET_UART_STATUS 0x22
	95	#define GET_UART_STATUS_MSR 0x06
	96
	97	#define SET_UART_STATUS 0x40
	98	#define SET_UART_STATUS_TYPE 0x23
	99	#define SET_UART_STATUS_MCR 0x0004
	100	#define SET_UART_STATUS_MCR_DTR 0x01
	101	#define SET_UART_STATUS_MCR_RTS 0x02
	102	#define SET_UART_STATUS_MCR_LOOP 0x10
	103
	104	#define SET_WORKING_MODE 0x40
	105	#define SET_WORKING_MODE_TYPE 0x24
	106	#define SET_WORKING_MODE_U2C 0x00
	107	#define SET_WORKING_MODE_RS485 0x01
	108	#define SET_WORKING_MODE_PDMA 0x02
	109	#define SET_WORKING_MODE_SPP 0x03
	110
	111	#define SET_FLOWCTL_CHAR 0x40
	112	#define SET_FLOWCTL_CHAR_TYPE 0x25
	113
	114	#define GET_VERSION 0xc0
	115	#define GET_VERSION_TYPE 0x26
	116
	117	#define SET_REGISTER 0x40
	118	#define SET_REGISTER_TYPE 0x27
	119
	120	#define GET_REGISTER 0xc0
	121	#define GET_REGISTER_TYPE 0x28
	122
	123	#define SET_RAM 0x40
	124	#define SET_RAM_TYPE 0x31
	125
	126	#define GET_RAM 0xc0
127	#define GET_RAM_TYPE 0x32
128
129	/* how come ??? */
130	#define UART_STATE 0x08
d14fc1a7	131	#define UART_STATE_TRANSIENT_MASK 0x75
619a6f1d GKH	132	#define UART_DCD 0x01
	133	#define UART_DSR 0x02
	134	#define UART_BREAK_ERROR 0x04
	135	#define UART_RING 0x08
	136	#define UART_FRAME_ERROR 0x10
	137	#define UART_PARITY_ERROR 0x20
	138	#define UART_OVERRUN_ERROR 0x40
	139	#define UART_CTS 0x80
	140
	141	enum spcp8x5_type {
	142	SPCP825_007_TYPE,
	143	SPCP825_008_TYPE,
	144	SPCP825_PHILIP_TYPE,
	145	SPCP825_INTERMATIC_TYPE,
	146	SPCP835_TYPE,
	147	};
	148
619a6f1d GKH	149	struct spcp8x5_private {
619a6f1d GKH	150	spinlock_t lock;
619a6f1d GKH	151	enum spcp8x5_type type;
	152	wait_queue_head_t delta_msr_wait;
	153	u8 line_control;
	154	u8 line_status;
619a6f1d GKH	155	};
619a6f1d GKH	156
bf90ff5f	157	static int spcp8x5_port_probe(struct usb_serial_port *port)
619a6f1d	158	{
bf90ff5f	159	struct usb_serial *serial = port->serial;
619a6f1d	160	struct spcp8x5_private *priv;
619a6f1d	161	enum spcp8x5_type type = SPCP825_007_TYPE;
fd05e720	162	u16 product = le16_to_cpu(serial->dev->descriptor.idProduct);
619a6f1d	163
fd05e720	164	if (product == 0x0201)
619a6f1d	165	type = SPCP825_007_TYPE;
fd05e720	166	else if (product == 0x0231)
619a6f1d	167	type = SPCP835_TYPE;
fd05e720	168	else if (product == 0x0235)
619a6f1d	169	type = SPCP825_008_TYPE;
fd05e720	170	else if (product == 0x0204)
619a6f1d	171	type = SPCP825_INTERMATIC_TYPE;
fd05e720 AV	172	else if (product == 0x0471 &&
fd05e720 AV	173	serial->dev->descriptor.idVendor == cpu_to_le16(0x081e))
619a6f1d GKH	174	type = SPCP825_PHILIP_TYPE;
	175	dev_dbg(&serial->dev->dev, "device type = %d\n", (int)type);
	176
bf90ff5f JH	177	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	178	if (!priv)
	179	return -ENOMEM;
619a6f1d	180
bf90ff5f JH	181	spin_lock_init(&priv->lock);
	182	init_waitqueue_head(&priv->delta_msr_wait);
	183	priv->type = type;
	184
	185	usb_set_serial_port_data(port , priv);
619a6f1d GKH	186
619a6f1d GKH	187	return 0;
619a6f1d GKH	188	}
619a6f1d GKH	189
bf90ff5f	190	static int spcp8x5_port_remove(struct usb_serial_port *port)
619a6f1d	191	{
bf90ff5f	192	struct spcp8x5_private *priv;
619a6f1d	193
bf90ff5f JH	194	priv = usb_get_serial_port_data(port);
	195	kfree(priv);
	196
	197	return 0;
619a6f1d GKH	198	}
	199
	200	/* set the modem control line of the device.
	201	* NOTE spcp825-007 not supported this */
	202	static int spcp8x5_set_ctrlLine(struct usb_device *dev, u8 value,
	203	enum spcp8x5_type type)
	204	{
	205	int retval;
	206	u8 mcr = 0 ;
	207
	208	if (type == SPCP825_007_TYPE)
	209	return -EPERM;
	210
	211	mcr = (unsigned short)value;
	212	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
	213	SET_UART_STATUS_TYPE, SET_UART_STATUS,
	214	mcr, 0x04, NULL, 0, 100);
	215	if (retval != 0)
	216	dev_dbg(&dev->dev, "usb_control_msg return %#x\n", retval);
	217	return retval;
	218	}
	219
	220	/* get the modem status register of the device
	221	* NOTE spcp825-007 not supported this */
	222	static int spcp8x5_get_msr(struct usb_device dev, u8 status,
	223	enum spcp8x5_type type)
	224	{
	225	u8 *status_buffer;
	226	int ret;
	227
	228	/* I return Permited not support here but seem inval device
	229	* is more fix */
	230	if (type == SPCP825_007_TYPE)
	231	return -EPERM;
	232	if (status == NULL)
	233	return -EINVAL;
	234
	235	status_buffer = kmalloc(1, GFP_KERNEL);
	236	if (!status_buffer)
	237	return -ENOMEM;
	238	status_buffer[0] = status[0];
	239
	240	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
	241	GET_UART_STATUS, GET_UART_STATUS_TYPE,
	242	0, GET_UART_STATUS_MSR, status_buffer, 1, 100);
	243	if (ret < 0)
	244	dev_dbg(&dev->dev, "Get MSR = 0x%p failed (error = %d)",
	245	status_buffer, ret);
	246
	247	dev_dbg(&dev->dev, "0xc0:0x22:0:6 %d - 0x%p ", ret, status_buffer);
	248	status[0] = status_buffer[0];
	249	kfree(status_buffer);
	250
	251	return ret;
	252	}
	253
	254	/* select the work mode.
	255	* NOTE this function not supported by spcp825-007 */
	256	static void spcp8x5_set_workMode(struct usb_device *dev, u16 value,
	257	u16 index, enum spcp8x5_type type)
	258	{
	259	int ret;
	260
	261	/* I return Permited not support here but seem inval device
262	* is more fix */
263	if (type == SPCP825_007_TYPE)
264	return;
265
266	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
267	SET_WORKING_MODE_TYPE, SET_WORKING_MODE,
268	value, index, NULL, 0, 100);
269	dev_dbg(&dev->dev, "value = %#x , index = %#x\n", value, index);
270	if (ret < 0)
271	dev_dbg(&dev->dev,
272	"RTSCTS usb_control_msg(enable flowctrl) = %d\n", ret);
273	}
274
335f8514 AC	275	static int spcp8x5_carrier_raised(struct usb_serial_port *port)
	276	{
	277	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	278	if (priv->line_status & MSR_STATUS_LINE_DCD)
	279	return 1;
	280	return 0;
	281	}
	282
	283	static void spcp8x5_dtr_rts(struct usb_serial_port *port, int on)
	284	{
	285	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	286	unsigned long flags;
	287	u8 control;
	288
	289	spin_lock_irqsave(&priv->lock, flags);
	290	if (on)
	291	priv->line_control = MCR_CONTROL_LINE_DTR
	292	\| MCR_CONTROL_LINE_RTS;
	293	else
	294	priv->line_control &= ~ (MCR_CONTROL_LINE_DTR
	295	\| MCR_CONTROL_LINE_RTS);
	296	control = priv->line_control;
	297	spin_unlock_irqrestore(&priv->lock, flags);
	298	spcp8x5_set_ctrlLine(port->serial->dev, control , priv->type);
	299	}
	300
fe1ae7fd AC	301	static void spcp8x5_init_termios(struct tty_struct *tty)
	302	{
	303	/* for the 1st time call this function */
adc8d746 AC	304	tty->termios = tty_std_termios;
	305	tty->termios.c_cflag = B115200 \| CS8 \| CREAD \| HUPCL \| CLOCAL;
	306	tty->termios.c_ispeed = 115200;
	307	tty->termios.c_ospeed = 115200;
fe1ae7fd AC	308	}
fe1ae7fd AC	309
619a6f1d	310	/* set the serial param for transfer. we should check if we really need to
95da310e AC	311	* transfer. if we set flow control we should do this too. */
	312	static void spcp8x5_set_termios(struct tty_struct *tty,
	313	struct usb_serial_port port, struct ktermios old_termios)
619a6f1d GKH	314	{
	315	struct usb_serial *serial = port->serial;
	316	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	317	unsigned long flags;
adc8d746	318	unsigned int cflag = tty->termios.c_cflag;
619a6f1d GKH	319	unsigned int old_cflag = old_termios->c_cflag;
	320	unsigned short uartdata;
	321	unsigned char buf[2] = {0, 0};
	322	int baud;
	323	int i;
	324	u8 control;
	325
619a6f1d GKH	326
619a6f1d GKH	327	/* check that they really want us to change something */
adc8d746	328	if (!tty_termios_hw_change(&tty->termios, old_termios))
619a6f1d GKH	329	return;
	330
	331	/* set DTR/RTS active */
	332	spin_lock_irqsave(&priv->lock, flags);
	333	control = priv->line_control;
	334	if ((old_cflag & CBAUD) == B0) {
	335	priv->line_control \|= MCR_DTR;
	336	if (!(old_cflag & CRTSCTS))
	337	priv->line_control \|= MCR_RTS;
	338	}
	339	if (control != priv->line_control) {
	340	control = priv->line_control;
	341	spin_unlock_irqrestore(&priv->lock, flags);
	342	spcp8x5_set_ctrlLine(serial->dev, control , priv->type);
	343	} else {
	344	spin_unlock_irqrestore(&priv->lock, flags);
	345	}
	346
	347	/* Set Baud Rate */
a419aef8	348	baud = tty_get_baud_rate(tty);
619a6f1d GKH	349	switch (baud) {
	350	case 300: buf[0] = 0x00; break;
	351	case 600: buf[0] = 0x01; break;
	352	case 1200: buf[0] = 0x02; break;
	353	case 2400: buf[0] = 0x03; break;
	354	case 4800: buf[0] = 0x04; break;
	355	case 9600: buf[0] = 0x05; break;
	356	case 19200: buf[0] = 0x07; break;
	357	case 38400: buf[0] = 0x09; break;
	358	case 57600: buf[0] = 0x0a; break;
	359	case 115200: buf[0] = 0x0b; break;
	360	case 230400: buf[0] = 0x0c; break;
	361	case 460800: buf[0] = 0x0d; break;
	362	case 921600: buf[0] = 0x0e; break;
	363	/* case 1200000: buf[0] = 0x0f; break; */
	364	/* case 2400000: buf[0] = 0x10; break; */
	365	case 3000000: buf[0] = 0x11; break;
	366	/* case 6000000: buf[0] = 0x12; break; */
	367	case 0:
	368	case 1000000:
	369	buf[0] = 0x0b; break;
	370	default:
194343d9 GKH	371	dev_err(&port->dev, "spcp825 driver does not support the "
194343d9 GKH	372	"baudrate requested, using default of 9600.\n");
619a6f1d GKH	373	}
	374
	375	/* Set Data Length : 00:5bit, 01:6bit, 10:7bit, 11:8bit */
	376	if (cflag & CSIZE) {
	377	switch (cflag & CSIZE) {
	378	case CS5:
	379	buf[1] \|= SET_UART_FORMAT_SIZE_5;
	380	break;
	381	case CS6:
	382	buf[1] \|= SET_UART_FORMAT_SIZE_6;
	383	break;
	384	case CS7:
	385	buf[1] \|= SET_UART_FORMAT_SIZE_7;
	386	break;
	387	default:
	388	case CS8:
	389	buf[1] \|= SET_UART_FORMAT_SIZE_8;
	390	break;
	391	}
	392	}
	393
	394	/* Set Stop bit2 : 0:1bit 1:2bit */
	395	buf[1] \|= (cflag & CSTOPB) ? SET_UART_FORMAT_STOP_2 :
	396	SET_UART_FORMAT_STOP_1;
	397
	398	/* Set Parity bit3-4 01:Odd 11:Even */
	399	if (cflag & PARENB) {
	400	buf[1] \|= (cflag & PARODD) ?
	401	SET_UART_FORMAT_PAR_ODD : SET_UART_FORMAT_PAR_EVEN ;
	402	} else
	403	buf[1] \|= SET_UART_FORMAT_PAR_NONE;
	404
	405	uartdata = buf[0] \| buf[1]<<8;
	406
	407	i = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
	408	SET_UART_FORMAT_TYPE, SET_UART_FORMAT,
	409	uartdata, 0, NULL, 0, 100);
	410	if (i < 0)
194343d9 GKH	411	dev_err(&port->dev, "Set UART format %#x failed (error = %d)\n",
194343d9 GKH	412	uartdata, i);
fe2baf87	413	dev_dbg(&port->dev, "0x21:0x40:0:0 %d\n", i);
619a6f1d GKH	414
	415	if (cflag & CRTSCTS) {
	416	/* enable hardware flow control */
	417	spcp8x5_set_workMode(serial->dev, 0x000a,
	418	SET_WORKING_MODE_U2C, priv->type);
	419	}
619a6f1d GKH	420	}
	421
	422	/* open the serial port. do some usb system call. set termios and get the line
fa993ca8	423	* status of the device. */
a509a7e4	424	static int spcp8x5_open(struct tty_struct tty, struct usb_serial_port port)
619a6f1d GKH	425	{
	426	struct ktermios tmp_termios;
	427	struct usb_serial *serial = port->serial;
	428	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	429	int ret;
	430	unsigned long flags;
	431	u8 status = 0x30;
	432	/* status 0x30 means DSR and CTS = 1 other CDC RI and delta = 0 */
	433
619a6f1d GKH	434	usb_clear_halt(serial->dev, port->write_urb->pipe);
	435	usb_clear_halt(serial->dev, port->read_urb->pipe);
	436
	437	ret = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
	438	0x09, 0x00,
	439	0x01, 0x00, NULL, 0x00, 100);
	440	if (ret)
	441	return ret;
	442
619a6f1d GKH	443	spcp8x5_set_ctrlLine(serial->dev, priv->line_control , priv->type);
	444
	445	/* Setup termios */
95da310e AC	446	if (tty)
95da310e AC	447	spcp8x5_set_termios(tty, port, &tmp_termios);
619a6f1d GKH	448
	449	spcp8x5_get_msr(serial->dev, &status, priv->type);
	450
	451	/* may be we should update uart status here but now we did not do */
	452	spin_lock_irqsave(&priv->lock, flags);
	453	priv->line_status = status & 0xf0 ;
	454	spin_unlock_irqrestore(&priv->lock, flags);
	455
335f8514	456	port->port.drain_delay = 256;
fa993ca8 JH	457
fa993ca8 JH	458	return usb_serial_generic_open(tty, port);
619a6f1d GKH	459	}
619a6f1d GKH	460
fa993ca8	461	static void spcp8x5_process_read_urb(struct urb *urb)
619a6f1d GKH	462	{
	463	struct usb_serial_port *port = urb->context;
	464	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	465	struct tty_struct *tty;
	466	unsigned char *data = urb->transfer_buffer;
	467	unsigned long flags;
50de36f7	468	u8 status;
619a6f1d GKH	469	char tty_flag;
619a6f1d GKH	470
619a6f1d GKH	471	/* get tty_flag from status */
	472	tty_flag = TTY_NORMAL;
	473
	474	spin_lock_irqsave(&priv->lock, flags);
	475	status = priv->line_status;
	476	priv->line_status &= ~UART_STATE_TRANSIENT_MASK;
	477	spin_unlock_irqrestore(&priv->lock, flags);
	478	/* wake up the wait for termios */
	479	wake_up_interruptible(&priv->delta_msr_wait);
	480
fa993ca8	481	if (!urb->actual_length)
619a6f1d	482	return;
619a6f1d	483
fa993ca8 JH	484	tty = tty_port_tty_get(&port->port);
fa993ca8 JH	485	if (!tty)
619a6f1d	486	return;
619a6f1d	487
fa993ca8 JH	488	if (status & UART_STATE_TRANSIENT_MASK) {
	489	/* break takes precedence over parity, which takes precedence
	490	* over framing errors */
	491	if (status & UART_BREAK_ERROR)
	492	tty_flag = TTY_BREAK;
	493	else if (status & UART_PARITY_ERROR)
	494	tty_flag = TTY_PARITY;
	495	else if (status & UART_FRAME_ERROR)
	496	tty_flag = TTY_FRAME;
	497	dev_dbg(&port->dev, "tty_flag = %d\n", tty_flag);
619a6f1d	498
fa993ca8 JH	499	/* overrun is special, not associated with a char */
fa993ca8 JH	500	if (status & UART_OVERRUN_ERROR)
92a19f9c	501	tty_insert_flip_char(&port->port, 0, TTY_OVERRUN);
d14fc1a7 LP	502
	503	if (status & UART_DCD)
	504	usb_serial_handle_dcd_change(port, tty,
	505	priv->line_status & MSR_STATUS_LINE_DCD);
619a6f1d GKH	506	}
619a6f1d GKH	507
2f693357	508	tty_insert_flip_string_fixed_flag(&port->port, data, tty_flag,
fa993ca8 JH	509	urb->actual_length);
	510	tty_flip_buffer_push(tty);
	511	tty_kref_put(tty);
619a6f1d GKH	512	}
	513
	514	static int spcp8x5_wait_modem_info(struct usb_serial_port *port,
	515	unsigned int arg)
	516	{
	517	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	518	unsigned long flags;
	519	unsigned int prevstatus;
	520	unsigned int status;
	521	unsigned int changed;
	522
	523	spin_lock_irqsave(&priv->lock, flags);
	524	prevstatus = priv->line_status;
	525	spin_unlock_irqrestore(&priv->lock, flags);
	526
	527	while (1) {
	528	/* wake up in bulk read */
	529	interruptible_sleep_on(&priv->delta_msr_wait);
	530
	531	/* see if a signal did it */
	532	if (signal_pending(current))
	533	return -ERESTARTSYS;
	534
	535	spin_lock_irqsave(&priv->lock, flags);
	536	status = priv->line_status;
	537	spin_unlock_irqrestore(&priv->lock, flags);
	538
	539	changed = prevstatus^status;
	540
	541	if (((arg & TIOCM_RNG) && (changed & MSR_STATUS_LINE_RI)) \|\|
	542	((arg & TIOCM_DSR) && (changed & MSR_STATUS_LINE_DSR)) \|\|
	543	((arg & TIOCM_CD) && (changed & MSR_STATUS_LINE_DCD)) \|\|
	544	((arg & TIOCM_CTS) && (changed & MSR_STATUS_LINE_CTS)))
	545	return 0;
	546
	547	prevstatus = status;
	548	}
	549	/* NOTREACHED */
	550	return 0;
	551	}
	552
00a0d0d6	553	static int spcp8x5_ioctl(struct tty_struct *tty,
619a6f1d GKH	554	unsigned int cmd, unsigned long arg)
619a6f1d GKH	555	{
95da310e	556	struct usb_serial_port *port = tty->driver_data;
fe2baf87 GKH	557
	558	dev_dbg(&port->dev, "%s (%d) cmd = 0x%04x\n", __func__,
	559	port->number, cmd);
619a6f1d GKH	560
	561	switch (cmd) {
	562	case TIOCMIWAIT:
fe2baf87 GKH	563	dev_dbg(&port->dev, "%s (%d) TIOCMIWAIT\n", __func__,
fe2baf87 GKH	564	port->number);
619a6f1d GKH	565	return spcp8x5_wait_modem_info(port, arg);
	566
	567	default:
fe2baf87 GKH	568	dev_dbg(&port->dev, "%s not supported = 0x%04x", __func__,
fe2baf87 GKH	569	cmd);
619a6f1d GKH	570	break;
	571	}
	572
	573	return -ENOIOCTLCMD;
	574	}
	575
20b9d177	576	static int spcp8x5_tiocmset(struct tty_struct *tty,
619a6f1d GKH	577	unsigned int set, unsigned int clear)
619a6f1d GKH	578	{
95da310e	579	struct usb_serial_port *port = tty->driver_data;
619a6f1d GKH	580	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	581	unsigned long flags;
	582	u8 control;
	583
	584	spin_lock_irqsave(&priv->lock, flags);
	585	if (set & TIOCM_RTS)
	586	priv->line_control \|= MCR_RTS;
	587	if (set & TIOCM_DTR)
	588	priv->line_control \|= MCR_DTR;
	589	if (clear & TIOCM_RTS)
	590	priv->line_control &= ~MCR_RTS;
	591	if (clear & TIOCM_DTR)
	592	priv->line_control &= ~MCR_DTR;
	593	control = priv->line_control;
	594	spin_unlock_irqrestore(&priv->lock, flags);
	595
	596	return spcp8x5_set_ctrlLine(port->serial->dev, control , priv->type);
	597	}
	598
60b33c13	599	static int spcp8x5_tiocmget(struct tty_struct *tty)
619a6f1d	600	{
95da310e	601	struct usb_serial_port *port = tty->driver_data;
619a6f1d GKH	602	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	603	unsigned long flags;
	604	unsigned int mcr;
	605	unsigned int status;
	606	unsigned int result;
	607
	608	spin_lock_irqsave(&priv->lock, flags);
	609	mcr = priv->line_control;
	610	status = priv->line_status;
	611	spin_unlock_irqrestore(&priv->lock, flags);
	612
	613	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
	614	\| ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
	615	\| ((status & MSR_STATUS_LINE_CTS) ? TIOCM_CTS : 0)
	616	\| ((status & MSR_STATUS_LINE_DSR) ? TIOCM_DSR : 0)
	617	\| ((status & MSR_STATUS_LINE_RI) ? TIOCM_RI : 0)
	618	\| ((status & MSR_STATUS_LINE_DCD) ? TIOCM_CD : 0);
	619
	620	return result;
	621	}
	622
619a6f1d GKH	623	/* All of the device info needed for the spcp8x5 SIO serial converter */
	624	static struct usb_serial_driver spcp8x5_device = {
	625	.driver = {
	626	.owner = THIS_MODULE,
	627	.name = "SPCP8x5",
	628	},
	629	.id_table = id_table,
619a6f1d GKH	630	.num_ports = 1,
619a6f1d GKH	631	.open = spcp8x5_open,
335f8514 AC	632	.dtr_rts = spcp8x5_dtr_rts,
335f8514 AC	633	.carrier_raised = spcp8x5_carrier_raised,
619a6f1d	634	.set_termios = spcp8x5_set_termios,
fe1ae7fd	635	.init_termios = spcp8x5_init_termios,
619a6f1d GKH	636	.ioctl = spcp8x5_ioctl,
	637	.tiocmget = spcp8x5_tiocmget,
	638	.tiocmset = spcp8x5_tiocmset,
bf90ff5f JH	639	.port_probe = spcp8x5_port_probe,
bf90ff5f JH	640	.port_remove = spcp8x5_port_remove,
fa993ca8	641	.process_read_urb = spcp8x5_process_read_urb,
619a6f1d GKH	642	};
619a6f1d GKH	643
d860322f AS	644	static struct usb_serial_driver * const serial_drivers[] = {
	645	&spcp8x5_device, NULL
	646	};
	647
68e24113	648	module_usb_serial_driver(serial_drivers, id_table);
619a6f1d GKH	649
619a6f1d GKH	650	MODULE_DESCRIPTION(DRIVER_DESC);
619a6f1d	651	MODULE_LICENSE("GPL");