xref: /linux/drivers/usb/serial/belkin_sa.c (revision f2f8b7fe5a7542df8e3c906fcc9897b596bbf1fc)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Belkin USB Serial Adapter Driver
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  *  Copyright (C) 2000		William Greathouse (wgreathouse@smva.com)
51da177e4SLinus Torvalds  *  Copyright (C) 2000-2001 	Greg Kroah-Hartman (greg@kroah.com)
61da177e4SLinus Torvalds  *
71da177e4SLinus Torvalds  *  This program is largely derived from work by the linux-usb group
81da177e4SLinus Torvalds  *  and associated source files.  Please see the usb/serial files for
91da177e4SLinus Torvalds  *  individual credits and copyrights.
101da177e4SLinus Torvalds  *
111da177e4SLinus Torvalds  * 	This program is free software; you can redistribute it and/or modify
121da177e4SLinus Torvalds  * 	it under the terms of the GNU General Public License as published by
131da177e4SLinus Torvalds  * 	the Free Software Foundation; either version 2 of the License, or
141da177e4SLinus Torvalds  * 	(at your option) any later version.
151da177e4SLinus Torvalds  *
16b69c1499SAlan Cox  * See Documentation/usb/usb-serial.txt for more information on using this
17b69c1499SAlan Cox  * driver
181da177e4SLinus Torvalds  *
191da177e4SLinus Torvalds  * TODO:
201da177e4SLinus Torvalds  * -- Add true modem contol line query capability.  Currently we track the
211da177e4SLinus Torvalds  *    states reported by the interrupt and the states we request.
221da177e4SLinus Torvalds  * -- Add error reporting back to application for UART error conditions.
231da177e4SLinus Torvalds  *    Just point me at how to implement this and I'll do it. I've put the
241da177e4SLinus Torvalds  *    framework in, but haven't analyzed the "tty_flip" interface yet.
251da177e4SLinus Torvalds  * -- Add support for flush commands
261da177e4SLinus Torvalds  * -- Add everything that is missing :)
271da177e4SLinus Torvalds  *
281da177e4SLinus Torvalds  * 27-Nov-2001 gkh
291da177e4SLinus Torvalds  * 	compressed all the differnent device entries into 1.
301da177e4SLinus Torvalds  *
311da177e4SLinus Torvalds  * 30-May-2001 gkh
32b69c1499SAlan Cox  *	switched from using spinlock to a semaphore, which fixes lots of
33b69c1499SAlan Cox  *	problems.
341da177e4SLinus Torvalds  *
351da177e4SLinus Torvalds  * 08-Apr-2001 gb
361da177e4SLinus Torvalds  *	- Identify version on module load.
371da177e4SLinus Torvalds  *
381da177e4SLinus Torvalds  * 12-Mar-2001 gkh
391da177e4SLinus Torvalds  *	- Added support for the GoHubs GO-COM232 device which is the same as the
401da177e4SLinus Torvalds  *	  Peracom device.
411da177e4SLinus Torvalds  *
421da177e4SLinus Torvalds  * 06-Nov-2000 gkh
431da177e4SLinus Torvalds  *	- Added support for the old Belkin and Peracom devices.
441da177e4SLinus Torvalds  *	- Made the port able to be opened multiple times.
451da177e4SLinus Torvalds  *	- Added some defaults incase the line settings are things these devices
461da177e4SLinus Torvalds  *	  can't support.
471da177e4SLinus Torvalds  *
481da177e4SLinus Torvalds  * 18-Oct-2000 William Greathouse
491da177e4SLinus Torvalds  *    Released into the wild (linux-usb-devel)
501da177e4SLinus Torvalds  *
511da177e4SLinus Torvalds  * 17-Oct-2000 William Greathouse
521da177e4SLinus Torvalds  *    Add code to recognize firmware version and set hardware flow control
531da177e4SLinus Torvalds  *    appropriately.  Belkin states that firmware prior to 3.05 does not
541da177e4SLinus Torvalds  *    operate correctly in hardware handshake mode.  I have verified this
551da177e4SLinus Torvalds  *    on firmware 2.05 -- for both RTS and DTR input flow control, the control
561da177e4SLinus Torvalds  *    line is not reset.  The test performed by the Belkin Win* driver is
571da177e4SLinus Torvalds  *    to enable hardware flow control for firmware 2.06 or greater and
581da177e4SLinus Torvalds  *    for 1.00 or prior.  I am only enabling for 2.06 or greater.
591da177e4SLinus Torvalds  *
601da177e4SLinus Torvalds  * 12-Oct-2000 William Greathouse
611da177e4SLinus Torvalds  *    First cut at supporting Belkin USB Serial Adapter F5U103
621da177e4SLinus Torvalds  *    I did not have a copy of the original work to support this
631da177e4SLinus Torvalds  *    adapter, so pardon any stupid mistakes.  All of the information
641da177e4SLinus Torvalds  *    I am using to write this driver was acquired by using a modified
651da177e4SLinus Torvalds  *    UsbSnoop on Windows2000 and from examining the other USB drivers.
661da177e4SLinus Torvalds  */
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds #include <linux/kernel.h>
691da177e4SLinus Torvalds #include <linux/errno.h>
701da177e4SLinus Torvalds #include <linux/init.h>
711da177e4SLinus Torvalds #include <linux/slab.h>
721da177e4SLinus Torvalds #include <linux/tty.h>
731da177e4SLinus Torvalds #include <linux/tty_driver.h>
741da177e4SLinus Torvalds #include <linux/tty_flip.h>
751da177e4SLinus Torvalds #include <linux/module.h>
761da177e4SLinus Torvalds #include <linux/spinlock.h>
77b69c1499SAlan Cox #include <linux/uaccess.h>
781da177e4SLinus Torvalds #include <linux/usb.h>
79a969888cSGreg Kroah-Hartman #include <linux/usb/serial.h>
801da177e4SLinus Torvalds #include "belkin_sa.h"
811da177e4SLinus Torvalds 
821da177e4SLinus Torvalds static int debug;
831da177e4SLinus Torvalds 
841da177e4SLinus Torvalds /*
851da177e4SLinus Torvalds  * Version Information
861da177e4SLinus Torvalds  */
871da177e4SLinus Torvalds #define DRIVER_VERSION "v1.2"
881da177e4SLinus Torvalds #define DRIVER_AUTHOR "William Greathouse <wgreathouse@smva.com>"
891da177e4SLinus Torvalds #define DRIVER_DESC "USB Belkin Serial converter driver"
901da177e4SLinus Torvalds 
911da177e4SLinus Torvalds /* function prototypes for a Belkin USB Serial Adapter F5U103 */
921da177e4SLinus Torvalds static int  belkin_sa_startup(struct usb_serial *serial);
93f9c99bb8SAlan Stern static void belkin_sa_release(struct usb_serial *serial);
94b69c1499SAlan Cox static int  belkin_sa_open(struct tty_struct *tty,
95a509a7e4SAlan Cox 			struct usb_serial_port *port);
96335f8514SAlan Cox static void belkin_sa_close(struct usb_serial_port *port);
977d12e780SDavid Howells static void belkin_sa_read_int_callback(struct urb *urb);
98b69c1499SAlan Cox static void belkin_sa_set_termios(struct tty_struct *tty,
99b69c1499SAlan Cox 			struct usb_serial_port *port, struct ktermios * old);
10095da310eSAlan Cox static void belkin_sa_break_ctl(struct tty_struct *tty, int break_state);
10195da310eSAlan Cox static int  belkin_sa_tiocmget(struct tty_struct *tty, struct file *file);
102b69c1499SAlan Cox static int  belkin_sa_tiocmset(struct tty_struct *tty, struct file *file,
103b69c1499SAlan Cox 					unsigned int set, unsigned int clear);
1041da177e4SLinus Torvalds 
1051da177e4SLinus Torvalds 
1067d40d7e8SNémeth Márton static const struct usb_device_id id_table_combined[] = {
1071da177e4SLinus Torvalds 	{ USB_DEVICE(BELKIN_SA_VID, BELKIN_SA_PID) },
1081da177e4SLinus Torvalds 	{ USB_DEVICE(BELKIN_OLD_VID, BELKIN_OLD_PID) },
1091da177e4SLinus Torvalds 	{ USB_DEVICE(PERACOM_VID, PERACOM_PID) },
1101da177e4SLinus Torvalds 	{ USB_DEVICE(GOHUBS_VID, GOHUBS_PID) },
1111da177e4SLinus Torvalds 	{ USB_DEVICE(GOHUBS_VID, HANDYLINK_PID) },
1121da177e4SLinus Torvalds 	{ USB_DEVICE(BELKIN_DOCKSTATION_VID, BELKIN_DOCKSTATION_PID) },
1131da177e4SLinus Torvalds 	{ }	/* Terminating entry */
1141da177e4SLinus Torvalds };
1151da177e4SLinus Torvalds MODULE_DEVICE_TABLE(usb, id_table_combined);
1161da177e4SLinus Torvalds 
1171da177e4SLinus Torvalds static struct usb_driver belkin_driver = {
1181da177e4SLinus Torvalds 	.name =		"belkin",
1191da177e4SLinus Torvalds 	.probe =	usb_serial_probe,
1201da177e4SLinus Torvalds 	.disconnect =	usb_serial_disconnect,
1211da177e4SLinus Torvalds 	.id_table =	id_table_combined,
122ba9dc657SGreg Kroah-Hartman 	.no_dynamic_id =	1,
1231da177e4SLinus Torvalds };
1241da177e4SLinus Torvalds 
1251da177e4SLinus Torvalds /* All of the device info needed for the serial converters */
126ea65370dSGreg Kroah-Hartman static struct usb_serial_driver belkin_device = {
12718fcac35SGreg Kroah-Hartman 	.driver = {
1281da177e4SLinus Torvalds 		.owner =	THIS_MODULE,
129269bda1cSGreg Kroah-Hartman 		.name =		"belkin",
13018fcac35SGreg Kroah-Hartman 	},
131269bda1cSGreg Kroah-Hartman 	.description =		"Belkin / Peracom / GoHubs USB Serial Adapter",
132d9b1b787SJohannes Hölzl 	.usb_driver =		&belkin_driver,
1331da177e4SLinus Torvalds 	.id_table =		id_table_combined,
1341da177e4SLinus Torvalds 	.num_ports =		1,
1351da177e4SLinus Torvalds 	.open =			belkin_sa_open,
1361da177e4SLinus Torvalds 	.close =		belkin_sa_close,
137b69c1499SAlan Cox 	.read_int_callback =	belkin_sa_read_int_callback,
138b69c1499SAlan Cox 					/* How we get the status info */
1391da177e4SLinus Torvalds 	.set_termios =		belkin_sa_set_termios,
1401da177e4SLinus Torvalds 	.break_ctl =		belkin_sa_break_ctl,
1411da177e4SLinus Torvalds 	.tiocmget =		belkin_sa_tiocmget,
1421da177e4SLinus Torvalds 	.tiocmset =		belkin_sa_tiocmset,
1431da177e4SLinus Torvalds 	.attach =		belkin_sa_startup,
144f9c99bb8SAlan Stern 	.release =		belkin_sa_release,
1451da177e4SLinus Torvalds };
1461da177e4SLinus Torvalds 
1471da177e4SLinus Torvalds struct belkin_sa_private {
1481da177e4SLinus Torvalds 	spinlock_t		lock;
1491da177e4SLinus Torvalds 	unsigned long		control_state;
1501da177e4SLinus Torvalds 	unsigned char		last_lsr;
1511da177e4SLinus Torvalds 	unsigned char		last_msr;
1521da177e4SLinus Torvalds 	int			bad_flow_control;
1531da177e4SLinus Torvalds };
1541da177e4SLinus Torvalds 
1551da177e4SLinus Torvalds 
1561da177e4SLinus Torvalds /*
1571da177e4SLinus Torvalds  * ***************************************************************************
1581da177e4SLinus Torvalds  * Belkin USB Serial Adapter F5U103 specific driver functions
1591da177e4SLinus Torvalds  * ***************************************************************************
1601da177e4SLinus Torvalds  */
1611da177e4SLinus Torvalds 
1621da177e4SLinus Torvalds #define WDR_TIMEOUT 5000 /* default urb timeout */
1631da177e4SLinus Torvalds 
1641da177e4SLinus Torvalds /* assumes that struct usb_serial *serial is available */
1651da177e4SLinus Torvalds #define BSA_USB_CMD(c, v) usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), \
1661da177e4SLinus Torvalds 					    (c), BELKIN_SA_SET_REQUEST_TYPE, \
1671da177e4SLinus Torvalds 					    (v), 0, NULL, 0, WDR_TIMEOUT)
1681da177e4SLinus Torvalds 
1691da177e4SLinus Torvalds /* do some startup allocations not currently performed by usb_serial_probe() */
1701da177e4SLinus Torvalds static int belkin_sa_startup(struct usb_serial *serial)
1711da177e4SLinus Torvalds {
1721da177e4SLinus Torvalds 	struct usb_device *dev = serial->dev;
1731da177e4SLinus Torvalds 	struct belkin_sa_private *priv;
1741da177e4SLinus Torvalds 
1751da177e4SLinus Torvalds 	/* allocate the private data structure */
1761da177e4SLinus Torvalds 	priv = kmalloc(sizeof(struct belkin_sa_private), GFP_KERNEL);
1771da177e4SLinus Torvalds 	if (!priv)
178b69c1499SAlan Cox 		return -1; /* error */
1791da177e4SLinus Torvalds 	/* set initial values for control structures */
1801da177e4SLinus Torvalds 	spin_lock_init(&priv->lock);
1811da177e4SLinus Torvalds 	priv->control_state = 0;
1821da177e4SLinus Torvalds 	priv->last_lsr = 0;
1831da177e4SLinus Torvalds 	priv->last_msr = 0;
1841da177e4SLinus Torvalds 	/* see comments at top of file */
185b69c1499SAlan Cox 	priv->bad_flow_control =
186b69c1499SAlan Cox 		(le16_to_cpu(dev->descriptor.bcdDevice) <= 0x0206) ? 1 : 0;
187c197a8dbSGreg Kroah-Hartman 	dev_info(&dev->dev, "bcdDevice: %04x, bfc: %d\n",
188b69c1499SAlan Cox 					le16_to_cpu(dev->descriptor.bcdDevice),
189b69c1499SAlan Cox 					priv->bad_flow_control);
1901da177e4SLinus Torvalds 
1911da177e4SLinus Torvalds 	init_waitqueue_head(&serial->port[0]->write_wait);
1921da177e4SLinus Torvalds 	usb_set_serial_port_data(serial->port[0], priv);
1931da177e4SLinus Torvalds 
194b69c1499SAlan Cox 	return 0;
1951da177e4SLinus Torvalds }
1961da177e4SLinus Torvalds 
197f9c99bb8SAlan Stern static void belkin_sa_release(struct usb_serial *serial)
1981da177e4SLinus Torvalds {
1991da177e4SLinus Torvalds 	int i;
2001da177e4SLinus Torvalds 
201441b62c1SHarvey Harrison 	dbg("%s", __func__);
2021da177e4SLinus Torvalds 
203726ef428SJohan Hovold 	for (i = 0; i < serial->num_ports; ++i)
204726ef428SJohan Hovold 		kfree(usb_get_serial_port_data(serial->port[i]));
2051da177e4SLinus Torvalds }
2061da177e4SLinus Torvalds 
207b69c1499SAlan Cox static int belkin_sa_open(struct tty_struct *tty,
208a509a7e4SAlan Cox 					struct usb_serial_port *port)
2091da177e4SLinus Torvalds {
210*f2f8b7feSJohan Hovold 	int retval;
2111da177e4SLinus Torvalds 
212441b62c1SHarvey Harrison 	dbg("%s port %d", __func__, port->number);
2131da177e4SLinus Torvalds 
2141da177e4SLinus Torvalds 	retval = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
2151da177e4SLinus Torvalds 	if (retval) {
216194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "usb_submit_urb(read int) failed\n");
217*f2f8b7feSJohan Hovold 		return retval;
2181da177e4SLinus Torvalds 	}
2191da177e4SLinus Torvalds 
220*f2f8b7feSJohan Hovold 	retval = usb_serial_generic_open(tty, port);
221*f2f8b7feSJohan Hovold 	if (retval)
222*f2f8b7feSJohan Hovold 		usb_kill_urb(port->interrupt_in_urb);
223*f2f8b7feSJohan Hovold 
2241da177e4SLinus Torvalds 	return retval;
225726ef428SJohan Hovold }
2261da177e4SLinus Torvalds 
227335f8514SAlan Cox static void belkin_sa_close(struct usb_serial_port *port)
2281da177e4SLinus Torvalds {
229441b62c1SHarvey Harrison 	dbg("%s port %d", __func__, port->number);
2301da177e4SLinus Torvalds 
231f26788daSJohan Hovold 	usb_serial_generic_close(port);
2321da177e4SLinus Torvalds 	usb_kill_urb(port->interrupt_in_urb);
233726ef428SJohan Hovold }
2341da177e4SLinus Torvalds 
2357d12e780SDavid Howells static void belkin_sa_read_int_callback(struct urb *urb)
2361da177e4SLinus Torvalds {
237cdc97792SMing Lei 	struct usb_serial_port *port = urb->context;
2381da177e4SLinus Torvalds 	struct belkin_sa_private *priv;
2391da177e4SLinus Torvalds 	unsigned char *data = urb->transfer_buffer;
2401da177e4SLinus Torvalds 	int retval;
241f26aad25SGreg Kroah-Hartman 	int status = urb->status;
2421da177e4SLinus Torvalds 	unsigned long flags;
2431da177e4SLinus Torvalds 
244f26aad25SGreg Kroah-Hartman 	switch (status) {
2451da177e4SLinus Torvalds 	case 0:
2461da177e4SLinus Torvalds 		/* success */
2471da177e4SLinus Torvalds 		break;
2481da177e4SLinus Torvalds 	case -ECONNRESET:
2491da177e4SLinus Torvalds 	case -ENOENT:
2501da177e4SLinus Torvalds 	case -ESHUTDOWN:
2511da177e4SLinus Torvalds 		/* this urb is terminated, clean up */
252f26aad25SGreg Kroah-Hartman 		dbg("%s - urb shutting down with status: %d",
253441b62c1SHarvey Harrison 		    __func__, status);
2541da177e4SLinus Torvalds 		return;
2551da177e4SLinus Torvalds 	default:
256f26aad25SGreg Kroah-Hartman 		dbg("%s - nonzero urb status received: %d",
257441b62c1SHarvey Harrison 		    __func__, status);
2581da177e4SLinus Torvalds 		goto exit;
2591da177e4SLinus Torvalds 	}
2601da177e4SLinus Torvalds 
261b69c1499SAlan Cox 	usb_serial_debug_data(debug, &port->dev, __func__,
262b69c1499SAlan Cox 					urb->actual_length, data);
2631da177e4SLinus Torvalds 
2641da177e4SLinus Torvalds 	/* Handle known interrupt data */
2651da177e4SLinus Torvalds 	/* ignore data[0] and data[1] */
2661da177e4SLinus Torvalds 
2671da177e4SLinus Torvalds 	priv = usb_get_serial_port_data(port);
2681da177e4SLinus Torvalds 	spin_lock_irqsave(&priv->lock, flags);
2691da177e4SLinus Torvalds 	priv->last_msr = data[BELKIN_SA_MSR_INDEX];
2701da177e4SLinus Torvalds 
2711da177e4SLinus Torvalds 	/* Record Control Line states */
2721da177e4SLinus Torvalds 	if (priv->last_msr & BELKIN_SA_MSR_DSR)
2731da177e4SLinus Torvalds 		priv->control_state |= TIOCM_DSR;
2741da177e4SLinus Torvalds 	else
2751da177e4SLinus Torvalds 		priv->control_state &= ~TIOCM_DSR;
2761da177e4SLinus Torvalds 
2771da177e4SLinus Torvalds 	if (priv->last_msr & BELKIN_SA_MSR_CTS)
2781da177e4SLinus Torvalds 		priv->control_state |= TIOCM_CTS;
2791da177e4SLinus Torvalds 	else
2801da177e4SLinus Torvalds 		priv->control_state &= ~TIOCM_CTS;
2811da177e4SLinus Torvalds 
2821da177e4SLinus Torvalds 	if (priv->last_msr & BELKIN_SA_MSR_RI)
2831da177e4SLinus Torvalds 		priv->control_state |= TIOCM_RI;
2841da177e4SLinus Torvalds 	else
2851da177e4SLinus Torvalds 		priv->control_state &= ~TIOCM_RI;
2861da177e4SLinus Torvalds 
2871da177e4SLinus Torvalds 	if (priv->last_msr & BELKIN_SA_MSR_CD)
2881da177e4SLinus Torvalds 		priv->control_state |= TIOCM_CD;
2891da177e4SLinus Torvalds 	else
2901da177e4SLinus Torvalds 		priv->control_state &= ~TIOCM_CD;
2911da177e4SLinus Torvalds 
2921da177e4SLinus Torvalds 	/* Now to report any errors */
2931da177e4SLinus Torvalds 	priv->last_lsr = data[BELKIN_SA_LSR_INDEX];
2941da177e4SLinus Torvalds #if 0
2951da177e4SLinus Torvalds 	/*
2961da177e4SLinus Torvalds 	 * fill in the flip buffer here, but I do not know the relation
2971da177e4SLinus Torvalds 	 * to the current/next receive buffer or characters.  I need
2981da177e4SLinus Torvalds 	 * to look in to this before committing any code.
2991da177e4SLinus Torvalds 	 */
3001da177e4SLinus Torvalds 	if (priv->last_lsr & BELKIN_SA_LSR_ERR) {
3014a90f09bSAlan Cox 		tty = tty_port_tty_get(&port->port);
3021da177e4SLinus Torvalds 		/* Overrun Error */
3031da177e4SLinus Torvalds 		if (priv->last_lsr & BELKIN_SA_LSR_OE) {
3041da177e4SLinus Torvalds 		}
3051da177e4SLinus Torvalds 		/* Parity Error */
3061da177e4SLinus Torvalds 		if (priv->last_lsr & BELKIN_SA_LSR_PE) {
3071da177e4SLinus Torvalds 		}
3081da177e4SLinus Torvalds 		/* Framing Error */
3091da177e4SLinus Torvalds 		if (priv->last_lsr & BELKIN_SA_LSR_FE) {
3101da177e4SLinus Torvalds 		}
3111da177e4SLinus Torvalds 		/* Break Indicator */
3121da177e4SLinus Torvalds 		if (priv->last_lsr & BELKIN_SA_LSR_BI) {
3131da177e4SLinus Torvalds 		}
3144a90f09bSAlan Cox 		tty_kref_put(tty);
3151da177e4SLinus Torvalds 	}
3161da177e4SLinus Torvalds #endif
3171da177e4SLinus Torvalds 	spin_unlock_irqrestore(&priv->lock, flags);
3181da177e4SLinus Torvalds exit:
3191da177e4SLinus Torvalds 	retval = usb_submit_urb(urb, GFP_ATOMIC);
3201da177e4SLinus Torvalds 	if (retval)
321194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "%s - usb_submit_urb failed with "
322194343d9SGreg Kroah-Hartman 			"result %d\n", __func__, retval);
3231da177e4SLinus Torvalds }
3241da177e4SLinus Torvalds 
32595da310eSAlan Cox static void belkin_sa_set_termios(struct tty_struct *tty,
32695da310eSAlan Cox 		struct usb_serial_port *port, struct ktermios *old_termios)
3271da177e4SLinus Torvalds {
3281da177e4SLinus Torvalds 	struct usb_serial *serial = port->serial;
3291da177e4SLinus Torvalds 	struct belkin_sa_private *priv = usb_get_serial_port_data(port);
3301da177e4SLinus Torvalds 	unsigned int iflag;
3311da177e4SLinus Torvalds 	unsigned int cflag;
3321da177e4SLinus Torvalds 	unsigned int old_iflag = 0;
3331da177e4SLinus Torvalds 	unsigned int old_cflag = 0;
3341da177e4SLinus Torvalds 	__u16 urb_value = 0; /* Will hold the new flags */
3351da177e4SLinus Torvalds 	unsigned long flags;
3361da177e4SLinus Torvalds 	unsigned long control_state;
3371da177e4SLinus Torvalds 	int bad_flow_control;
3389a8baec7SAlan Cox 	speed_t baud;
33995da310eSAlan Cox 	struct ktermios *termios = tty->termios;
3401da177e4SLinus Torvalds 
3413ec466b4SAlan Cox 	iflag = termios->c_iflag;
3423ec466b4SAlan Cox 	cflag = termios->c_cflag;
3431da177e4SLinus Torvalds 
3443ec466b4SAlan Cox 	termios->c_cflag &= ~CMSPAR;
3451da177e4SLinus Torvalds 
3461da177e4SLinus Torvalds 	/* get a local copy of the current port settings */
3471da177e4SLinus Torvalds 	spin_lock_irqsave(&priv->lock, flags);
3481da177e4SLinus Torvalds 	control_state = priv->control_state;
3491da177e4SLinus Torvalds 	bad_flow_control = priv->bad_flow_control;
3501da177e4SLinus Torvalds 	spin_unlock_irqrestore(&priv->lock, flags);
3511da177e4SLinus Torvalds 
3521da177e4SLinus Torvalds 	old_iflag = old_termios->c_iflag;
3531da177e4SLinus Torvalds 	old_cflag = old_termios->c_cflag;
3541da177e4SLinus Torvalds 
3551da177e4SLinus Torvalds 	/* Set the baud rate */
3561da177e4SLinus Torvalds 	if ((cflag & CBAUD) != (old_cflag & CBAUD)) {
3571da177e4SLinus Torvalds 		/* reassert DTR and (maybe) RTS on transition from B0 */
3581da177e4SLinus Torvalds 		if ((old_cflag & CBAUD) == B0) {
3591da177e4SLinus Torvalds 			control_state |= (TIOCM_DTR|TIOCM_RTS);
3601da177e4SLinus Torvalds 			if (BSA_USB_CMD(BELKIN_SA_SET_DTR_REQUEST, 1) < 0)
361194343d9SGreg Kroah-Hartman 				dev_err(&port->dev, "Set DTR error\n");
3621da177e4SLinus Torvalds 			/* don't set RTS if using hardware flow control */
3631da177e4SLinus Torvalds 			if (!(old_cflag & CRTSCTS))
364b69c1499SAlan Cox 				if (BSA_USB_CMD(BELKIN_SA_SET_RTS_REQUEST
365b69c1499SAlan Cox 								, 1) < 0)
366194343d9SGreg Kroah-Hartman 					dev_err(&port->dev, "Set RTS error\n");
3671da177e4SLinus Torvalds 		}
3681da177e4SLinus Torvalds 	}
3699a8baec7SAlan Cox 
37095da310eSAlan Cox 	baud = tty_get_baud_rate(tty);
3713ec466b4SAlan Cox 	if (baud) {
3729a8baec7SAlan Cox 		urb_value = BELKIN_SA_BAUD(baud);
3739a8baec7SAlan Cox 		/* Clip to maximum speed */
3749a8baec7SAlan Cox 		if (urb_value == 0)
3759a8baec7SAlan Cox 			urb_value = 1;
3769a8baec7SAlan Cox 		/* Turn it back into a resulting real baud rate */
3779a8baec7SAlan Cox 		baud = BELKIN_SA_BAUD(urb_value);
3789a8baec7SAlan Cox 
3793ec466b4SAlan Cox 		/* Report the actual baud rate back to the caller */
38095da310eSAlan Cox 		tty_encode_baud_rate(tty, baud, baud);
3811da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_BAUDRATE_REQUEST, urb_value) < 0)
382194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Set baudrate error\n");
3831da177e4SLinus Torvalds 	} else {
3841da177e4SLinus Torvalds 		/* Disable flow control */
385b69c1499SAlan Cox 		if (BSA_USB_CMD(BELKIN_SA_SET_FLOW_CTRL_REQUEST,
386b69c1499SAlan Cox 						BELKIN_SA_FLOW_NONE) < 0)
387194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Disable flowcontrol error\n");
3881da177e4SLinus Torvalds 		/* Drop RTS and DTR */
3891da177e4SLinus Torvalds 		control_state &= ~(TIOCM_DTR | TIOCM_RTS);
3901da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_DTR_REQUEST, 0) < 0)
391194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "DTR LOW error\n");
3921da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_RTS_REQUEST, 0) < 0)
393194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "RTS LOW error\n");
3941da177e4SLinus Torvalds 	}
3951da177e4SLinus Torvalds 
3961da177e4SLinus Torvalds 	/* set the parity */
397b69c1499SAlan Cox 	if ((cflag ^ old_cflag) & (PARENB | PARODD)) {
3981da177e4SLinus Torvalds 		if (cflag & PARENB)
399b69c1499SAlan Cox 			urb_value = (cflag & PARODD) ?  BELKIN_SA_PARITY_ODD
400b69c1499SAlan Cox 						: BELKIN_SA_PARITY_EVEN;
4011da177e4SLinus Torvalds 		else
4021da177e4SLinus Torvalds 			urb_value = BELKIN_SA_PARITY_NONE;
4031da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_PARITY_REQUEST, urb_value) < 0)
404194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Set parity error\n");
4051da177e4SLinus Torvalds 	}
4061da177e4SLinus Torvalds 
4071da177e4SLinus Torvalds 	/* set the number of data bits */
4081da177e4SLinus Torvalds 	if ((cflag & CSIZE) != (old_cflag & CSIZE)) {
4091da177e4SLinus Torvalds 		switch (cflag & CSIZE) {
410b69c1499SAlan Cox 		case CS5:
411b69c1499SAlan Cox 			urb_value = BELKIN_SA_DATA_BITS(5);
412b69c1499SAlan Cox 			break;
413b69c1499SAlan Cox 		case CS6:
414b69c1499SAlan Cox 			urb_value = BELKIN_SA_DATA_BITS(6);
415b69c1499SAlan Cox 			break;
416b69c1499SAlan Cox 		case CS7:
417b69c1499SAlan Cox 			urb_value = BELKIN_SA_DATA_BITS(7);
418b69c1499SAlan Cox 			break;
419b69c1499SAlan Cox 		case CS8:
420b69c1499SAlan Cox 			urb_value = BELKIN_SA_DATA_BITS(8);
421b69c1499SAlan Cox 			break;
4229a8baec7SAlan Cox 		default: dbg("CSIZE was not CS5-CS8, using default of 8");
4231da177e4SLinus Torvalds 			urb_value = BELKIN_SA_DATA_BITS(8);
4241da177e4SLinus Torvalds 			break;
4251da177e4SLinus Torvalds 		}
4261da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_DATA_BITS_REQUEST, urb_value) < 0)
427194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Set data bits error\n");
4281da177e4SLinus Torvalds 	}
4291da177e4SLinus Torvalds 
4301da177e4SLinus Torvalds 	/* set the number of stop bits */
4311da177e4SLinus Torvalds 	if ((cflag & CSTOPB) != (old_cflag & CSTOPB)) {
432b69c1499SAlan Cox 		urb_value = (cflag & CSTOPB) ? BELKIN_SA_STOP_BITS(2)
433b69c1499SAlan Cox 						: BELKIN_SA_STOP_BITS(1);
434b69c1499SAlan Cox 		if (BSA_USB_CMD(BELKIN_SA_SET_STOP_BITS_REQUEST,
435b69c1499SAlan Cox 							urb_value) < 0)
436194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Set stop bits error\n");
4371da177e4SLinus Torvalds 	}
4381da177e4SLinus Torvalds 
4391da177e4SLinus Torvalds 	/* Set flow control */
440b69c1499SAlan Cox 	if (((iflag ^ old_iflag) & (IXOFF | IXON)) ||
441b69c1499SAlan Cox 		((cflag ^ old_cflag) & CRTSCTS)) {
4421da177e4SLinus Torvalds 		urb_value = 0;
4431da177e4SLinus Torvalds 		if ((iflag & IXOFF) || (iflag & IXON))
4441da177e4SLinus Torvalds 			urb_value |= (BELKIN_SA_FLOW_OXON | BELKIN_SA_FLOW_IXON);
4451da177e4SLinus Torvalds 		else
4461da177e4SLinus Torvalds 			urb_value &= ~(BELKIN_SA_FLOW_OXON | BELKIN_SA_FLOW_IXON);
4471da177e4SLinus Torvalds 
4481da177e4SLinus Torvalds 		if (cflag & CRTSCTS)
4491da177e4SLinus Torvalds 			urb_value |=  (BELKIN_SA_FLOW_OCTS | BELKIN_SA_FLOW_IRTS);
4501da177e4SLinus Torvalds 		else
4511da177e4SLinus Torvalds 			urb_value &= ~(BELKIN_SA_FLOW_OCTS | BELKIN_SA_FLOW_IRTS);
4521da177e4SLinus Torvalds 
4531da177e4SLinus Torvalds 		if (bad_flow_control)
4541da177e4SLinus Torvalds 			urb_value &= ~(BELKIN_SA_FLOW_IRTS);
4551da177e4SLinus Torvalds 
4561da177e4SLinus Torvalds 		if (BSA_USB_CMD(BELKIN_SA_SET_FLOW_CTRL_REQUEST, urb_value) < 0)
457194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "Set flow control error\n");
4581da177e4SLinus Torvalds 	}
4591da177e4SLinus Torvalds 
4601da177e4SLinus Torvalds 	/* save off the modified port settings */
4611da177e4SLinus Torvalds 	spin_lock_irqsave(&priv->lock, flags);
4621da177e4SLinus Torvalds 	priv->control_state = control_state;
4631da177e4SLinus Torvalds 	spin_unlock_irqrestore(&priv->lock, flags);
464726ef428SJohan Hovold }
4651da177e4SLinus Torvalds 
46695da310eSAlan Cox static void belkin_sa_break_ctl(struct tty_struct *tty, int break_state)
4671da177e4SLinus Torvalds {
46895da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
4691da177e4SLinus Torvalds 	struct usb_serial *serial = port->serial;
4701da177e4SLinus Torvalds 
4711da177e4SLinus Torvalds 	if (BSA_USB_CMD(BELKIN_SA_SET_BREAK_REQUEST, break_state ? 1 : 0) < 0)
472194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "Set break_ctl %d\n", break_state);
4731da177e4SLinus Torvalds }
4741da177e4SLinus Torvalds 
47595da310eSAlan Cox static int belkin_sa_tiocmget(struct tty_struct *tty, struct file *file)
4761da177e4SLinus Torvalds {
47795da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
4781da177e4SLinus Torvalds 	struct belkin_sa_private *priv = usb_get_serial_port_data(port);
4791da177e4SLinus Torvalds 	unsigned long control_state;
4801da177e4SLinus Torvalds 	unsigned long flags;
4811da177e4SLinus Torvalds 
482441b62c1SHarvey Harrison 	dbg("%s", __func__);
4831da177e4SLinus Torvalds 
4841da177e4SLinus Torvalds 	spin_lock_irqsave(&priv->lock, flags);
4851da177e4SLinus Torvalds 	control_state = priv->control_state;
4861da177e4SLinus Torvalds 	spin_unlock_irqrestore(&priv->lock, flags);
4871da177e4SLinus Torvalds 
4881da177e4SLinus Torvalds 	return control_state;
4891da177e4SLinus Torvalds }
4901da177e4SLinus Torvalds 
49195da310eSAlan Cox static int belkin_sa_tiocmset(struct tty_struct *tty, struct file *file,
4921da177e4SLinus Torvalds 			       unsigned int set, unsigned int clear)
4931da177e4SLinus Torvalds {
49495da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
4951da177e4SLinus Torvalds 	struct usb_serial *serial = port->serial;
4961da177e4SLinus Torvalds 	struct belkin_sa_private *priv = usb_get_serial_port_data(port);
4971da177e4SLinus Torvalds 	unsigned long control_state;
4981da177e4SLinus Torvalds 	unsigned long flags;
4991da177e4SLinus Torvalds 	int retval;
5001da177e4SLinus Torvalds 	int rts = 0;
5011da177e4SLinus Torvalds 	int dtr = 0;
5021da177e4SLinus Torvalds 
503441b62c1SHarvey Harrison 	dbg("%s", __func__);
5041da177e4SLinus Torvalds 
5051da177e4SLinus Torvalds 	spin_lock_irqsave(&priv->lock, flags);
5061da177e4SLinus Torvalds 	control_state = priv->control_state;
5071da177e4SLinus Torvalds 
5081da177e4SLinus Torvalds 	if (set & TIOCM_RTS) {
5091da177e4SLinus Torvalds 		control_state |= TIOCM_RTS;
5101da177e4SLinus Torvalds 		rts = 1;
5111da177e4SLinus Torvalds 	}
5121da177e4SLinus Torvalds 	if (set & TIOCM_DTR) {
5131da177e4SLinus Torvalds 		control_state |= TIOCM_DTR;
5141da177e4SLinus Torvalds 		dtr = 1;
5151da177e4SLinus Torvalds 	}
5161da177e4SLinus Torvalds 	if (clear & TIOCM_RTS) {
5171da177e4SLinus Torvalds 		control_state &= ~TIOCM_RTS;
5181da177e4SLinus Torvalds 		rts = 0;
5191da177e4SLinus Torvalds 	}
5201da177e4SLinus Torvalds 	if (clear & TIOCM_DTR) {
5211da177e4SLinus Torvalds 		control_state &= ~TIOCM_DTR;
5221da177e4SLinus Torvalds 		dtr = 0;
5231da177e4SLinus Torvalds 	}
5241da177e4SLinus Torvalds 
5251da177e4SLinus Torvalds 	priv->control_state = control_state;
5261da177e4SLinus Torvalds 	spin_unlock_irqrestore(&priv->lock, flags);
5271da177e4SLinus Torvalds 
5281da177e4SLinus Torvalds 	retval = BSA_USB_CMD(BELKIN_SA_SET_RTS_REQUEST, rts);
5291da177e4SLinus Torvalds 	if (retval < 0) {
530194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "Set RTS error %d\n", retval);
5311da177e4SLinus Torvalds 		goto exit;
5321da177e4SLinus Torvalds 	}
5331da177e4SLinus Torvalds 
5341da177e4SLinus Torvalds 	retval = BSA_USB_CMD(BELKIN_SA_SET_DTR_REQUEST, dtr);
5351da177e4SLinus Torvalds 	if (retval < 0) {
536194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "Set DTR error %d\n", retval);
5371da177e4SLinus Torvalds 		goto exit;
5381da177e4SLinus Torvalds 	}
5391da177e4SLinus Torvalds exit:
5401da177e4SLinus Torvalds 	return retval;
5411da177e4SLinus Torvalds }
5421da177e4SLinus Torvalds 
5431da177e4SLinus Torvalds 
5441da177e4SLinus Torvalds static int __init belkin_sa_init(void)
5451da177e4SLinus Torvalds {
5461da177e4SLinus Torvalds 	int retval;
5471da177e4SLinus Torvalds 	retval = usb_serial_register(&belkin_device);
5481da177e4SLinus Torvalds 	if (retval)
5491da177e4SLinus Torvalds 		goto failed_usb_serial_register;
5501da177e4SLinus Torvalds 	retval = usb_register(&belkin_driver);
5511da177e4SLinus Torvalds 	if (retval)
5521da177e4SLinus Torvalds 		goto failed_usb_register;
553c197a8dbSGreg Kroah-Hartman 	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
554c197a8dbSGreg Kroah-Hartman 	       DRIVER_DESC "\n");
5551da177e4SLinus Torvalds 	return 0;
5561da177e4SLinus Torvalds failed_usb_register:
5571da177e4SLinus Torvalds 	usb_serial_deregister(&belkin_device);
5581da177e4SLinus Torvalds failed_usb_serial_register:
5591da177e4SLinus Torvalds 	return retval;
5601da177e4SLinus Torvalds }
5611da177e4SLinus Torvalds 
5621da177e4SLinus Torvalds static void __exit belkin_sa_exit (void)
5631da177e4SLinus Torvalds {
5641da177e4SLinus Torvalds 	usb_deregister(&belkin_driver);
5651da177e4SLinus Torvalds 	usb_serial_deregister(&belkin_device);
5661da177e4SLinus Torvalds }
5671da177e4SLinus Torvalds 
5681da177e4SLinus Torvalds 
5691da177e4SLinus Torvalds module_init(belkin_sa_init);
5701da177e4SLinus Torvalds module_exit(belkin_sa_exit);
5711da177e4SLinus Torvalds 
5721da177e4SLinus Torvalds MODULE_AUTHOR(DRIVER_AUTHOR);
5731da177e4SLinus Torvalds MODULE_DESCRIPTION(DRIVER_DESC);
5741da177e4SLinus Torvalds MODULE_VERSION(DRIVER_VERSION);
5751da177e4SLinus Torvalds MODULE_LICENSE("GPL");
5761da177e4SLinus Torvalds 
5771da177e4SLinus Torvalds module_param(debug, bool, S_IRUGO | S_IWUSR);
5781da177e4SLinus Torvalds MODULE_PARM_DESC(debug, "Debug enabled or not");
579