xref: /openbmc/linux/drivers/usb/serial/mos7840.c (revision a509a7e478e4766114d69f12d19d644ac63e9765)
13f542974SPaul B Schroeder /*
23f542974SPaul B Schroeder  * This program is free software; you can redistribute it and/or modify
33f542974SPaul B Schroeder  * it under the terms of the GNU General Public License as published by
43f542974SPaul B Schroeder  * the Free Software Foundation; either version 2 of the License, or
53f542974SPaul B Schroeder  * (at your option) any later version.
63f542974SPaul B Schroeder  *
73f542974SPaul B Schroeder  * This program is distributed in the hope that it will be useful,
83f542974SPaul B Schroeder  * but WITHOUT ANY WARRANTY; without even the implied warranty of
93f542974SPaul B Schroeder  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
103f542974SPaul B Schroeder  * GNU General Public License for more details.
113f542974SPaul B Schroeder  *
123f542974SPaul B Schroeder  * You should have received a copy of the GNU General Public License
133f542974SPaul B Schroeder  * along with this program; if not, write to the Free Software
143f542974SPaul B Schroeder  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
153f542974SPaul B Schroeder  *
163f542974SPaul B Schroeder  * Clean ups from Moschip version and a few ioctl implementations by:
173f542974SPaul B Schroeder  *	Paul B Schroeder <pschroeder "at" uplogix "dot" com>
183f542974SPaul B Schroeder  *
193f542974SPaul B Schroeder  * Originally based on drivers/usb/serial/io_edgeport.c which is:
203f542974SPaul B Schroeder  *      Copyright (C) 2000 Inside Out Networks, All rights reserved.
213f542974SPaul B Schroeder  *      Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com>
223f542974SPaul B Schroeder  *
233f542974SPaul B Schroeder  */
243f542974SPaul B Schroeder 
253f542974SPaul B Schroeder #include <linux/kernel.h>
263f542974SPaul B Schroeder #include <linux/errno.h>
273f542974SPaul B Schroeder #include <linux/init.h>
283f542974SPaul B Schroeder #include <linux/slab.h>
29405f5571SAlexey Dobriyan #include <linux/smp_lock.h>
303f542974SPaul B Schroeder #include <linux/tty.h>
313f542974SPaul B Schroeder #include <linux/tty_driver.h>
323f542974SPaul B Schroeder #include <linux/tty_flip.h>
333f542974SPaul B Schroeder #include <linux/module.h>
343f542974SPaul B Schroeder #include <linux/serial.h>
353f542974SPaul B Schroeder #include <linux/usb.h>
363f542974SPaul B Schroeder #include <linux/usb/serial.h>
37880af9dbSAlan Cox #include <linux/uaccess.h>
383f542974SPaul B Schroeder 
393f542974SPaul B Schroeder /*
403f542974SPaul B Schroeder  * Version Information
413f542974SPaul B Schroeder  */
4237768adfSTony Cook #define DRIVER_VERSION "1.3.2"
433f542974SPaul B Schroeder #define DRIVER_DESC "Moschip 7840/7820 USB Serial Driver"
443f542974SPaul B Schroeder 
453f542974SPaul B Schroeder /*
463f542974SPaul B Schroeder  * 16C50 UART register defines
473f542974SPaul B Schroeder  */
483f542974SPaul B Schroeder 
493f542974SPaul B Schroeder #define LCR_BITS_5             0x00	/* 5 bits/char */
503f542974SPaul B Schroeder #define LCR_BITS_6             0x01	/* 6 bits/char */
513f542974SPaul B Schroeder #define LCR_BITS_7             0x02	/* 7 bits/char */
523f542974SPaul B Schroeder #define LCR_BITS_8             0x03	/* 8 bits/char */
533f542974SPaul B Schroeder #define LCR_BITS_MASK          0x03	/* Mask for bits/char field */
543f542974SPaul B Schroeder 
553f542974SPaul B Schroeder #define LCR_STOP_1             0x00	/* 1 stop bit */
563f542974SPaul B Schroeder #define LCR_STOP_1_5           0x04	/* 1.5 stop bits (if 5   bits/char) */
573f542974SPaul B Schroeder #define LCR_STOP_2             0x04	/* 2 stop bits   (if 6-8 bits/char) */
583f542974SPaul B Schroeder #define LCR_STOP_MASK          0x04	/* Mask for stop bits field */
593f542974SPaul B Schroeder 
603f542974SPaul B Schroeder #define LCR_PAR_NONE           0x00	/* No parity */
613f542974SPaul B Schroeder #define LCR_PAR_ODD            0x08	/* Odd parity */
623f542974SPaul B Schroeder #define LCR_PAR_EVEN           0x18	/* Even parity */
633f542974SPaul B Schroeder #define LCR_PAR_MARK           0x28	/* Force parity bit to 1 */
643f542974SPaul B Schroeder #define LCR_PAR_SPACE          0x38	/* Force parity bit to 0 */
653f542974SPaul B Schroeder #define LCR_PAR_MASK           0x38	/* Mask for parity field */
663f542974SPaul B Schroeder 
673f542974SPaul B Schroeder #define LCR_SET_BREAK          0x40	/* Set Break condition */
683f542974SPaul B Schroeder #define LCR_DL_ENABLE          0x80	/* Enable access to divisor latch */
693f542974SPaul B Schroeder 
703f542974SPaul B Schroeder #define MCR_DTR                0x01	/* Assert DTR */
713f542974SPaul B Schroeder #define MCR_RTS                0x02	/* Assert RTS */
723f542974SPaul B Schroeder #define MCR_OUT1               0x04	/* Loopback only: Sets state of RI */
733f542974SPaul B Schroeder #define MCR_MASTER_IE          0x08	/* Enable interrupt outputs */
743f542974SPaul B Schroeder #define MCR_LOOPBACK           0x10	/* Set internal (digital) loopback mode */
753f542974SPaul B Schroeder #define MCR_XON_ANY            0x20	/* Enable any char to exit XOFF mode */
763f542974SPaul B Schroeder 
773f542974SPaul B Schroeder #define MOS7840_MSR_CTS        0x10	/* Current state of CTS */
783f542974SPaul B Schroeder #define MOS7840_MSR_DSR        0x20	/* Current state of DSR */
793f542974SPaul B Schroeder #define MOS7840_MSR_RI         0x40	/* Current state of RI */
803f542974SPaul B Schroeder #define MOS7840_MSR_CD         0x80	/* Current state of CD */
813f542974SPaul B Schroeder 
823f542974SPaul B Schroeder /*
833f542974SPaul B Schroeder  * Defines used for sending commands to port
843f542974SPaul B Schroeder  */
853f542974SPaul B Schroeder 
863f542974SPaul B Schroeder #define WAIT_FOR_EVER   (HZ * 0)	/* timeout urb is wait for ever */
873f542974SPaul B Schroeder #define MOS_WDR_TIMEOUT (HZ * 5)	/* default urb timeout */
883f542974SPaul B Schroeder 
893f542974SPaul B Schroeder #define MOS_PORT1       0x0200
903f542974SPaul B Schroeder #define MOS_PORT2       0x0300
913f542974SPaul B Schroeder #define MOS_VENREG      0x0000
923f542974SPaul B Schroeder #define MOS_MAX_PORT	0x02
933f542974SPaul B Schroeder #define MOS_WRITE       0x0E
943f542974SPaul B Schroeder #define MOS_READ        0x0D
953f542974SPaul B Schroeder 
963f542974SPaul B Schroeder /* Requests */
973f542974SPaul B Schroeder #define MCS_RD_RTYPE    0xC0
983f542974SPaul B Schroeder #define MCS_WR_RTYPE    0x40
993f542974SPaul B Schroeder #define MCS_RDREQ       0x0D
1003f542974SPaul B Schroeder #define MCS_WRREQ       0x0E
1013f542974SPaul B Schroeder #define MCS_CTRL_TIMEOUT        500
1023f542974SPaul B Schroeder #define VENDOR_READ_LENGTH      (0x01)
1033f542974SPaul B Schroeder 
1043f542974SPaul B Schroeder #define MAX_NAME_LEN    64
1053f542974SPaul B Schroeder 
106880af9dbSAlan Cox #define ZLP_REG1  0x3A		/* Zero_Flag_Reg1    58 */
107880af9dbSAlan Cox #define ZLP_REG5  0x3E		/* Zero_Flag_Reg5    62 */
1083f542974SPaul B Schroeder 
1093f542974SPaul B Schroeder /* For higher baud Rates use TIOCEXBAUD */
1103f542974SPaul B Schroeder #define TIOCEXBAUD     0x5462
1113f542974SPaul B Schroeder 
1123f542974SPaul B Schroeder /* vendor id and device id defines */
1133f542974SPaul B Schroeder 
11411e1abb4SDavid Ludlow /* The native mos7840/7820 component */
1153f542974SPaul B Schroeder #define USB_VENDOR_ID_MOSCHIP           0x9710
1163f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7840          0x7840
1173f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7820          0x7820
11811e1abb4SDavid Ludlow /* The native component can have its vendor/device id's overridden
11911e1abb4SDavid Ludlow  * in vendor-specific implementations.  Such devices can be handled
12011e1abb4SDavid Ludlow  * by making a change here, in moschip_port_id_table, and in
12111e1abb4SDavid Ludlow  * moschip_id_table_combined
12211e1abb4SDavid Ludlow  */
12311e1abb4SDavid Ludlow #define USB_VENDOR_ID_BANDB             0x0856
12411e1abb4SDavid Ludlow #define BANDB_DEVICE_ID_USOPTL4_4       0xAC44
12511e1abb4SDavid Ludlow #define BANDB_DEVICE_ID_USOPTL4_2       0xAC42
1263f542974SPaul B Schroeder 
1279d498beaSRussell Lang /* This driver also supports
1289d498beaSRussell Lang  * ATEN UC2324 device using Moschip MCS7840
1299d498beaSRussell Lang  * ATEN UC2322 device using Moschip MCS7820
1309d498beaSRussell Lang  */
131e9b8cffaSTony Cook #define USB_VENDOR_ID_ATENINTL		0x0557
132e9b8cffaSTony Cook #define ATENINTL_DEVICE_ID_UC2324	0x2011
1339d498beaSRussell Lang #define ATENINTL_DEVICE_ID_UC2322	0x7820
134e9b8cffaSTony Cook 
13511e1abb4SDavid Ludlow /* Interrupt Routine Defines    */
1363f542974SPaul B Schroeder 
1373f542974SPaul B Schroeder #define SERIAL_IIR_RLS      0x06
1383f542974SPaul B Schroeder #define SERIAL_IIR_MS       0x00
1393f542974SPaul B Schroeder 
1403f542974SPaul B Schroeder /*
1413f542974SPaul B Schroeder  *  Emulation of the bit mask on the LINE STATUS REGISTER.
1423f542974SPaul B Schroeder  */
1433f542974SPaul B Schroeder #define SERIAL_LSR_DR       0x0001
1443f542974SPaul B Schroeder #define SERIAL_LSR_OE       0x0002
1453f542974SPaul B Schroeder #define SERIAL_LSR_PE       0x0004
1463f542974SPaul B Schroeder #define SERIAL_LSR_FE       0x0008
1473f542974SPaul B Schroeder #define SERIAL_LSR_BI       0x0010
1483f542974SPaul B Schroeder 
1493f542974SPaul B Schroeder #define MOS_MSR_DELTA_CTS   0x10
1503f542974SPaul B Schroeder #define MOS_MSR_DELTA_DSR   0x20
1513f542974SPaul B Schroeder #define MOS_MSR_DELTA_RI    0x40
1523f542974SPaul B Schroeder #define MOS_MSR_DELTA_CD    0x80
1533f542974SPaul B Schroeder 
154880af9dbSAlan Cox /* Serial Port register Address */
1553f542974SPaul B Schroeder #define INTERRUPT_ENABLE_REGISTER  ((__u16)(0x01))
1563f542974SPaul B Schroeder #define FIFO_CONTROL_REGISTER      ((__u16)(0x02))
1573f542974SPaul B Schroeder #define LINE_CONTROL_REGISTER      ((__u16)(0x03))
1583f542974SPaul B Schroeder #define MODEM_CONTROL_REGISTER     ((__u16)(0x04))
1593f542974SPaul B Schroeder #define LINE_STATUS_REGISTER       ((__u16)(0x05))
1603f542974SPaul B Schroeder #define MODEM_STATUS_REGISTER      ((__u16)(0x06))
1613f542974SPaul B Schroeder #define SCRATCH_PAD_REGISTER       ((__u16)(0x07))
1623f542974SPaul B Schroeder #define DIVISOR_LATCH_LSB          ((__u16)(0x00))
1633f542974SPaul B Schroeder #define DIVISOR_LATCH_MSB          ((__u16)(0x01))
1643f542974SPaul B Schroeder 
1653f542974SPaul B Schroeder #define CLK_MULTI_REGISTER         ((__u16)(0x02))
1663f542974SPaul B Schroeder #define CLK_START_VALUE_REGISTER   ((__u16)(0x03))
1673f542974SPaul B Schroeder 
1683f542974SPaul B Schroeder #define SERIAL_LCR_DLAB            ((__u16)(0x0080))
1693f542974SPaul B Schroeder 
1703f542974SPaul B Schroeder /*
1713f542974SPaul B Schroeder  * URB POOL related defines
1723f542974SPaul B Schroeder  */
1733f542974SPaul B Schroeder #define NUM_URBS                        16	/* URB Count */
1743f542974SPaul B Schroeder #define URB_TRANSFER_BUFFER_SIZE        32	/* URB Size  */
1753f542974SPaul B Schroeder 
1763f542974SPaul B Schroeder 
1773f542974SPaul B Schroeder static struct usb_device_id moschip_port_id_table[] = {
1783f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
1793f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
18011e1abb4SDavid Ludlow 	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
18111e1abb4SDavid Ludlow 	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
182e9b8cffaSTony Cook 	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
1839d498beaSRussell Lang 	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
1843f542974SPaul B Schroeder 	{}			/* terminating entry */
1853f542974SPaul B Schroeder };
1863f542974SPaul B Schroeder 
1873f542974SPaul B Schroeder static __devinitdata struct usb_device_id moschip_id_table_combined[] = {
1883f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
1893f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
19011e1abb4SDavid Ludlow 	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
19111e1abb4SDavid Ludlow 	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
192e9b8cffaSTony Cook 	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
1939d498beaSRussell Lang 	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
1943f542974SPaul B Schroeder 	{}			/* terminating entry */
1953f542974SPaul B Schroeder };
1963f542974SPaul B Schroeder 
1973f542974SPaul B Schroeder MODULE_DEVICE_TABLE(usb, moschip_id_table_combined);
1983f542974SPaul B Schroeder 
1993f542974SPaul B Schroeder /* This structure holds all of the local port information */
2003f542974SPaul B Schroeder 
2013f542974SPaul B Schroeder struct moschip_port {
2023f542974SPaul B Schroeder 	int port_num;		/*Actual port number in the device(1,2,etc) */
2033f542974SPaul B Schroeder 	struct urb *write_urb;	/* write URB for this port */
2043f542974SPaul B Schroeder 	struct urb *read_urb;	/* read URB for this port */
2050de9a702SOliver Neukum 	struct urb *int_urb;
2063f542974SPaul B Schroeder 	__u8 shadowLCR;		/* last LCR value received */
2073f542974SPaul B Schroeder 	__u8 shadowMCR;		/* last MCR value received */
2083f542974SPaul B Schroeder 	char open;
2090de9a702SOliver Neukum 	char open_ports;
2100de9a702SOliver Neukum 	char zombie;
2113f542974SPaul B Schroeder 	wait_queue_head_t wait_chase;	/* for handling sleeping while waiting for chase to finish */
2123f542974SPaul B Schroeder 	wait_queue_head_t delta_msr_wait;	/* for handling sleeping while waiting for msr change to happen */
2133f542974SPaul B Schroeder 	int delta_msr_cond;
2143f542974SPaul B Schroeder 	struct async_icount icount;
2153f542974SPaul B Schroeder 	struct usb_serial_port *port;	/* loop back to the owner of this object */
2163f542974SPaul B Schroeder 
2173f542974SPaul B Schroeder 	/* Offsets */
2183f542974SPaul B Schroeder 	__u8 SpRegOffset;
2193f542974SPaul B Schroeder 	__u8 ControlRegOffset;
2203f542974SPaul B Schroeder 	__u8 DcrRegOffset;
221880af9dbSAlan Cox 	/* for processing control URBS in interrupt context */
2223f542974SPaul B Schroeder 	struct urb *control_urb;
2230de9a702SOliver Neukum 	struct usb_ctrlrequest *dr;
2243f542974SPaul B Schroeder 	char *ctrl_buf;
2253f542974SPaul B Schroeder 	int MsrLsr;
2263f542974SPaul B Schroeder 
2270de9a702SOliver Neukum 	spinlock_t pool_lock;
2283f542974SPaul B Schroeder 	struct urb *write_urb_pool[NUM_URBS];
2290de9a702SOliver Neukum 	char busy[NUM_URBS];
23050de36f7SGreg Kroah-Hartman 	bool read_urb_busy;
2313f542974SPaul B Schroeder };
2323f542974SPaul B Schroeder 
2333f542974SPaul B Schroeder 
2343f542974SPaul B Schroeder static int debug;
2353f542974SPaul B Schroeder 
2363f542974SPaul B Schroeder /*
2373f542974SPaul B Schroeder  * mos7840_set_reg_sync
2383f542974SPaul B Schroeder  * 	To set the Control register by calling usb_fill_control_urb function
2393f542974SPaul B Schroeder  *	by passing usb_sndctrlpipe function as parameter.
2403f542974SPaul B Schroeder  */
2413f542974SPaul B Schroeder 
2423f542974SPaul B Schroeder static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg,
2433f542974SPaul B Schroeder 				__u16 val)
2443f542974SPaul B Schroeder {
2453f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
2463f542974SPaul B Schroeder 	val = val & 0x00ff;
24784fe6e79STony Cook 	dbg("mos7840_set_reg_sync offset is %x, value %x", reg, val);
2483f542974SPaul B Schroeder 
2493f542974SPaul B Schroeder 	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
2503f542974SPaul B Schroeder 			       MCS_WR_RTYPE, val, reg, NULL, 0,
2513f542974SPaul B Schroeder 			       MOS_WDR_TIMEOUT);
2523f542974SPaul B Schroeder }
2533f542974SPaul B Schroeder 
2543f542974SPaul B Schroeder /*
2553f542974SPaul B Schroeder  * mos7840_get_reg_sync
2563f542974SPaul B Schroeder  * 	To set the Uart register by calling usb_fill_control_urb function by
2573f542974SPaul B Schroeder  *	passing usb_rcvctrlpipe function as parameter.
2583f542974SPaul B Schroeder  */
2593f542974SPaul B Schroeder 
2603f542974SPaul B Schroeder static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg,
2613f542974SPaul B Schroeder 				__u16 *val)
2623f542974SPaul B Schroeder {
2633f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
2643f542974SPaul B Schroeder 	int ret = 0;
2653f542974SPaul B Schroeder 
2663f542974SPaul B Schroeder 	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
2673f542974SPaul B Schroeder 			      MCS_RD_RTYPE, 0, reg, val, VENDOR_READ_LENGTH,
2683f542974SPaul B Schroeder 			      MOS_WDR_TIMEOUT);
26984fe6e79STony Cook 	dbg("mos7840_get_reg_sync offset is %x, return val %x", reg, *val);
2703f542974SPaul B Schroeder 	*val = (*val) & 0x00ff;
2713f542974SPaul B Schroeder 	return ret;
2723f542974SPaul B Schroeder }
2733f542974SPaul B Schroeder 
2743f542974SPaul B Schroeder /*
2753f542974SPaul B Schroeder  * mos7840_set_uart_reg
2763f542974SPaul B Schroeder  *	To set the Uart register by calling usb_fill_control_urb function by
2773f542974SPaul B Schroeder  *	passing usb_sndctrlpipe function as parameter.
2783f542974SPaul B Schroeder  */
2793f542974SPaul B Schroeder 
2803f542974SPaul B Schroeder static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg,
2813f542974SPaul B Schroeder 				__u16 val)
2823f542974SPaul B Schroeder {
2833f542974SPaul B Schroeder 
2843f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
2853f542974SPaul B Schroeder 	val = val & 0x00ff;
286880af9dbSAlan Cox 	/* For the UART control registers, the application number need
287880af9dbSAlan Cox 	   to be Or'ed */
2880de9a702SOliver Neukum 	if (port->serial->num_ports == 4) {
289880af9dbSAlan Cox 		val |= (((__u16) port->number -
290880af9dbSAlan Cox 				(__u16) (port->serial->minor)) + 1) << 8;
29184fe6e79STony Cook 		dbg("mos7840_set_uart_reg application number is %x", val);
2923f542974SPaul B Schroeder 	} else {
2933f542974SPaul B Schroeder 		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
294880af9dbSAlan Cox 			val |= (((__u16) port->number -
2953f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 1) << 8;
29684fe6e79STony Cook 			dbg("mos7840_set_uart_reg application number is %x",
2973f542974SPaul B Schroeder 			    val);
2983f542974SPaul B Schroeder 		} else {
2993f542974SPaul B Schroeder 			val |=
3003f542974SPaul B Schroeder 			    (((__u16) port->number -
3013f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 2) << 8;
30284fe6e79STony Cook 			dbg("mos7840_set_uart_reg application number is %x",
3033f542974SPaul B Schroeder 			    val);
3043f542974SPaul B Schroeder 		}
3053f542974SPaul B Schroeder 	}
3063f542974SPaul B Schroeder 	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
3073f542974SPaul B Schroeder 			       MCS_WR_RTYPE, val, reg, NULL, 0,
3083f542974SPaul B Schroeder 			       MOS_WDR_TIMEOUT);
3093f542974SPaul B Schroeder 
3103f542974SPaul B Schroeder }
3113f542974SPaul B Schroeder 
3123f542974SPaul B Schroeder /*
3133f542974SPaul B Schroeder  * mos7840_get_uart_reg
3143f542974SPaul B Schroeder  *	To set the Control register by calling usb_fill_control_urb function
3153f542974SPaul B Schroeder  *	by passing usb_rcvctrlpipe function as parameter.
3163f542974SPaul B Schroeder  */
3173f542974SPaul B Schroeder static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg,
3183f542974SPaul B Schroeder 				__u16 *val)
3193f542974SPaul B Schroeder {
3203f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
3213f542974SPaul B Schroeder 	int ret = 0;
3223f542974SPaul B Schroeder 	__u16 Wval;
3233f542974SPaul B Schroeder 
32484fe6e79STony Cook 	/* dbg("application number is %4x",
325880af9dbSAlan Cox 	    (((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); */
3263f542974SPaul B Schroeder 	/* Wval  is same as application number */
3270de9a702SOliver Neukum 	if (port->serial->num_ports == 4) {
3283f542974SPaul B Schroeder 		Wval =
3293f542974SPaul B Schroeder 		    (((__u16) port->number - (__u16) (port->serial->minor)) +
3303f542974SPaul B Schroeder 		     1) << 8;
33184fe6e79STony Cook 		dbg("mos7840_get_uart_reg application number is %x", Wval);
3323f542974SPaul B Schroeder 	} else {
3333f542974SPaul B Schroeder 		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
334880af9dbSAlan Cox 			Wval = (((__u16) port->number -
3353f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 1) << 8;
33684fe6e79STony Cook 			dbg("mos7840_get_uart_reg application number is %x",
3373f542974SPaul B Schroeder 			    Wval);
3383f542974SPaul B Schroeder 		} else {
339880af9dbSAlan Cox 			Wval = (((__u16) port->number -
3403f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 2) << 8;
34184fe6e79STony Cook 			dbg("mos7840_get_uart_reg application number is %x",
3423f542974SPaul B Schroeder 			    Wval);
3433f542974SPaul B Schroeder 		}
3443f542974SPaul B Schroeder 	}
3453f542974SPaul B Schroeder 	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
3463f542974SPaul B Schroeder 			      MCS_RD_RTYPE, Wval, reg, val, VENDOR_READ_LENGTH,
3473f542974SPaul B Schroeder 			      MOS_WDR_TIMEOUT);
3483f542974SPaul B Schroeder 	*val = (*val) & 0x00ff;
3493f542974SPaul B Schroeder 	return ret;
3503f542974SPaul B Schroeder }
3513f542974SPaul B Schroeder 
3523f542974SPaul B Schroeder static void mos7840_dump_serial_port(struct moschip_port *mos7840_port)
3533f542974SPaul B Schroeder {
3543f542974SPaul B Schroeder 
35584fe6e79STony Cook 	dbg("***************************************");
35684fe6e79STony Cook 	dbg("SpRegOffset is %2x", mos7840_port->SpRegOffset);
35784fe6e79STony Cook 	dbg("ControlRegOffset is %2x", mos7840_port->ControlRegOffset);
35884fe6e79STony Cook 	dbg("DCRRegOffset is %2x", mos7840_port->DcrRegOffset);
35984fe6e79STony Cook 	dbg("***************************************");
3603f542974SPaul B Schroeder 
3613f542974SPaul B Schroeder }
3623f542974SPaul B Schroeder 
3633f542974SPaul B Schroeder /************************************************************************/
3643f542974SPaul B Schroeder /************************************************************************/
3653f542974SPaul B Schroeder /*             I N T E R F A C E   F U N C T I O N S			*/
3663f542974SPaul B Schroeder /*             I N T E R F A C E   F U N C T I O N S			*/
3673f542974SPaul B Schroeder /************************************************************************/
3683f542974SPaul B Schroeder /************************************************************************/
3693f542974SPaul B Schroeder 
3703f542974SPaul B Schroeder static inline void mos7840_set_port_private(struct usb_serial_port *port,
3713f542974SPaul B Schroeder 					    struct moschip_port *data)
3723f542974SPaul B Schroeder {
3733f542974SPaul B Schroeder 	usb_set_serial_port_data(port, (void *)data);
3743f542974SPaul B Schroeder }
3753f542974SPaul B Schroeder 
3763f542974SPaul B Schroeder static inline struct moschip_port *mos7840_get_port_private(struct
3773f542974SPaul B Schroeder 							    usb_serial_port
3783f542974SPaul B Schroeder 							    *port)
3793f542974SPaul B Schroeder {
3803f542974SPaul B Schroeder 	return (struct moschip_port *)usb_get_serial_port_data(port);
3813f542974SPaul B Schroeder }
3823f542974SPaul B Schroeder 
3830de9a702SOliver Neukum static void mos7840_handle_new_msr(struct moschip_port *port, __u8 new_msr)
3843f542974SPaul B Schroeder {
3853f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
3863f542974SPaul B Schroeder 	struct async_icount *icount;
3873f542974SPaul B Schroeder 	mos7840_port = port;
3883f542974SPaul B Schroeder 	icount = &mos7840_port->icount;
3893f542974SPaul B Schroeder 	if (new_msr &
3903f542974SPaul B Schroeder 	    (MOS_MSR_DELTA_CTS | MOS_MSR_DELTA_DSR | MOS_MSR_DELTA_RI |
3913f542974SPaul B Schroeder 	     MOS_MSR_DELTA_CD)) {
3923f542974SPaul B Schroeder 		icount = &mos7840_port->icount;
3933f542974SPaul B Schroeder 
3943f542974SPaul B Schroeder 		/* update input line counters */
3953f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_CTS) {
3963f542974SPaul B Schroeder 			icount->cts++;
3970de9a702SOliver Neukum 			smp_wmb();
3983f542974SPaul B Schroeder 		}
3993f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_DSR) {
4003f542974SPaul B Schroeder 			icount->dsr++;
4010de9a702SOliver Neukum 			smp_wmb();
4023f542974SPaul B Schroeder 		}
4033f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_CD) {
4043f542974SPaul B Schroeder 			icount->dcd++;
4050de9a702SOliver Neukum 			smp_wmb();
4063f542974SPaul B Schroeder 		}
4073f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_RI) {
4083f542974SPaul B Schroeder 			icount->rng++;
4090de9a702SOliver Neukum 			smp_wmb();
4100de9a702SOliver Neukum 		}
4113f542974SPaul B Schroeder 	}
4123f542974SPaul B Schroeder }
4133f542974SPaul B Schroeder 
4140de9a702SOliver Neukum static void mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr)
4153f542974SPaul B Schroeder {
4163f542974SPaul B Schroeder 	struct async_icount *icount;
4173f542974SPaul B Schroeder 
418441b62c1SHarvey Harrison 	dbg("%s - %02x", __func__, new_lsr);
4193f542974SPaul B Schroeder 
4203f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_BI) {
421880af9dbSAlan Cox 		/*
422880af9dbSAlan Cox 		 * Parity and Framing errors only count if they
423880af9dbSAlan Cox 		 * occur exclusive of a break being
424880af9dbSAlan Cox 		 * received.
425880af9dbSAlan Cox 		 */
4263f542974SPaul B Schroeder 		new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI);
4273f542974SPaul B Schroeder 	}
4283f542974SPaul B Schroeder 
4293f542974SPaul B Schroeder 	/* update input line counters */
4303f542974SPaul B Schroeder 	icount = &port->icount;
4313f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_BI) {
4323f542974SPaul B Schroeder 		icount->brk++;
4330de9a702SOliver Neukum 		smp_wmb();
4343f542974SPaul B Schroeder 	}
4353f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_OE) {
4363f542974SPaul B Schroeder 		icount->overrun++;
4370de9a702SOliver Neukum 		smp_wmb();
4383f542974SPaul B Schroeder 	}
4393f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_PE) {
4403f542974SPaul B Schroeder 		icount->parity++;
4410de9a702SOliver Neukum 		smp_wmb();
4423f542974SPaul B Schroeder 	}
4433f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_FE) {
4443f542974SPaul B Schroeder 		icount->frame++;
4450de9a702SOliver Neukum 		smp_wmb();
4463f542974SPaul B Schroeder 	}
4473f542974SPaul B Schroeder }
4483f542974SPaul B Schroeder 
4493f542974SPaul B Schroeder /************************************************************************/
4503f542974SPaul B Schroeder /************************************************************************/
4513f542974SPaul B Schroeder /*            U S B  C A L L B A C K   F U N C T I O N S                */
4523f542974SPaul B Schroeder /*            U S B  C A L L B A C K   F U N C T I O N S                */
4533f542974SPaul B Schroeder /************************************************************************/
4543f542974SPaul B Schroeder /************************************************************************/
4553f542974SPaul B Schroeder 
4567d12e780SDavid Howells static void mos7840_control_callback(struct urb *urb)
4573f542974SPaul B Schroeder {
4583f542974SPaul B Schroeder 	unsigned char *data;
4593f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
4603f542974SPaul B Schroeder 	__u8 regval = 0x0;
4610de9a702SOliver Neukum 	int result = 0;
4620643c724SGreg Kroah-Hartman 	int status = urb->status;
4633f542974SPaul B Schroeder 
464cdc97792SMing Lei 	mos7840_port = urb->context;
4650de9a702SOliver Neukum 
4660643c724SGreg Kroah-Hartman 	switch (status) {
4673f542974SPaul B Schroeder 	case 0:
4683f542974SPaul B Schroeder 		/* success */
4693f542974SPaul B Schroeder 		break;
4703f542974SPaul B Schroeder 	case -ECONNRESET:
4713f542974SPaul B Schroeder 	case -ENOENT:
4723f542974SPaul B Schroeder 	case -ESHUTDOWN:
4733f542974SPaul B Schroeder 		/* this urb is terminated, clean up */
474441b62c1SHarvey Harrison 		dbg("%s - urb shutting down with status: %d", __func__,
4750643c724SGreg Kroah-Hartman 		    status);
4763f542974SPaul B Schroeder 		return;
4773f542974SPaul B Schroeder 	default:
478441b62c1SHarvey Harrison 		dbg("%s - nonzero urb status received: %d", __func__,
4790643c724SGreg Kroah-Hartman 		    status);
4803f542974SPaul B Schroeder 		goto exit;
4813f542974SPaul B Schroeder 	}
4823f542974SPaul B Schroeder 
48384fe6e79STony Cook 	dbg("%s urb buffer size is %d", __func__, urb->actual_length);
48484fe6e79STony Cook 	dbg("%s mos7840_port->MsrLsr is %d port %d", __func__,
4853f542974SPaul B Schroeder 	    mos7840_port->MsrLsr, mos7840_port->port_num);
4863f542974SPaul B Schroeder 	data = urb->transfer_buffer;
4873f542974SPaul B Schroeder 	regval = (__u8) data[0];
48884fe6e79STony Cook 	dbg("%s data is %x", __func__, regval);
4893f542974SPaul B Schroeder 	if (mos7840_port->MsrLsr == 0)
4903f542974SPaul B Schroeder 		mos7840_handle_new_msr(mos7840_port, regval);
4913f542974SPaul B Schroeder 	else if (mos7840_port->MsrLsr == 1)
4923f542974SPaul B Schroeder 		mos7840_handle_new_lsr(mos7840_port, regval);
4933f542974SPaul B Schroeder 
4943f542974SPaul B Schroeder exit:
4950de9a702SOliver Neukum 	spin_lock(&mos7840_port->pool_lock);
4960de9a702SOliver Neukum 	if (!mos7840_port->zombie)
4970de9a702SOliver Neukum 		result = usb_submit_urb(mos7840_port->int_urb, GFP_ATOMIC);
4980de9a702SOliver Neukum 	spin_unlock(&mos7840_port->pool_lock);
4990de9a702SOliver Neukum 	if (result) {
5000de9a702SOliver Neukum 		dev_err(&urb->dev->dev,
5010de9a702SOliver Neukum 			"%s - Error %d submitting interrupt urb\n",
502441b62c1SHarvey Harrison 			__func__, result);
5030de9a702SOliver Neukum 	}
5043f542974SPaul B Schroeder }
5053f542974SPaul B Schroeder 
5063f542974SPaul B Schroeder static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg,
5073f542974SPaul B Schroeder 			   __u16 *val)
5083f542974SPaul B Schroeder {
5093f542974SPaul B Schroeder 	struct usb_device *dev = mcs->port->serial->dev;
5100de9a702SOliver Neukum 	struct usb_ctrlrequest *dr = mcs->dr;
5110de9a702SOliver Neukum 	unsigned char *buffer = mcs->ctrl_buf;
5120de9a702SOliver Neukum 	int ret;
5133f542974SPaul B Schroeder 
5143f542974SPaul B Schroeder 	dr->bRequestType = MCS_RD_RTYPE;
5153f542974SPaul B Schroeder 	dr->bRequest = MCS_RDREQ;
516880af9dbSAlan Cox 	dr->wValue = cpu_to_le16(Wval);	/* 0 */
5173f542974SPaul B Schroeder 	dr->wIndex = cpu_to_le16(reg);
5183f542974SPaul B Schroeder 	dr->wLength = cpu_to_le16(2);
5193f542974SPaul B Schroeder 
5203f542974SPaul B Schroeder 	usb_fill_control_urb(mcs->control_urb, dev, usb_rcvctrlpipe(dev, 0),
5213f542974SPaul B Schroeder 			     (unsigned char *)dr, buffer, 2,
5223f542974SPaul B Schroeder 			     mos7840_control_callback, mcs);
5233f542974SPaul B Schroeder 	mcs->control_urb->transfer_buffer_length = 2;
5243f542974SPaul B Schroeder 	ret = usb_submit_urb(mcs->control_urb, GFP_ATOMIC);
5253f542974SPaul B Schroeder 	return ret;
5263f542974SPaul B Schroeder }
5273f542974SPaul B Schroeder 
5283f542974SPaul B Schroeder /*****************************************************************************
5293f542974SPaul B Schroeder  * mos7840_interrupt_callback
5303f542974SPaul B Schroeder  *	this is the callback function for when we have received data on the
5313f542974SPaul B Schroeder  *	interrupt endpoint.
5323f542974SPaul B Schroeder  *****************************************************************************/
5333f542974SPaul B Schroeder 
5347d12e780SDavid Howells static void mos7840_interrupt_callback(struct urb *urb)
5353f542974SPaul B Schroeder {
5363f542974SPaul B Schroeder 	int result;
5373f542974SPaul B Schroeder 	int length;
5383f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
5393f542974SPaul B Schroeder 	struct usb_serial *serial;
5403f542974SPaul B Schroeder 	__u16 Data;
5413f542974SPaul B Schroeder 	unsigned char *data;
5423f542974SPaul B Schroeder 	__u8 sp[5], st;
5430de9a702SOliver Neukum 	int i, rv = 0;
5440de9a702SOliver Neukum 	__u16 wval, wreg = 0;
5450643c724SGreg Kroah-Hartman 	int status = urb->status;
5463f542974SPaul B Schroeder 
54784fe6e79STony Cook 	dbg("%s", " : Entering");
5483f542974SPaul B Schroeder 
5490643c724SGreg Kroah-Hartman 	switch (status) {
5503f542974SPaul B Schroeder 	case 0:
5513f542974SPaul B Schroeder 		/* success */
5523f542974SPaul B Schroeder 		break;
5533f542974SPaul B Schroeder 	case -ECONNRESET:
5543f542974SPaul B Schroeder 	case -ENOENT:
5553f542974SPaul B Schroeder 	case -ESHUTDOWN:
5563f542974SPaul B Schroeder 		/* this urb is terminated, clean up */
557441b62c1SHarvey Harrison 		dbg("%s - urb shutting down with status: %d", __func__,
5580643c724SGreg Kroah-Hartman 		    status);
5593f542974SPaul B Schroeder 		return;
5603f542974SPaul B Schroeder 	default:
561441b62c1SHarvey Harrison 		dbg("%s - nonzero urb status received: %d", __func__,
5620643c724SGreg Kroah-Hartman 		    status);
5633f542974SPaul B Schroeder 		goto exit;
5643f542974SPaul B Schroeder 	}
5653f542974SPaul B Schroeder 
5663f542974SPaul B Schroeder 	length = urb->actual_length;
5673f542974SPaul B Schroeder 	data = urb->transfer_buffer;
5683f542974SPaul B Schroeder 
569cdc97792SMing Lei 	serial = urb->context;
5703f542974SPaul B Schroeder 
5713f542974SPaul B Schroeder 	/* Moschip get 5 bytes
5723f542974SPaul B Schroeder 	 * Byte 1 IIR Port 1 (port.number is 0)
5733f542974SPaul B Schroeder 	 * Byte 2 IIR Port 2 (port.number is 1)
5743f542974SPaul B Schroeder 	 * Byte 3 IIR Port 3 (port.number is 2)
5753f542974SPaul B Schroeder 	 * Byte 4 IIR Port 4 (port.number is 3)
5763f542974SPaul B Schroeder 	 * Byte 5 FIFO status for both */
5773f542974SPaul B Schroeder 
5783f542974SPaul B Schroeder 	if (length && length > 5) {
57984fe6e79STony Cook 		dbg("%s", "Wrong data !!!");
5803f542974SPaul B Schroeder 		return;
5813f542974SPaul B Schroeder 	}
5823f542974SPaul B Schroeder 
5833f542974SPaul B Schroeder 	sp[0] = (__u8) data[0];
5843f542974SPaul B Schroeder 	sp[1] = (__u8) data[1];
5853f542974SPaul B Schroeder 	sp[2] = (__u8) data[2];
5863f542974SPaul B Schroeder 	sp[3] = (__u8) data[3];
5873f542974SPaul B Schroeder 	st = (__u8) data[4];
5883f542974SPaul B Schroeder 
5893f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; i++) {
5903f542974SPaul B Schroeder 		mos7840_port = mos7840_get_port_private(serial->port[i]);
5913f542974SPaul B Schroeder 		wval =
5923f542974SPaul B Schroeder 		    (((__u16) serial->port[i]->number -
5933f542974SPaul B Schroeder 		      (__u16) (serial->minor)) + 1) << 8;
5943f542974SPaul B Schroeder 		if (mos7840_port->open) {
5953f542974SPaul B Schroeder 			if (sp[i] & 0x01) {
59684fe6e79STony Cook 				dbg("SP%d No Interrupt !!!", i);
5973f542974SPaul B Schroeder 			} else {
5983f542974SPaul B Schroeder 				switch (sp[i] & 0x0f) {
5993f542974SPaul B Schroeder 				case SERIAL_IIR_RLS:
6003f542974SPaul B Schroeder 					dbg("Serial Port %d: Receiver status error or ", i);
60184fe6e79STony Cook 					dbg("address bit detected in 9-bit mode");
6023f542974SPaul B Schroeder 					mos7840_port->MsrLsr = 1;
6030de9a702SOliver Neukum 					wreg = LINE_STATUS_REGISTER;
6043f542974SPaul B Schroeder 					break;
6053f542974SPaul B Schroeder 				case SERIAL_IIR_MS:
60684fe6e79STony Cook 					dbg("Serial Port %d: Modem status change", i);
6073f542974SPaul B Schroeder 					mos7840_port->MsrLsr = 0;
6080de9a702SOliver Neukum 					wreg = MODEM_STATUS_REGISTER;
6093f542974SPaul B Schroeder 					break;
6103f542974SPaul B Schroeder 				}
6110de9a702SOliver Neukum 				spin_lock(&mos7840_port->pool_lock);
6120de9a702SOliver Neukum 				if (!mos7840_port->zombie) {
6130de9a702SOliver Neukum 					rv = mos7840_get_reg(mos7840_port, wval, wreg, &Data);
6140de9a702SOliver Neukum 				} else {
6150de9a702SOliver Neukum 					spin_unlock(&mos7840_port->pool_lock);
6160de9a702SOliver Neukum 					return;
6170de9a702SOliver Neukum 				}
6180de9a702SOliver Neukum 				spin_unlock(&mos7840_port->pool_lock);
6193f542974SPaul B Schroeder 			}
6203f542974SPaul B Schroeder 		}
6213f542974SPaul B Schroeder 	}
622880af9dbSAlan Cox 	if (!(rv < 0))
623880af9dbSAlan Cox 		/* the completion handler for the control urb will resubmit */
6240de9a702SOliver Neukum 		return;
6253f542974SPaul B Schroeder exit:
6263f542974SPaul B Schroeder 	result = usb_submit_urb(urb, GFP_ATOMIC);
6273f542974SPaul B Schroeder 	if (result) {
6283f542974SPaul B Schroeder 		dev_err(&urb->dev->dev,
6293f542974SPaul B Schroeder 			"%s - Error %d submitting interrupt urb\n",
630441b62c1SHarvey Harrison 			__func__, result);
6313f542974SPaul B Schroeder 	}
6323f542974SPaul B Schroeder }
6333f542974SPaul B Schroeder 
6343f542974SPaul B Schroeder static int mos7840_port_paranoia_check(struct usb_serial_port *port,
6353f542974SPaul B Schroeder 				       const char *function)
6363f542974SPaul B Schroeder {
6373f542974SPaul B Schroeder 	if (!port) {
6383f542974SPaul B Schroeder 		dbg("%s - port == NULL", function);
6393f542974SPaul B Schroeder 		return -1;
6403f542974SPaul B Schroeder 	}
6413f542974SPaul B Schroeder 	if (!port->serial) {
6423f542974SPaul B Schroeder 		dbg("%s - port->serial == NULL", function);
6433f542974SPaul B Schroeder 		return -1;
6443f542974SPaul B Schroeder 	}
6453f542974SPaul B Schroeder 
6463f542974SPaul B Schroeder 	return 0;
6473f542974SPaul B Schroeder }
6483f542974SPaul B Schroeder 
6493f542974SPaul B Schroeder /* Inline functions to check the sanity of a pointer that is passed to us */
6503f542974SPaul B Schroeder static int mos7840_serial_paranoia_check(struct usb_serial *serial,
6513f542974SPaul B Schroeder 					 const char *function)
6523f542974SPaul B Schroeder {
6533f542974SPaul B Schroeder 	if (!serial) {
6543f542974SPaul B Schroeder 		dbg("%s - serial == NULL", function);
6553f542974SPaul B Schroeder 		return -1;
6563f542974SPaul B Schroeder 	}
6573f542974SPaul B Schroeder 	if (!serial->type) {
6583f542974SPaul B Schroeder 		dbg("%s - serial->type == NULL!", function);
6593f542974SPaul B Schroeder 		return -1;
6603f542974SPaul B Schroeder 	}
6613f542974SPaul B Schroeder 
6623f542974SPaul B Schroeder 	return 0;
6633f542974SPaul B Schroeder }
6643f542974SPaul B Schroeder 
6653f542974SPaul B Schroeder static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port,
6663f542974SPaul B Schroeder 						 const char *function)
6673f542974SPaul B Schroeder {
6683f542974SPaul B Schroeder 	/* if no port was specified, or it fails a paranoia check */
6693f542974SPaul B Schroeder 	if (!port ||
6703f542974SPaul B Schroeder 	    mos7840_port_paranoia_check(port, function) ||
6713f542974SPaul B Schroeder 	    mos7840_serial_paranoia_check(port->serial, function)) {
672880af9dbSAlan Cox 		/* then say that we don't have a valid usb_serial thing,
673880af9dbSAlan Cox 		 * which will end up genrating -ENODEV return values */
6743f542974SPaul B Schroeder 		return NULL;
6753f542974SPaul B Schroeder 	}
6763f542974SPaul B Schroeder 
6773f542974SPaul B Schroeder 	return port->serial;
6783f542974SPaul B Schroeder }
6793f542974SPaul B Schroeder 
6803f542974SPaul B Schroeder /*****************************************************************************
6813f542974SPaul B Schroeder  * mos7840_bulk_in_callback
6823f542974SPaul B Schroeder  *	this is the callback function for when we have received data on the
6833f542974SPaul B Schroeder  *	bulk in endpoint.
6843f542974SPaul B Schroeder  *****************************************************************************/
6853f542974SPaul B Schroeder 
6867d12e780SDavid Howells static void mos7840_bulk_in_callback(struct urb *urb)
6873f542974SPaul B Schroeder {
6880643c724SGreg Kroah-Hartman 	int retval;
6893f542974SPaul B Schroeder 	unsigned char *data;
6903f542974SPaul B Schroeder 	struct usb_serial *serial;
6913f542974SPaul B Schroeder 	struct usb_serial_port *port;
6923f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
6933f542974SPaul B Schroeder 	struct tty_struct *tty;
6940643c724SGreg Kroah-Hartman 	int status = urb->status;
6953f542974SPaul B Schroeder 
696cdc97792SMing Lei 	mos7840_port = urb->context;
6973f542974SPaul B Schroeder 	if (!mos7840_port) {
69884fe6e79STony Cook 		dbg("%s", "NULL mos7840_port pointer");
69950de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
70050de36f7SGreg Kroah-Hartman 		return;
70150de36f7SGreg Kroah-Hartman 	}
70250de36f7SGreg Kroah-Hartman 
70350de36f7SGreg Kroah-Hartman 	if (status) {
70450de36f7SGreg Kroah-Hartman 		dbg("nonzero read bulk status received: %d", status);
70550de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
7063f542974SPaul B Schroeder 		return;
7073f542974SPaul B Schroeder 	}
7083f542974SPaul B Schroeder 
7093f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
710441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
71184fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
71250de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
7133f542974SPaul B Schroeder 		return;
7143f542974SPaul B Schroeder 	}
7153f542974SPaul B Schroeder 
716441b62c1SHarvey Harrison 	serial = mos7840_get_usb_serial(port, __func__);
7173f542974SPaul B Schroeder 	if (!serial) {
71884fe6e79STony Cook 		dbg("%s", "Bad serial pointer");
71950de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
7203f542974SPaul B Schroeder 		return;
7213f542974SPaul B Schroeder 	}
7223f542974SPaul B Schroeder 
72384fe6e79STony Cook 	dbg("%s", "Entering... ");
7243f542974SPaul B Schroeder 
7253f542974SPaul B Schroeder 	data = urb->transfer_buffer;
7263f542974SPaul B Schroeder 
72784fe6e79STony Cook 	dbg("%s", "Entering ...........");
7283f542974SPaul B Schroeder 
7293f542974SPaul B Schroeder 	if (urb->actual_length) {
7304a90f09bSAlan Cox 		tty = tty_port_tty_get(&mos7840_port->port->port);
7313f542974SPaul B Schroeder 		if (tty) {
7323f542974SPaul B Schroeder 			tty_buffer_request_room(tty, urb->actual_length);
7333f542974SPaul B Schroeder 			tty_insert_flip_string(tty, data, urb->actual_length);
73484fe6e79STony Cook 			dbg(" %s ", data);
7353f542974SPaul B Schroeder 			tty_flip_buffer_push(tty);
7364a90f09bSAlan Cox 			tty_kref_put(tty);
7373f542974SPaul B Schroeder 		}
7383f542974SPaul B Schroeder 		mos7840_port->icount.rx += urb->actual_length;
7390de9a702SOliver Neukum 		smp_wmb();
74084fe6e79STony Cook 		dbg("mos7840_port->icount.rx is %d:",
7413f542974SPaul B Schroeder 		    mos7840_port->icount.rx);
7423f542974SPaul B Schroeder 	}
7433f542974SPaul B Schroeder 
7443f542974SPaul B Schroeder 	if (!mos7840_port->read_urb) {
74584fe6e79STony Cook 		dbg("%s", "URB KILLED !!!");
74650de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
7473f542974SPaul B Schroeder 		return;
7483f542974SPaul B Schroeder 	}
7493f542974SPaul B Schroeder 
7500de9a702SOliver Neukum 
7513f542974SPaul B Schroeder 	mos7840_port->read_urb->dev = serial->dev;
7523f542974SPaul B Schroeder 
75350de36f7SGreg Kroah-Hartman 	mos7840_port->read_urb_busy = true;
7540643c724SGreg Kroah-Hartman 	retval = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
7553f542974SPaul B Schroeder 
7560643c724SGreg Kroah-Hartman 	if (retval) {
75750de36f7SGreg Kroah-Hartman 		dbg("usb_submit_urb(read bulk) failed, retval = %d", retval);
75850de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
7593f542974SPaul B Schroeder 	}
7603f542974SPaul B Schroeder }
7613f542974SPaul B Schroeder 
7623f542974SPaul B Schroeder /*****************************************************************************
7633f542974SPaul B Schroeder  * mos7840_bulk_out_data_callback
764880af9dbSAlan Cox  *	this is the callback function for when we have finished sending
765880af9dbSAlan Cox  *	serial data on the bulk out endpoint.
7663f542974SPaul B Schroeder  *****************************************************************************/
7673f542974SPaul B Schroeder 
7687d12e780SDavid Howells static void mos7840_bulk_out_data_callback(struct urb *urb)
7693f542974SPaul B Schroeder {
7703f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
7713f542974SPaul B Schroeder 	struct tty_struct *tty;
7720643c724SGreg Kroah-Hartman 	int status = urb->status;
7730de9a702SOliver Neukum 	int i;
7740de9a702SOliver Neukum 
775cdc97792SMing Lei 	mos7840_port = urb->context;
7760de9a702SOliver Neukum 	spin_lock(&mos7840_port->pool_lock);
7770de9a702SOliver Neukum 	for (i = 0; i < NUM_URBS; i++) {
7780de9a702SOliver Neukum 		if (urb == mos7840_port->write_urb_pool[i]) {
7790de9a702SOliver Neukum 			mos7840_port->busy[i] = 0;
7800de9a702SOliver Neukum 			break;
7810de9a702SOliver Neukum 		}
7820de9a702SOliver Neukum 	}
7830de9a702SOliver Neukum 	spin_unlock(&mos7840_port->pool_lock);
7840de9a702SOliver Neukum 
7850643c724SGreg Kroah-Hartman 	if (status) {
78684fe6e79STony Cook 		dbg("nonzero write bulk status received:%d", status);
7873f542974SPaul B Schroeder 		return;
7883f542974SPaul B Schroeder 	}
7893f542974SPaul B Schroeder 
790441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(mos7840_port->port, __func__)) {
79184fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
7923f542974SPaul B Schroeder 		return;
7933f542974SPaul B Schroeder 	}
7943f542974SPaul B Schroeder 
79584fe6e79STony Cook 	dbg("%s", "Entering .........");
7963f542974SPaul B Schroeder 
7974a90f09bSAlan Cox 	tty = tty_port_tty_get(&mos7840_port->port->port);
798b963a844SJiri Slaby 	if (tty && mos7840_port->open)
799b963a844SJiri Slaby 		tty_wakeup(tty);
8004a90f09bSAlan Cox 	tty_kref_put(tty);
8013f542974SPaul B Schroeder 
8023f542974SPaul B Schroeder }
8033f542974SPaul B Schroeder 
8043f542974SPaul B Schroeder /************************************************************************/
8053f542974SPaul B Schroeder /*       D R I V E R  T T Y  I N T E R F A C E  F U N C T I O N S       */
8063f542974SPaul B Schroeder /************************************************************************/
8073f542974SPaul B Schroeder #ifdef MCSSerialProbe
8083f542974SPaul B Schroeder static int mos7840_serial_probe(struct usb_serial *serial,
8093f542974SPaul B Schroeder 				const struct usb_device_id *id)
8103f542974SPaul B Schroeder {
8113f542974SPaul B Schroeder 
8123f542974SPaul B Schroeder 	/*need to implement the mode_reg reading and updating\
8133f542974SPaul B Schroeder 	   structures usb_serial_ device_type\
8143f542974SPaul B Schroeder 	   (i.e num_ports, num_bulkin,bulkout etc) */
8153f542974SPaul B Schroeder 	/* Also we can update the changes  attach */
8163f542974SPaul B Schroeder 	return 1;
8173f542974SPaul B Schroeder }
8183f542974SPaul B Schroeder #endif
8193f542974SPaul B Schroeder 
8203f542974SPaul B Schroeder /*****************************************************************************
8213f542974SPaul B Schroeder  * mos7840_open
8223f542974SPaul B Schroeder  *	this function is called by the tty driver when a port is opened
8233f542974SPaul B Schroeder  *	If successful, we return 0
8243f542974SPaul B Schroeder  *	Otherwise we return a negative error number.
8253f542974SPaul B Schroeder  *****************************************************************************/
8263f542974SPaul B Schroeder 
827*a509a7e4SAlan Cox static int mos7840_open(struct tty_struct *tty, struct usb_serial_port *port)
8283f542974SPaul B Schroeder {
8293f542974SPaul B Schroeder 	int response;
8303f542974SPaul B Schroeder 	int j;
8313f542974SPaul B Schroeder 	struct usb_serial *serial;
8323f542974SPaul B Schroeder 	struct urb *urb;
8333f542974SPaul B Schroeder 	__u16 Data;
8343f542974SPaul B Schroeder 	int status;
8353f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
8360de9a702SOliver Neukum 	struct moschip_port *port0;
8373f542974SPaul B Schroeder 
83884fe6e79STony Cook 	dbg ("%s enter", __func__);
83984fe6e79STony Cook 
840441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
84184fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
8423f542974SPaul B Schroeder 		return -ENODEV;
8433f542974SPaul B Schroeder 	}
8443f542974SPaul B Schroeder 
8453f542974SPaul B Schroeder 	serial = port->serial;
8463f542974SPaul B Schroeder 
847441b62c1SHarvey Harrison 	if (mos7840_serial_paranoia_check(serial, __func__)) {
84884fe6e79STony Cook 		dbg("%s", "Serial Paranoia failed");
8493f542974SPaul B Schroeder 		return -ENODEV;
8503f542974SPaul B Schroeder 	}
8513f542974SPaul B Schroeder 
8523f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
8530de9a702SOliver Neukum 	port0 = mos7840_get_port_private(serial->port[0]);
8543f542974SPaul B Schroeder 
8550de9a702SOliver Neukum 	if (mos7840_port == NULL || port0 == NULL)
8563f542974SPaul B Schroeder 		return -ENODEV;
8573f542974SPaul B Schroeder 
8583f542974SPaul B Schroeder 	usb_clear_halt(serial->dev, port->write_urb->pipe);
8593f542974SPaul B Schroeder 	usb_clear_halt(serial->dev, port->read_urb->pipe);
8600de9a702SOliver Neukum 	port0->open_ports++;
8613f542974SPaul B Schroeder 
8623f542974SPaul B Schroeder 	/* Initialising the write urb pool */
8633f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j) {
8640de9a702SOliver Neukum 		urb = usb_alloc_urb(0, GFP_KERNEL);
8653f542974SPaul B Schroeder 		mos7840_port->write_urb_pool[j] = urb;
8663f542974SPaul B Schroeder 
8673f542974SPaul B Schroeder 		if (urb == NULL) {
868194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "No more urbs???\n");
8693f542974SPaul B Schroeder 			continue;
8703f542974SPaul B Schroeder 		}
8713f542974SPaul B Schroeder 
872880af9dbSAlan Cox 		urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE,
873880af9dbSAlan Cox 								GFP_KERNEL);
8743f542974SPaul B Schroeder 		if (!urb->transfer_buffer) {
8750de9a702SOliver Neukum 			usb_free_urb(urb);
8760de9a702SOliver Neukum 			mos7840_port->write_urb_pool[j] = NULL;
877194343d9SGreg Kroah-Hartman 			dev_err(&port->dev,
878194343d9SGreg Kroah-Hartman 				"%s-out of memory for urb buffers.\n",
879194343d9SGreg Kroah-Hartman 				__func__);
8803f542974SPaul B Schroeder 			continue;
8813f542974SPaul B Schroeder 		}
8823f542974SPaul B Schroeder 	}
8833f542974SPaul B Schroeder 
8843f542974SPaul B Schroeder /*****************************************************************************
8853f542974SPaul B Schroeder  * Initialize MCS7840 -- Write Init values to corresponding Registers
8863f542974SPaul B Schroeder  *
8873f542974SPaul B Schroeder  * Register Index
8883f542974SPaul B Schroeder  * 1 : IER
8893f542974SPaul B Schroeder  * 2 : FCR
8903f542974SPaul B Schroeder  * 3 : LCR
8913f542974SPaul B Schroeder  * 4 : MCR
8923f542974SPaul B Schroeder  *
8933f542974SPaul B Schroeder  * 0x08 : SP1/2 Control Reg
8943f542974SPaul B Schroeder  *****************************************************************************/
8953f542974SPaul B Schroeder 
896880af9dbSAlan Cox 	/* NEED to check the following Block */
8973f542974SPaul B Schroeder 
8983f542974SPaul B Schroeder 	Data = 0x0;
8993f542974SPaul B Schroeder 	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);
9003f542974SPaul B Schroeder 	if (status < 0) {
90184fe6e79STony Cook 		dbg("Reading Spreg failed");
9023f542974SPaul B Schroeder 		return -1;
9033f542974SPaul B Schroeder 	}
9043f542974SPaul B Schroeder 	Data |= 0x80;
9053f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
9063f542974SPaul B Schroeder 	if (status < 0) {
90784fe6e79STony Cook 		dbg("writing Spreg failed");
9083f542974SPaul B Schroeder 		return -1;
9093f542974SPaul B Schroeder 	}
9103f542974SPaul B Schroeder 
9113f542974SPaul B Schroeder 	Data &= ~0x80;
9123f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
9133f542974SPaul B Schroeder 	if (status < 0) {
91484fe6e79STony Cook 		dbg("writing Spreg failed");
9153f542974SPaul B Schroeder 		return -1;
9163f542974SPaul B Schroeder 	}
917880af9dbSAlan Cox 	/* End of block to be checked */
9183f542974SPaul B Schroeder 
9193f542974SPaul B Schroeder 	Data = 0x0;
920880af9dbSAlan Cox 	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
921880af9dbSAlan Cox 									&Data);
9223f542974SPaul B Schroeder 	if (status < 0) {
92384fe6e79STony Cook 		dbg("Reading Controlreg failed");
9243f542974SPaul B Schroeder 		return -1;
9253f542974SPaul B Schroeder 	}
926880af9dbSAlan Cox 	Data |= 0x08;		/* Driver done bit */
927880af9dbSAlan Cox 	Data |= 0x20;		/* rx_disable */
928880af9dbSAlan Cox 	status = mos7840_set_reg_sync(port,
929880af9dbSAlan Cox 				mos7840_port->ControlRegOffset, Data);
9303f542974SPaul B Schroeder 	if (status < 0) {
93184fe6e79STony Cook 		dbg("writing Controlreg failed");
9323f542974SPaul B Schroeder 		return -1;
9333f542974SPaul B Schroeder 	}
934880af9dbSAlan Cox 	/* do register settings here */
935880af9dbSAlan Cox 	/* Set all regs to the device default values. */
936880af9dbSAlan Cox 	/***********************************
937880af9dbSAlan Cox 	 * First Disable all interrupts.
938880af9dbSAlan Cox 	 ***********************************/
9393f542974SPaul B Schroeder 	Data = 0x00;
9403f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
9413f542974SPaul B Schroeder 	if (status < 0) {
94284fe6e79STony Cook 		dbg("disabling interrupts failed");
9433f542974SPaul B Schroeder 		return -1;
9443f542974SPaul B Schroeder 	}
945880af9dbSAlan Cox 	/* Set FIFO_CONTROL_REGISTER to the default value */
9463f542974SPaul B Schroeder 	Data = 0x00;
9473f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
9483f542974SPaul B Schroeder 	if (status < 0) {
94984fe6e79STony Cook 		dbg("Writing FIFO_CONTROL_REGISTER  failed");
9503f542974SPaul B Schroeder 		return -1;
9513f542974SPaul B Schroeder 	}
9523f542974SPaul B Schroeder 
9533f542974SPaul B Schroeder 	Data = 0xcf;
9543f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
9553f542974SPaul B Schroeder 	if (status < 0) {
95684fe6e79STony Cook 		dbg("Writing FIFO_CONTROL_REGISTER  failed");
9573f542974SPaul B Schroeder 		return -1;
9583f542974SPaul B Schroeder 	}
9593f542974SPaul B Schroeder 
9603f542974SPaul B Schroeder 	Data = 0x03;
9613f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
9623f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
9633f542974SPaul B Schroeder 
9643f542974SPaul B Schroeder 	Data = 0x0b;
9653f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
9663f542974SPaul B Schroeder 	mos7840_port->shadowMCR = Data;
9673f542974SPaul B Schroeder 
9683f542974SPaul B Schroeder 	Data = 0x00;
9693f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
9703f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
9713f542974SPaul B Schroeder 
972880af9dbSAlan Cox 	Data |= SERIAL_LCR_DLAB;	/* data latch enable in LCR 0x80 */
9733f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
9743f542974SPaul B Schroeder 
9753f542974SPaul B Schroeder 	Data = 0x0c;
9763f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
9773f542974SPaul B Schroeder 
9783f542974SPaul B Schroeder 	Data = 0x0;
9793f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
9803f542974SPaul B Schroeder 
9813f542974SPaul B Schroeder 	Data = 0x00;
9823f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
9833f542974SPaul B Schroeder 
9843f542974SPaul B Schroeder 	Data = Data & ~SERIAL_LCR_DLAB;
9853f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
9863f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
9873f542974SPaul B Schroeder 
988880af9dbSAlan Cox 	/* clearing Bulkin and Bulkout Fifo */
9893f542974SPaul B Schroeder 	Data = 0x0;
9903f542974SPaul B Schroeder 	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);
9913f542974SPaul B Schroeder 
9923f542974SPaul B Schroeder 	Data = Data | 0x0c;
9933f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
9943f542974SPaul B Schroeder 
9953f542974SPaul B Schroeder 	Data = Data & ~0x0c;
9963f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
997880af9dbSAlan Cox 	/* Finally enable all interrupts */
9983f542974SPaul B Schroeder 	Data = 0x0c;
9993f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
10003f542974SPaul B Schroeder 
1001880af9dbSAlan Cox 	/* clearing rx_disable */
10023f542974SPaul B Schroeder 	Data = 0x0;
1003880af9dbSAlan Cox 	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
1004880af9dbSAlan Cox 									&Data);
10053f542974SPaul B Schroeder 	Data = Data & ~0x20;
1006880af9dbSAlan Cox 	status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset,
1007880af9dbSAlan Cox 									Data);
10083f542974SPaul B Schroeder 
1009880af9dbSAlan Cox 	/* rx_negate */
10103f542974SPaul B Schroeder 	Data = 0x0;
1011880af9dbSAlan Cox 	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
1012880af9dbSAlan Cox 									&Data);
10133f542974SPaul B Schroeder 	Data = Data | 0x10;
1014880af9dbSAlan Cox 	status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset,
1015880af9dbSAlan Cox 									Data);
10163f542974SPaul B Schroeder 
10173f542974SPaul B Schroeder 	/* Check to see if we've set up our endpoint info yet    *
10183f542974SPaul B Schroeder 	 * (can't set it up in mos7840_startup as the structures *
10193f542974SPaul B Schroeder 	 * were not set up at that time.)                        */
10200de9a702SOliver Neukum 	if (port0->open_ports == 1) {
10213f542974SPaul B Schroeder 		if (serial->port[0]->interrupt_in_buffer == NULL) {
10223f542974SPaul B Schroeder 			/* set up interrupt urb */
10233f542974SPaul B Schroeder 			usb_fill_int_urb(serial->port[0]->interrupt_in_urb,
10243f542974SPaul B Schroeder 				serial->dev,
10253f542974SPaul B Schroeder 				usb_rcvintpipe(serial->dev,
1026880af9dbSAlan Cox 				serial->port[0]->interrupt_in_endpointAddress),
10273f542974SPaul B Schroeder 				serial->port[0]->interrupt_in_buffer,
10283f542974SPaul B Schroeder 				serial->port[0]->interrupt_in_urb->
10293f542974SPaul B Schroeder 				transfer_buffer_length,
10303f542974SPaul B Schroeder 				mos7840_interrupt_callback,
10313f542974SPaul B Schroeder 				serial,
1032880af9dbSAlan Cox 				serial->port[0]->interrupt_in_urb->interval);
10333f542974SPaul B Schroeder 
10343f542974SPaul B Schroeder 			/* start interrupt read for mos7840               *
10353f542974SPaul B Schroeder 			 * will continue as long as mos7840 is connected  */
10363f542974SPaul B Schroeder 
10373f542974SPaul B Schroeder 			response =
10383f542974SPaul B Schroeder 			    usb_submit_urb(serial->port[0]->interrupt_in_urb,
10393f542974SPaul B Schroeder 					   GFP_KERNEL);
10403f542974SPaul B Schroeder 			if (response) {
1041194343d9SGreg Kroah-Hartman 				dev_err(&port->dev, "%s - Error %d submitting "
1042194343d9SGreg Kroah-Hartman 					"interrupt urb\n", __func__, response);
10433f542974SPaul B Schroeder 			}
10443f542974SPaul B Schroeder 
10453f542974SPaul B Schroeder 		}
10463f542974SPaul B Schroeder 
10473f542974SPaul B Schroeder 	}
10483f542974SPaul B Schroeder 
10493f542974SPaul B Schroeder 	/* see if we've set up our endpoint info yet   *
10503f542974SPaul B Schroeder 	 * (can't set it up in mos7840_startup as the  *
10513f542974SPaul B Schroeder 	 * structures were not set up at that time.)   */
10523f542974SPaul B Schroeder 
105384fe6e79STony Cook 	dbg("port number is %d", port->number);
105484fe6e79STony Cook 	dbg("serial number is %d", port->serial->minor);
105584fe6e79STony Cook 	dbg("Bulkin endpoint is %d", port->bulk_in_endpointAddress);
105684fe6e79STony Cook 	dbg("BulkOut endpoint is %d", port->bulk_out_endpointAddress);
105784fe6e79STony Cook 	dbg("Interrupt endpoint is %d", port->interrupt_in_endpointAddress);
105884fe6e79STony Cook 	dbg("port's number in the device is %d", mos7840_port->port_num);
10593f542974SPaul B Schroeder 	mos7840_port->read_urb = port->read_urb;
10603f542974SPaul B Schroeder 
10613f542974SPaul B Schroeder 	/* set up our bulk in urb */
10623f542974SPaul B Schroeder 
10633f542974SPaul B Schroeder 	usb_fill_bulk_urb(mos7840_port->read_urb,
10643f542974SPaul B Schroeder 			  serial->dev,
10653f542974SPaul B Schroeder 			  usb_rcvbulkpipe(serial->dev,
10663f542974SPaul B Schroeder 					  port->bulk_in_endpointAddress),
10673f542974SPaul B Schroeder 			  port->bulk_in_buffer,
10683f542974SPaul B Schroeder 			  mos7840_port->read_urb->transfer_buffer_length,
10693f542974SPaul B Schroeder 			  mos7840_bulk_in_callback, mos7840_port);
10703f542974SPaul B Schroeder 
107184fe6e79STony Cook 	dbg("mos7840_open: bulkin endpoint is %d",
10723f542974SPaul B Schroeder 	    port->bulk_in_endpointAddress);
107350de36f7SGreg Kroah-Hartman 	mos7840_port->read_urb_busy = true;
10743f542974SPaul B Schroeder 	response = usb_submit_urb(mos7840_port->read_urb, GFP_KERNEL);
10753f542974SPaul B Schroeder 	if (response) {
1076194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "%s - Error %d submitting control urb\n",
1077194343d9SGreg Kroah-Hartman 			__func__, response);
107850de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = false;
10793f542974SPaul B Schroeder 	}
10803f542974SPaul B Schroeder 
10813f542974SPaul B Schroeder 	/* initialize our wait queues */
10823f542974SPaul B Schroeder 	init_waitqueue_head(&mos7840_port->wait_chase);
10833f542974SPaul B Schroeder 	init_waitqueue_head(&mos7840_port->delta_msr_wait);
10843f542974SPaul B Schroeder 
10853f542974SPaul B Schroeder 	/* initialize our icount structure */
10863f542974SPaul B Schroeder 	memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount));
10873f542974SPaul B Schroeder 
10883f542974SPaul B Schroeder 	/* initialize our port settings */
1089880af9dbSAlan Cox 	/* Must set to enable ints! */
1090880af9dbSAlan Cox 	mos7840_port->shadowMCR = MCR_MASTER_IE;
10913f542974SPaul B Schroeder 	/* send a open port command */
10923f542974SPaul B Schroeder 	mos7840_port->open = 1;
1093880af9dbSAlan Cox 	/* mos7840_change_port_settings(mos7840_port,old_termios); */
10943f542974SPaul B Schroeder 	mos7840_port->icount.tx = 0;
10953f542974SPaul B Schroeder 	mos7840_port->icount.rx = 0;
10963f542974SPaul B Schroeder 
109784fe6e79STony Cook 	dbg("usb_serial serial:%p       mos7840_port:%p\n      usb_serial_port port:%p",
1098880af9dbSAlan Cox 				serial, mos7840_port, port);
10993f542974SPaul B Schroeder 
110084fe6e79STony Cook 	dbg ("%s leave", __func__);
110184fe6e79STony Cook 
11023f542974SPaul B Schroeder 	return 0;
11033f542974SPaul B Schroeder 
11043f542974SPaul B Schroeder }
11053f542974SPaul B Schroeder 
11063f542974SPaul B Schroeder /*****************************************************************************
11073f542974SPaul B Schroeder  * mos7840_chars_in_buffer
11083f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to know how many
11093f542974SPaul B Schroeder  *	bytes of data we currently have outstanding in the port (data that has
11103f542974SPaul B Schroeder  *	been written, but hasn't made it out the port yet)
11113f542974SPaul B Schroeder  *	If successful, we return the number of bytes left to be written in the
11123f542974SPaul B Schroeder  *	system,
111395da310eSAlan Cox  *	Otherwise we return zero.
11143f542974SPaul B Schroeder  *****************************************************************************/
11153f542974SPaul B Schroeder 
111695da310eSAlan Cox static int mos7840_chars_in_buffer(struct tty_struct *tty)
11173f542974SPaul B Schroeder {
111895da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
11193f542974SPaul B Schroeder 	int i;
11203f542974SPaul B Schroeder 	int chars = 0;
11210de9a702SOliver Neukum 	unsigned long flags;
11223f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
11233f542974SPaul B Schroeder 
112484fe6e79STony Cook 	dbg("%s", " mos7840_chars_in_buffer:entering ...........");
11253f542974SPaul B Schroeder 
1126441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
112784fe6e79STony Cook 		dbg("%s", "Invalid port");
112895da310eSAlan Cox 		return 0;
11293f542974SPaul B Schroeder 	}
11303f542974SPaul B Schroeder 
11313f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
11323f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
113384fe6e79STony Cook 		dbg("%s", "mos7840_break:leaving ...........");
113495da310eSAlan Cox 		return 0;
11353f542974SPaul B Schroeder 	}
11363f542974SPaul B Schroeder 
11370de9a702SOliver Neukum 	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
113895da310eSAlan Cox 	for (i = 0; i < NUM_URBS; ++i)
113995da310eSAlan Cox 		if (mos7840_port->busy[i])
11403f542974SPaul B Schroeder 			chars += URB_TRANSFER_BUFFER_SIZE;
11410de9a702SOliver Neukum 	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
1142441b62c1SHarvey Harrison 	dbg("%s - returns %d", __func__, chars);
11430de9a702SOliver Neukum 	return chars;
11443f542974SPaul B Schroeder 
11453f542974SPaul B Schroeder }
11463f542974SPaul B Schroeder 
11473f542974SPaul B Schroeder /*****************************************************************************
11483f542974SPaul B Schroeder  * mos7840_close
11493f542974SPaul B Schroeder  *	this function is called by the tty driver when a port is closed
11503f542974SPaul B Schroeder  *****************************************************************************/
11513f542974SPaul B Schroeder 
1152335f8514SAlan Cox static void mos7840_close(struct usb_serial_port *port)
11533f542974SPaul B Schroeder {
11543f542974SPaul B Schroeder 	struct usb_serial *serial;
11553f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
11560de9a702SOliver Neukum 	struct moschip_port *port0;
11573f542974SPaul B Schroeder 	int j;
11583f542974SPaul B Schroeder 	__u16 Data;
11593f542974SPaul B Schroeder 
116084fe6e79STony Cook 	dbg("%s", "mos7840_close:entering...");
11613f542974SPaul B Schroeder 
1162441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
116384fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
11643f542974SPaul B Schroeder 		return;
11653f542974SPaul B Schroeder 	}
11663f542974SPaul B Schroeder 
1167441b62c1SHarvey Harrison 	serial = mos7840_get_usb_serial(port, __func__);
11683f542974SPaul B Schroeder 	if (!serial) {
116984fe6e79STony Cook 		dbg("%s", "Serial Paranoia failed");
11703f542974SPaul B Schroeder 		return;
11713f542974SPaul B Schroeder 	}
11723f542974SPaul B Schroeder 
11733f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
11740de9a702SOliver Neukum 	port0 = mos7840_get_port_private(serial->port[0]);
11753f542974SPaul B Schroeder 
11760de9a702SOliver Neukum 	if (mos7840_port == NULL || port0 == NULL)
11773f542974SPaul B Schroeder 		return;
11783f542974SPaul B Schroeder 
11793f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j)
11803f542974SPaul B Schroeder 		usb_kill_urb(mos7840_port->write_urb_pool[j]);
11813f542974SPaul B Schroeder 
11823f542974SPaul B Schroeder 	/* Freeing Write URBs */
11833f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j) {
11843f542974SPaul B Schroeder 		if (mos7840_port->write_urb_pool[j]) {
11853f542974SPaul B Schroeder 			if (mos7840_port->write_urb_pool[j]->transfer_buffer)
11863f542974SPaul B Schroeder 				kfree(mos7840_port->write_urb_pool[j]->
11873f542974SPaul B Schroeder 				      transfer_buffer);
11883f542974SPaul B Schroeder 
11893f542974SPaul B Schroeder 			usb_free_urb(mos7840_port->write_urb_pool[j]);
11903f542974SPaul B Schroeder 		}
11913f542974SPaul B Schroeder 	}
11923f542974SPaul B Schroeder 
11933f542974SPaul B Schroeder 	/* While closing port, shutdown all bulk read, write  *
11943f542974SPaul B Schroeder 	 * and interrupt read if they exists                  */
11953f542974SPaul B Schroeder 	if (serial->dev) {
11963f542974SPaul B Schroeder 		if (mos7840_port->write_urb) {
119784fe6e79STony Cook 			dbg("%s", "Shutdown bulk write");
11983f542974SPaul B Schroeder 			usb_kill_urb(mos7840_port->write_urb);
11993f542974SPaul B Schroeder 		}
12003f542974SPaul B Schroeder 		if (mos7840_port->read_urb) {
120184fe6e79STony Cook 			dbg("%s", "Shutdown bulk read");
12023f542974SPaul B Schroeder 			usb_kill_urb(mos7840_port->read_urb);
120350de36f7SGreg Kroah-Hartman 			mos7840_port->read_urb_busy = false;
12043f542974SPaul B Schroeder 		}
12053f542974SPaul B Schroeder 		if ((&mos7840_port->control_urb)) {
120684fe6e79STony Cook 			dbg("%s", "Shutdown control read");
1207880af9dbSAlan Cox 			/*/      usb_kill_urb (mos7840_port->control_urb); */
12083f542974SPaul B Schroeder 		}
12093f542974SPaul B Schroeder 	}
1210880af9dbSAlan Cox /*      if(mos7840_port->ctrl_buf != NULL) */
1211880af9dbSAlan Cox /*              kfree(mos7840_port->ctrl_buf); */
12120de9a702SOliver Neukum 	port0->open_ports--;
121384fe6e79STony Cook 	dbg("mos7840_num_open_ports in close%d:in port%d",
12140de9a702SOliver Neukum 	    port0->open_ports, port->number);
12150de9a702SOliver Neukum 	if (port0->open_ports == 0) {
12163f542974SPaul B Schroeder 		if (serial->port[0]->interrupt_in_urb) {
121784fe6e79STony Cook 			dbg("%s", "Shutdown interrupt_in_urb");
12180de9a702SOliver Neukum 			usb_kill_urb(serial->port[0]->interrupt_in_urb);
12193f542974SPaul B Schroeder 		}
12203f542974SPaul B Schroeder 	}
12213f542974SPaul B Schroeder 
12223f542974SPaul B Schroeder 	if (mos7840_port->write_urb) {
12233f542974SPaul B Schroeder 		/* if this urb had a transfer buffer already (old tx) free it */
1224880af9dbSAlan Cox 		if (mos7840_port->write_urb->transfer_buffer != NULL)
12253f542974SPaul B Schroeder 			kfree(mos7840_port->write_urb->transfer_buffer);
12263f542974SPaul B Schroeder 		usb_free_urb(mos7840_port->write_urb);
12273f542974SPaul B Schroeder 	}
12283f542974SPaul B Schroeder 
12293f542974SPaul B Schroeder 	Data = 0x0;
12303f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
12313f542974SPaul B Schroeder 
12323f542974SPaul B Schroeder 	Data = 0x00;
12333f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
12343f542974SPaul B Schroeder 
12353f542974SPaul B Schroeder 	mos7840_port->open = 0;
12363f542974SPaul B Schroeder 
123784fe6e79STony Cook 	dbg("%s", "Leaving ............");
12383f542974SPaul B Schroeder }
12393f542974SPaul B Schroeder 
12403f542974SPaul B Schroeder /************************************************************************
12413f542974SPaul B Schroeder  *
12423f542974SPaul B Schroeder  * mos7840_block_until_chase_response
12433f542974SPaul B Schroeder  *
12443f542974SPaul B Schroeder  *	This function will block the close until one of the following:
12453f542974SPaul B Schroeder  *		1. Response to our Chase comes from mos7840
1246dc0d5c1eSJoe Perches  *		2. A timeout of 10 seconds without activity has expired
12473f542974SPaul B Schroeder  *		   (1K of mos7840 data @ 2400 baud ==> 4 sec to empty)
12483f542974SPaul B Schroeder  *
12493f542974SPaul B Schroeder  ************************************************************************/
12503f542974SPaul B Schroeder 
125195da310eSAlan Cox static void mos7840_block_until_chase_response(struct tty_struct *tty,
125295da310eSAlan Cox 					struct moschip_port *mos7840_port)
12533f542974SPaul B Schroeder {
12543f542974SPaul B Schroeder 	int timeout = 1 * HZ;
12553f542974SPaul B Schroeder 	int wait = 10;
12563f542974SPaul B Schroeder 	int count;
12573f542974SPaul B Schroeder 
12583f542974SPaul B Schroeder 	while (1) {
125995da310eSAlan Cox 		count = mos7840_chars_in_buffer(tty);
12603f542974SPaul B Schroeder 
12613f542974SPaul B Schroeder 		/* Check for Buffer status */
1262880af9dbSAlan Cox 		if (count <= 0)
12633f542974SPaul B Schroeder 			return;
12643f542974SPaul B Schroeder 
12653f542974SPaul B Schroeder 		/* Block the thread for a while */
12663f542974SPaul B Schroeder 		interruptible_sleep_on_timeout(&mos7840_port->wait_chase,
12673f542974SPaul B Schroeder 					       timeout);
12683f542974SPaul B Schroeder 		/* No activity.. count down section */
12693f542974SPaul B Schroeder 		wait--;
12703f542974SPaul B Schroeder 		if (wait == 0) {
1271441b62c1SHarvey Harrison 			dbg("%s - TIMEOUT", __func__);
12723f542974SPaul B Schroeder 			return;
12733f542974SPaul B Schroeder 		} else {
1274dc0d5c1eSJoe Perches 			/* Reset timeout value back to seconds */
12753f542974SPaul B Schroeder 			wait = 10;
12763f542974SPaul B Schroeder 		}
12773f542974SPaul B Schroeder 	}
12783f542974SPaul B Schroeder 
12793f542974SPaul B Schroeder }
12803f542974SPaul B Schroeder 
12813f542974SPaul B Schroeder /*****************************************************************************
12823f542974SPaul B Schroeder  * mos7840_break
12833f542974SPaul B Schroeder  *	this function sends a break to the port
12843f542974SPaul B Schroeder  *****************************************************************************/
128595da310eSAlan Cox static void mos7840_break(struct tty_struct *tty, int break_state)
12863f542974SPaul B Schroeder {
128795da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
12883f542974SPaul B Schroeder 	unsigned char data;
12893f542974SPaul B Schroeder 	struct usb_serial *serial;
12903f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
12913f542974SPaul B Schroeder 
129284fe6e79STony Cook 	dbg("%s", "Entering ...........");
129384fe6e79STony Cook 	dbg("mos7840_break: Start");
12943f542974SPaul B Schroeder 
1295441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
129684fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
12973f542974SPaul B Schroeder 		return;
12983f542974SPaul B Schroeder 	}
12993f542974SPaul B Schroeder 
1300441b62c1SHarvey Harrison 	serial = mos7840_get_usb_serial(port, __func__);
13013f542974SPaul B Schroeder 	if (!serial) {
130284fe6e79STony Cook 		dbg("%s", "Serial Paranoia failed");
13033f542974SPaul B Schroeder 		return;
13043f542974SPaul B Schroeder 	}
13053f542974SPaul B Schroeder 
13063f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
13073f542974SPaul B Schroeder 
1308880af9dbSAlan Cox 	if (mos7840_port == NULL)
13093f542974SPaul B Schroeder 		return;
13103f542974SPaul B Schroeder 
131195da310eSAlan Cox 	if (serial->dev)
13123f542974SPaul B Schroeder 		/* flush and block until tx is empty */
131395da310eSAlan Cox 		mos7840_block_until_chase_response(tty, mos7840_port);
13143f542974SPaul B Schroeder 
131595da310eSAlan Cox 	if (break_state == -1)
13163f542974SPaul B Schroeder 		data = mos7840_port->shadowLCR | LCR_SET_BREAK;
131795da310eSAlan Cox 	else
13183f542974SPaul B Schroeder 		data = mos7840_port->shadowLCR & ~LCR_SET_BREAK;
13193f542974SPaul B Schroeder 
13206b447f04SAlan Cox 	/* FIXME: no locking on shadowLCR anywhere in driver */
13213f542974SPaul B Schroeder 	mos7840_port->shadowLCR = data;
132284fe6e79STony Cook 	dbg("mcs7840_break mos7840_port->shadowLCR is %x",
13233f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
13243f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER,
13253f542974SPaul B Schroeder 			     mos7840_port->shadowLCR);
13263f542974SPaul B Schroeder 
13273f542974SPaul B Schroeder 	return;
13283f542974SPaul B Schroeder }
13293f542974SPaul B Schroeder 
13303f542974SPaul B Schroeder /*****************************************************************************
13313f542974SPaul B Schroeder  * mos7840_write_room
13323f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to know how many
13333f542974SPaul B Schroeder  *	bytes of data we can accept for a specific port.
13343f542974SPaul B Schroeder  *	If successful, we return the amount of room that we have for this port
13353f542974SPaul B Schroeder  *	Otherwise we return a negative error number.
13363f542974SPaul B Schroeder  *****************************************************************************/
13373f542974SPaul B Schroeder 
133895da310eSAlan Cox static int mos7840_write_room(struct tty_struct *tty)
13393f542974SPaul B Schroeder {
134095da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
13413f542974SPaul B Schroeder 	int i;
13423f542974SPaul B Schroeder 	int room = 0;
13430de9a702SOliver Neukum 	unsigned long flags;
13443f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
13453f542974SPaul B Schroeder 
134684fe6e79STony Cook 	dbg("%s", " mos7840_write_room:entering ...........");
13473f542974SPaul B Schroeder 
1348441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
134984fe6e79STony Cook 		dbg("%s", "Invalid port");
135084fe6e79STony Cook 		dbg("%s", " mos7840_write_room:leaving ...........");
13513f542974SPaul B Schroeder 		return -1;
13523f542974SPaul B Schroeder 	}
13533f542974SPaul B Schroeder 
13543f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
13553f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
135684fe6e79STony Cook 		dbg("%s", "mos7840_break:leaving ...........");
13573f542974SPaul B Schroeder 		return -1;
13583f542974SPaul B Schroeder 	}
13593f542974SPaul B Schroeder 
13600de9a702SOliver Neukum 	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
13613f542974SPaul B Schroeder 	for (i = 0; i < NUM_URBS; ++i) {
1362880af9dbSAlan Cox 		if (!mos7840_port->busy[i])
13633f542974SPaul B Schroeder 			room += URB_TRANSFER_BUFFER_SIZE;
13643f542974SPaul B Schroeder 	}
13650de9a702SOliver Neukum 	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
13663f542974SPaul B Schroeder 
13670de9a702SOliver Neukum 	room = (room == 0) ? 0 : room - URB_TRANSFER_BUFFER_SIZE + 1;
1368441b62c1SHarvey Harrison 	dbg("%s - returns %d", __func__, room);
13690de9a702SOliver Neukum 	return room;
13703f542974SPaul B Schroeder 
13713f542974SPaul B Schroeder }
13723f542974SPaul B Schroeder 
13733f542974SPaul B Schroeder /*****************************************************************************
13743f542974SPaul B Schroeder  * mos7840_write
13753f542974SPaul B Schroeder  *	this function is called by the tty driver when data should be written to
13763f542974SPaul B Schroeder  *	the port.
13773f542974SPaul B Schroeder  *	If successful, we return the number of bytes written, otherwise we
13783f542974SPaul B Schroeder  *      return a negative error number.
13793f542974SPaul B Schroeder  *****************************************************************************/
13803f542974SPaul B Schroeder 
138195da310eSAlan Cox static int mos7840_write(struct tty_struct *tty, struct usb_serial_port *port,
13823f542974SPaul B Schroeder 			 const unsigned char *data, int count)
13833f542974SPaul B Schroeder {
13843f542974SPaul B Schroeder 	int status;
13853f542974SPaul B Schroeder 	int i;
13863f542974SPaul B Schroeder 	int bytes_sent = 0;
13873f542974SPaul B Schroeder 	int transfer_size;
13880de9a702SOliver Neukum 	unsigned long flags;
13893f542974SPaul B Schroeder 
13903f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
13913f542974SPaul B Schroeder 	struct usb_serial *serial;
13923f542974SPaul B Schroeder 	struct urb *urb;
1393880af9dbSAlan Cox 	/* __u16 Data; */
13943f542974SPaul B Schroeder 	const unsigned char *current_position = data;
13953f542974SPaul B Schroeder 	unsigned char *data1;
139684fe6e79STony Cook 	dbg("%s", "entering ...........");
139784fe6e79STony Cook 	/* dbg("mos7840_write: mos7840_port->shadowLCR is %x",
1398880af9dbSAlan Cox 					mos7840_port->shadowLCR); */
13993f542974SPaul B Schroeder 
14003f542974SPaul B Schroeder #ifdef NOTMOS7840
14013f542974SPaul B Schroeder 	Data = 0x00;
14023f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
14033f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
140484fe6e79STony Cook 	dbg("mos7840_write: LINE_CONTROL_REGISTER is %x", Data);
140584fe6e79STony Cook 	dbg("mos7840_write: mos7840_port->shadowLCR is %x",
14063f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
14073f542974SPaul B Schroeder 
1408880af9dbSAlan Cox 	/* Data = 0x03; */
1409880af9dbSAlan Cox 	/* status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); */
1410880af9dbSAlan Cox 	/* mos7840_port->shadowLCR=Data;//Need to add later */
14113f542974SPaul B Schroeder 
1412880af9dbSAlan Cox 	Data |= SERIAL_LCR_DLAB;	/* data latch enable in LCR 0x80 */
14133f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
14143f542974SPaul B Schroeder 
1415880af9dbSAlan Cox 	/* Data = 0x0c; */
1416880af9dbSAlan Cox 	/* status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); */
14173f542974SPaul B Schroeder 	Data = 0x00;
14183f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data);
141984fe6e79STony Cook 	dbg("mos7840_write:DLL value is %x", Data);
14203f542974SPaul B Schroeder 
14213f542974SPaul B Schroeder 	Data = 0x0;
14223f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data);
142384fe6e79STony Cook 	dbg("mos7840_write:DLM value is %x", Data);
14243f542974SPaul B Schroeder 
14253f542974SPaul B Schroeder 	Data = Data & ~SERIAL_LCR_DLAB;
142684fe6e79STony Cook 	dbg("mos7840_write: mos7840_port->shadowLCR is %x",
14273f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
14283f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
14293f542974SPaul B Schroeder #endif
14303f542974SPaul B Schroeder 
1431441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
143284fe6e79STony Cook 		dbg("%s", "Port Paranoia failed");
14333f542974SPaul B Schroeder 		return -1;
14343f542974SPaul B Schroeder 	}
14353f542974SPaul B Schroeder 
14363f542974SPaul B Schroeder 	serial = port->serial;
1437441b62c1SHarvey Harrison 	if (mos7840_serial_paranoia_check(serial, __func__)) {
143884fe6e79STony Cook 		dbg("%s", "Serial Paranoia failed");
14393f542974SPaul B Schroeder 		return -1;
14403f542974SPaul B Schroeder 	}
14413f542974SPaul B Schroeder 
14423f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
14433f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
144484fe6e79STony Cook 		dbg("%s", "mos7840_port is NULL");
14453f542974SPaul B Schroeder 		return -1;
14463f542974SPaul B Schroeder 	}
14473f542974SPaul B Schroeder 
14483f542974SPaul B Schroeder 	/* try to find a free urb in the list */
14493f542974SPaul B Schroeder 	urb = NULL;
14503f542974SPaul B Schroeder 
14510de9a702SOliver Neukum 	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
14523f542974SPaul B Schroeder 	for (i = 0; i < NUM_URBS; ++i) {
14530de9a702SOliver Neukum 		if (!mos7840_port->busy[i]) {
14540de9a702SOliver Neukum 			mos7840_port->busy[i] = 1;
14553f542974SPaul B Schroeder 			urb = mos7840_port->write_urb_pool[i];
145684fe6e79STony Cook 			dbg("URB:%d", i);
14573f542974SPaul B Schroeder 			break;
14583f542974SPaul B Schroeder 		}
14593f542974SPaul B Schroeder 	}
14600de9a702SOliver Neukum 	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
14613f542974SPaul B Schroeder 
14623f542974SPaul B Schroeder 	if (urb == NULL) {
1463441b62c1SHarvey Harrison 		dbg("%s - no more free urbs", __func__);
14643f542974SPaul B Schroeder 		goto exit;
14653f542974SPaul B Schroeder 	}
14663f542974SPaul B Schroeder 
14673f542974SPaul B Schroeder 	if (urb->transfer_buffer == NULL) {
14683f542974SPaul B Schroeder 		urb->transfer_buffer =
14693f542974SPaul B Schroeder 		    kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);
14703f542974SPaul B Schroeder 
14713f542974SPaul B Schroeder 		if (urb->transfer_buffer == NULL) {
1472194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "%s no more kernel memory...\n",
1473194343d9SGreg Kroah-Hartman 				__func__);
14743f542974SPaul B Schroeder 			goto exit;
14753f542974SPaul B Schroeder 		}
14763f542974SPaul B Schroeder 	}
14773f542974SPaul B Schroeder 	transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE);
14783f542974SPaul B Schroeder 
14793f542974SPaul B Schroeder 	memcpy(urb->transfer_buffer, current_position, transfer_size);
14803f542974SPaul B Schroeder 
14813f542974SPaul B Schroeder 	/* fill urb with data and submit  */
14823f542974SPaul B Schroeder 	usb_fill_bulk_urb(urb,
14833f542974SPaul B Schroeder 			  serial->dev,
14843f542974SPaul B Schroeder 			  usb_sndbulkpipe(serial->dev,
14853f542974SPaul B Schroeder 					  port->bulk_out_endpointAddress),
14863f542974SPaul B Schroeder 			  urb->transfer_buffer,
14873f542974SPaul B Schroeder 			  transfer_size,
14883f542974SPaul B Schroeder 			  mos7840_bulk_out_data_callback, mos7840_port);
14893f542974SPaul B Schroeder 
14903f542974SPaul B Schroeder 	data1 = urb->transfer_buffer;
149184fe6e79STony Cook 	dbg("bulkout endpoint is %d", port->bulk_out_endpointAddress);
14923f542974SPaul B Schroeder 
14933f542974SPaul B Schroeder 	/* send it down the pipe */
14943f542974SPaul B Schroeder 	status = usb_submit_urb(urb, GFP_ATOMIC);
14953f542974SPaul B Schroeder 
14963f542974SPaul B Schroeder 	if (status) {
14970de9a702SOliver Neukum 		mos7840_port->busy[i] = 0;
1498194343d9SGreg Kroah-Hartman 		dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed "
1499194343d9SGreg Kroah-Hartman 			"with status = %d\n", __func__, status);
15003f542974SPaul B Schroeder 		bytes_sent = status;
15013f542974SPaul B Schroeder 		goto exit;
15023f542974SPaul B Schroeder 	}
15033f542974SPaul B Schroeder 	bytes_sent = transfer_size;
15043f542974SPaul B Schroeder 	mos7840_port->icount.tx += transfer_size;
15050de9a702SOliver Neukum 	smp_wmb();
150684fe6e79STony Cook 	dbg("mos7840_port->icount.tx is %d:", mos7840_port->icount.tx);
15073f542974SPaul B Schroeder exit:
15083f542974SPaul B Schroeder 	return bytes_sent;
15093f542974SPaul B Schroeder 
15103f542974SPaul B Schroeder }
15113f542974SPaul B Schroeder 
15123f542974SPaul B Schroeder /*****************************************************************************
15133f542974SPaul B Schroeder  * mos7840_throttle
15143f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to stop the data
15153f542974SPaul B Schroeder  *	being read from the port.
15163f542974SPaul B Schroeder  *****************************************************************************/
15173f542974SPaul B Schroeder 
151895da310eSAlan Cox static void mos7840_throttle(struct tty_struct *tty)
15193f542974SPaul B Schroeder {
152095da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
15213f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
15223f542974SPaul B Schroeder 	int status;
15233f542974SPaul B Schroeder 
1524441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
152584fe6e79STony Cook 		dbg("%s", "Invalid port");
15263f542974SPaul B Schroeder 		return;
15273f542974SPaul B Schroeder 	}
15283f542974SPaul B Schroeder 
152984fe6e79STony Cook 	dbg("- port %d", port->number);
15303f542974SPaul B Schroeder 
15313f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
15323f542974SPaul B Schroeder 
15333f542974SPaul B Schroeder 	if (mos7840_port == NULL)
15343f542974SPaul B Schroeder 		return;
15353f542974SPaul B Schroeder 
15363f542974SPaul B Schroeder 	if (!mos7840_port->open) {
153784fe6e79STony Cook 		dbg("%s", "port not opened");
15383f542974SPaul B Schroeder 		return;
15393f542974SPaul B Schroeder 	}
15403f542974SPaul B Schroeder 
154184fe6e79STony Cook 	dbg("%s", "Entering ..........");
15423f542974SPaul B Schroeder 
15433f542974SPaul B Schroeder 	/* if we are implementing XON/XOFF, send the stop character */
15443f542974SPaul B Schroeder 	if (I_IXOFF(tty)) {
15453f542974SPaul B Schroeder 		unsigned char stop_char = STOP_CHAR(tty);
154695da310eSAlan Cox 		status = mos7840_write(tty, port, &stop_char, 1);
154795da310eSAlan Cox 		if (status <= 0)
15483f542974SPaul B Schroeder 			return;
15493f542974SPaul B Schroeder 	}
15503f542974SPaul B Schroeder 	/* if we are implementing RTS/CTS, toggle that line */
15513f542974SPaul B Schroeder 	if (tty->termios->c_cflag & CRTSCTS) {
15523f542974SPaul B Schroeder 		mos7840_port->shadowMCR &= ~MCR_RTS;
155395da310eSAlan Cox 		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
15543f542974SPaul B Schroeder 					 mos7840_port->shadowMCR);
155595da310eSAlan Cox 		if (status < 0)
15563f542974SPaul B Schroeder 			return;
15573f542974SPaul B Schroeder 	}
15583f542974SPaul B Schroeder 
15593f542974SPaul B Schroeder 	return;
15603f542974SPaul B Schroeder }
15613f542974SPaul B Schroeder 
15623f542974SPaul B Schroeder /*****************************************************************************
15633f542974SPaul B Schroeder  * mos7840_unthrottle
1564880af9dbSAlan Cox  *	this function is called by the tty driver when it wants to resume
1565880af9dbSAlan Cox  *	the data being read from the port (called after mos7840_throttle is
1566880af9dbSAlan Cox  *	called)
15673f542974SPaul B Schroeder  *****************************************************************************/
156895da310eSAlan Cox static void mos7840_unthrottle(struct tty_struct *tty)
15693f542974SPaul B Schroeder {
157095da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
15713f542974SPaul B Schroeder 	int status;
15723f542974SPaul B Schroeder 	struct moschip_port *mos7840_port = mos7840_get_port_private(port);
15733f542974SPaul B Schroeder 
1574441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
157584fe6e79STony Cook 		dbg("%s", "Invalid port");
15763f542974SPaul B Schroeder 		return;
15773f542974SPaul B Schroeder 	}
15783f542974SPaul B Schroeder 
15793f542974SPaul B Schroeder 	if (mos7840_port == NULL)
15803f542974SPaul B Schroeder 		return;
15813f542974SPaul B Schroeder 
15823f542974SPaul B Schroeder 	if (!mos7840_port->open) {
1583441b62c1SHarvey Harrison 		dbg("%s - port not opened", __func__);
15843f542974SPaul B Schroeder 		return;
15853f542974SPaul B Schroeder 	}
15863f542974SPaul B Schroeder 
158784fe6e79STony Cook 	dbg("%s", "Entering ..........");
15883f542974SPaul B Schroeder 
15893f542974SPaul B Schroeder 	/* if we are implementing XON/XOFF, send the start character */
15903f542974SPaul B Schroeder 	if (I_IXOFF(tty)) {
15913f542974SPaul B Schroeder 		unsigned char start_char = START_CHAR(tty);
159295da310eSAlan Cox 		status = mos7840_write(tty, port, &start_char, 1);
159395da310eSAlan Cox 		if (status <= 0)
15943f542974SPaul B Schroeder 			return;
15953f542974SPaul B Schroeder 	}
15963f542974SPaul B Schroeder 
15973f542974SPaul B Schroeder 	/* if we are implementing RTS/CTS, toggle that line */
15983f542974SPaul B Schroeder 	if (tty->termios->c_cflag & CRTSCTS) {
15993f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= MCR_RTS;
160095da310eSAlan Cox 		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
16013f542974SPaul B Schroeder 					 mos7840_port->shadowMCR);
160295da310eSAlan Cox 		if (status < 0)
16033f542974SPaul B Schroeder 			return;
16043f542974SPaul B Schroeder 	}
16053f542974SPaul B Schroeder }
16063f542974SPaul B Schroeder 
160795da310eSAlan Cox static int mos7840_tiocmget(struct tty_struct *tty, struct file *file)
16083f542974SPaul B Schroeder {
160995da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
16103f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
16113f542974SPaul B Schroeder 	unsigned int result;
16123f542974SPaul B Schroeder 	__u16 msr;
16133f542974SPaul B Schroeder 	__u16 mcr;
1614880af9dbSAlan Cox 	int status;
16153f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
16163f542974SPaul B Schroeder 
1617441b62c1SHarvey Harrison 	dbg("%s - port %d", __func__, port->number);
16183f542974SPaul B Schroeder 
16193f542974SPaul B Schroeder 	if (mos7840_port == NULL)
16203f542974SPaul B Schroeder 		return -ENODEV;
16213f542974SPaul B Schroeder 
16223f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, MODEM_STATUS_REGISTER, &msr);
16233f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr);
16243f542974SPaul B Schroeder 	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
16253f542974SPaul B Schroeder 	    | ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
16263f542974SPaul B Schroeder 	    | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0)
16273f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0)
16283f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0)
16293f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0)
16303f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0);
16313f542974SPaul B Schroeder 
1632441b62c1SHarvey Harrison 	dbg("%s - 0x%04X", __func__, result);
16333f542974SPaul B Schroeder 
16343f542974SPaul B Schroeder 	return result;
16353f542974SPaul B Schroeder }
16363f542974SPaul B Schroeder 
163795da310eSAlan Cox static int mos7840_tiocmset(struct tty_struct *tty, struct file *file,
16383f542974SPaul B Schroeder 			    unsigned int set, unsigned int clear)
16393f542974SPaul B Schroeder {
164095da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
16413f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
16423f542974SPaul B Schroeder 	unsigned int mcr;
164387521c46SRoel Kluin 	int status;
16443f542974SPaul B Schroeder 
1645441b62c1SHarvey Harrison 	dbg("%s - port %d", __func__, port->number);
16463f542974SPaul B Schroeder 
16473f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
16483f542974SPaul B Schroeder 
16493f542974SPaul B Schroeder 	if (mos7840_port == NULL)
16503f542974SPaul B Schroeder 		return -ENODEV;
16513f542974SPaul B Schroeder 
1652e2984494SAlan Cox 	/* FIXME: What locks the port registers ? */
16533f542974SPaul B Schroeder 	mcr = mos7840_port->shadowMCR;
16543f542974SPaul B Schroeder 	if (clear & TIOCM_RTS)
16553f542974SPaul B Schroeder 		mcr &= ~MCR_RTS;
16563f542974SPaul B Schroeder 	if (clear & TIOCM_DTR)
16573f542974SPaul B Schroeder 		mcr &= ~MCR_DTR;
16583f542974SPaul B Schroeder 	if (clear & TIOCM_LOOP)
16593f542974SPaul B Schroeder 		mcr &= ~MCR_LOOPBACK;
16603f542974SPaul B Schroeder 
16613f542974SPaul B Schroeder 	if (set & TIOCM_RTS)
16623f542974SPaul B Schroeder 		mcr |= MCR_RTS;
16633f542974SPaul B Schroeder 	if (set & TIOCM_DTR)
16643f542974SPaul B Schroeder 		mcr |= MCR_DTR;
16653f542974SPaul B Schroeder 	if (set & TIOCM_LOOP)
16663f542974SPaul B Schroeder 		mcr |= MCR_LOOPBACK;
16673f542974SPaul B Schroeder 
16683f542974SPaul B Schroeder 	mos7840_port->shadowMCR = mcr;
16693f542974SPaul B Schroeder 
16703f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr);
16713f542974SPaul B Schroeder 	if (status < 0) {
167284fe6e79STony Cook 		dbg("setting MODEM_CONTROL_REGISTER Failed");
167387521c46SRoel Kluin 		return status;
16743f542974SPaul B Schroeder 	}
16753f542974SPaul B Schroeder 
16763f542974SPaul B Schroeder 	return 0;
16773f542974SPaul B Schroeder }
16783f542974SPaul B Schroeder 
16793f542974SPaul B Schroeder /*****************************************************************************
16803f542974SPaul B Schroeder  * mos7840_calc_baud_rate_divisor
16813f542974SPaul B Schroeder  *	this function calculates the proper baud rate divisor for the specified
16823f542974SPaul B Schroeder  *	baud rate.
16833f542974SPaul B Schroeder  *****************************************************************************/
16843f542974SPaul B Schroeder static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor,
16853f542974SPaul B Schroeder 					  __u16 *clk_sel_val)
16863f542974SPaul B Schroeder {
16873f542974SPaul B Schroeder 
1688441b62c1SHarvey Harrison 	dbg("%s - %d", __func__, baudRate);
16893f542974SPaul B Schroeder 
16903f542974SPaul B Schroeder 	if (baudRate <= 115200) {
16913f542974SPaul B Schroeder 		*divisor = 115200 / baudRate;
16923f542974SPaul B Schroeder 		*clk_sel_val = 0x0;
16933f542974SPaul B Schroeder 	}
16943f542974SPaul B Schroeder 	if ((baudRate > 115200) && (baudRate <= 230400)) {
16953f542974SPaul B Schroeder 		*divisor = 230400 / baudRate;
16963f542974SPaul B Schroeder 		*clk_sel_val = 0x10;
16973f542974SPaul B Schroeder 	} else if ((baudRate > 230400) && (baudRate <= 403200)) {
16983f542974SPaul B Schroeder 		*divisor = 403200 / baudRate;
16993f542974SPaul B Schroeder 		*clk_sel_val = 0x20;
17003f542974SPaul B Schroeder 	} else if ((baudRate > 403200) && (baudRate <= 460800)) {
17013f542974SPaul B Schroeder 		*divisor = 460800 / baudRate;
17023f542974SPaul B Schroeder 		*clk_sel_val = 0x30;
17033f542974SPaul B Schroeder 	} else if ((baudRate > 460800) && (baudRate <= 806400)) {
17043f542974SPaul B Schroeder 		*divisor = 806400 / baudRate;
17053f542974SPaul B Schroeder 		*clk_sel_val = 0x40;
17063f542974SPaul B Schroeder 	} else if ((baudRate > 806400) && (baudRate <= 921600)) {
17073f542974SPaul B Schroeder 		*divisor = 921600 / baudRate;
17083f542974SPaul B Schroeder 		*clk_sel_val = 0x50;
17093f542974SPaul B Schroeder 	} else if ((baudRate > 921600) && (baudRate <= 1572864)) {
17103f542974SPaul B Schroeder 		*divisor = 1572864 / baudRate;
17113f542974SPaul B Schroeder 		*clk_sel_val = 0x60;
17123f542974SPaul B Schroeder 	} else if ((baudRate > 1572864) && (baudRate <= 3145728)) {
17133f542974SPaul B Schroeder 		*divisor = 3145728 / baudRate;
17143f542974SPaul B Schroeder 		*clk_sel_val = 0x70;
17153f542974SPaul B Schroeder 	}
17163f542974SPaul B Schroeder 	return 0;
17173f542974SPaul B Schroeder 
17183f542974SPaul B Schroeder #ifdef NOTMCS7840
17193f542974SPaul B Schroeder 
17203f542974SPaul B Schroeder 	for (i = 0; i < ARRAY_SIZE(mos7840_divisor_table); i++) {
17213f542974SPaul B Schroeder 		if (mos7840_divisor_table[i].BaudRate == baudrate) {
17223f542974SPaul B Schroeder 			*divisor = mos7840_divisor_table[i].Divisor;
17233f542974SPaul B Schroeder 			return 0;
17243f542974SPaul B Schroeder 		}
17253f542974SPaul B Schroeder 	}
17263f542974SPaul B Schroeder 
17273f542974SPaul B Schroeder 	/* After trying for all the standard baud rates    *
17283f542974SPaul B Schroeder 	 * Try calculating the divisor for this baud rate  */
17293f542974SPaul B Schroeder 
17303f542974SPaul B Schroeder 	if (baudrate > 75 && baudrate < 230400) {
17313f542974SPaul B Schroeder 		/* get the divisor */
17323f542974SPaul B Schroeder 		custom = (__u16) (230400L / baudrate);
17333f542974SPaul B Schroeder 
17343f542974SPaul B Schroeder 		/* Check for round off */
17353f542974SPaul B Schroeder 		round1 = (__u16) (2304000L / baudrate);
17363f542974SPaul B Schroeder 		round = (__u16) (round1 - (custom * 10));
1737880af9dbSAlan Cox 		if (round > 4)
17383f542974SPaul B Schroeder 			custom++;
17393f542974SPaul B Schroeder 		*divisor = custom;
17403f542974SPaul B Schroeder 
174184fe6e79STony Cook 		dbg(" Baud %d = %d", baudrate, custom);
17423f542974SPaul B Schroeder 		return 0;
17433f542974SPaul B Schroeder 	}
17443f542974SPaul B Schroeder 
174584fe6e79STony Cook 	dbg("%s", " Baud calculation Failed...");
17463f542974SPaul B Schroeder 	return -1;
17473f542974SPaul B Schroeder #endif
17483f542974SPaul B Schroeder }
17493f542974SPaul B Schroeder 
17503f542974SPaul B Schroeder /*****************************************************************************
17513f542974SPaul B Schroeder  * mos7840_send_cmd_write_baud_rate
17523f542974SPaul B Schroeder  *	this function sends the proper command to change the baud rate of the
17533f542974SPaul B Schroeder  *	specified port.
17543f542974SPaul B Schroeder  *****************************************************************************/
17553f542974SPaul B Schroeder 
17563f542974SPaul B Schroeder static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port,
17573f542974SPaul B Schroeder 					    int baudRate)
17583f542974SPaul B Schroeder {
17593f542974SPaul B Schroeder 	int divisor = 0;
17603f542974SPaul B Schroeder 	int status;
17613f542974SPaul B Schroeder 	__u16 Data;
17623f542974SPaul B Schroeder 	unsigned char number;
17633f542974SPaul B Schroeder 	__u16 clk_sel_val;
17643f542974SPaul B Schroeder 	struct usb_serial_port *port;
17653f542974SPaul B Schroeder 
17663f542974SPaul B Schroeder 	if (mos7840_port == NULL)
17673f542974SPaul B Schroeder 		return -1;
17683f542974SPaul B Schroeder 
17693f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
1770441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
177184fe6e79STony Cook 		dbg("%s", "Invalid port");
17723f542974SPaul B Schroeder 		return -1;
17733f542974SPaul B Schroeder 	}
17743f542974SPaul B Schroeder 
1775441b62c1SHarvey Harrison 	if (mos7840_serial_paranoia_check(port->serial, __func__)) {
177684fe6e79STony Cook 		dbg("%s", "Invalid Serial");
17773f542974SPaul B Schroeder 		return -1;
17783f542974SPaul B Schroeder 	}
17793f542974SPaul B Schroeder 
178084fe6e79STony Cook 	dbg("%s", "Entering ..........");
17813f542974SPaul B Schroeder 
17823f542974SPaul B Schroeder 	number = mos7840_port->port->number - mos7840_port->port->serial->minor;
17833f542974SPaul B Schroeder 
1784441b62c1SHarvey Harrison 	dbg("%s - port = %d, baud = %d", __func__,
17853f542974SPaul B Schroeder 	    mos7840_port->port->number, baudRate);
1786880af9dbSAlan Cox 	/* reset clk_uart_sel in spregOffset */
17873f542974SPaul B Schroeder 	if (baudRate > 115200) {
17883f542974SPaul B Schroeder #ifdef HW_flow_control
1789880af9dbSAlan Cox 		/* NOTE: need to see the pther register to modify */
1790880af9dbSAlan Cox 		/* setting h/w flow control bit to 1 */
17913f542974SPaul B Schroeder 		Data = 0x2b;
17923f542974SPaul B Schroeder 		mos7840_port->shadowMCR = Data;
1793880af9dbSAlan Cox 		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1794880af9dbSAlan Cox 									Data);
17953f542974SPaul B Schroeder 		if (status < 0) {
179684fe6e79STony Cook 			dbg("Writing spreg failed in set_serial_baud");
17973f542974SPaul B Schroeder 			return -1;
17983f542974SPaul B Schroeder 		}
17993f542974SPaul B Schroeder #endif
18003f542974SPaul B Schroeder 
18013f542974SPaul B Schroeder 	} else {
18023f542974SPaul B Schroeder #ifdef HW_flow_control
1803880af9dbSAlan Cox 		/ *setting h/w flow control bit to 0 */
18043f542974SPaul B Schroeder 		Data = 0xb;
18053f542974SPaul B Schroeder 		mos7840_port->shadowMCR = Data;
1806880af9dbSAlan Cox 		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1807880af9dbSAlan Cox 									Data);
18083f542974SPaul B Schroeder 		if (status < 0) {
180984fe6e79STony Cook 			dbg("Writing spreg failed in set_serial_baud");
18103f542974SPaul B Schroeder 			return -1;
18113f542974SPaul B Schroeder 		}
18123f542974SPaul B Schroeder #endif
18133f542974SPaul B Schroeder 
18143f542974SPaul B Schroeder 	}
18153f542974SPaul B Schroeder 
1816880af9dbSAlan Cox 	if (1) {		/* baudRate <= 115200) */
18173f542974SPaul B Schroeder 		clk_sel_val = 0x0;
18183f542974SPaul B Schroeder 		Data = 0x0;
1819880af9dbSAlan Cox 		status = mos7840_calc_baud_rate_divisor(baudRate, &divisor,
18203f542974SPaul B Schroeder 						   &clk_sel_val);
1821880af9dbSAlan Cox 		status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset,
18223f542974SPaul B Schroeder 								 &Data);
18233f542974SPaul B Schroeder 		if (status < 0) {
182484fe6e79STony Cook 			dbg("reading spreg failed in set_serial_baud");
18253f542974SPaul B Schroeder 			return -1;
18263f542974SPaul B Schroeder 		}
18273f542974SPaul B Schroeder 		Data = (Data & 0x8f) | clk_sel_val;
1828880af9dbSAlan Cox 		status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset,
1829880af9dbSAlan Cox 								Data);
18303f542974SPaul B Schroeder 		if (status < 0) {
183184fe6e79STony Cook 			dbg("Writing spreg failed in set_serial_baud");
18323f542974SPaul B Schroeder 			return -1;
18333f542974SPaul B Schroeder 		}
18343f542974SPaul B Schroeder 		/* Calculate the Divisor */
18353f542974SPaul B Schroeder 
18363f542974SPaul B Schroeder 		if (status) {
1837194343d9SGreg Kroah-Hartman 			dev_err(&port->dev, "%s - bad baud rate\n", __func__);
18383f542974SPaul B Schroeder 			return status;
18393f542974SPaul B Schroeder 		}
18403f542974SPaul B Schroeder 		/* Enable access to divisor latch */
18413f542974SPaul B Schroeder 		Data = mos7840_port->shadowLCR | SERIAL_LCR_DLAB;
18423f542974SPaul B Schroeder 		mos7840_port->shadowLCR = Data;
18433f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
18443f542974SPaul B Schroeder 
18453f542974SPaul B Schroeder 		/* Write the divisor */
18463f542974SPaul B Schroeder 		Data = (unsigned char)(divisor & 0xff);
184784fe6e79STony Cook 		dbg("set_serial_baud Value to write DLL is %x", Data);
18483f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
18493f542974SPaul B Schroeder 
18503f542974SPaul B Schroeder 		Data = (unsigned char)((divisor & 0xff00) >> 8);
185184fe6e79STony Cook 		dbg("set_serial_baud Value to write DLM is %x", Data);
18523f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
18533f542974SPaul B Schroeder 
18543f542974SPaul B Schroeder 		/* Disable access to divisor latch */
18553f542974SPaul B Schroeder 		Data = mos7840_port->shadowLCR & ~SERIAL_LCR_DLAB;
18563f542974SPaul B Schroeder 		mos7840_port->shadowLCR = Data;
18573f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
18583f542974SPaul B Schroeder 
18593f542974SPaul B Schroeder 	}
18603f542974SPaul B Schroeder 	return status;
18613f542974SPaul B Schroeder }
18623f542974SPaul B Schroeder 
18633f542974SPaul B Schroeder /*****************************************************************************
18643f542974SPaul B Schroeder  * mos7840_change_port_settings
18653f542974SPaul B Schroeder  *	This routine is called to set the UART on the device to match
18663f542974SPaul B Schroeder  *      the specified new settings.
18673f542974SPaul B Schroeder  *****************************************************************************/
18683f542974SPaul B Schroeder 
186995da310eSAlan Cox static void mos7840_change_port_settings(struct tty_struct *tty,
187095da310eSAlan Cox 	struct moschip_port *mos7840_port, struct ktermios *old_termios)
18713f542974SPaul B Schroeder {
18723f542974SPaul B Schroeder 	int baud;
18733f542974SPaul B Schroeder 	unsigned cflag;
18743f542974SPaul B Schroeder 	unsigned iflag;
18753f542974SPaul B Schroeder 	__u8 lData;
18763f542974SPaul B Schroeder 	__u8 lParity;
18773f542974SPaul B Schroeder 	__u8 lStop;
18783f542974SPaul B Schroeder 	int status;
18793f542974SPaul B Schroeder 	__u16 Data;
18803f542974SPaul B Schroeder 	struct usb_serial_port *port;
18813f542974SPaul B Schroeder 	struct usb_serial *serial;
18823f542974SPaul B Schroeder 
18833f542974SPaul B Schroeder 	if (mos7840_port == NULL)
18843f542974SPaul B Schroeder 		return;
18853f542974SPaul B Schroeder 
18863f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
18873f542974SPaul B Schroeder 
1888441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
188984fe6e79STony Cook 		dbg("%s", "Invalid port");
18903f542974SPaul B Schroeder 		return;
18913f542974SPaul B Schroeder 	}
18923f542974SPaul B Schroeder 
1893441b62c1SHarvey Harrison 	if (mos7840_serial_paranoia_check(port->serial, __func__)) {
189484fe6e79STony Cook 		dbg("%s", "Invalid Serial");
18953f542974SPaul B Schroeder 		return;
18963f542974SPaul B Schroeder 	}
18973f542974SPaul B Schroeder 
18983f542974SPaul B Schroeder 	serial = port->serial;
18993f542974SPaul B Schroeder 
1900441b62c1SHarvey Harrison 	dbg("%s - port %d", __func__, mos7840_port->port->number);
19013f542974SPaul B Schroeder 
19023f542974SPaul B Schroeder 	if (!mos7840_port->open) {
1903441b62c1SHarvey Harrison 		dbg("%s - port not opened", __func__);
19043f542974SPaul B Schroeder 		return;
19053f542974SPaul B Schroeder 	}
19063f542974SPaul B Schroeder 
190784fe6e79STony Cook 	dbg("%s", "Entering ..........");
19083f542974SPaul B Schroeder 
19093f542974SPaul B Schroeder 	lData = LCR_BITS_8;
19103f542974SPaul B Schroeder 	lStop = LCR_STOP_1;
19113f542974SPaul B Schroeder 	lParity = LCR_PAR_NONE;
19123f542974SPaul B Schroeder 
19133f542974SPaul B Schroeder 	cflag = tty->termios->c_cflag;
19143f542974SPaul B Schroeder 	iflag = tty->termios->c_iflag;
19153f542974SPaul B Schroeder 
19163f542974SPaul B Schroeder 	/* Change the number of bits */
19173f542974SPaul B Schroeder 	if (cflag & CSIZE) {
19183f542974SPaul B Schroeder 		switch (cflag & CSIZE) {
19193f542974SPaul B Schroeder 		case CS5:
19203f542974SPaul B Schroeder 			lData = LCR_BITS_5;
19213f542974SPaul B Schroeder 			break;
19223f542974SPaul B Schroeder 
19233f542974SPaul B Schroeder 		case CS6:
19243f542974SPaul B Schroeder 			lData = LCR_BITS_6;
19253f542974SPaul B Schroeder 			break;
19263f542974SPaul B Schroeder 
19273f542974SPaul B Schroeder 		case CS7:
19283f542974SPaul B Schroeder 			lData = LCR_BITS_7;
19293f542974SPaul B Schroeder 			break;
19303f542974SPaul B Schroeder 		default:
19313f542974SPaul B Schroeder 		case CS8:
19323f542974SPaul B Schroeder 			lData = LCR_BITS_8;
19333f542974SPaul B Schroeder 			break;
19343f542974SPaul B Schroeder 		}
19353f542974SPaul B Schroeder 	}
19363f542974SPaul B Schroeder 	/* Change the Parity bit */
19373f542974SPaul B Schroeder 	if (cflag & PARENB) {
19383f542974SPaul B Schroeder 		if (cflag & PARODD) {
19393f542974SPaul B Schroeder 			lParity = LCR_PAR_ODD;
1940441b62c1SHarvey Harrison 			dbg("%s - parity = odd", __func__);
19413f542974SPaul B Schroeder 		} else {
19423f542974SPaul B Schroeder 			lParity = LCR_PAR_EVEN;
1943441b62c1SHarvey Harrison 			dbg("%s - parity = even", __func__);
19443f542974SPaul B Schroeder 		}
19453f542974SPaul B Schroeder 
19463f542974SPaul B Schroeder 	} else {
1947441b62c1SHarvey Harrison 		dbg("%s - parity = none", __func__);
19483f542974SPaul B Schroeder 	}
19493f542974SPaul B Schroeder 
1950880af9dbSAlan Cox 	if (cflag & CMSPAR)
19513f542974SPaul B Schroeder 		lParity = lParity | 0x20;
19523f542974SPaul B Schroeder 
19533f542974SPaul B Schroeder 	/* Change the Stop bit */
19543f542974SPaul B Schroeder 	if (cflag & CSTOPB) {
19553f542974SPaul B Schroeder 		lStop = LCR_STOP_2;
1956441b62c1SHarvey Harrison 		dbg("%s - stop bits = 2", __func__);
19573f542974SPaul B Schroeder 	} else {
19583f542974SPaul B Schroeder 		lStop = LCR_STOP_1;
1959441b62c1SHarvey Harrison 		dbg("%s - stop bits = 1", __func__);
19603f542974SPaul B Schroeder 	}
19613f542974SPaul B Schroeder 
19623f542974SPaul B Schroeder 	/* Update the LCR with the correct value */
19633f542974SPaul B Schroeder 	mos7840_port->shadowLCR &=
19643f542974SPaul B Schroeder 	    ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK);
19653f542974SPaul B Schroeder 	mos7840_port->shadowLCR |= (lData | lParity | lStop);
19663f542974SPaul B Schroeder 
196784fe6e79STony Cook 	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is %x",
19683f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
19693f542974SPaul B Schroeder 	/* Disable Interrupts */
19703f542974SPaul B Schroeder 	Data = 0x00;
19713f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
19723f542974SPaul B Schroeder 
19733f542974SPaul B Schroeder 	Data = 0x00;
19743f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
19753f542974SPaul B Schroeder 
19763f542974SPaul B Schroeder 	Data = 0xcf;
19773f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
19783f542974SPaul B Schroeder 
19793f542974SPaul B Schroeder 	/* Send the updated LCR value to the mos7840 */
19803f542974SPaul B Schroeder 	Data = mos7840_port->shadowLCR;
19813f542974SPaul B Schroeder 
19823f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
19833f542974SPaul B Schroeder 
19843f542974SPaul B Schroeder 	Data = 0x00b;
19853f542974SPaul B Schroeder 	mos7840_port->shadowMCR = Data;
19863f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
19873f542974SPaul B Schroeder 	Data = 0x00b;
19883f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
19893f542974SPaul B Schroeder 
19903f542974SPaul B Schroeder 	/* set up the MCR register and send it to the mos7840 */
19913f542974SPaul B Schroeder 
19923f542974SPaul B Schroeder 	mos7840_port->shadowMCR = MCR_MASTER_IE;
1993880af9dbSAlan Cox 	if (cflag & CBAUD)
19943f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS);
19953f542974SPaul B Schroeder 
1996880af9dbSAlan Cox 	if (cflag & CRTSCTS)
19973f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= (MCR_XON_ANY);
1998880af9dbSAlan Cox 	else
19993f542974SPaul B Schroeder 		mos7840_port->shadowMCR &= ~(MCR_XON_ANY);
20003f542974SPaul B Schroeder 
20013f542974SPaul B Schroeder 	Data = mos7840_port->shadowMCR;
20023f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
20033f542974SPaul B Schroeder 
20043f542974SPaul B Schroeder 	/* Determine divisor based on baud rate */
20053f542974SPaul B Schroeder 	baud = tty_get_baud_rate(tty);
20063f542974SPaul B Schroeder 
20073f542974SPaul B Schroeder 	if (!baud) {
20083f542974SPaul B Schroeder 		/* pick a default, any default... */
200984fe6e79STony Cook 		dbg("%s", "Picked default baud...");
20103f542974SPaul B Schroeder 		baud = 9600;
20113f542974SPaul B Schroeder 	}
20123f542974SPaul B Schroeder 
2013441b62c1SHarvey Harrison 	dbg("%s - baud rate = %d", __func__, baud);
20143f542974SPaul B Schroeder 	status = mos7840_send_cmd_write_baud_rate(mos7840_port, baud);
20153f542974SPaul B Schroeder 
20163f542974SPaul B Schroeder 	/* Enable Interrupts */
20173f542974SPaul B Schroeder 	Data = 0x0c;
20183f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
20193f542974SPaul B Schroeder 
202050de36f7SGreg Kroah-Hartman 	if (mos7840_port->read_urb_busy == false) {
20213f542974SPaul B Schroeder 		mos7840_port->read_urb->dev = serial->dev;
202250de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = true;
20233f542974SPaul B Schroeder 		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
20243f542974SPaul B Schroeder 		if (status) {
20253f542974SPaul B Schroeder 			dbg("usb_submit_urb(read bulk) failed, status = %d",
20263f542974SPaul B Schroeder 			    status);
202750de36f7SGreg Kroah-Hartman 			mos7840_port->read_urb_busy = false;
20283f542974SPaul B Schroeder 		}
20293f542974SPaul B Schroeder 	}
20303f542974SPaul B Schroeder 	wake_up(&mos7840_port->delta_msr_wait);
20313f542974SPaul B Schroeder 	mos7840_port->delta_msr_cond = 1;
203284fe6e79STony Cook 	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is End %x",
20333f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
20343f542974SPaul B Schroeder 
20353f542974SPaul B Schroeder 	return;
20363f542974SPaul B Schroeder }
20373f542974SPaul B Schroeder 
20383f542974SPaul B Schroeder /*****************************************************************************
20393f542974SPaul B Schroeder  * mos7840_set_termios
20403f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to change
20413f542974SPaul B Schroeder  *	the termios structure
20423f542974SPaul B Schroeder  *****************************************************************************/
20433f542974SPaul B Schroeder 
204495da310eSAlan Cox static void mos7840_set_termios(struct tty_struct *tty,
204595da310eSAlan Cox 				struct usb_serial_port *port,
2046606d099cSAlan Cox 				struct ktermios *old_termios)
20473f542974SPaul B Schroeder {
20483f542974SPaul B Schroeder 	int status;
20493f542974SPaul B Schroeder 	unsigned int cflag;
20503f542974SPaul B Schroeder 	struct usb_serial *serial;
20513f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
205284fe6e79STony Cook 	dbg("mos7840_set_termios: START");
2053441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
205484fe6e79STony Cook 		dbg("%s", "Invalid port");
20553f542974SPaul B Schroeder 		return;
20563f542974SPaul B Schroeder 	}
20573f542974SPaul B Schroeder 
20583f542974SPaul B Schroeder 	serial = port->serial;
20593f542974SPaul B Schroeder 
2060441b62c1SHarvey Harrison 	if (mos7840_serial_paranoia_check(serial, __func__)) {
206184fe6e79STony Cook 		dbg("%s", "Invalid Serial");
20623f542974SPaul B Schroeder 		return;
20633f542974SPaul B Schroeder 	}
20643f542974SPaul B Schroeder 
20653f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
20663f542974SPaul B Schroeder 
20673f542974SPaul B Schroeder 	if (mos7840_port == NULL)
20683f542974SPaul B Schroeder 		return;
20693f542974SPaul B Schroeder 
20703f542974SPaul B Schroeder 	if (!mos7840_port->open) {
2071441b62c1SHarvey Harrison 		dbg("%s - port not opened", __func__);
20723f542974SPaul B Schroeder 		return;
20733f542974SPaul B Schroeder 	}
20743f542974SPaul B Schroeder 
207584fe6e79STony Cook 	dbg("%s", "setting termios - ");
20763f542974SPaul B Schroeder 
20773f542974SPaul B Schroeder 	cflag = tty->termios->c_cflag;
20783f542974SPaul B Schroeder 
2079441b62c1SHarvey Harrison 	dbg("%s - clfag %08x iflag %08x", __func__,
20803f542974SPaul B Schroeder 	    tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag));
2081441b62c1SHarvey Harrison 	dbg("%s - old clfag %08x old iflag %08x", __func__,
20823f542974SPaul B Schroeder 	    old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag));
2083441b62c1SHarvey Harrison 	dbg("%s - port %d", __func__, port->number);
20843f542974SPaul B Schroeder 
20853f542974SPaul B Schroeder 	/* change the port settings to the new ones specified */
20863f542974SPaul B Schroeder 
208795da310eSAlan Cox 	mos7840_change_port_settings(tty, mos7840_port, old_termios);
20883f542974SPaul B Schroeder 
20893f542974SPaul B Schroeder 	if (!mos7840_port->read_urb) {
209084fe6e79STony Cook 		dbg("%s", "URB KILLED !!!!!");
20913f542974SPaul B Schroeder 		return;
20923f542974SPaul B Schroeder 	}
20933f542974SPaul B Schroeder 
209450de36f7SGreg Kroah-Hartman 	if (mos7840_port->read_urb_busy == false) {
20953f542974SPaul B Schroeder 		mos7840_port->read_urb->dev = serial->dev;
209650de36f7SGreg Kroah-Hartman 		mos7840_port->read_urb_busy = true;
20973f542974SPaul B Schroeder 		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
20983f542974SPaul B Schroeder 		if (status) {
20993f542974SPaul B Schroeder 			dbg("usb_submit_urb(read bulk) failed, status = %d",
21003f542974SPaul B Schroeder 			    status);
210150de36f7SGreg Kroah-Hartman 			mos7840_port->read_urb_busy = false;
21023f542974SPaul B Schroeder 		}
21033f542974SPaul B Schroeder 	}
21043f542974SPaul B Schroeder 	return;
21053f542974SPaul B Schroeder }
21063f542974SPaul B Schroeder 
21073f542974SPaul B Schroeder /*****************************************************************************
21083f542974SPaul B Schroeder  * mos7840_get_lsr_info - get line status register info
21093f542974SPaul B Schroeder  *
21103f542974SPaul B Schroeder  * Purpose: Let user call ioctl() to get info when the UART physically
21113f542974SPaul B Schroeder  * 	    is emptied.  On bus types like RS485, the transmitter must
21123f542974SPaul B Schroeder  * 	    release the bus after transmitting. This must be done when
21133f542974SPaul B Schroeder  * 	    the transmit shift register is empty, not be done when the
21143f542974SPaul B Schroeder  * 	    transmit holding register is empty.  This functionality
21153f542974SPaul B Schroeder  * 	    allows an RS485 driver to be written in user space.
21163f542974SPaul B Schroeder  *****************************************************************************/
21173f542974SPaul B Schroeder 
211895da310eSAlan Cox static int mos7840_get_lsr_info(struct tty_struct *tty,
211997c4965dSAl Viro 				unsigned int __user *value)
21203f542974SPaul B Schroeder {
21213f542974SPaul B Schroeder 	int count;
21223f542974SPaul B Schroeder 	unsigned int result = 0;
21233f542974SPaul B Schroeder 
212495da310eSAlan Cox 	count = mos7840_chars_in_buffer(tty);
21253f542974SPaul B Schroeder 	if (count == 0) {
2126441b62c1SHarvey Harrison 		dbg("%s -- Empty", __func__);
21273f542974SPaul B Schroeder 		result = TIOCSER_TEMT;
21283f542974SPaul B Schroeder 	}
21293f542974SPaul B Schroeder 
21303f542974SPaul B Schroeder 	if (copy_to_user(value, &result, sizeof(int)))
21313f542974SPaul B Schroeder 		return -EFAULT;
21323f542974SPaul B Schroeder 	return 0;
21333f542974SPaul B Schroeder }
21343f542974SPaul B Schroeder 
21353f542974SPaul B Schroeder /*****************************************************************************
21363f542974SPaul B Schroeder  * mos7840_get_serial_info
21373f542974SPaul B Schroeder  *      function to get information about serial port
21383f542974SPaul B Schroeder  *****************************************************************************/
21393f542974SPaul B Schroeder 
21403f542974SPaul B Schroeder static int mos7840_get_serial_info(struct moschip_port *mos7840_port,
214197c4965dSAl Viro 				   struct serial_struct __user *retinfo)
21423f542974SPaul B Schroeder {
21433f542974SPaul B Schroeder 	struct serial_struct tmp;
21443f542974SPaul B Schroeder 
21453f542974SPaul B Schroeder 	if (mos7840_port == NULL)
21463f542974SPaul B Schroeder 		return -1;
21473f542974SPaul B Schroeder 
21483f542974SPaul B Schroeder 	if (!retinfo)
21493f542974SPaul B Schroeder 		return -EFAULT;
21503f542974SPaul B Schroeder 
21513f542974SPaul B Schroeder 	memset(&tmp, 0, sizeof(tmp));
21523f542974SPaul B Schroeder 
21533f542974SPaul B Schroeder 	tmp.type = PORT_16550A;
21543f542974SPaul B Schroeder 	tmp.line = mos7840_port->port->serial->minor;
21553f542974SPaul B Schroeder 	tmp.port = mos7840_port->port->number;
21563f542974SPaul B Schroeder 	tmp.irq = 0;
21573f542974SPaul B Schroeder 	tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
21583f542974SPaul B Schroeder 	tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE;
21593f542974SPaul B Schroeder 	tmp.baud_base = 9600;
21603f542974SPaul B Schroeder 	tmp.close_delay = 5 * HZ;
21613f542974SPaul B Schroeder 	tmp.closing_wait = 30 * HZ;
21623f542974SPaul B Schroeder 
21633f542974SPaul B Schroeder 	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
21643f542974SPaul B Schroeder 		return -EFAULT;
21653f542974SPaul B Schroeder 	return 0;
21663f542974SPaul B Schroeder }
21673f542974SPaul B Schroeder 
21683f542974SPaul B Schroeder /*****************************************************************************
21693f542974SPaul B Schroeder  * SerialIoctl
21703f542974SPaul B Schroeder  *	this function handles any ioctl calls to the driver
21713f542974SPaul B Schroeder  *****************************************************************************/
21723f542974SPaul B Schroeder 
217395da310eSAlan Cox static int mos7840_ioctl(struct tty_struct *tty, struct file *file,
21743f542974SPaul B Schroeder 			 unsigned int cmd, unsigned long arg)
21753f542974SPaul B Schroeder {
217695da310eSAlan Cox 	struct usb_serial_port *port = tty->driver_data;
217797c4965dSAl Viro 	void __user *argp = (void __user *)arg;
21783f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
21793f542974SPaul B Schroeder 
21803f542974SPaul B Schroeder 	struct async_icount cnow;
21813f542974SPaul B Schroeder 	struct async_icount cprev;
21823f542974SPaul B Schroeder 	struct serial_icounter_struct icount;
21833f542974SPaul B Schroeder 
2184441b62c1SHarvey Harrison 	if (mos7840_port_paranoia_check(port, __func__)) {
218584fe6e79STony Cook 		dbg("%s", "Invalid port");
21863f542974SPaul B Schroeder 		return -1;
21873f542974SPaul B Schroeder 	}
21883f542974SPaul B Schroeder 
21893f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
21903f542974SPaul B Schroeder 
21913f542974SPaul B Schroeder 	if (mos7840_port == NULL)
21923f542974SPaul B Schroeder 		return -1;
21933f542974SPaul B Schroeder 
2194441b62c1SHarvey Harrison 	dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd);
21953f542974SPaul B Schroeder 
21963f542974SPaul B Schroeder 	switch (cmd) {
21973f542974SPaul B Schroeder 		/* return number of bytes available */
21983f542974SPaul B Schroeder 
21993f542974SPaul B Schroeder 	case TIOCSERGETLSR:
2200441b62c1SHarvey Harrison 		dbg("%s (%d) TIOCSERGETLSR", __func__, port->number);
220195da310eSAlan Cox 		return mos7840_get_lsr_info(tty, argp);
22023f542974SPaul B Schroeder 		return 0;
22033f542974SPaul B Schroeder 
22043f542974SPaul B Schroeder 	case TIOCGSERIAL:
2205441b62c1SHarvey Harrison 		dbg("%s (%d) TIOCGSERIAL", __func__, port->number);
220697c4965dSAl Viro 		return mos7840_get_serial_info(mos7840_port, argp);
22073f542974SPaul B Schroeder 
22083f542974SPaul B Schroeder 	case TIOCSSERIAL:
2209441b62c1SHarvey Harrison 		dbg("%s (%d) TIOCSSERIAL", __func__, port->number);
22103f542974SPaul B Schroeder 		break;
22113f542974SPaul B Schroeder 
22123f542974SPaul B Schroeder 	case TIOCMIWAIT:
2213441b62c1SHarvey Harrison 		dbg("%s (%d) TIOCMIWAIT", __func__, port->number);
22143f542974SPaul B Schroeder 		cprev = mos7840_port->icount;
22153f542974SPaul B Schroeder 		while (1) {
2216880af9dbSAlan Cox 			/* interruptible_sleep_on(&mos7840_port->delta_msr_wait); */
22173f542974SPaul B Schroeder 			mos7840_port->delta_msr_cond = 0;
22183f542974SPaul B Schroeder 			wait_event_interruptible(mos7840_port->delta_msr_wait,
22193f542974SPaul B Schroeder 						 (mos7840_port->
22203f542974SPaul B Schroeder 						  delta_msr_cond == 1));
22213f542974SPaul B Schroeder 
22223f542974SPaul B Schroeder 			/* see if a signal did it */
22233f542974SPaul B Schroeder 			if (signal_pending(current))
22243f542974SPaul B Schroeder 				return -ERESTARTSYS;
22253f542974SPaul B Schroeder 			cnow = mos7840_port->icount;
22260de9a702SOliver Neukum 			smp_rmb();
22273f542974SPaul B Schroeder 			if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
22283f542974SPaul B Schroeder 			    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
22293f542974SPaul B Schroeder 				return -EIO;	/* no change => error */
22303f542974SPaul B Schroeder 			if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
22313f542974SPaul B Schroeder 			    ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
22323f542974SPaul B Schroeder 			    ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
22333f542974SPaul B Schroeder 			    ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
22343f542974SPaul B Schroeder 				return 0;
22353f542974SPaul B Schroeder 			}
22363f542974SPaul B Schroeder 			cprev = cnow;
22373f542974SPaul B Schroeder 		}
22383f542974SPaul B Schroeder 		/* NOTREACHED */
22393f542974SPaul B Schroeder 		break;
22403f542974SPaul B Schroeder 
22413f542974SPaul B Schroeder 	case TIOCGICOUNT:
22423f542974SPaul B Schroeder 		cnow = mos7840_port->icount;
22430de9a702SOliver Neukum 		smp_rmb();
22443f542974SPaul B Schroeder 		icount.cts = cnow.cts;
22453f542974SPaul B Schroeder 		icount.dsr = cnow.dsr;
22463f542974SPaul B Schroeder 		icount.rng = cnow.rng;
22473f542974SPaul B Schroeder 		icount.dcd = cnow.dcd;
22483f542974SPaul B Schroeder 		icount.rx = cnow.rx;
22493f542974SPaul B Schroeder 		icount.tx = cnow.tx;
22503f542974SPaul B Schroeder 		icount.frame = cnow.frame;
22513f542974SPaul B Schroeder 		icount.overrun = cnow.overrun;
22523f542974SPaul B Schroeder 		icount.parity = cnow.parity;
22533f542974SPaul B Schroeder 		icount.brk = cnow.brk;
22543f542974SPaul B Schroeder 		icount.buf_overrun = cnow.buf_overrun;
22553f542974SPaul B Schroeder 
2256441b62c1SHarvey Harrison 		dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __func__,
22573f542974SPaul B Schroeder 		    port->number, icount.rx, icount.tx);
225897c4965dSAl Viro 		if (copy_to_user(argp, &icount, sizeof(icount)))
22593f542974SPaul B Schroeder 			return -EFAULT;
22603f542974SPaul B Schroeder 		return 0;
22613f542974SPaul B Schroeder 	default:
22623f542974SPaul B Schroeder 		break;
22633f542974SPaul B Schroeder 	}
22643f542974SPaul B Schroeder 	return -ENOIOCTLCMD;
22653f542974SPaul B Schroeder }
22663f542974SPaul B Schroeder 
22673f542974SPaul B Schroeder static int mos7840_calc_num_ports(struct usb_serial *serial)
22683f542974SPaul B Schroeder {
22690de9a702SOliver Neukum 	int mos7840_num_ports = 0;
22703f542974SPaul B Schroeder 
227184fe6e79STony Cook 	dbg("numberofendpoints: cur %d, alt %d",
227284fe6e79STony Cook 	    (int)serial->interface->cur_altsetting->desc.bNumEndpoints,
22733f542974SPaul B Schroeder 	    (int)serial->interface->altsetting->desc.bNumEndpoints);
22743f542974SPaul B Schroeder 	if (serial->interface->cur_altsetting->desc.bNumEndpoints == 5) {
22750de9a702SOliver Neukum 		mos7840_num_ports = serial->num_ports = 2;
22763f542974SPaul B Schroeder 	} else if (serial->interface->cur_altsetting->desc.bNumEndpoints == 9) {
22770de9a702SOliver Neukum 		serial->num_bulk_in = 4;
22780de9a702SOliver Neukum 		serial->num_bulk_out = 4;
22790de9a702SOliver Neukum 		mos7840_num_ports = serial->num_ports = 4;
22803f542974SPaul B Schroeder 	}
228184fe6e79STony Cook 	dbg ("mos7840_num_ports = %d", mos7840_num_ports);
22823f542974SPaul B Schroeder 	return mos7840_num_ports;
22833f542974SPaul B Schroeder }
22843f542974SPaul B Schroeder 
22853f542974SPaul B Schroeder /****************************************************************************
22863f542974SPaul B Schroeder  * mos7840_startup
22873f542974SPaul B Schroeder  ****************************************************************************/
22883f542974SPaul B Schroeder 
22893f542974SPaul B Schroeder static int mos7840_startup(struct usb_serial *serial)
22903f542974SPaul B Schroeder {
22913f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
22923f542974SPaul B Schroeder 	struct usb_device *dev;
22933f542974SPaul B Schroeder 	int i, status;
22943f542974SPaul B Schroeder 
22953f542974SPaul B Schroeder 	__u16 Data;
229684fe6e79STony Cook 	dbg("%s", "mos7840_startup :Entering..........");
22973f542974SPaul B Schroeder 
22983f542974SPaul B Schroeder 	if (!serial) {
229984fe6e79STony Cook 		dbg("%s", "Invalid Handler");
23003f542974SPaul B Schroeder 		return -1;
23013f542974SPaul B Schroeder 	}
23023f542974SPaul B Schroeder 
23033f542974SPaul B Schroeder 	dev = serial->dev;
23043f542974SPaul B Schroeder 
230584fe6e79STony Cook 	dbg("%s", "Entering...");
230684fe6e79STony Cook 	dbg ("mos7840_startup: serial = %p", serial);
23073f542974SPaul B Schroeder 
23083f542974SPaul B Schroeder 	/* we set up the pointers to the endpoints in the mos7840_open *
23093f542974SPaul B Schroeder 	 * function, as the structures aren't created yet.             */
23103f542974SPaul B Schroeder 
23113f542974SPaul B Schroeder 	/* set up port private structures */
23123f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; ++i) {
231384fe6e79STony Cook 		dbg ("mos7840_startup: configuring port %d............", i);
23147ac9da10SBurman Yan 		mos7840_port = kzalloc(sizeof(struct moschip_port), GFP_KERNEL);
23153f542974SPaul B Schroeder 		if (mos7840_port == NULL) {
2316194343d9SGreg Kroah-Hartman 			dev_err(&dev->dev, "%s - Out of memory\n", __func__);
23170de9a702SOliver Neukum 			status = -ENOMEM;
23180de9a702SOliver Neukum 			i--; /* don't follow NULL pointer cleaning up */
23190de9a702SOliver Neukum 			goto error;
23203f542974SPaul B Schroeder 		}
23213f542974SPaul B Schroeder 
2322880af9dbSAlan Cox 		/* Initialize all port interrupt end point to port 0 int
2323880af9dbSAlan Cox 		 * endpoint. Our device has only one interrupt end point
2324880af9dbSAlan Cox 		 * common to all port */
23253f542974SPaul B Schroeder 
23263f542974SPaul B Schroeder 		mos7840_port->port = serial->port[i];
23273f542974SPaul B Schroeder 		mos7840_set_port_private(serial->port[i], mos7840_port);
23280de9a702SOliver Neukum 		spin_lock_init(&mos7840_port->pool_lock);
23293f542974SPaul B Schroeder 
233037768adfSTony Cook 		/* minor is not initialised until later by
233137768adfSTony Cook 		 * usb-serial.c:get_free_serial() and cannot therefore be used
233237768adfSTony Cook 		 * to index device instances */
233337768adfSTony Cook 		mos7840_port->port_num = i + 1;
233437768adfSTony Cook 		dbg ("serial->port[i]->number = %d", serial->port[i]->number);
233537768adfSTony Cook 		dbg ("serial->port[i]->serial->minor = %d", serial->port[i]->serial->minor);
233637768adfSTony Cook 		dbg ("mos7840_port->port_num = %d", mos7840_port->port_num);
233737768adfSTony Cook 		dbg ("serial->minor = %d", serial->minor);
23383f542974SPaul B Schroeder 
23393f542974SPaul B Schroeder 		if (mos7840_port->port_num == 1) {
23403f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0x0;
23413f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0x1;
23423f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x4;
23433f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 2)
23440de9a702SOliver Neukum 			   && (serial->num_ports == 4)) {
23453f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0x8;
23463f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0x9;
23473f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x16;
23483f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 2)
23490de9a702SOliver Neukum 			   && (serial->num_ports == 2)) {
23503f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xa;
23513f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xb;
23523f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x19;
23533f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 3)
23540de9a702SOliver Neukum 			   && (serial->num_ports == 4)) {
23553f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xa;
23563f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xb;
23573f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x19;
23583f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 4)
23590de9a702SOliver Neukum 			   && (serial->num_ports == 4)) {
23603f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xc;
23613f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xd;
23623f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x1c;
23633f542974SPaul B Schroeder 		}
23643f542974SPaul B Schroeder 		mos7840_dump_serial_port(mos7840_port);
23653f542974SPaul B Schroeder 		mos7840_set_port_private(serial->port[i], mos7840_port);
23663f542974SPaul B Schroeder 
2367880af9dbSAlan Cox 		/* enable rx_disable bit in control register */
2368880af9dbSAlan Cox 		status = mos7840_get_reg_sync(serial->port[i],
23693f542974SPaul B Schroeder 				 mos7840_port->ControlRegOffset, &Data);
23703f542974SPaul B Schroeder 		if (status < 0) {
237184fe6e79STony Cook 			dbg("Reading ControlReg failed status-0x%x", status);
23723f542974SPaul B Schroeder 			break;
23733f542974SPaul B Schroeder 		} else
237484fe6e79STony Cook 			dbg("ControlReg Reading success val is %x, status%d",
23753f542974SPaul B Schroeder 			    Data, status);
2376880af9dbSAlan Cox 		Data |= 0x08;	/* setting driver done bit */
2377880af9dbSAlan Cox 		Data |= 0x04;	/* sp1_bit to have cts change reflect in
2378880af9dbSAlan Cox 				   modem status reg */
23793f542974SPaul B Schroeder 
2380880af9dbSAlan Cox 		/* Data |= 0x20; //rx_disable bit */
2381880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
23823f542974SPaul B Schroeder 					 mos7840_port->ControlRegOffset, Data);
23833f542974SPaul B Schroeder 		if (status < 0) {
238484fe6e79STony Cook 			dbg("Writing ControlReg failed(rx_disable) status-0x%x", status);
23853f542974SPaul B Schroeder 			break;
23863f542974SPaul B Schroeder 		} else
238784fe6e79STony Cook 			dbg("ControlReg Writing success(rx_disable) status%d",
23883f542974SPaul B Schroeder 			    status);
23893f542974SPaul B Schroeder 
2390880af9dbSAlan Cox 		/* Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2
2391880af9dbSAlan Cox 		   and 0x24 in DCR3 */
23923f542974SPaul B Schroeder 		Data = 0x01;
2393880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
2394880af9dbSAlan Cox 			 (__u16) (mos7840_port->DcrRegOffset + 0), Data);
23953f542974SPaul B Schroeder 		if (status < 0) {
239684fe6e79STony Cook 			dbg("Writing DCR0 failed status-0x%x", status);
23973f542974SPaul B Schroeder 			break;
23983f542974SPaul B Schroeder 		} else
239984fe6e79STony Cook 			dbg("DCR0 Writing success status%d", status);
24003f542974SPaul B Schroeder 
24013f542974SPaul B Schroeder 		Data = 0x05;
2402880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
2403880af9dbSAlan Cox 			 (__u16) (mos7840_port->DcrRegOffset + 1), Data);
24043f542974SPaul B Schroeder 		if (status < 0) {
240584fe6e79STony Cook 			dbg("Writing DCR1 failed status-0x%x", status);
24063f542974SPaul B Schroeder 			break;
24073f542974SPaul B Schroeder 		} else
240884fe6e79STony Cook 			dbg("DCR1 Writing success status%d", status);
24093f542974SPaul B Schroeder 
24103f542974SPaul B Schroeder 		Data = 0x24;
2411880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
2412880af9dbSAlan Cox 			 (__u16) (mos7840_port->DcrRegOffset + 2), Data);
24133f542974SPaul B Schroeder 		if (status < 0) {
241484fe6e79STony Cook 			dbg("Writing DCR2 failed status-0x%x", status);
24153f542974SPaul B Schroeder 			break;
24163f542974SPaul B Schroeder 		} else
241784fe6e79STony Cook 			dbg("DCR2 Writing success status%d", status);
24183f542974SPaul B Schroeder 
2419880af9dbSAlan Cox 		/* write values in clkstart0x0 and clkmulti 0x20 */
24203f542974SPaul B Schroeder 		Data = 0x0;
2421880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
24223f542974SPaul B Schroeder 					 CLK_START_VALUE_REGISTER, Data);
24233f542974SPaul B Schroeder 		if (status < 0) {
242484fe6e79STony Cook 			dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x", status);
24253f542974SPaul B Schroeder 			break;
24263f542974SPaul B Schroeder 		} else
242784fe6e79STony Cook 			dbg("CLK_START_VALUE_REGISTER Writing success status%d", status);
24283f542974SPaul B Schroeder 
24293f542974SPaul B Schroeder 		Data = 0x20;
2430880af9dbSAlan Cox 		status = mos7840_set_reg_sync(serial->port[i],
2431880af9dbSAlan Cox 					CLK_MULTI_REGISTER, Data);
24323f542974SPaul B Schroeder 		if (status < 0) {
243384fe6e79STony Cook 			dbg("Writing CLK_MULTI_REGISTER failed status-0x%x",
24343f542974SPaul B Schroeder 			    status);
24350de9a702SOliver Neukum 			goto error;
24363f542974SPaul B Schroeder 		} else
243784fe6e79STony Cook 			dbg("CLK_MULTI_REGISTER Writing success status%d",
24383f542974SPaul B Schroeder 			    status);
24393f542974SPaul B Schroeder 
2440880af9dbSAlan Cox 		/* write value 0x0 to scratchpad register */
24413f542974SPaul B Schroeder 		Data = 0x00;
2442880af9dbSAlan Cox 		status = mos7840_set_uart_reg(serial->port[i],
2443880af9dbSAlan Cox 						SCRATCH_PAD_REGISTER, Data);
24443f542974SPaul B Schroeder 		if (status < 0) {
244584fe6e79STony Cook 			dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x",
24463f542974SPaul B Schroeder 			    status);
24473f542974SPaul B Schroeder 			break;
24483f542974SPaul B Schroeder 		} else
244984fe6e79STony Cook 			dbg("SCRATCH_PAD_REGISTER Writing success status%d",
24503f542974SPaul B Schroeder 			    status);
24513f542974SPaul B Schroeder 
2452880af9dbSAlan Cox 		/* Zero Length flag register */
24533f542974SPaul B Schroeder 		if ((mos7840_port->port_num != 1)
24540de9a702SOliver Neukum 		    && (serial->num_ports == 2)) {
24553f542974SPaul B Schroeder 
24563f542974SPaul B Schroeder 			Data = 0xff;
24573f542974SPaul B Schroeder 			status = mos7840_set_reg_sync(serial->port[i],
24583f542974SPaul B Schroeder 				      (__u16) (ZLP_REG1 +
2459880af9dbSAlan Cox 				      ((__u16)mos7840_port->port_num)), Data);
246084fe6e79STony Cook 			dbg("ZLIP offset %x",
24613f542974SPaul B Schroeder 			    (__u16) (ZLP_REG1 +
24623f542974SPaul B Schroeder 					((__u16) mos7840_port->port_num)));
24633f542974SPaul B Schroeder 			if (status < 0) {
246484fe6e79STony Cook 				dbg("Writing ZLP_REG%d failed status-0x%x",
24653f542974SPaul B Schroeder 				    i + 2, status);
24663f542974SPaul B Schroeder 				break;
24673f542974SPaul B Schroeder 			} else
246884fe6e79STony Cook 				dbg("ZLP_REG%d Writing success status%d",
24693f542974SPaul B Schroeder 				    i + 2, status);
24703f542974SPaul B Schroeder 		} else {
24713f542974SPaul B Schroeder 			Data = 0xff;
24723f542974SPaul B Schroeder 			status = mos7840_set_reg_sync(serial->port[i],
24733f542974SPaul B Schroeder 			      (__u16) (ZLP_REG1 +
2474880af9dbSAlan Cox 			      ((__u16)mos7840_port->port_num) - 0x1), Data);
247584fe6e79STony Cook 			dbg("ZLIP offset %x",
24763f542974SPaul B Schroeder 			    (__u16) (ZLP_REG1 +
24773f542974SPaul B Schroeder 				     ((__u16) mos7840_port->port_num) - 0x1));
24783f542974SPaul B Schroeder 			if (status < 0) {
247984fe6e79STony Cook 				dbg("Writing ZLP_REG%d failed status-0x%x",
24803f542974SPaul B Schroeder 				    i + 1, status);
24813f542974SPaul B Schroeder 				break;
24823f542974SPaul B Schroeder 			} else
248384fe6e79STony Cook 				dbg("ZLP_REG%d Writing success status%d",
24843f542974SPaul B Schroeder 				    i + 1, status);
24853f542974SPaul B Schroeder 
24863f542974SPaul B Schroeder 		}
24870de9a702SOliver Neukum 		mos7840_port->control_urb = usb_alloc_urb(0, GFP_KERNEL);
24883f542974SPaul B Schroeder 		mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL);
2489880af9dbSAlan Cox 		mos7840_port->dr = kmalloc(sizeof(struct usb_ctrlrequest),
2490880af9dbSAlan Cox 								GFP_KERNEL);
2491880af9dbSAlan Cox 		if (!mos7840_port->control_urb || !mos7840_port->ctrl_buf ||
2492880af9dbSAlan Cox 							!mos7840_port->dr) {
24930de9a702SOliver Neukum 			status = -ENOMEM;
24940de9a702SOliver Neukum 			goto error;
24950de9a702SOliver Neukum 		}
24963f542974SPaul B Schroeder 	}
249784fe6e79STony Cook 	dbg ("mos7840_startup: all ports configured...........");
24983f542974SPaul B Schroeder 
2499880af9dbSAlan Cox 	/* Zero Length flag enable */
25003f542974SPaul B Schroeder 	Data = 0x0f;
25013f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data);
25023f542974SPaul B Schroeder 	if (status < 0) {
250384fe6e79STony Cook 		dbg("Writing ZLP_REG5 failed status-0x%x", status);
25047ced46c3SRoel Kluin 		goto error;
25053f542974SPaul B Schroeder 	} else
250684fe6e79STony Cook 		dbg("ZLP_REG5 Writing success status%d", status);
25073f542974SPaul B Schroeder 
25083f542974SPaul B Schroeder 	/* setting configuration feature to one */
25093f542974SPaul B Schroeder 	usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
251097c4965dSAl Viro 			(__u8) 0x03, 0x00, 0x01, 0x00, NULL, 0x00, 5 * HZ);
25113f542974SPaul B Schroeder 	return 0;
25120de9a702SOliver Neukum error:
25130de9a702SOliver Neukum 	for (/* nothing */; i >= 0; i--) {
25140de9a702SOliver Neukum 		mos7840_port = mos7840_get_port_private(serial->port[i]);
25150de9a702SOliver Neukum 
25160de9a702SOliver Neukum 		kfree(mos7840_port->dr);
25170de9a702SOliver Neukum 		kfree(mos7840_port->ctrl_buf);
25180de9a702SOliver Neukum 		usb_free_urb(mos7840_port->control_urb);
25190de9a702SOliver Neukum 		kfree(mos7840_port);
25200de9a702SOliver Neukum 		serial->port[i] = NULL;
25210de9a702SOliver Neukum 	}
25220de9a702SOliver Neukum 	return status;
25233f542974SPaul B Schroeder }
25243f542974SPaul B Schroeder 
25253f542974SPaul B Schroeder /****************************************************************************
2526f9c99bb8SAlan Stern  * mos7840_disconnect
25273f542974SPaul B Schroeder  *	This function is called whenever the device is removed from the usb bus.
25283f542974SPaul B Schroeder  ****************************************************************************/
25293f542974SPaul B Schroeder 
2530f9c99bb8SAlan Stern static void mos7840_disconnect(struct usb_serial *serial)
25313f542974SPaul B Schroeder {
25323f542974SPaul B Schroeder 	int i;
25330de9a702SOliver Neukum 	unsigned long flags;
25343f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
2535f9c99bb8SAlan Stern 	dbg("%s", " disconnect :entering..........");
25363f542974SPaul B Schroeder 
25373f542974SPaul B Schroeder 	if (!serial) {
253884fe6e79STony Cook 		dbg("%s", "Invalid Handler");
25393f542974SPaul B Schroeder 		return;
25403f542974SPaul B Schroeder 	}
25413f542974SPaul B Schroeder 
25423f542974SPaul B Schroeder 	/* check for the ports to be closed,close the ports and disconnect */
25433f542974SPaul B Schroeder 
25443f542974SPaul B Schroeder 	/* free private structure allocated for serial port  *
25453f542974SPaul B Schroeder 	 * stop reads and writes on all ports                */
25463f542974SPaul B Schroeder 
25473f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; ++i) {
25483f542974SPaul B Schroeder 		mos7840_port = mos7840_get_port_private(serial->port[i]);
254937768adfSTony Cook 		dbg ("mos7840_port %d = %p", i, mos7840_port);
255037768adfSTony Cook 		if (mos7840_port) {
25510de9a702SOliver Neukum 			spin_lock_irqsave(&mos7840_port->pool_lock, flags);
25520de9a702SOliver Neukum 			mos7840_port->zombie = 1;
25530de9a702SOliver Neukum 			spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
25543f542974SPaul B Schroeder 			usb_kill_urb(mos7840_port->control_urb);
2555f9c99bb8SAlan Stern 		}
2556f9c99bb8SAlan Stern 	}
2557f9c99bb8SAlan Stern 
2558f9c99bb8SAlan Stern 	dbg("%s", "Thank u :: ");
2559f9c99bb8SAlan Stern 
2560f9c99bb8SAlan Stern }
2561f9c99bb8SAlan Stern 
2562f9c99bb8SAlan Stern /****************************************************************************
2563f9c99bb8SAlan Stern  * mos7840_release
2564f9c99bb8SAlan Stern  *	This function is called when the usb_serial structure is freed.
2565f9c99bb8SAlan Stern  ****************************************************************************/
2566f9c99bb8SAlan Stern 
2567f9c99bb8SAlan Stern static void mos7840_release(struct usb_serial *serial)
2568f9c99bb8SAlan Stern {
2569f9c99bb8SAlan Stern 	int i;
2570f9c99bb8SAlan Stern 	struct moschip_port *mos7840_port;
2571f9c99bb8SAlan Stern 	dbg("%s", " release :entering..........");
2572f9c99bb8SAlan Stern 
2573f9c99bb8SAlan Stern 	if (!serial) {
2574f9c99bb8SAlan Stern 		dbg("%s", "Invalid Handler");
2575f9c99bb8SAlan Stern 		return;
2576f9c99bb8SAlan Stern 	}
2577f9c99bb8SAlan Stern 
2578f9c99bb8SAlan Stern 	/* check for the ports to be closed,close the ports and disconnect */
2579f9c99bb8SAlan Stern 
2580f9c99bb8SAlan Stern 	/* free private structure allocated for serial port  *
2581f9c99bb8SAlan Stern 	 * stop reads and writes on all ports                */
2582f9c99bb8SAlan Stern 
2583f9c99bb8SAlan Stern 	for (i = 0; i < serial->num_ports; ++i) {
2584f9c99bb8SAlan Stern 		mos7840_port = mos7840_get_port_private(serial->port[i]);
2585f9c99bb8SAlan Stern 		dbg("mos7840_port %d = %p", i, mos7840_port);
2586f9c99bb8SAlan Stern 		if (mos7840_port) {
25870de9a702SOliver Neukum 			kfree(mos7840_port->ctrl_buf);
25880de9a702SOliver Neukum 			kfree(mos7840_port->dr);
25893f542974SPaul B Schroeder 			kfree(mos7840_port);
259037768adfSTony Cook 		}
25913f542974SPaul B Schroeder 	}
25923f542974SPaul B Schroeder 
259384fe6e79STony Cook 	dbg("%s", "Thank u :: ");
25943f542974SPaul B Schroeder 
25953f542974SPaul B Schroeder }
25963f542974SPaul B Schroeder 
2597d9b1b787SJohannes Hölzl static struct usb_driver io_driver = {
2598d9b1b787SJohannes Hölzl 	.name = "mos7840",
2599d9b1b787SJohannes Hölzl 	.probe = usb_serial_probe,
2600d9b1b787SJohannes Hölzl 	.disconnect = usb_serial_disconnect,
2601d9b1b787SJohannes Hölzl 	.id_table = moschip_id_table_combined,
2602d9b1b787SJohannes Hölzl 	.no_dynamic_id = 1,
2603d9b1b787SJohannes Hölzl };
2604d9b1b787SJohannes Hölzl 
26053f542974SPaul B Schroeder static struct usb_serial_driver moschip7840_4port_device = {
26063f542974SPaul B Schroeder 	.driver = {
26073f542974SPaul B Schroeder 		   .owner = THIS_MODULE,
26083f542974SPaul B Schroeder 		   .name = "mos7840",
26093f542974SPaul B Schroeder 		   },
26103f542974SPaul B Schroeder 	.description = DRIVER_DESC,
2611d9b1b787SJohannes Hölzl 	.usb_driver = &io_driver,
26123f542974SPaul B Schroeder 	.id_table = moschip_port_id_table,
26133f542974SPaul B Schroeder 	.num_ports = 4,
26143f542974SPaul B Schroeder 	.open = mos7840_open,
26153f542974SPaul B Schroeder 	.close = mos7840_close,
26163f542974SPaul B Schroeder 	.write = mos7840_write,
26173f542974SPaul B Schroeder 	.write_room = mos7840_write_room,
26183f542974SPaul B Schroeder 	.chars_in_buffer = mos7840_chars_in_buffer,
26193f542974SPaul B Schroeder 	.throttle = mos7840_throttle,
26203f542974SPaul B Schroeder 	.unthrottle = mos7840_unthrottle,
26213f542974SPaul B Schroeder 	.calc_num_ports = mos7840_calc_num_ports,
26223f542974SPaul B Schroeder #ifdef MCSSerialProbe
26233f542974SPaul B Schroeder 	.probe = mos7840_serial_probe,
26243f542974SPaul B Schroeder #endif
26253f542974SPaul B Schroeder 	.ioctl = mos7840_ioctl,
26263f542974SPaul B Schroeder 	.set_termios = mos7840_set_termios,
26273f542974SPaul B Schroeder 	.break_ctl = mos7840_break,
26283f542974SPaul B Schroeder 	.tiocmget = mos7840_tiocmget,
26293f542974SPaul B Schroeder 	.tiocmset = mos7840_tiocmset,
26303f542974SPaul B Schroeder 	.attach = mos7840_startup,
2631f9c99bb8SAlan Stern 	.disconnect = mos7840_disconnect,
2632f9c99bb8SAlan Stern 	.release = mos7840_release,
26333f542974SPaul B Schroeder 	.read_bulk_callback = mos7840_bulk_in_callback,
26343f542974SPaul B Schroeder 	.read_int_callback = mos7840_interrupt_callback,
26353f542974SPaul B Schroeder };
26363f542974SPaul B Schroeder 
26373f542974SPaul B Schroeder /****************************************************************************
26383f542974SPaul B Schroeder  * moschip7840_init
26393f542974SPaul B Schroeder  *	This is called by the module subsystem, or on startup to initialize us
26403f542974SPaul B Schroeder  ****************************************************************************/
26413f542974SPaul B Schroeder static int __init moschip7840_init(void)
26423f542974SPaul B Schroeder {
26433f542974SPaul B Schroeder 	int retval;
26443f542974SPaul B Schroeder 
264584fe6e79STony Cook 	dbg("%s", " mos7840_init :entering..........");
26463f542974SPaul B Schroeder 
26473f542974SPaul B Schroeder 	/* Register with the usb serial */
26483f542974SPaul B Schroeder 	retval = usb_serial_register(&moschip7840_4port_device);
26493f542974SPaul B Schroeder 
26503f542974SPaul B Schroeder 	if (retval)
26513f542974SPaul B Schroeder 		goto failed_port_device_register;
26523f542974SPaul B Schroeder 
265384fe6e79STony Cook 	dbg("%s", "Entering...");
2654c197a8dbSGreg Kroah-Hartman 	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
2655c197a8dbSGreg Kroah-Hartman 	       DRIVER_DESC "\n");
26563f542974SPaul B Schroeder 
26573f542974SPaul B Schroeder 	/* Register with the usb */
26583f542974SPaul B Schroeder 	retval = usb_register(&io_driver);
26593f542974SPaul B Schroeder 	if (retval == 0) {
266084fe6e79STony Cook 		dbg("%s", "Leaving...");
26613f542974SPaul B Schroeder 		return 0;
26623f542974SPaul B Schroeder 	}
26633f542974SPaul B Schroeder 	usb_serial_deregister(&moschip7840_4port_device);
26643f542974SPaul B Schroeder failed_port_device_register:
26653f542974SPaul B Schroeder 	return retval;
26663f542974SPaul B Schroeder }
26673f542974SPaul B Schroeder 
26683f542974SPaul B Schroeder /****************************************************************************
26693f542974SPaul B Schroeder  * moschip7840_exit
26703f542974SPaul B Schroeder  *	Called when the driver is about to be unloaded.
26713f542974SPaul B Schroeder  ****************************************************************************/
26723f542974SPaul B Schroeder static void __exit moschip7840_exit(void)
26733f542974SPaul B Schroeder {
26743f542974SPaul B Schroeder 
267584fe6e79STony Cook 	dbg("%s", " mos7840_exit :entering..........");
26763f542974SPaul B Schroeder 
26773f542974SPaul B Schroeder 	usb_deregister(&io_driver);
26783f542974SPaul B Schroeder 
26793f542974SPaul B Schroeder 	usb_serial_deregister(&moschip7840_4port_device);
26803f542974SPaul B Schroeder 
268184fe6e79STony Cook 	dbg("%s", "Entering...");
26823f542974SPaul B Schroeder }
26833f542974SPaul B Schroeder 
26843f542974SPaul B Schroeder module_init(moschip7840_init);
26853f542974SPaul B Schroeder module_exit(moschip7840_exit);
26863f542974SPaul B Schroeder 
26873f542974SPaul B Schroeder /* Module information */
26883f542974SPaul B Schroeder MODULE_DESCRIPTION(DRIVER_DESC);
26893f542974SPaul B Schroeder MODULE_LICENSE("GPL");
26903f542974SPaul B Schroeder 
26913f542974SPaul B Schroeder module_param(debug, bool, S_IRUGO | S_IWUSR);
26923f542974SPaul B Schroeder MODULE_PARM_DESC(debug, "Debug enabled or not");
2693