[deliverable/linux.git] / drivers / usb / serial / spcp8x5.c

/*
 * spcp8x5 USB to serial adaptor driver
 *
 * Copyright (C) 2010-2013 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 SPCP825_QUIRK_NO_UART_STATUS	0x01
#define SPCP825_QUIRK_NO_WORK_MODE	0x02

#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),
	  .driver_info = SPCP825_QUIRK_NO_UART_STATUS |
				SPCP825_QUIRK_NO_WORK_MODE },
	{ }					/* 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

struct spcp8x5_private {
	unsigned		quirks;
	spinlock_t		lock;
	u8			line_control;
};

static int spcp8x5_probe(struct usb_serial *serial,
						const struct usb_device_id *id)
{
	usb_set_serial_data(serial, (void *)id);

	return 0;
}

static int spcp8x5_port_probe(struct usb_serial_port *port)
{
	const struct usb_device_id *id = usb_get_serial_data(port->serial);
	struct spcp8x5_private *priv;

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

	spin_lock_init(&priv->lock);
	priv->quirks = id->driver_info;

	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;
}

static int spcp8x5_set_ctrl_line(struct usb_serial_port *port, u8 mcr)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	struct usb_device *dev = port->serial->dev;
	int retval;

	if (priv->quirks & SPCP825_QUIRK_NO_UART_STATUS)
		return -EPERM;

	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_err(&port->dev, "failed to set control lines: %d\n",
								retval);
	}
	return retval;
}

static int spcp8x5_get_msr(struct usb_serial_port *port, u8 *status)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	struct usb_device *dev = port->serial->dev;
	u8 *buf;
	int ret;

	if (priv->quirks & SPCP825_QUIRK_NO_UART_STATUS)
		return -EPERM;

	buf = kzalloc(1, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;

	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
			      GET_UART_STATUS, GET_UART_STATUS_TYPE,
			      0, GET_UART_STATUS_MSR, buf, 1, 100);
	if (ret < 0)
		dev_err(&port->dev, "failed to get modem status: %d", ret);

	dev_dbg(&port->dev, "0xc0:0x22:0:6  %d - 0x02%x", ret, *buf);
	*status = *buf;
	kfree(buf);

	return ret;
}

static void spcp8x5_set_work_mode(struct usb_serial_port *port, u16 value,
								 u16 index)
{
	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	struct usb_device *dev = port->serial->dev;
	int ret;

	if (priv->quirks & SPCP825_QUIRK_NO_WORK_MODE)
		return;

	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
			      SET_WORKING_MODE_TYPE, SET_WORKING_MODE,
			      value, index, NULL, 0, 100);
	dev_dbg(&port->dev, "value = %#x , index = %#x\n", value, index);
	if (ret < 0)
		dev_err(&port->dev, "failed to set work mode: %d\n", ret);
}

static int spcp8x5_carrier_raised(struct usb_serial_port *port)
{
	u8 msr;
	int ret;

	ret = spcp8x5_get_msr(port, &msr);
	if (ret || msr & 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_ctrl_line(port, control);
}

static void spcp8x5_init_termios(struct tty_struct *tty)
{
	tty->termios = tty_std_termios;
	tty->termios.c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL;
	tty->termios.c_ispeed = 115200;
	tty->termios.c_ospeed = 115200;
}

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_ctrl_line(port, control);
	} 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_work_mode(port, 0x000a, SET_WORKING_MODE_U2C);
	}
}

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;

	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_ctrl_line(port, priv->line_control);

	if (tty)
		spcp8x5_set_termios(tty, port, &tmp_termios);

	port->port.drain_delay = 256;

	return usb_serial_generic_open(tty, port);
}

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_ctrl_line(port, control);
}

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;
	u8 status;
	unsigned int result;

	result = spcp8x5_get_msr(port, &status);
	if (result)
		return result;

	spin_lock_irqsave(&priv->lock, flags);
	mcr = priv->line_control;
	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;
}

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,
	.tiocmget		= spcp8x5_tiocmget,
	.tiocmset		= spcp8x5_tiocmset,
	.probe			= spcp8x5_probe,
	.port_probe		= spcp8x5_port_probe,
	.port_remove		= spcp8x5_port_remove,
};

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	*
e1ed212d	4	* Copyright (C) 2010-2013 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.
619a6f1d GKH	16	*/
	17	#include <linux/kernel.h>
	18	#include <linux/errno.h>
	19	#include <linux/init.h>
	20	#include <linux/slab.h>
	21	#include <linux/tty.h>
	22	#include <linux/tty_driver.h>
	23	#include <linux/tty_flip.h>
	24	#include <linux/module.h>
	25	#include <linux/spinlock.h>
	26	#include <linux/usb.h>
	27	#include <linux/usb/serial.h>
	28
2d816ac6	29	#define DRIVER_DESC "SPCP8x5 USB to serial adaptor driver"
619a6f1d	30
4d63143d JH	31	#define SPCP825_QUIRK_NO_UART_STATUS 0x01
	32	#define SPCP825_QUIRK_NO_WORK_MODE 0x02
	33
619a6f1d GKH	34	#define SPCP8x5_007_VID 0x04FC
	35	#define SPCP8x5_007_PID 0x0201
	36	#define SPCP8x5_008_VID 0x04fc
	37	#define SPCP8x5_008_PID 0x0235
	38	#define SPCP8x5_PHILIPS_VID 0x0471
	39	#define SPCP8x5_PHILIPS_PID 0x081e
	40	#define SPCP8x5_INTERMATIC_VID 0x04FC
	41	#define SPCP8x5_INTERMATIC_PID 0x0204
	42	#define SPCP8x5_835_VID 0x04fc
	43	#define SPCP8x5_835_PID 0x0231
	44
7d40d7e8	45	static const struct usb_device_id id_table[] = {
619a6f1d GKH	46	{ USB_DEVICE(SPCP8x5_PHILIPS_VID , SPCP8x5_PHILIPS_PID)},
	47	{ USB_DEVICE(SPCP8x5_INTERMATIC_VID, SPCP8x5_INTERMATIC_PID)},
	48	{ USB_DEVICE(SPCP8x5_835_VID, SPCP8x5_835_PID)},
	49	{ USB_DEVICE(SPCP8x5_008_VID, SPCP8x5_008_PID)},
4d63143d JH	50	{ USB_DEVICE(SPCP8x5_007_VID, SPCP8x5_007_PID),
	51	.driver_info = SPCP825_QUIRK_NO_UART_STATUS \|
	52	SPCP825_QUIRK_NO_WORK_MODE },
619a6f1d GKH	53	{ } /* Terminating entry */
	54	};
	55	MODULE_DEVICE_TABLE(usb, id_table);
	56
	57	struct spcp8x5_usb_ctrl_arg {
2d816ac6	58	u8 type;
619a6f1d GKH	59	u8 cmd;
	60	u8 cmd_type;
	61	u16 value;
	62	u16 index;
	63	u16 length;
	64	};
	65
619a6f1d GKH	66
	67	/* spcp8x5 spec register define */
	68	#define MCR_CONTROL_LINE_RTS 0x02
	69	#define MCR_CONTROL_LINE_DTR 0x01
	70	#define MCR_DTR 0x01
	71	#define MCR_RTS 0x02
	72
	73	#define MSR_STATUS_LINE_DCD 0x80
	74	#define MSR_STATUS_LINE_RI 0x40
	75	#define MSR_STATUS_LINE_DSR 0x20
	76	#define MSR_STATUS_LINE_CTS 0x10
	77
	78	/* verdor command here , we should define myself */
	79	#define SET_DEFAULT 0x40
	80	#define SET_DEFAULT_TYPE 0x20
	81
	82	#define SET_UART_FORMAT 0x40
	83	#define SET_UART_FORMAT_TYPE 0x21
	84	#define SET_UART_FORMAT_SIZE_5 0x00
	85	#define SET_UART_FORMAT_SIZE_6 0x01
	86	#define SET_UART_FORMAT_SIZE_7 0x02
	87	#define SET_UART_FORMAT_SIZE_8 0x03
	88	#define SET_UART_FORMAT_STOP_1 0x00
	89	#define SET_UART_FORMAT_STOP_2 0x04
	90	#define SET_UART_FORMAT_PAR_NONE 0x00
	91	#define SET_UART_FORMAT_PAR_ODD 0x10
	92	#define SET_UART_FORMAT_PAR_EVEN 0x30
	93	#define SET_UART_FORMAT_PAR_MASK 0xD0
	94	#define SET_UART_FORMAT_PAR_SPACE 0x90
	95
	96	#define GET_UART_STATUS_TYPE 0xc0
	97	#define GET_UART_STATUS 0x22
	98	#define GET_UART_STATUS_MSR 0x06
	99
	100	#define SET_UART_STATUS 0x40
	101	#define SET_UART_STATUS_TYPE 0x23
	102	#define SET_UART_STATUS_MCR 0x0004
	103	#define SET_UART_STATUS_MCR_DTR 0x01
	104	#define SET_UART_STATUS_MCR_RTS 0x02
	105	#define SET_UART_STATUS_MCR_LOOP 0x10
	106
	107	#define SET_WORKING_MODE 0x40
	108	#define SET_WORKING_MODE_TYPE 0x24
	109	#define SET_WORKING_MODE_U2C 0x00
	110	#define SET_WORKING_MODE_RS485 0x01
	111	#define SET_WORKING_MODE_PDMA 0x02
	112	#define SET_WORKING_MODE_SPP 0x03
	113
	114	#define SET_FLOWCTL_CHAR 0x40
	115	#define SET_FLOWCTL_CHAR_TYPE 0x25
	116
	117	#define GET_VERSION 0xc0
	118	#define GET_VERSION_TYPE 0x26
	119
	120	#define SET_REGISTER 0x40
	121	#define SET_REGISTER_TYPE 0x27
	122
	123	#define GET_REGISTER 0xc0
	124	#define GET_REGISTER_TYPE 0x28
	125
	126	#define SET_RAM 0x40
	127	#define SET_RAM_TYPE 0x31
	128
	129	#define GET_RAM 0xc0
130	#define GET_RAM_TYPE 0x32
131
132	/* how come ??? */
133	#define UART_STATE 0x08
d14fc1a7	134	#define UART_STATE_TRANSIENT_MASK 0x75
619a6f1d GKH	135	#define UART_DCD 0x01
	136	#define UART_DSR 0x02
	137	#define UART_BREAK_ERROR 0x04
	138	#define UART_RING 0x08
	139	#define UART_FRAME_ERROR 0x10
	140	#define UART_PARITY_ERROR 0x20
	141	#define UART_OVERRUN_ERROR 0x40
	142	#define UART_CTS 0x80
	143
619a6f1d	144	struct spcp8x5_private {
4d63143d	145	unsigned quirks;
2d816ac6	146	spinlock_t lock;
2d816ac6	147	u8 line_control;
619a6f1d GKH	148	};
619a6f1d GKH	149
4d63143d JH	150	static int spcp8x5_probe(struct usb_serial *serial,
	151	const struct usb_device_id *id)
	152	{
	153	usb_set_serial_data(serial, (void *)id);
	154
	155	return 0;
	156	}
	157
bf90ff5f	158	static int spcp8x5_port_probe(struct usb_serial_port *port)
619a6f1d	159	{
4d63143d	160	const struct usb_device_id *id = usb_get_serial_data(port->serial);
619a6f1d	161	struct spcp8x5_private *priv;
619a6f1d	162
bf90ff5f JH	163	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	164	if (!priv)
	165	return -ENOMEM;
619a6f1d	166
bf90ff5f	167	spin_lock_init(&priv->lock);
4d63143d	168	priv->quirks = id->driver_info;
bf90ff5f	169
2d816ac6	170	usb_set_serial_port_data(port, priv);
619a6f1d GKH	171
619a6f1d GKH	172	return 0;
619a6f1d GKH	173	}
619a6f1d GKH	174
bf90ff5f	175	static int spcp8x5_port_remove(struct usb_serial_port *port)
619a6f1d	176	{
bf90ff5f	177	struct spcp8x5_private *priv;
619a6f1d	178
bf90ff5f JH	179	priv = usb_get_serial_port_data(port);
	180	kfree(priv);
	181
	182	return 0;
619a6f1d GKH	183	}
619a6f1d GKH	184
8413d2fd	185	static int spcp8x5_set_ctrl_line(struct usb_serial_port *port, u8 mcr)
619a6f1d	186	{
8413d2fd JH	187	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
8413d2fd JH	188	struct usb_device *dev = port->serial->dev;
619a6f1d	189	int retval;
619a6f1d	190
4d63143d	191	if (priv->quirks & SPCP825_QUIRK_NO_UART_STATUS)
619a6f1d GKH	192	return -EPERM;
619a6f1d GKH	193
619a6f1d GKH	194	retval = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
	195	SET_UART_STATUS_TYPE, SET_UART_STATUS,
	196	mcr, 0x04, NULL, 0, 100);
8413d2fd JH	197	if (retval != 0) {
	198	dev_err(&port->dev, "failed to set control lines: %d\n",
	199	retval);
	200	}
619a6f1d GKH	201	return retval;
	202	}
	203
8413d2fd	204	static int spcp8x5_get_msr(struct usb_serial_port port, u8 status)
619a6f1d	205	{
8413d2fd JH	206	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
8413d2fd JH	207	struct usb_device *dev = port->serial->dev;
0a967f62	208	u8 *buf;
619a6f1d GKH	209	int ret;
619a6f1d GKH	210
4d63143d	211	if (priv->quirks & SPCP825_QUIRK_NO_UART_STATUS)
619a6f1d	212	return -EPERM;
619a6f1d	213
0a967f62 JH	214	buf = kzalloc(1, GFP_KERNEL);
0a967f62 JH	215	if (!buf)
619a6f1d	216	return -ENOMEM;
619a6f1d GKH	217
	218	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
	219	GET_UART_STATUS, GET_UART_STATUS_TYPE,
0a967f62	220	0, GET_UART_STATUS_MSR, buf, 1, 100);
619a6f1d	221	if (ret < 0)
8413d2fd JH	222	dev_err(&port->dev, "failed to get modem status: %d", ret);
8413d2fd JH	223
0a967f62 JH	224	dev_dbg(&port->dev, "0xc0:0x22:0:6 %d - 0x02%x", ret, *buf);
	225	status = buf;
	226	kfree(buf);
619a6f1d GKH	227
	228	return ret;
	229	}
	230
8413d2fd JH	231	static void spcp8x5_set_work_mode(struct usb_serial_port *port, u16 value,
8413d2fd JH	232	u16 index)
619a6f1d	233	{
8413d2fd JH	234	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
8413d2fd JH	235	struct usb_device *dev = port->serial->dev;
619a6f1d GKH	236	int ret;
619a6f1d GKH	237
4d63143d	238	if (priv->quirks & SPCP825_QUIRK_NO_WORK_MODE)
619a6f1d GKH	239	return;
	240
	241	ret = usb_control_msg(dev, usb_sndctrlpipe(dev, 0),
	242	SET_WORKING_MODE_TYPE, SET_WORKING_MODE,
	243	value, index, NULL, 0, 100);
8413d2fd	244	dev_dbg(&port->dev, "value = %#x , index = %#x\n", value, index);
619a6f1d	245	if (ret < 0)
8413d2fd	246	dev_err(&port->dev, "failed to set work mode: %d\n", ret);
619a6f1d GKH	247	}
619a6f1d GKH	248
335f8514 AC	249	static int spcp8x5_carrier_raised(struct usb_serial_port *port)
335f8514 AC	250	{
e1ed212d JH	251	u8 msr;
e1ed212d JH	252	int ret;
2d816ac6	253
e1ed212d JH	254	ret = spcp8x5_get_msr(port, &msr);
e1ed212d JH	255	if (ret \|\| msr & MSR_STATUS_LINE_DCD)
335f8514	256	return 1;
2d816ac6	257
335f8514 AC	258	return 0;
	259	}
	260
	261	static void spcp8x5_dtr_rts(struct usb_serial_port *port, int on)
	262	{
	263	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	264	unsigned long flags;
	265	u8 control;
	266
	267	spin_lock_irqsave(&priv->lock, flags);
	268	if (on)
	269	priv->line_control = MCR_CONTROL_LINE_DTR
	270	\| MCR_CONTROL_LINE_RTS;
	271	else
	272	priv->line_control &= ~ (MCR_CONTROL_LINE_DTR
	273	\| MCR_CONTROL_LINE_RTS);
	274	control = priv->line_control;
	275	spin_unlock_irqrestore(&priv->lock, flags);
8413d2fd	276	spcp8x5_set_ctrl_line(port, control);
335f8514 AC	277	}
335f8514 AC	278
fe1ae7fd AC	279	static void spcp8x5_init_termios(struct tty_struct *tty)
fe1ae7fd AC	280	{
adc8d746 AC	281	tty->termios = tty_std_termios;
	282	tty->termios.c_cflag = B115200 \| CS8 \| CREAD \| HUPCL \| CLOCAL;
	283	tty->termios.c_ispeed = 115200;
	284	tty->termios.c_ospeed = 115200;
fe1ae7fd AC	285	}
fe1ae7fd AC	286
95da310e AC	287	static void spcp8x5_set_termios(struct tty_struct *tty,
95da310e AC	288	struct usb_serial_port port, struct ktermios old_termios)
619a6f1d GKH	289	{
	290	struct usb_serial *serial = port->serial;
	291	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	292	unsigned long flags;
adc8d746	293	unsigned int cflag = tty->termios.c_cflag;
619a6f1d GKH	294	unsigned int old_cflag = old_termios->c_cflag;
	295	unsigned short uartdata;
	296	unsigned char buf[2] = {0, 0};
	297	int baud;
	298	int i;
	299	u8 control;
	300
619a6f1d	301	/* check that they really want us to change something */
adc8d746	302	if (!tty_termios_hw_change(&tty->termios, old_termios))
619a6f1d GKH	303	return;
	304
	305	/* set DTR/RTS active */
	306	spin_lock_irqsave(&priv->lock, flags);
	307	control = priv->line_control;
	308	if ((old_cflag & CBAUD) == B0) {
	309	priv->line_control \|= MCR_DTR;
	310	if (!(old_cflag & CRTSCTS))
	311	priv->line_control \|= MCR_RTS;
	312	}
	313	if (control != priv->line_control) {
	314	control = priv->line_control;
	315	spin_unlock_irqrestore(&priv->lock, flags);
8413d2fd	316	spcp8x5_set_ctrl_line(port, control);
619a6f1d GKH	317	} else {
	318	spin_unlock_irqrestore(&priv->lock, flags);
	319	}
	320
	321	/* Set Baud Rate */
a419aef8	322	baud = tty_get_baud_rate(tty);
619a6f1d GKH	323	switch (baud) {
	324	case 300: buf[0] = 0x00; break;
	325	case 600: buf[0] = 0x01; break;
	326	case 1200: buf[0] = 0x02; break;
	327	case 2400: buf[0] = 0x03; break;
	328	case 4800: buf[0] = 0x04; break;
	329	case 9600: buf[0] = 0x05; break;
	330	case 19200: buf[0] = 0x07; break;
	331	case 38400: buf[0] = 0x09; break;
	332	case 57600: buf[0] = 0x0a; break;
	333	case 115200: buf[0] = 0x0b; break;
	334	case 230400: buf[0] = 0x0c; break;
	335	case 460800: buf[0] = 0x0d; break;
	336	case 921600: buf[0] = 0x0e; break;
	337	/* case 1200000: buf[0] = 0x0f; break; */
	338	/* case 2400000: buf[0] = 0x10; break; */
	339	case 3000000: buf[0] = 0x11; break;
	340	/* case 6000000: buf[0] = 0x12; break; */
	341	case 0:
	342	case 1000000:
	343	buf[0] = 0x0b; break;
	344	default:
194343d9 GKH	345	dev_err(&port->dev, "spcp825 driver does not support the "
194343d9 GKH	346	"baudrate requested, using default of 9600.\n");
619a6f1d GKH	347	}
	348
	349	/* Set Data Length : 00:5bit, 01:6bit, 10:7bit, 11:8bit */
	350	if (cflag & CSIZE) {
	351	switch (cflag & CSIZE) {
	352	case CS5:
	353	buf[1] \|= SET_UART_FORMAT_SIZE_5;
	354	break;
	355	case CS6:
	356	buf[1] \|= SET_UART_FORMAT_SIZE_6;
	357	break;
	358	case CS7:
	359	buf[1] \|= SET_UART_FORMAT_SIZE_7;
	360	break;
	361	default:
	362	case CS8:
	363	buf[1] \|= SET_UART_FORMAT_SIZE_8;
	364	break;
	365	}
	366	}
	367
	368	/* Set Stop bit2 : 0:1bit 1:2bit */
	369	buf[1] \|= (cflag & CSTOPB) ? SET_UART_FORMAT_STOP_2 :
	370	SET_UART_FORMAT_STOP_1;
	371
	372	/* Set Parity bit3-4 01:Odd 11:Even */
	373	if (cflag & PARENB) {
	374	buf[1] \|= (cflag & PARODD) ?
	375	SET_UART_FORMAT_PAR_ODD : SET_UART_FORMAT_PAR_EVEN ;
2d816ac6	376	} else {
619a6f1d	377	buf[1] \|= SET_UART_FORMAT_PAR_NONE;
2d816ac6	378	}
619a6f1d GKH	379	uartdata = buf[0] \| buf[1]<<8;
	380
	381	i = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
	382	SET_UART_FORMAT_TYPE, SET_UART_FORMAT,
	383	uartdata, 0, NULL, 0, 100);
	384	if (i < 0)
194343d9 GKH	385	dev_err(&port->dev, "Set UART format %#x failed (error = %d)\n",
194343d9 GKH	386	uartdata, i);
fe2baf87	387	dev_dbg(&port->dev, "0x21:0x40:0:0 %d\n", i);
619a6f1d GKH	388
	389	if (cflag & CRTSCTS) {
	390	/* enable hardware flow control */
8413d2fd	391	spcp8x5_set_work_mode(port, 0x000a, SET_WORKING_MODE_U2C);
619a6f1d	392	}
619a6f1d GKH	393	}
619a6f1d GKH	394
a509a7e4	395	static int spcp8x5_open(struct tty_struct tty, struct usb_serial_port port)
619a6f1d GKH	396	{
	397	struct ktermios tmp_termios;
	398	struct usb_serial *serial = port->serial;
	399	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	400	int ret;
619a6f1d	401
619a6f1d GKH	402	usb_clear_halt(serial->dev, port->write_urb->pipe);
	403	usb_clear_halt(serial->dev, port->read_urb->pipe);
	404
	405	ret = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
	406	0x09, 0x00,
	407	0x01, 0x00, NULL, 0x00, 100);
	408	if (ret)
	409	return ret;
	410
8413d2fd	411	spcp8x5_set_ctrl_line(port, priv->line_control);
619a6f1d	412
95da310e AC	413	if (tty)
95da310e AC	414	spcp8x5_set_termios(tty, port, &tmp_termios);
619a6f1d	415
335f8514	416	port->port.drain_delay = 256;
fa993ca8 JH	417
fa993ca8 JH	418	return usb_serial_generic_open(tty, port);
619a6f1d GKH	419	}
619a6f1d GKH	420
20b9d177	421	static int spcp8x5_tiocmset(struct tty_struct *tty,
619a6f1d GKH	422	unsigned int set, unsigned int clear)
619a6f1d GKH	423	{
95da310e	424	struct usb_serial_port *port = tty->driver_data;
619a6f1d GKH	425	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	426	unsigned long flags;
	427	u8 control;
	428
	429	spin_lock_irqsave(&priv->lock, flags);
	430	if (set & TIOCM_RTS)
	431	priv->line_control \|= MCR_RTS;
	432	if (set & TIOCM_DTR)
	433	priv->line_control \|= MCR_DTR;
	434	if (clear & TIOCM_RTS)
	435	priv->line_control &= ~MCR_RTS;
	436	if (clear & TIOCM_DTR)
	437	priv->line_control &= ~MCR_DTR;
	438	control = priv->line_control;
	439	spin_unlock_irqrestore(&priv->lock, flags);
	440
8413d2fd	441	return spcp8x5_set_ctrl_line(port, control);
619a6f1d GKH	442	}
619a6f1d GKH	443
60b33c13	444	static int spcp8x5_tiocmget(struct tty_struct *tty)
619a6f1d	445	{
95da310e	446	struct usb_serial_port *port = tty->driver_data;
619a6f1d GKH	447	struct spcp8x5_private *priv = usb_get_serial_port_data(port);
	448	unsigned long flags;
	449	unsigned int mcr;
e1ed212d	450	u8 status;
619a6f1d GKH	451	unsigned int result;
619a6f1d GKH	452
e1ed212d JH	453	result = spcp8x5_get_msr(port, &status);
	454	if (result)
	455	return result;
	456
619a6f1d GKH	457	spin_lock_irqsave(&priv->lock, flags);
619a6f1d GKH	458	mcr = priv->line_control;
619a6f1d GKH	459	spin_unlock_irqrestore(&priv->lock, flags);
	460
	461	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
	462	\| ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
	463	\| ((status & MSR_STATUS_LINE_CTS) ? TIOCM_CTS : 0)
	464	\| ((status & MSR_STATUS_LINE_DSR) ? TIOCM_DSR : 0)
	465	\| ((status & MSR_STATUS_LINE_RI) ? TIOCM_RI : 0)
	466	\| ((status & MSR_STATUS_LINE_DCD) ? TIOCM_CD : 0);
	467
	468	return result;
	469	}
	470
619a6f1d GKH	471	static struct usb_serial_driver spcp8x5_device = {
	472	.driver = {
	473	.owner = THIS_MODULE,
	474	.name = "SPCP8x5",
	475	},
	476	.id_table = id_table,
619a6f1d	477	.num_ports = 1,
2d816ac6	478	.open = spcp8x5_open,
335f8514 AC	479	.dtr_rts = spcp8x5_dtr_rts,
335f8514 AC	480	.carrier_raised = spcp8x5_carrier_raised,
2d816ac6	481	.set_termios = spcp8x5_set_termios,
fe1ae7fd	482	.init_termios = spcp8x5_init_termios,
2d816ac6 JH	483	.tiocmget = spcp8x5_tiocmget,
2d816ac6 JH	484	.tiocmset = spcp8x5_tiocmset,
4d63143d	485	.probe = spcp8x5_probe,
bf90ff5f JH	486	.port_probe = spcp8x5_port_probe,
bf90ff5f JH	487	.port_remove = spcp8x5_port_remove,
619a6f1d GKH	488	};
619a6f1d GKH	489
d860322f AS	490	static struct usb_serial_driver * const serial_drivers[] = {
	491	&spcp8x5_device, NULL
	492	};
	493
68e24113	494	module_usb_serial_driver(serial_drivers, id_table);
619a6f1d GKH	495
619a6f1d GKH	496	MODULE_DESCRIPTION(DRIVER_DESC);
619a6f1d	497	MODULE_LICENSE("GPL");