[deliverable/linux.git] / drivers / usb / serial / metro-usb.c

/*
  Some of this code is credited to Linux USB open source files that are
  distributed with Linux.

  Copyright:	2007 Metrologic Instruments. All rights reserved.
  Copyright:	2011 Azimut Ltd. <http://azimutrzn.ru/>
*/

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/tty.h>
#include <linux/module.h>
#include <linux/usb.h>
#include <linux/errno.h>
#include <linux/slab.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/moduleparam.h>
#include <linux/spinlock.h>
#include <linux/errno.h>
#include <linux/uaccess.h>
#include <linux/usb/serial.h>

/* Version Information */
#define DRIVER_VERSION "v1.2.0.0"
#define DRIVER_DESC "Metrologic Instruments Inc. - USB-POS driver"

/* Product information. */
#define FOCUS_VENDOR_ID			0x0C2E
#define FOCUS_PRODUCT_ID		0x0720
#define FOCUS_PRODUCT_ID_UNI		0x0710

#define METROUSB_SET_REQUEST_TYPE	0x40
#define METROUSB_SET_MODEM_CTRL_REQUEST	10
#define METROUSB_SET_BREAK_REQUEST	0x40
#define METROUSB_MCR_NONE		0x08	/* Deactivate DTR and RTS. */
#define METROUSB_MCR_RTS		0x0a	/* Activate RTS. */
#define METROUSB_MCR_DTR		0x09	/* Activate DTR. */
#define WDR_TIMEOUT			5000	/* default urb timeout. */

/* Private data structure. */
struct metrousb_private {
	spinlock_t lock;
	int throttled;
	unsigned long control_state;
};

/* Device table list. */
static struct usb_device_id id_table[] = {
	{ USB_DEVICE(FOCUS_VENDOR_ID, FOCUS_PRODUCT_ID) },
	{ USB_DEVICE(FOCUS_VENDOR_ID, FOCUS_PRODUCT_ID_UNI) },
	{ }, /* Terminating entry. */
};
MODULE_DEVICE_TABLE(usb, id_table);

/* Input parameter constants. */
static bool debug;

static void metrousb_read_int_callback(struct urb *urb)
{
	struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
	int throttled = 0;
	int result = 0;
	unsigned long flags = 0;

	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	switch (urb->status) {
	case 0:
		/* Success status, read from the port. */
		break;
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* urb has been terminated. */
		dbg("METRO-USB - %s - urb shutting down, port number=%d, error code=%d",
			__FUNCTION__, port->number, result);
		return;
	default:
		dbg("METRO-USB - %s - non-zero urb received, port number=%d, error code=%d",
			__FUNCTION__, port->number, result);
		goto exit;
	}


	/* Set the data read from the usb port into the serial port buffer. */
	tty = tty_port_tty_get(&port->port);
	if (!tty) {
		dbg("%s - bad tty pointer - exiting", __func__);
		return;
	}

	if (tty && urb->actual_length) {
		/* Loop through the data copying each byte to the tty layer. */
		tty_insert_flip_string(tty, data, urb->actual_length);

		/* Force the data to the tty layer. */
		tty_flip_buffer_push(tty);
	}
	tty_kref_put(tty);

	/* Set any port variables. */
	spin_lock_irqsave(&metro_priv->lock, flags);
	throttled = metro_priv->throttled;
	spin_unlock_irqrestore(&metro_priv->lock, flags);

	/* Continue trying to read if set. */
	if (!throttled) {
		usb_fill_int_urb(port->interrupt_in_urb, port->serial->dev,
				 usb_rcvintpipe(port->serial->dev, port->interrupt_in_endpointAddress),
				 port->interrupt_in_urb->transfer_buffer,
				 port->interrupt_in_urb->transfer_buffer_length,
				 metrousb_read_int_callback, port, 1);

		result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);

		if (result) {
			dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
				__FUNCTION__, port->number, result);
		}
	}
	return;

exit:
	/* Try to resubmit the urb. */
	result = usb_submit_urb(urb, GFP_ATOMIC);
	if (result) {
		dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
			__FUNCTION__, port->number, result);
	}
}

static void metrousb_cleanup(struct usb_serial_port *port)
{
	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	if (port->serial->dev) {
		/* Shutdown any interrupt in urbs. */
		if (port->interrupt_in_urb) {
			usb_unlink_urb(port->interrupt_in_urb);
			usb_kill_urb(port->interrupt_in_urb);
		}
	}
}

static int metrousb_open(struct tty_struct *tty, struct usb_serial_port *port)
{
	struct usb_serial *serial = port->serial;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;
	int result = 0;

	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	/* Make sure the urb is initialized. */
	if (!port->interrupt_in_urb) {
		dbg("METRO-USB - %s - interrupt urb not initialized for port number=%d", __FUNCTION__, port->number);
		return -ENODEV;
	}

	/* Set the private data information for the port. */
	spin_lock_irqsave(&metro_priv->lock, flags);
	metro_priv->control_state = 0;
	metro_priv->throttled = 0;
	spin_unlock_irqrestore(&metro_priv->lock, flags);

	/*
	 * Force low_latency on so that our tty_push actually forces the data
	 * through, otherwise it is scheduled, and with high data rates (like
	 * with OHCI) data can get lost.
	 */
	if (tty)
		tty->low_latency = 1;

	/* Clear the urb pipe. */
	usb_clear_halt(serial->dev, port->interrupt_in_urb->pipe);

	/* Start reading from the device */
	usb_fill_int_urb(port->interrupt_in_urb, serial->dev,
			  usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress),
			   port->interrupt_in_urb->transfer_buffer,
			   port->interrupt_in_urb->transfer_buffer_length,
			   metrousb_read_int_callback, port, 1);
	result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);

	if (result) {
		dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d"
			, __FUNCTION__, port->number, result);
		goto exit;
	}

	dbg("METRO-USB - %s - port open for port number=%d", __FUNCTION__, port->number);
exit:
	return result;
}

static int metrousb_set_modem_ctrl(struct usb_serial *serial, unsigned int control_state)
{
	int retval = 0;
	unsigned char mcr = METROUSB_MCR_NONE;

	dbg("METRO-USB - %s - control state=%d", __FUNCTION__, control_state);

	/* Set the modem control value. */
	if (control_state & TIOCM_DTR)
		mcr |= METROUSB_MCR_DTR;
	if (control_state & TIOCM_RTS)
		mcr |= METROUSB_MCR_RTS;

	/* Send the command to the usb port. */
	retval = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
				METROUSB_SET_REQUEST_TYPE, METROUSB_SET_MODEM_CTRL_REQUEST,
				control_state, 0, NULL, 0, WDR_TIMEOUT);
	if (retval < 0)
		dbg("METRO-USB - %s - set modem ctrl=0x%x failed, error code=%d", __FUNCTION__, mcr, retval);

	return retval;
}

static void metrousb_shutdown(struct usb_serial *serial)
{
	int i = 0;

	dbg("METRO-USB - %s", __FUNCTION__);

	/* Stop reading and writing on all ports. */
	for (i = 0; i < serial->num_ports; ++i) {
		/* Close any open urbs. */
		metrousb_cleanup(serial->port[i]);

		/* Free memory. */
		kfree(usb_get_serial_port_data(serial->port[i]));
		usb_set_serial_port_data(serial->port[i], NULL);

		dbg("METRO-USB - %s - freed port number=%d", __FUNCTION__, serial->port[i]->number);
	}
}

static int metrousb_startup(struct usb_serial *serial)
{
	struct metrousb_private *metro_priv;
	struct usb_serial_port *port;
	int i = 0;

	dbg("METRO-USB - %s", __FUNCTION__);

	/* Loop through the serial ports setting up the private structures.
	 * Currently we only use one port. */
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];

		/* Declare memory. */
		metro_priv = kmalloc(sizeof(struct metrousb_private), GFP_KERNEL);
		if (!metro_priv)
			return -ENOMEM;

		/* Clear memory. */
		memset(metro_priv, 0x00, sizeof(struct metrousb_private));

		/* Initialize memory. */
		spin_lock_init(&metro_priv->lock);
		usb_set_serial_port_data(port, metro_priv);

		dbg("METRO-USB - %s - port number=%d.", __FUNCTION__, port->number);
	}

	return 0;
}

static void metrousb_throttle(struct tty_struct *tty)
{
	struct usb_serial_port *port = tty->driver_data;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;

	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	/* Set the private information for the port to stop reading data. */
	spin_lock_irqsave(&metro_priv->lock, flags);
	metro_priv->throttled = 1;
	spin_unlock_irqrestore(&metro_priv->lock, flags);
}

static int metrousb_tiocmget(struct tty_struct *tty)
{
	unsigned long control_state = 0;
	struct usb_serial_port *port = tty->driver_data;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;

	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	spin_lock_irqsave(&metro_priv->lock, flags);
	control_state = metro_priv->control_state;
	spin_unlock_irqrestore(&metro_priv->lock, flags);

	return control_state;
}

static int metrousb_tiocmset(struct tty_struct *tty,
			     unsigned int set, unsigned int clear)
{
	struct usb_serial_port *port = tty->driver_data;
	struct usb_serial *serial = port->serial;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;
	unsigned long control_state = 0;

	dbg("METRO-USB - %s - port number=%d, set=%d, clear=%d", __FUNCTION__, port->number, set, clear);

	spin_lock_irqsave(&metro_priv->lock, flags);
	control_state = metro_priv->control_state;

	/* Set the RTS and DTR values. */
	if (set & TIOCM_RTS)
		control_state |= TIOCM_RTS;
	if (set & TIOCM_DTR)
		control_state |= TIOCM_DTR;
	if (clear & TIOCM_RTS)
		control_state &= ~TIOCM_RTS;
	if (clear & TIOCM_DTR)
		control_state &= ~TIOCM_DTR;

	metro_priv->control_state = control_state;
	spin_unlock_irqrestore(&metro_priv->lock, flags);
	return metrousb_set_modem_ctrl(serial, control_state);
}

static void metrousb_unthrottle(struct tty_struct *tty)
{
	struct usb_serial_port *port = tty->driver_data;
	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;
	int result = 0;

	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);

	/* Set the private information for the port to resume reading data. */
	spin_lock_irqsave(&metro_priv->lock, flags);
	metro_priv->throttled = 0;
	spin_unlock_irqrestore(&metro_priv->lock, flags);

	/* Submit the urb to read from the port. */
	port->interrupt_in_urb->dev = port->serial->dev;
	result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
	if (result) {
		dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
			__FUNCTION__, port->number, result);
	}
}

static struct usb_driver metrousb_driver = {
	.name =		"metro-usb",
	.probe =	usb_serial_probe,
	.disconnect =	usb_serial_disconnect,
	.id_table =	id_table
};

static struct usb_serial_driver metrousb_device = {
	.driver = {
		.owner =	THIS_MODULE,
		.name =		"metro-usb",
	},
	.description		= "Metrologic USB to serial converter.",
	.id_table		= id_table,
	.num_ports		= 1,
	.open			= metrousb_open,
	.close			= metrousb_cleanup,
	.read_int_callback	= metrousb_read_int_callback,
	.attach			= metrousb_startup,
	.release		= metrousb_shutdown,
	.throttle		= metrousb_throttle,
	.unthrottle		= metrousb_unthrottle,
	.tiocmget		= metrousb_tiocmget,
	.tiocmset		= metrousb_tiocmset,
};

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

module_usb_serial_driver(metrousb_driver, serial_drivers);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Philip Nicastro");
MODULE_AUTHOR("Aleksey Babahin <tamerlan311@gmail.com>");
MODULE_DESCRIPTION(DRIVER_DESC);

/* Module input parameters */
module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Print debug info (bool 1=on, 0=off)");
Commit	Line	Data
43d186fe	1	/*
d4cbd6e9 GKH	2	Some of this code is credited to Linux USB open source files that are
d4cbd6e9 GKH	3	distributed with Linux.
43d186fe AB	4
	5	Copyright: 2007 Metrologic Instruments. All rights reserved.
	6	Copyright: 2011 Azimut Ltd. <http://azimutrzn.ru/>
43d186fe AB	7	*/
	8
	9	#include <linux/kernel.h>
	10	#include <linux/init.h>
	11	#include <linux/tty.h>
	12	#include <linux/module.h>
	13	#include <linux/usb.h>
	14	#include <linux/errno.h>
	15	#include <linux/slab.h>
	16	#include <linux/tty_driver.h>
	17	#include <linux/tty_flip.h>
	18	#include <linux/moduleparam.h>
	19	#include <linux/spinlock.h>
43d186fe	20	#include <linux/errno.h>
d4cbd6e9	21	#include <linux/uaccess.h>
43d186fe AB	22	#include <linux/usb/serial.h>
	23
	24	/* Version Information */
	25	#define DRIVER_VERSION "v1.2.0.0"
	26	#define DRIVER_DESC "Metrologic Instruments Inc. - USB-POS driver"
	27
159d4d8d GKH	28	/* Product information. */
	29	#define FOCUS_VENDOR_ID 0x0C2E
	30	#define FOCUS_PRODUCT_ID 0x0720
	31	#define FOCUS_PRODUCT_ID_UNI 0x0710
	32
	33	#define METROUSB_SET_REQUEST_TYPE 0x40
	34	#define METROUSB_SET_MODEM_CTRL_REQUEST 10
	35	#define METROUSB_SET_BREAK_REQUEST 0x40
	36	#define METROUSB_MCR_NONE 0x08 /* Deactivate DTR and RTS. */
	37	#define METROUSB_MCR_RTS 0x0a /* Activate RTS. */
	38	#define METROUSB_MCR_DTR 0x09 /* Activate DTR. */
d4cbd6e9	39	#define WDR_TIMEOUT 5000 /* default urb timeout. */
159d4d8d GKH	40
	41	/* Private data structure. */
	42	struct metrousb_private {
	43	spinlock_t lock;
	44	int throttled;
	45	unsigned long control_state;
	46	};
	47
43d186fe	48	/* Device table list. */
d4cbd6e9	49	static struct usb_device_id id_table[] = {
43d186fe AB	50	{ USB_DEVICE(FOCUS_VENDOR_ID, FOCUS_PRODUCT_ID) },
43d186fe AB	51	{ USB_DEVICE(FOCUS_VENDOR_ID, FOCUS_PRODUCT_ID_UNI) },
43d186fe AB	52	{ }, /* Terminating entry. */
	53	};
	54	MODULE_DEVICE_TABLE(usb, id_table);
	55
	56	/* Input parameter constants. */
fdac0f64	57	static bool debug;
43d186fe	58
9fbd1649	59	static void metrousb_read_int_callback(struct urb *urb)
43d186fe	60	{
9fbd1649 GKH	61	struct usb_serial_port port = (struct usb_serial_port )urb->context;
	62	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	63	struct tty_struct *tty;
	64	unsigned char *data = urb->transfer_buffer;
	65	int throttled = 0;
	66	int result = 0;
	67	unsigned long flags = 0;
	68
43d186fe AB	69	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
43d186fe AB	70
9fbd1649 GKH	71	switch (urb->status) {
	72	case 0:
	73	/* Success status, read from the port. */
	74	break;
	75	case -ECONNRESET:
	76	case -ENOENT:
	77	case -ESHUTDOWN:
	78	/* urb has been terminated. */
	79	dbg("METRO-USB - %s - urb shutting down, port number=%d, error code=%d",
	80	__FUNCTION__, port->number, result);
	81	return;
	82	default:
	83	dbg("METRO-USB - %s - non-zero urb received, port number=%d, error code=%d",
	84	__FUNCTION__, port->number, result);
	85	goto exit;
	86	}
	87
	88
	89	/* Set the data read from the usb port into the serial port buffer. */
	90	tty = tty_port_tty_get(&port->port);
	91	if (!tty) {
	92	dbg("%s - bad tty pointer - exiting", __func__);
	93	return;
	94	}
	95
	96	if (tty && urb->actual_length) {
	97	/* Loop through the data copying each byte to the tty layer. */
	98	tty_insert_flip_string(tty, data, urb->actual_length);
	99
	100	/* Force the data to the tty layer. */
	101	tty_flip_buffer_push(tty);
	102	}
	103	tty_kref_put(tty);
	104
	105	/* Set any port variables. */
	106	spin_lock_irqsave(&metro_priv->lock, flags);
	107	throttled = metro_priv->throttled;
	108	spin_unlock_irqrestore(&metro_priv->lock, flags);
	109
	110	/* Continue trying to read if set. */
	111	if (!throttled) {
	112	usb_fill_int_urb(port->interrupt_in_urb, port->serial->dev,
	113	usb_rcvintpipe(port->serial->dev, port->interrupt_in_endpointAddress),
	114	port->interrupt_in_urb->transfer_buffer,
	115	port->interrupt_in_urb->transfer_buffer_length,
	116	metrousb_read_int_callback, port, 1);
	117
	118	result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
	119
	120	if (result) {
	121	dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
	122	__FUNCTION__, port->number, result);
43d186fe	123	}
43d186fe	124	}
9fbd1649 GKH	125	return;
	126
	127	exit:
	128	/* Try to resubmit the urb. */
	129	result = usb_submit_urb(urb, GFP_ATOMIC);
	130	if (result) {
	131	dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
	132	__FUNCTION__, port->number, result);
	133	}
43d186fe AB	134	}
43d186fe AB	135
9fbd1649	136	static void metrousb_cleanup(struct usb_serial_port *port)
43d186fe AB	137	{
43d186fe AB	138	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
9fbd1649 GKH	139
	140	if (port->serial->dev) {
	141	/* Shutdown any interrupt in urbs. */
	142	if (port->interrupt_in_urb) {
	143	usb_unlink_urb(port->interrupt_in_urb);
	144	usb_kill_urb(port->interrupt_in_urb);
	145	}
	146	}
43d186fe AB	147	}
43d186fe AB	148
d4cbd6e9	149	static int metrousb_open(struct tty_struct tty, struct usb_serial_port port)
43d186fe AB	150	{
	151	struct usb_serial *serial = port->serial;
	152	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	153	unsigned long flags = 0;
	154	int result = 0;
	155
	156	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
	157
	158	/* Make sure the urb is initialized. */
	159	if (!port->interrupt_in_urb) {
	160	dbg("METRO-USB - %s - interrupt urb not initialized for port number=%d", __FUNCTION__, port->number);
	161	return -ENODEV;
	162	}
	163
	164	/* Set the private data information for the port. */
	165	spin_lock_irqsave(&metro_priv->lock, flags);
	166	metro_priv->control_state = 0;
	167	metro_priv->throttled = 0;
	168	spin_unlock_irqrestore(&metro_priv->lock, flags);
	169
	170	/*
	171	* Force low_latency on so that our tty_push actually forces the data
	172	* through, otherwise it is scheduled, and with high data rates (like
	173	* with OHCI) data can get lost.
	174	*/
d4cbd6e9	175	if (tty)
43d186fe	176	tty->low_latency = 1;
43d186fe AB	177
	178	/* Clear the urb pipe. */
	179	usb_clear_halt(serial->dev, port->interrupt_in_urb->pipe);
	180
	181	/* Start reading from the device */
d4cbd6e9 GKH	182	usb_fill_int_urb(port->interrupt_in_urb, serial->dev,
d4cbd6e9 GKH	183	usb_rcvintpipe(serial->dev, port->interrupt_in_endpointAddress),
43d186fe AB	184	port->interrupt_in_urb->transfer_buffer,
	185	port->interrupt_in_urb->transfer_buffer_length,
	186	metrousb_read_int_callback, port, 1);
	187	result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
	188
	189	if (result) {
	190	dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d"
	191	, __FUNCTION__, port->number, result);
	192	goto exit;
	193	}
	194
	195	dbg("METRO-USB - %s - port open for port number=%d", __FUNCTION__, port->number);
	196	exit:
	197	return result;
	198	}
	199
43d186fe AB	200	static int metrousb_set_modem_ctrl(struct usb_serial *serial, unsigned int control_state)
	201	{
	202	int retval = 0;
	203	unsigned char mcr = METROUSB_MCR_NONE;
	204
	205	dbg("METRO-USB - %s - control state=%d", __FUNCTION__, control_state);
	206
	207	/* Set the modem control value. */
	208	if (control_state & TIOCM_DTR)
	209	mcr \|= METROUSB_MCR_DTR;
	210	if (control_state & TIOCM_RTS)
	211	mcr \|= METROUSB_MCR_RTS;
	212
	213	/* Send the command to the usb port. */
	214	retval = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
	215	METROUSB_SET_REQUEST_TYPE, METROUSB_SET_MODEM_CTRL_REQUEST,
	216	control_state, 0, NULL, 0, WDR_TIMEOUT);
	217	if (retval < 0)
	218	dbg("METRO-USB - %s - set modem ctrl=0x%x failed, error code=%d", __FUNCTION__, mcr, retval);
	219
	220	return retval;
	221	}
	222
d4cbd6e9	223	static void metrousb_shutdown(struct usb_serial *serial)
43d186fe AB	224	{
	225	int i = 0;
	226
	227	dbg("METRO-USB - %s", __FUNCTION__);
	228
	229	/* Stop reading and writing on all ports. */
d4cbd6e9	230	for (i = 0; i < serial->num_ports; ++i) {
43d186fe AB	231	/* Close any open urbs. */
	232	metrousb_cleanup(serial->port[i]);
	233
	234	/* Free memory. */
	235	kfree(usb_get_serial_port_data(serial->port[i]));
	236	usb_set_serial_port_data(serial->port[i], NULL);
	237
	238	dbg("METRO-USB - %s - freed port number=%d", __FUNCTION__, serial->port[i]->number);
	239	}
	240	}
	241
43d186fe AB	242	static int metrousb_startup(struct usb_serial *serial)
	243	{
	244	struct metrousb_private *metro_priv;
	245	struct usb_serial_port *port;
	246	int i = 0;
	247
	248	dbg("METRO-USB - %s", __FUNCTION__);
	249
	250	/* Loop through the serial ports setting up the private structures.
	251	* Currently we only use one port. */
	252	for (i = 0; i < serial->num_ports; ++i) {
	253	port = serial->port[i];
	254
	255	/* Declare memory. */
d4cbd6e9	256	metro_priv = kmalloc(sizeof(struct metrousb_private), GFP_KERNEL);
43d186fe AB	257	if (!metro_priv)
	258	return -ENOMEM;
	259
	260	/* Clear memory. */
d4cbd6e9	261	memset(metro_priv, 0x00, sizeof(struct metrousb_private));
43d186fe AB	262
	263	/* Initialize memory. */
	264	spin_lock_init(&metro_priv->lock);
	265	usb_set_serial_port_data(port, metro_priv);
	266
	267	dbg("METRO-USB - %s - port number=%d.", __FUNCTION__, port->number);
	268	}
	269
	270	return 0;
	271	}
	272
d4cbd6e9	273	static void metrousb_throttle(struct tty_struct *tty)
43d186fe AB	274	{
	275	struct usb_serial_port *port = tty->driver_data;
	276	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	277	unsigned long flags = 0;
	278
	279	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
	280
	281	/* Set the private information for the port to stop reading data. */
	282	spin_lock_irqsave(&metro_priv->lock, flags);
	283	metro_priv->throttled = 1;
	284	spin_unlock_irqrestore(&metro_priv->lock, flags);
	285	}
	286
d4cbd6e9	287	static int metrousb_tiocmget(struct tty_struct *tty)
43d186fe AB	288	{
	289	unsigned long control_state = 0;
	290	struct usb_serial_port *port = tty->driver_data;
	291	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	292	unsigned long flags = 0;
	293
	294	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
	295
	296	spin_lock_irqsave(&metro_priv->lock, flags);
	297	control_state = metro_priv->control_state;
	298	spin_unlock_irqrestore(&metro_priv->lock, flags);
	299
	300	return control_state;
	301	}
	302
d4cbd6e9 GKH	303	static int metrousb_tiocmset(struct tty_struct *tty,
d4cbd6e9 GKH	304	unsigned int set, unsigned int clear)
43d186fe AB	305	{
	306	struct usb_serial_port *port = tty->driver_data;
	307	struct usb_serial *serial = port->serial;
	308	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	309	unsigned long flags = 0;
	310	unsigned long control_state = 0;
	311
	312	dbg("METRO-USB - %s - port number=%d, set=%d, clear=%d", __FUNCTION__, port->number, set, clear);
	313
	314	spin_lock_irqsave(&metro_priv->lock, flags);
	315	control_state = metro_priv->control_state;
	316
d4cbd6e9	317	/* Set the RTS and DTR values. */
43d186fe AB	318	if (set & TIOCM_RTS)
	319	control_state \|= TIOCM_RTS;
	320	if (set & TIOCM_DTR)
	321	control_state \|= TIOCM_DTR;
	322	if (clear & TIOCM_RTS)
	323	control_state &= ~TIOCM_RTS;
	324	if (clear & TIOCM_DTR)
	325	control_state &= ~TIOCM_DTR;
	326
	327	metro_priv->control_state = control_state;
	328	spin_unlock_irqrestore(&metro_priv->lock, flags);
	329	return metrousb_set_modem_ctrl(serial, control_state);
	330	}
	331
d4cbd6e9	332	static void metrousb_unthrottle(struct tty_struct *tty)
43d186fe AB	333	{
	334	struct usb_serial_port *port = tty->driver_data;
	335	struct metrousb_private *metro_priv = usb_get_serial_port_data(port);
	336	unsigned long flags = 0;
	337	int result = 0;
	338
	339	dbg("METRO-USB - %s - port number=%d", __FUNCTION__, port->number);
	340
	341	/* Set the private information for the port to resume reading data. */
	342	spin_lock_irqsave(&metro_priv->lock, flags);
	343	metro_priv->throttled = 0;
	344	spin_unlock_irqrestore(&metro_priv->lock, flags);
	345
	346	/* Submit the urb to read from the port. */
	347	port->interrupt_in_urb->dev = port->serial->dev;
	348	result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
	349	if (result) {
	350	dbg("METRO-USB - %s - failed submitting interrupt in urb for port number=%d, error code=%d",
	351	__FUNCTION__, port->number, result);
	352	}
	353	}
	354
9fbd1649 GKH	355	static struct usb_driver metrousb_driver = {
	356	.name = "metro-usb",
	357	.probe = usb_serial_probe,
	358	.disconnect = usb_serial_disconnect,
	359	.id_table = id_table
	360	};
	361
9fbd1649 GKH	362	static struct usb_serial_driver metrousb_device = {
	363	.driver = {
	364	.owner = THIS_MODULE,
	365	.name = "metro-usb",
	366	},
	367	.description = "Metrologic USB to serial converter.",
	368	.id_table = id_table,
	369	.num_ports = 1,
	370	.open = metrousb_open,
	371	.close = metrousb_cleanup,
	372	.read_int_callback = metrousb_read_int_callback,
	373	.attach = metrousb_startup,
	374	.release = metrousb_shutdown,
	375	.throttle = metrousb_throttle,
	376	.unthrottle = metrousb_unthrottle,
	377	.tiocmget = metrousb_tiocmget,
	378	.tiocmset = metrousb_tiocmset,
	379	};
	380
	381	static struct usb_serial_driver * const serial_drivers[] = {
	382	&metrousb_device,
	383	NULL,
	384	};
	385
1935e357 GKH	386	module_usb_serial_driver(metrousb_driver, serial_drivers);
1935e357 GKH	387
43d186fe	388	MODULE_LICENSE("GPL");
d4cbd6e9 GKH	389	MODULE_AUTHOR("Philip Nicastro");
	390	MODULE_AUTHOR("Aleksey Babahin <tamerlan311@gmail.com>");
	391	MODULE_DESCRIPTION(DRIVER_DESC);
43d186fe AB	392
	393	/* Module input parameters */
	394	module_param(debug, bool, S_IRUGO \| S_IWUSR);
	395	MODULE_PARM_DESC(debug, "Print debug info (bool 1=on, 0=off)");