xref: /openbmc/linux/drivers/usb/serial/mos7840.c (revision 3f5429746d91f21f60f68b14177c0d534d80240b)
1*3f542974SPaul B Schroeder /*
2*3f542974SPaul B Schroeder  * This program is free software; you can redistribute it and/or modify
3*3f542974SPaul B Schroeder  * it under the terms of the GNU General Public License as published by
4*3f542974SPaul B Schroeder  * the Free Software Foundation; either version 2 of the License, or
5*3f542974SPaul B Schroeder  * (at your option) any later version.
6*3f542974SPaul B Schroeder  *
7*3f542974SPaul B Schroeder  * This program is distributed in the hope that it will be useful,
8*3f542974SPaul B Schroeder  * but WITHOUT ANY WARRANTY; without even the implied warranty of
9*3f542974SPaul B Schroeder  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
10*3f542974SPaul B Schroeder  * GNU General Public License for more details.
11*3f542974SPaul B Schroeder  *
12*3f542974SPaul B Schroeder  * You should have received a copy of the GNU General Public License
13*3f542974SPaul B Schroeder  * along with this program; if not, write to the Free Software
14*3f542974SPaul B Schroeder  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
15*3f542974SPaul B Schroeder  *
16*3f542974SPaul B Schroeder  * Clean ups from Moschip version and a few ioctl implementations by:
17*3f542974SPaul B Schroeder  *	Paul B Schroeder <pschroeder "at" uplogix "dot" com>
18*3f542974SPaul B Schroeder  *
19*3f542974SPaul B Schroeder  * Originally based on drivers/usb/serial/io_edgeport.c which is:
20*3f542974SPaul B Schroeder  *      Copyright (C) 2000 Inside Out Networks, All rights reserved.
21*3f542974SPaul B Schroeder  *      Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com>
22*3f542974SPaul B Schroeder  *
23*3f542974SPaul B Schroeder  */
24*3f542974SPaul B Schroeder 
25*3f542974SPaul B Schroeder #include <linux/kernel.h>
26*3f542974SPaul B Schroeder #include <linux/errno.h>
27*3f542974SPaul B Schroeder #include <linux/init.h>
28*3f542974SPaul B Schroeder #include <linux/slab.h>
29*3f542974SPaul B Schroeder #include <linux/tty.h>
30*3f542974SPaul B Schroeder #include <linux/tty_driver.h>
31*3f542974SPaul B Schroeder #include <linux/tty_flip.h>
32*3f542974SPaul B Schroeder #include <linux/module.h>
33*3f542974SPaul B Schroeder #include <linux/serial.h>
34*3f542974SPaul B Schroeder #include <linux/usb.h>
35*3f542974SPaul B Schroeder #include <linux/usb/serial.h>
36*3f542974SPaul B Schroeder #include <asm/uaccess.h>
37*3f542974SPaul B Schroeder 
38*3f542974SPaul B Schroeder /*
39*3f542974SPaul B Schroeder  * Version Information
40*3f542974SPaul B Schroeder  */
41*3f542974SPaul B Schroeder #define DRIVER_VERSION "1.3.1"
42*3f542974SPaul B Schroeder #define DRIVER_DESC "Moschip 7840/7820 USB Serial Driver"
43*3f542974SPaul B Schroeder 
44*3f542974SPaul B Schroeder /*
45*3f542974SPaul B Schroeder  * 16C50 UART register defines
46*3f542974SPaul B Schroeder  */
47*3f542974SPaul B Schroeder 
48*3f542974SPaul B Schroeder #define LCR_BITS_5             0x00	/* 5 bits/char */
49*3f542974SPaul B Schroeder #define LCR_BITS_6             0x01	/* 6 bits/char */
50*3f542974SPaul B Schroeder #define LCR_BITS_7             0x02	/* 7 bits/char */
51*3f542974SPaul B Schroeder #define LCR_BITS_8             0x03	/* 8 bits/char */
52*3f542974SPaul B Schroeder #define LCR_BITS_MASK          0x03	/* Mask for bits/char field */
53*3f542974SPaul B Schroeder 
54*3f542974SPaul B Schroeder #define LCR_STOP_1             0x00	/* 1 stop bit */
55*3f542974SPaul B Schroeder #define LCR_STOP_1_5           0x04	/* 1.5 stop bits (if 5   bits/char) */
56*3f542974SPaul B Schroeder #define LCR_STOP_2             0x04	/* 2 stop bits   (if 6-8 bits/char) */
57*3f542974SPaul B Schroeder #define LCR_STOP_MASK          0x04	/* Mask for stop bits field */
58*3f542974SPaul B Schroeder 
59*3f542974SPaul B Schroeder #define LCR_PAR_NONE           0x00	/* No parity */
60*3f542974SPaul B Schroeder #define LCR_PAR_ODD            0x08	/* Odd parity */
61*3f542974SPaul B Schroeder #define LCR_PAR_EVEN           0x18	/* Even parity */
62*3f542974SPaul B Schroeder #define LCR_PAR_MARK           0x28	/* Force parity bit to 1 */
63*3f542974SPaul B Schroeder #define LCR_PAR_SPACE          0x38	/* Force parity bit to 0 */
64*3f542974SPaul B Schroeder #define LCR_PAR_MASK           0x38	/* Mask for parity field */
65*3f542974SPaul B Schroeder 
66*3f542974SPaul B Schroeder #define LCR_SET_BREAK          0x40	/* Set Break condition */
67*3f542974SPaul B Schroeder #define LCR_DL_ENABLE          0x80	/* Enable access to divisor latch */
68*3f542974SPaul B Schroeder 
69*3f542974SPaul B Schroeder #define MCR_DTR                0x01	/* Assert DTR */
70*3f542974SPaul B Schroeder #define MCR_RTS                0x02	/* Assert RTS */
71*3f542974SPaul B Schroeder #define MCR_OUT1               0x04	/* Loopback only: Sets state of RI */
72*3f542974SPaul B Schroeder #define MCR_MASTER_IE          0x08	/* Enable interrupt outputs */
73*3f542974SPaul B Schroeder #define MCR_LOOPBACK           0x10	/* Set internal (digital) loopback mode */
74*3f542974SPaul B Schroeder #define MCR_XON_ANY            0x20	/* Enable any char to exit XOFF mode */
75*3f542974SPaul B Schroeder 
76*3f542974SPaul B Schroeder #define MOS7840_MSR_CTS        0x10	/* Current state of CTS */
77*3f542974SPaul B Schroeder #define MOS7840_MSR_DSR        0x20	/* Current state of DSR */
78*3f542974SPaul B Schroeder #define MOS7840_MSR_RI         0x40	/* Current state of RI */
79*3f542974SPaul B Schroeder #define MOS7840_MSR_CD         0x80	/* Current state of CD */
80*3f542974SPaul B Schroeder 
81*3f542974SPaul B Schroeder /*
82*3f542974SPaul B Schroeder  * Defines used for sending commands to port
83*3f542974SPaul B Schroeder  */
84*3f542974SPaul B Schroeder 
85*3f542974SPaul B Schroeder #define WAIT_FOR_EVER   (HZ * 0 )	/* timeout urb is wait for ever */
86*3f542974SPaul B Schroeder #define MOS_WDR_TIMEOUT (HZ * 5 )	/* default urb timeout */
87*3f542974SPaul B Schroeder 
88*3f542974SPaul B Schroeder #define MOS_PORT1       0x0200
89*3f542974SPaul B Schroeder #define MOS_PORT2       0x0300
90*3f542974SPaul B Schroeder #define MOS_VENREG      0x0000
91*3f542974SPaul B Schroeder #define MOS_MAX_PORT	0x02
92*3f542974SPaul B Schroeder #define MOS_WRITE       0x0E
93*3f542974SPaul B Schroeder #define MOS_READ        0x0D
94*3f542974SPaul B Schroeder 
95*3f542974SPaul B Schroeder /* Requests */
96*3f542974SPaul B Schroeder #define MCS_RD_RTYPE    0xC0
97*3f542974SPaul B Schroeder #define MCS_WR_RTYPE    0x40
98*3f542974SPaul B Schroeder #define MCS_RDREQ       0x0D
99*3f542974SPaul B Schroeder #define MCS_WRREQ       0x0E
100*3f542974SPaul B Schroeder #define MCS_CTRL_TIMEOUT        500
101*3f542974SPaul B Schroeder #define VENDOR_READ_LENGTH      (0x01)
102*3f542974SPaul B Schroeder 
103*3f542974SPaul B Schroeder #define MAX_NAME_LEN    64
104*3f542974SPaul B Schroeder 
105*3f542974SPaul B Schroeder #define ZLP_REG1  0x3A		//Zero_Flag_Reg1    58
106*3f542974SPaul B Schroeder #define ZLP_REG5  0x3E		//Zero_Flag_Reg5    62
107*3f542974SPaul B Schroeder 
108*3f542974SPaul B Schroeder /* For higher baud Rates use TIOCEXBAUD */
109*3f542974SPaul B Schroeder #define TIOCEXBAUD     0x5462
110*3f542974SPaul B Schroeder 
111*3f542974SPaul B Schroeder /* vendor id and device id defines */
112*3f542974SPaul B Schroeder 
113*3f542974SPaul B Schroeder #define USB_VENDOR_ID_MOSCHIP           0x9710
114*3f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7840          0x7840
115*3f542974SPaul B Schroeder #define MOSCHIP_DEVICE_ID_7820          0x7820
116*3f542974SPaul B Schroeder 
117*3f542974SPaul B Schroeder /* Interrupt Rotinue Defines    */
118*3f542974SPaul B Schroeder 
119*3f542974SPaul B Schroeder #define SERIAL_IIR_RLS      0x06
120*3f542974SPaul B Schroeder #define SERIAL_IIR_MS       0x00
121*3f542974SPaul B Schroeder 
122*3f542974SPaul B Schroeder /*
123*3f542974SPaul B Schroeder  *  Emulation of the bit mask on the LINE STATUS REGISTER.
124*3f542974SPaul B Schroeder  */
125*3f542974SPaul B Schroeder #define SERIAL_LSR_DR       0x0001
126*3f542974SPaul B Schroeder #define SERIAL_LSR_OE       0x0002
127*3f542974SPaul B Schroeder #define SERIAL_LSR_PE       0x0004
128*3f542974SPaul B Schroeder #define SERIAL_LSR_FE       0x0008
129*3f542974SPaul B Schroeder #define SERIAL_LSR_BI       0x0010
130*3f542974SPaul B Schroeder 
131*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_CTS   0x10
132*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_DSR   0x20
133*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_RI    0x40
134*3f542974SPaul B Schroeder #define MOS_MSR_DELTA_CD    0x80
135*3f542974SPaul B Schroeder 
136*3f542974SPaul B Schroeder // Serial Port register Address
137*3f542974SPaul B Schroeder #define INTERRUPT_ENABLE_REGISTER  ((__u16)(0x01))
138*3f542974SPaul B Schroeder #define FIFO_CONTROL_REGISTER      ((__u16)(0x02))
139*3f542974SPaul B Schroeder #define LINE_CONTROL_REGISTER      ((__u16)(0x03))
140*3f542974SPaul B Schroeder #define MODEM_CONTROL_REGISTER     ((__u16)(0x04))
141*3f542974SPaul B Schroeder #define LINE_STATUS_REGISTER       ((__u16)(0x05))
142*3f542974SPaul B Schroeder #define MODEM_STATUS_REGISTER      ((__u16)(0x06))
143*3f542974SPaul B Schroeder #define SCRATCH_PAD_REGISTER       ((__u16)(0x07))
144*3f542974SPaul B Schroeder #define DIVISOR_LATCH_LSB          ((__u16)(0x00))
145*3f542974SPaul B Schroeder #define DIVISOR_LATCH_MSB          ((__u16)(0x01))
146*3f542974SPaul B Schroeder 
147*3f542974SPaul B Schroeder #define CLK_MULTI_REGISTER         ((__u16)(0x02))
148*3f542974SPaul B Schroeder #define CLK_START_VALUE_REGISTER   ((__u16)(0x03))
149*3f542974SPaul B Schroeder 
150*3f542974SPaul B Schroeder #define SERIAL_LCR_DLAB            ((__u16)(0x0080))
151*3f542974SPaul B Schroeder 
152*3f542974SPaul B Schroeder /*
153*3f542974SPaul B Schroeder  * URB POOL related defines
154*3f542974SPaul B Schroeder  */
155*3f542974SPaul B Schroeder #define NUM_URBS                        16	/* URB Count */
156*3f542974SPaul B Schroeder #define URB_TRANSFER_BUFFER_SIZE        32	/* URB Size  */
157*3f542974SPaul B Schroeder 
158*3f542974SPaul B Schroeder 
159*3f542974SPaul B Schroeder static struct usb_device_id moschip_port_id_table[] = {
160*3f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
161*3f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
162*3f542974SPaul B Schroeder 	{}			/* terminating entry */
163*3f542974SPaul B Schroeder };
164*3f542974SPaul B Schroeder 
165*3f542974SPaul B Schroeder static __devinitdata struct usb_device_id moschip_id_table_combined[] = {
166*3f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
167*3f542974SPaul B Schroeder 	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
168*3f542974SPaul B Schroeder 	{}			/* terminating entry */
169*3f542974SPaul B Schroeder };
170*3f542974SPaul B Schroeder 
171*3f542974SPaul B Schroeder MODULE_DEVICE_TABLE(usb, moschip_id_table_combined);
172*3f542974SPaul B Schroeder 
173*3f542974SPaul B Schroeder /* This structure holds all of the local port information */
174*3f542974SPaul B Schroeder 
175*3f542974SPaul B Schroeder struct moschip_port {
176*3f542974SPaul B Schroeder 	int port_num;		/*Actual port number in the device(1,2,etc) */
177*3f542974SPaul B Schroeder 	struct urb *write_urb;	/* write URB for this port */
178*3f542974SPaul B Schroeder 	struct urb *read_urb;	/* read URB for this port */
179*3f542974SPaul B Schroeder 	__u8 shadowLCR;		/* last LCR value received */
180*3f542974SPaul B Schroeder 	__u8 shadowMCR;		/* last MCR value received */
181*3f542974SPaul B Schroeder 	char open;
182*3f542974SPaul B Schroeder 	wait_queue_head_t wait_chase;	/* for handling sleeping while waiting for chase to finish */
183*3f542974SPaul B Schroeder 	wait_queue_head_t delta_msr_wait;	/* for handling sleeping while waiting for msr change to happen */
184*3f542974SPaul B Schroeder 	int delta_msr_cond;
185*3f542974SPaul B Schroeder 	struct async_icount icount;
186*3f542974SPaul B Schroeder 	struct usb_serial_port *port;	/* loop back to the owner of this object */
187*3f542974SPaul B Schroeder 
188*3f542974SPaul B Schroeder 	/*Offsets */
189*3f542974SPaul B Schroeder 	__u8 SpRegOffset;
190*3f542974SPaul B Schroeder 	__u8 ControlRegOffset;
191*3f542974SPaul B Schroeder 	__u8 DcrRegOffset;
192*3f542974SPaul B Schroeder 	//for processing control URBS in interrupt context
193*3f542974SPaul B Schroeder 	struct urb *control_urb;
194*3f542974SPaul B Schroeder 	char *ctrl_buf;
195*3f542974SPaul B Schroeder 	int MsrLsr;
196*3f542974SPaul B Schroeder 
197*3f542974SPaul B Schroeder 	struct urb *write_urb_pool[NUM_URBS];
198*3f542974SPaul B Schroeder };
199*3f542974SPaul B Schroeder 
200*3f542974SPaul B Schroeder 
201*3f542974SPaul B Schroeder static int debug;
202*3f542974SPaul B Schroeder static int mos7840_num_ports;	//this says the number of ports in the device
203*3f542974SPaul B Schroeder static int mos7840_num_open_ports;
204*3f542974SPaul B Schroeder 
205*3f542974SPaul B Schroeder 
206*3f542974SPaul B Schroeder /*
207*3f542974SPaul B Schroeder  * mos7840_set_reg_sync
208*3f542974SPaul B Schroeder  * 	To set the Control register by calling usb_fill_control_urb function
209*3f542974SPaul B Schroeder  *	by passing usb_sndctrlpipe function as parameter.
210*3f542974SPaul B Schroeder  */
211*3f542974SPaul B Schroeder 
212*3f542974SPaul B Schroeder static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg,
213*3f542974SPaul B Schroeder 				__u16 val)
214*3f542974SPaul B Schroeder {
215*3f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
216*3f542974SPaul B Schroeder 	val = val & 0x00ff;
217*3f542974SPaul B Schroeder 	dbg("mos7840_set_reg_sync offset is %x, value %x\n", reg, val);
218*3f542974SPaul B Schroeder 
219*3f542974SPaul B Schroeder 	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
220*3f542974SPaul B Schroeder 			       MCS_WR_RTYPE, val, reg, NULL, 0,
221*3f542974SPaul B Schroeder 			       MOS_WDR_TIMEOUT);
222*3f542974SPaul B Schroeder }
223*3f542974SPaul B Schroeder 
224*3f542974SPaul B Schroeder /*
225*3f542974SPaul B Schroeder  * mos7840_get_reg_sync
226*3f542974SPaul B Schroeder  * 	To set the Uart register by calling usb_fill_control_urb function by
227*3f542974SPaul B Schroeder  *	passing usb_rcvctrlpipe function as parameter.
228*3f542974SPaul B Schroeder  */
229*3f542974SPaul B Schroeder 
230*3f542974SPaul B Schroeder static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg,
231*3f542974SPaul B Schroeder 				__u16 * val)
232*3f542974SPaul B Schroeder {
233*3f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
234*3f542974SPaul B Schroeder 	int ret = 0;
235*3f542974SPaul B Schroeder 
236*3f542974SPaul B Schroeder 	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
237*3f542974SPaul B Schroeder 			      MCS_RD_RTYPE, 0, reg, val, VENDOR_READ_LENGTH,
238*3f542974SPaul B Schroeder 			      MOS_WDR_TIMEOUT);
239*3f542974SPaul B Schroeder 	dbg("mos7840_get_reg_sync offset is %x, return val %x\n", reg, *val);
240*3f542974SPaul B Schroeder 	*val = (*val) & 0x00ff;
241*3f542974SPaul B Schroeder 	return ret;
242*3f542974SPaul B Schroeder }
243*3f542974SPaul B Schroeder 
244*3f542974SPaul B Schroeder /*
245*3f542974SPaul B Schroeder  * mos7840_set_uart_reg
246*3f542974SPaul B Schroeder  *	To set the Uart register by calling usb_fill_control_urb function by
247*3f542974SPaul B Schroeder  *	passing usb_sndctrlpipe function as parameter.
248*3f542974SPaul B Schroeder  */
249*3f542974SPaul B Schroeder 
250*3f542974SPaul B Schroeder static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg,
251*3f542974SPaul B Schroeder 				__u16 val)
252*3f542974SPaul B Schroeder {
253*3f542974SPaul B Schroeder 
254*3f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
255*3f542974SPaul B Schroeder 	val = val & 0x00ff;
256*3f542974SPaul B Schroeder 	// For the UART control registers, the application number need to be Or'ed
257*3f542974SPaul B Schroeder 	if (mos7840_num_ports == 4) {
258*3f542974SPaul B Schroeder 		val |=
259*3f542974SPaul B Schroeder 		    (((__u16) port->number - (__u16) (port->serial->minor)) +
260*3f542974SPaul B Schroeder 		     1) << 8;
261*3f542974SPaul B Schroeder 		dbg("mos7840_set_uart_reg application number is %x\n", val);
262*3f542974SPaul B Schroeder 	} else {
263*3f542974SPaul B Schroeder 		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
264*3f542974SPaul B Schroeder 			val |=
265*3f542974SPaul B Schroeder 			    (((__u16) port->number -
266*3f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 1) << 8;
267*3f542974SPaul B Schroeder 			dbg("mos7840_set_uart_reg application number is %x\n",
268*3f542974SPaul B Schroeder 			    val);
269*3f542974SPaul B Schroeder 		} else {
270*3f542974SPaul B Schroeder 			val |=
271*3f542974SPaul B Schroeder 			    (((__u16) port->number -
272*3f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 2) << 8;
273*3f542974SPaul B Schroeder 			dbg("mos7840_set_uart_reg application number is %x\n",
274*3f542974SPaul B Schroeder 			    val);
275*3f542974SPaul B Schroeder 		}
276*3f542974SPaul B Schroeder 	}
277*3f542974SPaul B Schroeder 	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
278*3f542974SPaul B Schroeder 			       MCS_WR_RTYPE, val, reg, NULL, 0,
279*3f542974SPaul B Schroeder 			       MOS_WDR_TIMEOUT);
280*3f542974SPaul B Schroeder 
281*3f542974SPaul B Schroeder }
282*3f542974SPaul B Schroeder 
283*3f542974SPaul B Schroeder /*
284*3f542974SPaul B Schroeder  * mos7840_get_uart_reg
285*3f542974SPaul B Schroeder  *	To set the Control register by calling usb_fill_control_urb function
286*3f542974SPaul B Schroeder  *	by passing usb_rcvctrlpipe function as parameter.
287*3f542974SPaul B Schroeder  */
288*3f542974SPaul B Schroeder static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg,
289*3f542974SPaul B Schroeder 				__u16 * val)
290*3f542974SPaul B Schroeder {
291*3f542974SPaul B Schroeder 	struct usb_device *dev = port->serial->dev;
292*3f542974SPaul B Schroeder 	int ret = 0;
293*3f542974SPaul B Schroeder 	__u16 Wval;
294*3f542974SPaul B Schroeder 
295*3f542974SPaul B Schroeder 	//dbg("application number is %4x \n",(((__u16)port->number - (__u16)(port->serial->minor))+1)<<8);
296*3f542974SPaul B Schroeder 	/*Wval  is same as application number */
297*3f542974SPaul B Schroeder 	if (mos7840_num_ports == 4) {
298*3f542974SPaul B Schroeder 		Wval =
299*3f542974SPaul B Schroeder 		    (((__u16) port->number - (__u16) (port->serial->minor)) +
300*3f542974SPaul B Schroeder 		     1) << 8;
301*3f542974SPaul B Schroeder 		dbg("mos7840_get_uart_reg application number is %x\n", Wval);
302*3f542974SPaul B Schroeder 	} else {
303*3f542974SPaul B Schroeder 		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
304*3f542974SPaul B Schroeder 			Wval =
305*3f542974SPaul B Schroeder 			    (((__u16) port->number -
306*3f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 1) << 8;
307*3f542974SPaul B Schroeder 			dbg("mos7840_get_uart_reg application number is %x\n",
308*3f542974SPaul B Schroeder 			    Wval);
309*3f542974SPaul B Schroeder 		} else {
310*3f542974SPaul B Schroeder 			Wval =
311*3f542974SPaul B Schroeder 			    (((__u16) port->number -
312*3f542974SPaul B Schroeder 			      (__u16) (port->serial->minor)) + 2) << 8;
313*3f542974SPaul B Schroeder 			dbg("mos7840_get_uart_reg application number is %x\n",
314*3f542974SPaul B Schroeder 			    Wval);
315*3f542974SPaul B Schroeder 		}
316*3f542974SPaul B Schroeder 	}
317*3f542974SPaul B Schroeder 	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
318*3f542974SPaul B Schroeder 			      MCS_RD_RTYPE, Wval, reg, val, VENDOR_READ_LENGTH,
319*3f542974SPaul B Schroeder 			      MOS_WDR_TIMEOUT);
320*3f542974SPaul B Schroeder 	*val = (*val) & 0x00ff;
321*3f542974SPaul B Schroeder 	return ret;
322*3f542974SPaul B Schroeder }
323*3f542974SPaul B Schroeder 
324*3f542974SPaul B Schroeder static void mos7840_dump_serial_port(struct moschip_port *mos7840_port)
325*3f542974SPaul B Schroeder {
326*3f542974SPaul B Schroeder 
327*3f542974SPaul B Schroeder 	dbg("***************************************\n");
328*3f542974SPaul B Schroeder 	dbg("SpRegOffset is %2x\n", mos7840_port->SpRegOffset);
329*3f542974SPaul B Schroeder 	dbg("ControlRegOffset is %2x \n", mos7840_port->ControlRegOffset);
330*3f542974SPaul B Schroeder 	dbg("DCRRegOffset is %2x \n", mos7840_port->DcrRegOffset);
331*3f542974SPaul B Schroeder 	dbg("***************************************\n");
332*3f542974SPaul B Schroeder 
333*3f542974SPaul B Schroeder }
334*3f542974SPaul B Schroeder 
335*3f542974SPaul B Schroeder /************************************************************************/
336*3f542974SPaul B Schroeder /************************************************************************/
337*3f542974SPaul B Schroeder /*             I N T E R F A C E   F U N C T I O N S			*/
338*3f542974SPaul B Schroeder /*             I N T E R F A C E   F U N C T I O N S			*/
339*3f542974SPaul B Schroeder /************************************************************************/
340*3f542974SPaul B Schroeder /************************************************************************/
341*3f542974SPaul B Schroeder 
342*3f542974SPaul B Schroeder static inline void mos7840_set_port_private(struct usb_serial_port *port,
343*3f542974SPaul B Schroeder 					    struct moschip_port *data)
344*3f542974SPaul B Schroeder {
345*3f542974SPaul B Schroeder 	usb_set_serial_port_data(port, (void *)data);
346*3f542974SPaul B Schroeder }
347*3f542974SPaul B Schroeder 
348*3f542974SPaul B Schroeder static inline struct moschip_port *mos7840_get_port_private(struct
349*3f542974SPaul B Schroeder 							    usb_serial_port
350*3f542974SPaul B Schroeder 							    *port)
351*3f542974SPaul B Schroeder {
352*3f542974SPaul B Schroeder 	return (struct moschip_port *)usb_get_serial_port_data(port);
353*3f542974SPaul B Schroeder }
354*3f542974SPaul B Schroeder 
355*3f542974SPaul B Schroeder static int mos7840_handle_new_msr(struct moschip_port *port, __u8 new_msr)
356*3f542974SPaul B Schroeder {
357*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
358*3f542974SPaul B Schroeder 	struct async_icount *icount;
359*3f542974SPaul B Schroeder 	mos7840_port = port;
360*3f542974SPaul B Schroeder 	icount = &mos7840_port->icount;
361*3f542974SPaul B Schroeder 	if (new_msr &
362*3f542974SPaul B Schroeder 	    (MOS_MSR_DELTA_CTS | MOS_MSR_DELTA_DSR | MOS_MSR_DELTA_RI |
363*3f542974SPaul B Schroeder 	     MOS_MSR_DELTA_CD)) {
364*3f542974SPaul B Schroeder 		icount = &mos7840_port->icount;
365*3f542974SPaul B Schroeder 
366*3f542974SPaul B Schroeder 		/* update input line counters */
367*3f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_CTS) {
368*3f542974SPaul B Schroeder 			icount->cts++;
369*3f542974SPaul B Schroeder 		}
370*3f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_DSR) {
371*3f542974SPaul B Schroeder 			icount->dsr++;
372*3f542974SPaul B Schroeder 		}
373*3f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_CD) {
374*3f542974SPaul B Schroeder 			icount->dcd++;
375*3f542974SPaul B Schroeder 		}
376*3f542974SPaul B Schroeder 		if (new_msr & MOS_MSR_DELTA_RI) {
377*3f542974SPaul B Schroeder 			icount->rng++;
378*3f542974SPaul B Schroeder 		}
379*3f542974SPaul B Schroeder 	}
380*3f542974SPaul B Schroeder 
381*3f542974SPaul B Schroeder 	return 0;
382*3f542974SPaul B Schroeder }
383*3f542974SPaul B Schroeder 
384*3f542974SPaul B Schroeder static int mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr)
385*3f542974SPaul B Schroeder {
386*3f542974SPaul B Schroeder 	struct async_icount *icount;
387*3f542974SPaul B Schroeder 
388*3f542974SPaul B Schroeder 	dbg("%s - %02x", __FUNCTION__, new_lsr);
389*3f542974SPaul B Schroeder 
390*3f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_BI) {
391*3f542974SPaul B Schroeder 		//
392*3f542974SPaul B Schroeder 		// Parity and Framing errors only count if they
393*3f542974SPaul B Schroeder 		// occur exclusive of a break being
394*3f542974SPaul B Schroeder 		// received.
395*3f542974SPaul B Schroeder 		//
396*3f542974SPaul B Schroeder 		new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI);
397*3f542974SPaul B Schroeder 	}
398*3f542974SPaul B Schroeder 
399*3f542974SPaul B Schroeder 	/* update input line counters */
400*3f542974SPaul B Schroeder 	icount = &port->icount;
401*3f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_BI) {
402*3f542974SPaul B Schroeder 		icount->brk++;
403*3f542974SPaul B Schroeder 	}
404*3f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_OE) {
405*3f542974SPaul B Schroeder 		icount->overrun++;
406*3f542974SPaul B Schroeder 	}
407*3f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_PE) {
408*3f542974SPaul B Schroeder 		icount->parity++;
409*3f542974SPaul B Schroeder 	}
410*3f542974SPaul B Schroeder 	if (new_lsr & SERIAL_LSR_FE) {
411*3f542974SPaul B Schroeder 		icount->frame++;
412*3f542974SPaul B Schroeder 	}
413*3f542974SPaul B Schroeder 
414*3f542974SPaul B Schroeder 	return 0;
415*3f542974SPaul B Schroeder }
416*3f542974SPaul B Schroeder 
417*3f542974SPaul B Schroeder /************************************************************************/
418*3f542974SPaul B Schroeder /************************************************************************/
419*3f542974SPaul B Schroeder /*            U S B  C A L L B A C K   F U N C T I O N S                */
420*3f542974SPaul B Schroeder /*            U S B  C A L L B A C K   F U N C T I O N S                */
421*3f542974SPaul B Schroeder /************************************************************************/
422*3f542974SPaul B Schroeder /************************************************************************/
423*3f542974SPaul B Schroeder 
424*3f542974SPaul B Schroeder static void mos7840_control_callback(struct urb *urb, struct pt_regs *regs)
425*3f542974SPaul B Schroeder {
426*3f542974SPaul B Schroeder 	unsigned char *data;
427*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
428*3f542974SPaul B Schroeder 	__u8 regval = 0x0;
429*3f542974SPaul B Schroeder 
430*3f542974SPaul B Schroeder 	if (!urb) {
431*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Pointer !!!!:\n");
432*3f542974SPaul B Schroeder 		return;
433*3f542974SPaul B Schroeder 	}
434*3f542974SPaul B Schroeder 
435*3f542974SPaul B Schroeder 	switch (urb->status) {
436*3f542974SPaul B Schroeder 	case 0:
437*3f542974SPaul B Schroeder 		/* success */
438*3f542974SPaul B Schroeder 		break;
439*3f542974SPaul B Schroeder 	case -ECONNRESET:
440*3f542974SPaul B Schroeder 	case -ENOENT:
441*3f542974SPaul B Schroeder 	case -ESHUTDOWN:
442*3f542974SPaul B Schroeder 		/* this urb is terminated, clean up */
443*3f542974SPaul B Schroeder 		dbg("%s - urb shutting down with status: %d", __FUNCTION__,
444*3f542974SPaul B Schroeder 		    urb->status);
445*3f542974SPaul B Schroeder 		return;
446*3f542974SPaul B Schroeder 	default:
447*3f542974SPaul B Schroeder 		dbg("%s - nonzero urb status received: %d", __FUNCTION__,
448*3f542974SPaul B Schroeder 		    urb->status);
449*3f542974SPaul B Schroeder 		goto exit;
450*3f542974SPaul B Schroeder 	}
451*3f542974SPaul B Schroeder 
452*3f542974SPaul B Schroeder 	mos7840_port = (struct moschip_port *)urb->context;
453*3f542974SPaul B Schroeder 
454*3f542974SPaul B Schroeder 	dbg("%s urb buffer size is %d\n", __FUNCTION__, urb->actual_length);
455*3f542974SPaul B Schroeder 	dbg("%s mos7840_port->MsrLsr is %d port %d\n", __FUNCTION__,
456*3f542974SPaul B Schroeder 	    mos7840_port->MsrLsr, mos7840_port->port_num);
457*3f542974SPaul B Schroeder 	data = urb->transfer_buffer;
458*3f542974SPaul B Schroeder 	regval = (__u8) data[0];
459*3f542974SPaul B Schroeder 	dbg("%s data is %x\n", __FUNCTION__, regval);
460*3f542974SPaul B Schroeder 	if (mos7840_port->MsrLsr == 0)
461*3f542974SPaul B Schroeder 		mos7840_handle_new_msr(mos7840_port, regval);
462*3f542974SPaul B Schroeder 	else if (mos7840_port->MsrLsr == 1)
463*3f542974SPaul B Schroeder 		mos7840_handle_new_lsr(mos7840_port, regval);
464*3f542974SPaul B Schroeder 
465*3f542974SPaul B Schroeder       exit:
466*3f542974SPaul B Schroeder 	return;
467*3f542974SPaul B Schroeder }
468*3f542974SPaul B Schroeder 
469*3f542974SPaul B Schroeder static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg,
470*3f542974SPaul B Schroeder 			   __u16 * val)
471*3f542974SPaul B Schroeder {
472*3f542974SPaul B Schroeder 	struct usb_device *dev = mcs->port->serial->dev;
473*3f542974SPaul B Schroeder 	struct usb_ctrlrequest *dr = NULL;
474*3f542974SPaul B Schroeder 	unsigned char *buffer = NULL;
475*3f542974SPaul B Schroeder 	int ret = 0;
476*3f542974SPaul B Schroeder 	buffer = (__u8 *) mcs->ctrl_buf;
477*3f542974SPaul B Schroeder 
478*3f542974SPaul B Schroeder //      dr=(struct usb_ctrlrequest *)(buffer);
479*3f542974SPaul B Schroeder 	dr = (void *)(buffer + 2);
480*3f542974SPaul B Schroeder 	dr->bRequestType = MCS_RD_RTYPE;
481*3f542974SPaul B Schroeder 	dr->bRequest = MCS_RDREQ;
482*3f542974SPaul B Schroeder 	dr->wValue = cpu_to_le16(Wval);	//0;
483*3f542974SPaul B Schroeder 	dr->wIndex = cpu_to_le16(reg);
484*3f542974SPaul B Schroeder 	dr->wLength = cpu_to_le16(2);
485*3f542974SPaul B Schroeder 
486*3f542974SPaul B Schroeder 	usb_fill_control_urb(mcs->control_urb, dev, usb_rcvctrlpipe(dev, 0),
487*3f542974SPaul B Schroeder 			     (unsigned char *)dr, buffer, 2,
488*3f542974SPaul B Schroeder 			     mos7840_control_callback, mcs);
489*3f542974SPaul B Schroeder 	mcs->control_urb->transfer_buffer_length = 2;
490*3f542974SPaul B Schroeder 	ret = usb_submit_urb(mcs->control_urb, GFP_ATOMIC);
491*3f542974SPaul B Schroeder 	return ret;
492*3f542974SPaul B Schroeder }
493*3f542974SPaul B Schroeder 
494*3f542974SPaul B Schroeder /*****************************************************************************
495*3f542974SPaul B Schroeder  * mos7840_interrupt_callback
496*3f542974SPaul B Schroeder  *	this is the callback function for when we have received data on the
497*3f542974SPaul B Schroeder  *	interrupt endpoint.
498*3f542974SPaul B Schroeder  *****************************************************************************/
499*3f542974SPaul B Schroeder 
500*3f542974SPaul B Schroeder static void mos7840_interrupt_callback(struct urb *urb, struct pt_regs *regs)
501*3f542974SPaul B Schroeder {
502*3f542974SPaul B Schroeder 	int result;
503*3f542974SPaul B Schroeder 	int length;
504*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
505*3f542974SPaul B Schroeder 	struct usb_serial *serial;
506*3f542974SPaul B Schroeder 	__u16 Data;
507*3f542974SPaul B Schroeder 	unsigned char *data;
508*3f542974SPaul B Schroeder 	__u8 sp[5], st;
509*3f542974SPaul B Schroeder 	int i;
510*3f542974SPaul B Schroeder 	__u16 wval;
511*3f542974SPaul B Schroeder 
512*3f542974SPaul B Schroeder 	dbg("%s", " : Entering\n");
513*3f542974SPaul B Schroeder 	if (!urb) {
514*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Pointer !!!!:\n");
515*3f542974SPaul B Schroeder 		return;
516*3f542974SPaul B Schroeder 	}
517*3f542974SPaul B Schroeder 
518*3f542974SPaul B Schroeder 	switch (urb->status) {
519*3f542974SPaul B Schroeder 	case 0:
520*3f542974SPaul B Schroeder 		/* success */
521*3f542974SPaul B Schroeder 		break;
522*3f542974SPaul B Schroeder 	case -ECONNRESET:
523*3f542974SPaul B Schroeder 	case -ENOENT:
524*3f542974SPaul B Schroeder 	case -ESHUTDOWN:
525*3f542974SPaul B Schroeder 		/* this urb is terminated, clean up */
526*3f542974SPaul B Schroeder 		dbg("%s - urb shutting down with status: %d", __FUNCTION__,
527*3f542974SPaul B Schroeder 		    urb->status);
528*3f542974SPaul B Schroeder 		return;
529*3f542974SPaul B Schroeder 	default:
530*3f542974SPaul B Schroeder 		dbg("%s - nonzero urb status received: %d", __FUNCTION__,
531*3f542974SPaul B Schroeder 		    urb->status);
532*3f542974SPaul B Schroeder 		goto exit;
533*3f542974SPaul B Schroeder 	}
534*3f542974SPaul B Schroeder 
535*3f542974SPaul B Schroeder 	length = urb->actual_length;
536*3f542974SPaul B Schroeder 	data = urb->transfer_buffer;
537*3f542974SPaul B Schroeder 
538*3f542974SPaul B Schroeder 	serial = (struct usb_serial *)urb->context;
539*3f542974SPaul B Schroeder 
540*3f542974SPaul B Schroeder 	/* Moschip get 5 bytes
541*3f542974SPaul B Schroeder 	 * Byte 1 IIR Port 1 (port.number is 0)
542*3f542974SPaul B Schroeder 	 * Byte 2 IIR Port 2 (port.number is 1)
543*3f542974SPaul B Schroeder 	 * Byte 3 IIR Port 3 (port.number is 2)
544*3f542974SPaul B Schroeder 	 * Byte 4 IIR Port 4 (port.number is 3)
545*3f542974SPaul B Schroeder 	 * Byte 5 FIFO status for both */
546*3f542974SPaul B Schroeder 
547*3f542974SPaul B Schroeder 	if (length && length > 5) {
548*3f542974SPaul B Schroeder 		dbg("%s \n", "Wrong data !!!");
549*3f542974SPaul B Schroeder 		return;
550*3f542974SPaul B Schroeder 	}
551*3f542974SPaul B Schroeder 
552*3f542974SPaul B Schroeder 	sp[0] = (__u8) data[0];
553*3f542974SPaul B Schroeder 	sp[1] = (__u8) data[1];
554*3f542974SPaul B Schroeder 	sp[2] = (__u8) data[2];
555*3f542974SPaul B Schroeder 	sp[3] = (__u8) data[3];
556*3f542974SPaul B Schroeder 	st = (__u8) data[4];
557*3f542974SPaul B Schroeder 
558*3f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; i++) {
559*3f542974SPaul B Schroeder 		mos7840_port = mos7840_get_port_private(serial->port[i]);
560*3f542974SPaul B Schroeder 		wval =
561*3f542974SPaul B Schroeder 		    (((__u16) serial->port[i]->number -
562*3f542974SPaul B Schroeder 		      (__u16) (serial->minor)) + 1) << 8;
563*3f542974SPaul B Schroeder 		if (mos7840_port->open) {
564*3f542974SPaul B Schroeder 			if (sp[i] & 0x01) {
565*3f542974SPaul B Schroeder 				dbg("SP%d No Interrupt !!!\n", i);
566*3f542974SPaul B Schroeder 			} else {
567*3f542974SPaul B Schroeder 				switch (sp[i] & 0x0f) {
568*3f542974SPaul B Schroeder 				case SERIAL_IIR_RLS:
569*3f542974SPaul B Schroeder 					dbg("Serial Port %d: Receiver status error or ", i);
570*3f542974SPaul B Schroeder 					dbg("address bit detected in 9-bit mode\n");
571*3f542974SPaul B Schroeder 					mos7840_port->MsrLsr = 1;
572*3f542974SPaul B Schroeder 					mos7840_get_reg(mos7840_port, wval,
573*3f542974SPaul B Schroeder 							LINE_STATUS_REGISTER,
574*3f542974SPaul B Schroeder 							&Data);
575*3f542974SPaul B Schroeder 					break;
576*3f542974SPaul B Schroeder 				case SERIAL_IIR_MS:
577*3f542974SPaul B Schroeder 					dbg("Serial Port %d: Modem status change\n", i);
578*3f542974SPaul B Schroeder 					mos7840_port->MsrLsr = 0;
579*3f542974SPaul B Schroeder 					mos7840_get_reg(mos7840_port, wval,
580*3f542974SPaul B Schroeder 							MODEM_STATUS_REGISTER,
581*3f542974SPaul B Schroeder 							&Data);
582*3f542974SPaul B Schroeder 					break;
583*3f542974SPaul B Schroeder 				}
584*3f542974SPaul B Schroeder 			}
585*3f542974SPaul B Schroeder 		}
586*3f542974SPaul B Schroeder 	}
587*3f542974SPaul B Schroeder       exit:
588*3f542974SPaul B Schroeder 	result = usb_submit_urb(urb, GFP_ATOMIC);
589*3f542974SPaul B Schroeder 	if (result) {
590*3f542974SPaul B Schroeder 		dev_err(&urb->dev->dev,
591*3f542974SPaul B Schroeder 			"%s - Error %d submitting interrupt urb\n",
592*3f542974SPaul B Schroeder 			__FUNCTION__, result);
593*3f542974SPaul B Schroeder 	}
594*3f542974SPaul B Schroeder 
595*3f542974SPaul B Schroeder 	return;
596*3f542974SPaul B Schroeder 
597*3f542974SPaul B Schroeder }
598*3f542974SPaul B Schroeder 
599*3f542974SPaul B Schroeder static int mos7840_port_paranoia_check(struct usb_serial_port *port,
600*3f542974SPaul B Schroeder 				       const char *function)
601*3f542974SPaul B Schroeder {
602*3f542974SPaul B Schroeder 	if (!port) {
603*3f542974SPaul B Schroeder 		dbg("%s - port == NULL", function);
604*3f542974SPaul B Schroeder 		return -1;
605*3f542974SPaul B Schroeder 	}
606*3f542974SPaul B Schroeder 	if (!port->serial) {
607*3f542974SPaul B Schroeder 		dbg("%s - port->serial == NULL", function);
608*3f542974SPaul B Schroeder 		return -1;
609*3f542974SPaul B Schroeder 	}
610*3f542974SPaul B Schroeder 
611*3f542974SPaul B Schroeder 	return 0;
612*3f542974SPaul B Schroeder }
613*3f542974SPaul B Schroeder 
614*3f542974SPaul B Schroeder /* Inline functions to check the sanity of a pointer that is passed to us */
615*3f542974SPaul B Schroeder static int mos7840_serial_paranoia_check(struct usb_serial *serial,
616*3f542974SPaul B Schroeder 					 const char *function)
617*3f542974SPaul B Schroeder {
618*3f542974SPaul B Schroeder 	if (!serial) {
619*3f542974SPaul B Schroeder 		dbg("%s - serial == NULL", function);
620*3f542974SPaul B Schroeder 		return -1;
621*3f542974SPaul B Schroeder 	}
622*3f542974SPaul B Schroeder 	if (!serial->type) {
623*3f542974SPaul B Schroeder 		dbg("%s - serial->type == NULL!", function);
624*3f542974SPaul B Schroeder 		return -1;
625*3f542974SPaul B Schroeder 	}
626*3f542974SPaul B Schroeder 
627*3f542974SPaul B Schroeder 	return 0;
628*3f542974SPaul B Schroeder }
629*3f542974SPaul B Schroeder 
630*3f542974SPaul B Schroeder static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port,
631*3f542974SPaul B Schroeder 						 const char *function)
632*3f542974SPaul B Schroeder {
633*3f542974SPaul B Schroeder 	/* if no port was specified, or it fails a paranoia check */
634*3f542974SPaul B Schroeder 	if (!port ||
635*3f542974SPaul B Schroeder 	    mos7840_port_paranoia_check(port, function) ||
636*3f542974SPaul B Schroeder 	    mos7840_serial_paranoia_check(port->serial, function)) {
637*3f542974SPaul B Schroeder 		/* then say that we don't have a valid usb_serial thing, which will                  * end up genrating -ENODEV return values */
638*3f542974SPaul B Schroeder 		return NULL;
639*3f542974SPaul B Schroeder 	}
640*3f542974SPaul B Schroeder 
641*3f542974SPaul B Schroeder 	return port->serial;
642*3f542974SPaul B Schroeder }
643*3f542974SPaul B Schroeder 
644*3f542974SPaul B Schroeder /*****************************************************************************
645*3f542974SPaul B Schroeder  * mos7840_bulk_in_callback
646*3f542974SPaul B Schroeder  *	this is the callback function for when we have received data on the
647*3f542974SPaul B Schroeder  *	bulk in endpoint.
648*3f542974SPaul B Schroeder  *****************************************************************************/
649*3f542974SPaul B Schroeder 
650*3f542974SPaul B Schroeder static void mos7840_bulk_in_callback(struct urb *urb, struct pt_regs *regs)
651*3f542974SPaul B Schroeder {
652*3f542974SPaul B Schroeder 	int status;
653*3f542974SPaul B Schroeder 	unsigned char *data;
654*3f542974SPaul B Schroeder 	struct usb_serial *serial;
655*3f542974SPaul B Schroeder 	struct usb_serial_port *port;
656*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
657*3f542974SPaul B Schroeder 	struct tty_struct *tty;
658*3f542974SPaul B Schroeder 
659*3f542974SPaul B Schroeder 	if (!urb) {
660*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Pointer !!!!:\n");
661*3f542974SPaul B Schroeder 		return;
662*3f542974SPaul B Schroeder 	}
663*3f542974SPaul B Schroeder 
664*3f542974SPaul B Schroeder 	if (urb->status) {
665*3f542974SPaul B Schroeder 		dbg("nonzero read bulk status received: %d", urb->status);
666*3f542974SPaul B Schroeder 		return;
667*3f542974SPaul B Schroeder 	}
668*3f542974SPaul B Schroeder 
669*3f542974SPaul B Schroeder 	mos7840_port = (struct moschip_port *)urb->context;
670*3f542974SPaul B Schroeder 	if (!mos7840_port) {
671*3f542974SPaul B Schroeder 		dbg("%s", "NULL mos7840_port pointer \n");
672*3f542974SPaul B Schroeder 		return;
673*3f542974SPaul B Schroeder 	}
674*3f542974SPaul B Schroeder 
675*3f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
676*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
677*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
678*3f542974SPaul B Schroeder 		return;
679*3f542974SPaul B Schroeder 	}
680*3f542974SPaul B Schroeder 
681*3f542974SPaul B Schroeder 	serial = mos7840_get_usb_serial(port, __FUNCTION__);
682*3f542974SPaul B Schroeder 	if (!serial) {
683*3f542974SPaul B Schroeder 		dbg("%s\n", "Bad serial pointer ");
684*3f542974SPaul B Schroeder 		return;
685*3f542974SPaul B Schroeder 	}
686*3f542974SPaul B Schroeder 
687*3f542974SPaul B Schroeder 	dbg("%s\n", "Entering... \n");
688*3f542974SPaul B Schroeder 
689*3f542974SPaul B Schroeder 	data = urb->transfer_buffer;
690*3f542974SPaul B Schroeder 
691*3f542974SPaul B Schroeder 	dbg("%s", "Entering ........... \n");
692*3f542974SPaul B Schroeder 
693*3f542974SPaul B Schroeder 	if (urb->actual_length) {
694*3f542974SPaul B Schroeder 		tty = mos7840_port->port->tty;
695*3f542974SPaul B Schroeder 		if (tty) {
696*3f542974SPaul B Schroeder 			tty_buffer_request_room(tty, urb->actual_length);
697*3f542974SPaul B Schroeder 			tty_insert_flip_string(tty, data, urb->actual_length);
698*3f542974SPaul B Schroeder 			dbg(" %s \n", data);
699*3f542974SPaul B Schroeder 			tty_flip_buffer_push(tty);
700*3f542974SPaul B Schroeder 		}
701*3f542974SPaul B Schroeder 		mos7840_port->icount.rx += urb->actual_length;
702*3f542974SPaul B Schroeder 		dbg("mos7840_port->icount.rx is %d:\n",
703*3f542974SPaul B Schroeder 		    mos7840_port->icount.rx);
704*3f542974SPaul B Schroeder 	}
705*3f542974SPaul B Schroeder 
706*3f542974SPaul B Schroeder 	if (!mos7840_port->read_urb) {
707*3f542974SPaul B Schroeder 		dbg("%s", "URB KILLED !!!\n");
708*3f542974SPaul B Schroeder 		return;
709*3f542974SPaul B Schroeder 	}
710*3f542974SPaul B Schroeder 
711*3f542974SPaul B Schroeder 	if (mos7840_port->read_urb->status != -EINPROGRESS) {
712*3f542974SPaul B Schroeder 		mos7840_port->read_urb->dev = serial->dev;
713*3f542974SPaul B Schroeder 
714*3f542974SPaul B Schroeder 		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
715*3f542974SPaul B Schroeder 
716*3f542974SPaul B Schroeder 		if (status) {
717*3f542974SPaul B Schroeder 			dbg(" usb_submit_urb(read bulk) failed, status = %d",
718*3f542974SPaul B Schroeder 			    status);
719*3f542974SPaul B Schroeder 		}
720*3f542974SPaul B Schroeder 	}
721*3f542974SPaul B Schroeder }
722*3f542974SPaul B Schroeder 
723*3f542974SPaul B Schroeder /*****************************************************************************
724*3f542974SPaul B Schroeder  * mos7840_bulk_out_data_callback
725*3f542974SPaul B Schroeder  *	this is the callback function for when we have finished sending serial data
726*3f542974SPaul B Schroeder  *	on the bulk out endpoint.
727*3f542974SPaul B Schroeder  *****************************************************************************/
728*3f542974SPaul B Schroeder 
729*3f542974SPaul B Schroeder static void mos7840_bulk_out_data_callback(struct urb *urb,
730*3f542974SPaul B Schroeder 					   struct pt_regs *regs)
731*3f542974SPaul B Schroeder {
732*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
733*3f542974SPaul B Schroeder 	struct tty_struct *tty;
734*3f542974SPaul B Schroeder 	if (!urb) {
735*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Pointer !!!!:\n");
736*3f542974SPaul B Schroeder 		return;
737*3f542974SPaul B Schroeder 	}
738*3f542974SPaul B Schroeder 
739*3f542974SPaul B Schroeder 	if (urb->status) {
740*3f542974SPaul B Schroeder 		dbg("nonzero write bulk status received:%d\n", urb->status);
741*3f542974SPaul B Schroeder 		return;
742*3f542974SPaul B Schroeder 	}
743*3f542974SPaul B Schroeder 
744*3f542974SPaul B Schroeder 	mos7840_port = (struct moschip_port *)urb->context;
745*3f542974SPaul B Schroeder 	if (!mos7840_port) {
746*3f542974SPaul B Schroeder 		dbg("%s", "NULL mos7840_port pointer \n");
747*3f542974SPaul B Schroeder 		return;
748*3f542974SPaul B Schroeder 	}
749*3f542974SPaul B Schroeder 
750*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(mos7840_port->port, __FUNCTION__)) {
751*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
752*3f542974SPaul B Schroeder 		return;
753*3f542974SPaul B Schroeder 	}
754*3f542974SPaul B Schroeder 
755*3f542974SPaul B Schroeder 	dbg("%s \n", "Entering .........");
756*3f542974SPaul B Schroeder 
757*3f542974SPaul B Schroeder 	tty = mos7840_port->port->tty;
758*3f542974SPaul B Schroeder 
759*3f542974SPaul B Schroeder 	if (tty && mos7840_port->open) {
760*3f542974SPaul B Schroeder 		/* let the tty driver wakeup if it has a special *
761*3f542974SPaul B Schroeder 		 * write_wakeup function                         */
762*3f542974SPaul B Schroeder 
763*3f542974SPaul B Schroeder 		if ((tty->flags & (1 << TTY_DO_WRITE_WAKEUP))
764*3f542974SPaul B Schroeder 		    && tty->ldisc.write_wakeup) {
765*3f542974SPaul B Schroeder 			(tty->ldisc.write_wakeup) (tty);
766*3f542974SPaul B Schroeder 		}
767*3f542974SPaul B Schroeder 
768*3f542974SPaul B Schroeder 		/* tell the tty driver that something has changed */
769*3f542974SPaul B Schroeder 		wake_up_interruptible(&tty->write_wait);
770*3f542974SPaul B Schroeder 	}
771*3f542974SPaul B Schroeder 
772*3f542974SPaul B Schroeder }
773*3f542974SPaul B Schroeder 
774*3f542974SPaul B Schroeder /************************************************************************/
775*3f542974SPaul 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       */
776*3f542974SPaul B Schroeder /************************************************************************/
777*3f542974SPaul B Schroeder #ifdef MCSSerialProbe
778*3f542974SPaul B Schroeder static int mos7840_serial_probe(struct usb_serial *serial,
779*3f542974SPaul B Schroeder 				const struct usb_device_id *id)
780*3f542974SPaul B Schroeder {
781*3f542974SPaul B Schroeder 
782*3f542974SPaul B Schroeder 	/*need to implement the mode_reg reading and updating\
783*3f542974SPaul B Schroeder 	   structures usb_serial_ device_type\
784*3f542974SPaul B Schroeder 	   (i.e num_ports, num_bulkin,bulkout etc) */
785*3f542974SPaul B Schroeder 	/* Also we can update the changes  attach */
786*3f542974SPaul B Schroeder 	return 1;
787*3f542974SPaul B Schroeder }
788*3f542974SPaul B Schroeder #endif
789*3f542974SPaul B Schroeder 
790*3f542974SPaul B Schroeder /*****************************************************************************
791*3f542974SPaul B Schroeder  * mos7840_open
792*3f542974SPaul B Schroeder  *	this function is called by the tty driver when a port is opened
793*3f542974SPaul B Schroeder  *	If successful, we return 0
794*3f542974SPaul B Schroeder  *	Otherwise we return a negative error number.
795*3f542974SPaul B Schroeder  *****************************************************************************/
796*3f542974SPaul B Schroeder 
797*3f542974SPaul B Schroeder static int mos7840_open(struct usb_serial_port *port, struct file *filp)
798*3f542974SPaul B Schroeder {
799*3f542974SPaul B Schroeder 	int response;
800*3f542974SPaul B Schroeder 	int j;
801*3f542974SPaul B Schroeder 	struct usb_serial *serial;
802*3f542974SPaul B Schroeder 	struct urb *urb;
803*3f542974SPaul B Schroeder 	__u16 Data;
804*3f542974SPaul B Schroeder 	int status;
805*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
806*3f542974SPaul B Schroeder 
807*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
808*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
809*3f542974SPaul B Schroeder 		return -ENODEV;
810*3f542974SPaul B Schroeder 	}
811*3f542974SPaul B Schroeder 
812*3f542974SPaul B Schroeder 	mos7840_num_open_ports++;
813*3f542974SPaul B Schroeder 	serial = port->serial;
814*3f542974SPaul B Schroeder 
815*3f542974SPaul B Schroeder 	if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) {
816*3f542974SPaul B Schroeder 		dbg("%s", "Serial Paranoia failed \n");
817*3f542974SPaul B Schroeder 		return -ENODEV;
818*3f542974SPaul B Schroeder 	}
819*3f542974SPaul B Schroeder 
820*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
821*3f542974SPaul B Schroeder 
822*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
823*3f542974SPaul B Schroeder 		return -ENODEV;
824*3f542974SPaul B Schroeder 
825*3f542974SPaul B Schroeder 	usb_clear_halt(serial->dev, port->write_urb->pipe);
826*3f542974SPaul B Schroeder 	usb_clear_halt(serial->dev, port->read_urb->pipe);
827*3f542974SPaul B Schroeder 
828*3f542974SPaul B Schroeder 	/* Initialising the write urb pool */
829*3f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j) {
830*3f542974SPaul B Schroeder 		urb = usb_alloc_urb(0, SLAB_ATOMIC);
831*3f542974SPaul B Schroeder 		mos7840_port->write_urb_pool[j] = urb;
832*3f542974SPaul B Schroeder 
833*3f542974SPaul B Schroeder 		if (urb == NULL) {
834*3f542974SPaul B Schroeder 			err("No more urbs???");
835*3f542974SPaul B Schroeder 			continue;
836*3f542974SPaul B Schroeder 		}
837*3f542974SPaul B Schroeder 
838*3f542974SPaul B Schroeder 		urb->transfer_buffer = NULL;
839*3f542974SPaul B Schroeder 		urb->transfer_buffer =
840*3f542974SPaul B Schroeder 		    kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);
841*3f542974SPaul B Schroeder 		if (!urb->transfer_buffer) {
842*3f542974SPaul B Schroeder 			err("%s-out of memory for urb buffers.", __FUNCTION__);
843*3f542974SPaul B Schroeder 			continue;
844*3f542974SPaul B Schroeder 		}
845*3f542974SPaul B Schroeder 	}
846*3f542974SPaul B Schroeder 
847*3f542974SPaul B Schroeder /*****************************************************************************
848*3f542974SPaul B Schroeder  * Initialize MCS7840 -- Write Init values to corresponding Registers
849*3f542974SPaul B Schroeder  *
850*3f542974SPaul B Schroeder  * Register Index
851*3f542974SPaul B Schroeder  * 1 : IER
852*3f542974SPaul B Schroeder  * 2 : FCR
853*3f542974SPaul B Schroeder  * 3 : LCR
854*3f542974SPaul B Schroeder  * 4 : MCR
855*3f542974SPaul B Schroeder  *
856*3f542974SPaul B Schroeder  * 0x08 : SP1/2 Control Reg
857*3f542974SPaul B Schroeder  *****************************************************************************/
858*3f542974SPaul B Schroeder 
859*3f542974SPaul B Schroeder //NEED to check the following Block
860*3f542974SPaul B Schroeder 
861*3f542974SPaul B Schroeder 	status = 0;
862*3f542974SPaul B Schroeder 	Data = 0x0;
863*3f542974SPaul B Schroeder 	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);
864*3f542974SPaul B Schroeder 	if (status < 0) {
865*3f542974SPaul B Schroeder 		dbg("Reading Spreg failed\n");
866*3f542974SPaul B Schroeder 		return -1;
867*3f542974SPaul B Schroeder 	}
868*3f542974SPaul B Schroeder 	Data |= 0x80;
869*3f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
870*3f542974SPaul B Schroeder 	if (status < 0) {
871*3f542974SPaul B Schroeder 		dbg("writing Spreg failed\n");
872*3f542974SPaul B Schroeder 		return -1;
873*3f542974SPaul B Schroeder 	}
874*3f542974SPaul B Schroeder 
875*3f542974SPaul B Schroeder 	Data &= ~0x80;
876*3f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
877*3f542974SPaul B Schroeder 	if (status < 0) {
878*3f542974SPaul B Schroeder 		dbg("writing Spreg failed\n");
879*3f542974SPaul B Schroeder 		return -1;
880*3f542974SPaul B Schroeder 	}
881*3f542974SPaul B Schroeder //End of block to be checked
882*3f542974SPaul B Schroeder 
883*3f542974SPaul B Schroeder 	status = 0;
884*3f542974SPaul B Schroeder 	Data = 0x0;
885*3f542974SPaul B Schroeder 	status =
886*3f542974SPaul B Schroeder 	    mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data);
887*3f542974SPaul B Schroeder 	if (status < 0) {
888*3f542974SPaul B Schroeder 		dbg("Reading Controlreg failed\n");
889*3f542974SPaul B Schroeder 		return -1;
890*3f542974SPaul B Schroeder 	}
891*3f542974SPaul B Schroeder 	Data |= 0x08;		//Driver done bit
892*3f542974SPaul B Schroeder 	Data |= 0x20;		//rx_disable
893*3f542974SPaul B Schroeder 	status = 0;
894*3f542974SPaul B Schroeder 	status =
895*3f542974SPaul B Schroeder 	    mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data);
896*3f542974SPaul B Schroeder 	if (status < 0) {
897*3f542974SPaul B Schroeder 		dbg("writing Controlreg failed\n");
898*3f542974SPaul B Schroeder 		return -1;
899*3f542974SPaul B Schroeder 	}
900*3f542974SPaul B Schroeder 	//do register settings here
901*3f542974SPaul B Schroeder 	// Set all regs to the device default values.
902*3f542974SPaul B Schroeder 	////////////////////////////////////
903*3f542974SPaul B Schroeder 	// First Disable all interrupts.
904*3f542974SPaul B Schroeder 	////////////////////////////////////
905*3f542974SPaul B Schroeder 
906*3f542974SPaul B Schroeder 	Data = 0x00;
907*3f542974SPaul B Schroeder 	status = 0;
908*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
909*3f542974SPaul B Schroeder 	if (status < 0) {
910*3f542974SPaul B Schroeder 		dbg("disableing interrupts failed\n");
911*3f542974SPaul B Schroeder 		return -1;
912*3f542974SPaul B Schroeder 	}
913*3f542974SPaul B Schroeder 	// Set FIFO_CONTROL_REGISTER to the default value
914*3f542974SPaul B Schroeder 	Data = 0x00;
915*3f542974SPaul B Schroeder 	status = 0;
916*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
917*3f542974SPaul B Schroeder 	if (status < 0) {
918*3f542974SPaul B Schroeder 		dbg("Writing FIFO_CONTROL_REGISTER  failed\n");
919*3f542974SPaul B Schroeder 		return -1;
920*3f542974SPaul B Schroeder 	}
921*3f542974SPaul B Schroeder 
922*3f542974SPaul B Schroeder 	Data = 0xcf;
923*3f542974SPaul B Schroeder 	status = 0;
924*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
925*3f542974SPaul B Schroeder 	if (status < 0) {
926*3f542974SPaul B Schroeder 		dbg("Writing FIFO_CONTROL_REGISTER  failed\n");
927*3f542974SPaul B Schroeder 		return -1;
928*3f542974SPaul B Schroeder 	}
929*3f542974SPaul B Schroeder 
930*3f542974SPaul B Schroeder 	Data = 0x03;
931*3f542974SPaul B Schroeder 	status = 0;
932*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
933*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
934*3f542974SPaul B Schroeder 
935*3f542974SPaul B Schroeder 	Data = 0x0b;
936*3f542974SPaul B Schroeder 	status = 0;
937*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
938*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = Data;
939*3f542974SPaul B Schroeder 
940*3f542974SPaul B Schroeder 	Data = 0x00;
941*3f542974SPaul B Schroeder 	status = 0;
942*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
943*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
944*3f542974SPaul B Schroeder 
945*3f542974SPaul B Schroeder 	Data |= SERIAL_LCR_DLAB;	//data latch enable in LCR 0x80
946*3f542974SPaul B Schroeder 	status = 0;
947*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
948*3f542974SPaul B Schroeder 
949*3f542974SPaul B Schroeder 	Data = 0x0c;
950*3f542974SPaul B Schroeder 	status = 0;
951*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
952*3f542974SPaul B Schroeder 
953*3f542974SPaul B Schroeder 	Data = 0x0;
954*3f542974SPaul B Schroeder 	status = 0;
955*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
956*3f542974SPaul B Schroeder 
957*3f542974SPaul B Schroeder 	Data = 0x00;
958*3f542974SPaul B Schroeder 	status = 0;
959*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
960*3f542974SPaul B Schroeder 
961*3f542974SPaul B Schroeder 	Data = Data & ~SERIAL_LCR_DLAB;
962*3f542974SPaul B Schroeder 	status = 0;
963*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
964*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
965*3f542974SPaul B Schroeder 
966*3f542974SPaul B Schroeder 	//clearing Bulkin and Bulkout Fifo
967*3f542974SPaul B Schroeder 	Data = 0x0;
968*3f542974SPaul B Schroeder 	status = 0;
969*3f542974SPaul B Schroeder 	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);
970*3f542974SPaul B Schroeder 
971*3f542974SPaul B Schroeder 	Data = Data | 0x0c;
972*3f542974SPaul B Schroeder 	status = 0;
973*3f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
974*3f542974SPaul B Schroeder 
975*3f542974SPaul B Schroeder 	Data = Data & ~0x0c;
976*3f542974SPaul B Schroeder 	status = 0;
977*3f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
978*3f542974SPaul B Schroeder 	//Finally enable all interrupts
979*3f542974SPaul B Schroeder 	Data = 0x0;
980*3f542974SPaul B Schroeder 	Data = 0x0c;
981*3f542974SPaul B Schroeder 	status = 0;
982*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
983*3f542974SPaul B Schroeder 
984*3f542974SPaul B Schroeder 	//clearing rx_disable
985*3f542974SPaul B Schroeder 	Data = 0x0;
986*3f542974SPaul B Schroeder 	status = 0;
987*3f542974SPaul B Schroeder 	status =
988*3f542974SPaul B Schroeder 	    mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data);
989*3f542974SPaul B Schroeder 	Data = Data & ~0x20;
990*3f542974SPaul B Schroeder 	status = 0;
991*3f542974SPaul B Schroeder 	status =
992*3f542974SPaul B Schroeder 	    mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data);
993*3f542974SPaul B Schroeder 
994*3f542974SPaul B Schroeder 	// rx_negate
995*3f542974SPaul B Schroeder 	Data = 0x0;
996*3f542974SPaul B Schroeder 	status = 0;
997*3f542974SPaul B Schroeder 	status =
998*3f542974SPaul B Schroeder 	    mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset, &Data);
999*3f542974SPaul B Schroeder 	Data = Data | 0x10;
1000*3f542974SPaul B Schroeder 	status = 0;
1001*3f542974SPaul B Schroeder 	status =
1002*3f542974SPaul B Schroeder 	    mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset, Data);
1003*3f542974SPaul B Schroeder 
1004*3f542974SPaul B Schroeder 	/* force low_latency on so that our tty_push actually forces *
1005*3f542974SPaul B Schroeder 	 * the data through,otherwise it is scheduled, and with      *
1006*3f542974SPaul B Schroeder 	 * high data rates (like with OHCI) data can get lost.       */
1007*3f542974SPaul B Schroeder 
1008*3f542974SPaul B Schroeder 	if (port->tty)
1009*3f542974SPaul B Schroeder 		port->tty->low_latency = 1;
1010*3f542974SPaul B Schroeder /* Check to see if we've set up our endpoint info yet    *
1011*3f542974SPaul B Schroeder      * (can't set it up in mos7840_startup as the structures *
1012*3f542974SPaul B Schroeder      * were not set up at that time.)                        */
1013*3f542974SPaul B Schroeder 	if (mos7840_num_open_ports == 1) {
1014*3f542974SPaul B Schroeder 		if (serial->port[0]->interrupt_in_buffer == NULL) {
1015*3f542974SPaul B Schroeder 
1016*3f542974SPaul B Schroeder 			/* set up interrupt urb */
1017*3f542974SPaul B Schroeder 
1018*3f542974SPaul B Schroeder 			usb_fill_int_urb(serial->port[0]->interrupt_in_urb,
1019*3f542974SPaul B Schroeder 					 serial->dev,
1020*3f542974SPaul B Schroeder 					 usb_rcvintpipe(serial->dev,
1021*3f542974SPaul B Schroeder 							serial->port[0]->
1022*3f542974SPaul B Schroeder 							interrupt_in_endpointAddress),
1023*3f542974SPaul B Schroeder 					 serial->port[0]->interrupt_in_buffer,
1024*3f542974SPaul B Schroeder 					 serial->port[0]->interrupt_in_urb->
1025*3f542974SPaul B Schroeder 					 transfer_buffer_length,
1026*3f542974SPaul B Schroeder 					 mos7840_interrupt_callback,
1027*3f542974SPaul B Schroeder 					 serial,
1028*3f542974SPaul B Schroeder 					 serial->port[0]->interrupt_in_urb->
1029*3f542974SPaul B Schroeder 					 interval);
1030*3f542974SPaul B Schroeder 
1031*3f542974SPaul B Schroeder 			/* start interrupt read for mos7840               *
1032*3f542974SPaul B Schroeder 			 * will continue as long as mos7840 is connected  */
1033*3f542974SPaul B Schroeder 
1034*3f542974SPaul B Schroeder 			response =
1035*3f542974SPaul B Schroeder 			    usb_submit_urb(serial->port[0]->interrupt_in_urb,
1036*3f542974SPaul B Schroeder 					   GFP_KERNEL);
1037*3f542974SPaul B Schroeder 			if (response) {
1038*3f542974SPaul B Schroeder 				err("%s - Error %d submitting interrupt urb",
1039*3f542974SPaul B Schroeder 				    __FUNCTION__, response);
1040*3f542974SPaul B Schroeder 			}
1041*3f542974SPaul B Schroeder 
1042*3f542974SPaul B Schroeder 		}
1043*3f542974SPaul B Schroeder 
1044*3f542974SPaul B Schroeder 	}
1045*3f542974SPaul B Schroeder 
1046*3f542974SPaul B Schroeder 	/* see if we've set up our endpoint info yet   *
1047*3f542974SPaul B Schroeder 	 * (can't set it up in mos7840_startup as the  *
1048*3f542974SPaul B Schroeder 	 * structures were not set up at that time.)   */
1049*3f542974SPaul B Schroeder 
1050*3f542974SPaul B Schroeder 	dbg("port number is %d \n", port->number);
1051*3f542974SPaul B Schroeder 	dbg("serial number is %d \n", port->serial->minor);
1052*3f542974SPaul B Schroeder 	dbg("Bulkin endpoint is %d \n", port->bulk_in_endpointAddress);
1053*3f542974SPaul B Schroeder 	dbg("BulkOut endpoint is %d \n", port->bulk_out_endpointAddress);
1054*3f542974SPaul B Schroeder 	dbg("Interrupt endpoint is %d \n", port->interrupt_in_endpointAddress);
1055*3f542974SPaul B Schroeder 	dbg("port's number in the device is %d\n", mos7840_port->port_num);
1056*3f542974SPaul B Schroeder 	mos7840_port->read_urb = port->read_urb;
1057*3f542974SPaul B Schroeder 
1058*3f542974SPaul B Schroeder 	/* set up our bulk in urb */
1059*3f542974SPaul B Schroeder 
1060*3f542974SPaul B Schroeder 	usb_fill_bulk_urb(mos7840_port->read_urb,
1061*3f542974SPaul B Schroeder 			  serial->dev,
1062*3f542974SPaul B Schroeder 			  usb_rcvbulkpipe(serial->dev,
1063*3f542974SPaul B Schroeder 					  port->bulk_in_endpointAddress),
1064*3f542974SPaul B Schroeder 			  port->bulk_in_buffer,
1065*3f542974SPaul B Schroeder 			  mos7840_port->read_urb->transfer_buffer_length,
1066*3f542974SPaul B Schroeder 			  mos7840_bulk_in_callback, mos7840_port);
1067*3f542974SPaul B Schroeder 
1068*3f542974SPaul B Schroeder 	dbg("mos7840_open: bulkin endpoint is %d\n",
1069*3f542974SPaul B Schroeder 	    port->bulk_in_endpointAddress);
1070*3f542974SPaul B Schroeder 	response = usb_submit_urb(mos7840_port->read_urb, GFP_KERNEL);
1071*3f542974SPaul B Schroeder 	if (response) {
1072*3f542974SPaul B Schroeder 		err("%s - Error %d submitting control urb", __FUNCTION__,
1073*3f542974SPaul B Schroeder 		    response);
1074*3f542974SPaul B Schroeder 	}
1075*3f542974SPaul B Schroeder 
1076*3f542974SPaul B Schroeder 	/* initialize our wait queues */
1077*3f542974SPaul B Schroeder 	init_waitqueue_head(&mos7840_port->wait_chase);
1078*3f542974SPaul B Schroeder 	init_waitqueue_head(&mos7840_port->delta_msr_wait);
1079*3f542974SPaul B Schroeder 
1080*3f542974SPaul B Schroeder 	/* initialize our icount structure */
1081*3f542974SPaul B Schroeder 	memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount));
1082*3f542974SPaul B Schroeder 
1083*3f542974SPaul B Schroeder 	/* initialize our port settings */
1084*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = MCR_MASTER_IE;	/* Must set to enable ints! */
1085*3f542974SPaul B Schroeder 	/* send a open port command */
1086*3f542974SPaul B Schroeder 	mos7840_port->open = 1;
1087*3f542974SPaul B Schroeder 	//mos7840_change_port_settings(mos7840_port,old_termios);
1088*3f542974SPaul B Schroeder 	mos7840_port->icount.tx = 0;
1089*3f542974SPaul B Schroeder 	mos7840_port->icount.rx = 0;
1090*3f542974SPaul B Schroeder 
1091*3f542974SPaul B Schroeder 	dbg("\n\nusb_serial serial:%x       mos7840_port:%x\n      usb_serial_port port:%x\n\n", (unsigned int)serial, (unsigned int)mos7840_port, (unsigned int)port);
1092*3f542974SPaul B Schroeder 
1093*3f542974SPaul B Schroeder 	return 0;
1094*3f542974SPaul B Schroeder 
1095*3f542974SPaul B Schroeder }
1096*3f542974SPaul B Schroeder 
1097*3f542974SPaul B Schroeder /*****************************************************************************
1098*3f542974SPaul B Schroeder  * mos7840_chars_in_buffer
1099*3f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to know how many
1100*3f542974SPaul B Schroeder  *	bytes of data we currently have outstanding in the port (data that has
1101*3f542974SPaul B Schroeder  *	been written, but hasn't made it out the port yet)
1102*3f542974SPaul B Schroeder  *	If successful, we return the number of bytes left to be written in the
1103*3f542974SPaul B Schroeder  *	system,
1104*3f542974SPaul B Schroeder  *	Otherwise we return a negative error number.
1105*3f542974SPaul B Schroeder  *****************************************************************************/
1106*3f542974SPaul B Schroeder 
1107*3f542974SPaul B Schroeder static int mos7840_chars_in_buffer(struct usb_serial_port *port)
1108*3f542974SPaul B Schroeder {
1109*3f542974SPaul B Schroeder 	int i;
1110*3f542974SPaul B Schroeder 	int chars = 0;
1111*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1112*3f542974SPaul B Schroeder 
1113*3f542974SPaul B Schroeder 	dbg("%s \n", " mos7840_chars_in_buffer:entering ...........");
1114*3f542974SPaul B Schroeder 
1115*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1116*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1117*3f542974SPaul B Schroeder 		return -1;
1118*3f542974SPaul B Schroeder 	}
1119*3f542974SPaul B Schroeder 
1120*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1121*3f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
1122*3f542974SPaul B Schroeder 		dbg("%s \n", "mos7840_break:leaving ...........");
1123*3f542974SPaul B Schroeder 		return -1;
1124*3f542974SPaul B Schroeder 	}
1125*3f542974SPaul B Schroeder 
1126*3f542974SPaul B Schroeder 	for (i = 0; i < NUM_URBS; ++i) {
1127*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb_pool[i]->status == -EINPROGRESS) {
1128*3f542974SPaul B Schroeder 			chars += URB_TRANSFER_BUFFER_SIZE;
1129*3f542974SPaul B Schroeder 		}
1130*3f542974SPaul B Schroeder 	}
1131*3f542974SPaul B Schroeder 	dbg("%s - returns %d", __FUNCTION__, chars);
1132*3f542974SPaul B Schroeder 	return (chars);
1133*3f542974SPaul B Schroeder 
1134*3f542974SPaul B Schroeder }
1135*3f542974SPaul B Schroeder 
1136*3f542974SPaul B Schroeder /************************************************************************
1137*3f542974SPaul B Schroeder  *
1138*3f542974SPaul B Schroeder  * mos7840_block_until_tx_empty
1139*3f542974SPaul B Schroeder  *
1140*3f542974SPaul B Schroeder  *	This function will block the close until one of the following:
1141*3f542974SPaul B Schroeder  *		1. TX count are 0
1142*3f542974SPaul B Schroeder  *		2. The mos7840 has stopped
1143*3f542974SPaul B Schroeder  *		3. A timout of 3 seconds without activity has expired
1144*3f542974SPaul B Schroeder  *
1145*3f542974SPaul B Schroeder  ************************************************************************/
1146*3f542974SPaul B Schroeder static void mos7840_block_until_tx_empty(struct moschip_port *mos7840_port)
1147*3f542974SPaul B Schroeder {
1148*3f542974SPaul B Schroeder 	int timeout = HZ / 10;
1149*3f542974SPaul B Schroeder 	int wait = 30;
1150*3f542974SPaul B Schroeder 	int count;
1151*3f542974SPaul B Schroeder 
1152*3f542974SPaul B Schroeder 	while (1) {
1153*3f542974SPaul B Schroeder 
1154*3f542974SPaul B Schroeder 		count = mos7840_chars_in_buffer(mos7840_port->port);
1155*3f542974SPaul B Schroeder 
1156*3f542974SPaul B Schroeder 		/* Check for Buffer status */
1157*3f542974SPaul B Schroeder 		if (count <= 0) {
1158*3f542974SPaul B Schroeder 			return;
1159*3f542974SPaul B Schroeder 		}
1160*3f542974SPaul B Schroeder 
1161*3f542974SPaul B Schroeder 		/* Block the thread for a while */
1162*3f542974SPaul B Schroeder 		interruptible_sleep_on_timeout(&mos7840_port->wait_chase,
1163*3f542974SPaul B Schroeder 					       timeout);
1164*3f542974SPaul B Schroeder 
1165*3f542974SPaul B Schroeder 		/* No activity.. count down section */
1166*3f542974SPaul B Schroeder 		wait--;
1167*3f542974SPaul B Schroeder 		if (wait == 0) {
1168*3f542974SPaul B Schroeder 			dbg("%s - TIMEOUT", __FUNCTION__);
1169*3f542974SPaul B Schroeder 			return;
1170*3f542974SPaul B Schroeder 		} else {
1171*3f542974SPaul B Schroeder 			/* Reset timout value back to seconds */
1172*3f542974SPaul B Schroeder 			wait = 30;
1173*3f542974SPaul B Schroeder 		}
1174*3f542974SPaul B Schroeder 	}
1175*3f542974SPaul B Schroeder }
1176*3f542974SPaul B Schroeder 
1177*3f542974SPaul B Schroeder /*****************************************************************************
1178*3f542974SPaul B Schroeder  * mos7840_close
1179*3f542974SPaul B Schroeder  *	this function is called by the tty driver when a port is closed
1180*3f542974SPaul B Schroeder  *****************************************************************************/
1181*3f542974SPaul B Schroeder 
1182*3f542974SPaul B Schroeder static void mos7840_close(struct usb_serial_port *port, struct file *filp)
1183*3f542974SPaul B Schroeder {
1184*3f542974SPaul B Schroeder 	struct usb_serial *serial;
1185*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1186*3f542974SPaul B Schroeder 	int j;
1187*3f542974SPaul B Schroeder 	__u16 Data;
1188*3f542974SPaul B Schroeder 
1189*3f542974SPaul B Schroeder 	dbg("%s\n", "mos7840_close:entering...");
1190*3f542974SPaul B Schroeder 
1191*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1192*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
1193*3f542974SPaul B Schroeder 		return;
1194*3f542974SPaul B Schroeder 	}
1195*3f542974SPaul B Schroeder 
1196*3f542974SPaul B Schroeder 	serial = mos7840_get_usb_serial(port, __FUNCTION__);
1197*3f542974SPaul B Schroeder 	if (!serial) {
1198*3f542974SPaul B Schroeder 		dbg("%s", "Serial Paranoia failed \n");
1199*3f542974SPaul B Schroeder 		return;
1200*3f542974SPaul B Schroeder 	}
1201*3f542974SPaul B Schroeder 
1202*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1203*3f542974SPaul B Schroeder 
1204*3f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
1205*3f542974SPaul B Schroeder 		return;
1206*3f542974SPaul B Schroeder 	}
1207*3f542974SPaul B Schroeder 
1208*3f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j)
1209*3f542974SPaul B Schroeder 		usb_kill_urb(mos7840_port->write_urb_pool[j]);
1210*3f542974SPaul B Schroeder 
1211*3f542974SPaul B Schroeder 	/* Freeing Write URBs */
1212*3f542974SPaul B Schroeder 	for (j = 0; j < NUM_URBS; ++j) {
1213*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb_pool[j]) {
1214*3f542974SPaul B Schroeder 			if (mos7840_port->write_urb_pool[j]->transfer_buffer)
1215*3f542974SPaul B Schroeder 				kfree(mos7840_port->write_urb_pool[j]->
1216*3f542974SPaul B Schroeder 				      transfer_buffer);
1217*3f542974SPaul B Schroeder 
1218*3f542974SPaul B Schroeder 			usb_free_urb(mos7840_port->write_urb_pool[j]);
1219*3f542974SPaul B Schroeder 		}
1220*3f542974SPaul B Schroeder 	}
1221*3f542974SPaul B Schroeder 
1222*3f542974SPaul B Schroeder 	if (serial->dev) {
1223*3f542974SPaul B Schroeder 		/* flush and block until tx is empty */
1224*3f542974SPaul B Schroeder 		mos7840_block_until_tx_empty(mos7840_port);
1225*3f542974SPaul B Schroeder 	}
1226*3f542974SPaul B Schroeder 
1227*3f542974SPaul B Schroeder 	/* While closing port, shutdown all bulk read, write  *
1228*3f542974SPaul B Schroeder 	 * and interrupt read if they exists                  */
1229*3f542974SPaul B Schroeder 	if (serial->dev) {
1230*3f542974SPaul B Schroeder 
1231*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb) {
1232*3f542974SPaul B Schroeder 			dbg("%s", "Shutdown bulk write\n");
1233*3f542974SPaul B Schroeder 			usb_kill_urb(mos7840_port->write_urb);
1234*3f542974SPaul B Schroeder 		}
1235*3f542974SPaul B Schroeder 
1236*3f542974SPaul B Schroeder 		if (mos7840_port->read_urb) {
1237*3f542974SPaul B Schroeder 			dbg("%s", "Shutdown bulk read\n");
1238*3f542974SPaul B Schroeder 			usb_kill_urb(mos7840_port->read_urb);
1239*3f542974SPaul B Schroeder 		}
1240*3f542974SPaul B Schroeder 		if ((&mos7840_port->control_urb)) {
1241*3f542974SPaul B Schroeder 			dbg("%s", "Shutdown control read\n");
1242*3f542974SPaul B Schroeder 			//      usb_kill_urb (mos7840_port->control_urb);
1243*3f542974SPaul B Schroeder 
1244*3f542974SPaul B Schroeder 		}
1245*3f542974SPaul B Schroeder 	}
1246*3f542974SPaul B Schroeder //              if(mos7840_port->ctrl_buf != NULL)
1247*3f542974SPaul B Schroeder //                      kfree(mos7840_port->ctrl_buf);
1248*3f542974SPaul B Schroeder 	mos7840_num_open_ports--;
1249*3f542974SPaul B Schroeder 	dbg("mos7840_num_open_ports in close%d:in port%d\n",
1250*3f542974SPaul B Schroeder 	    mos7840_num_open_ports, port->number);
1251*3f542974SPaul B Schroeder 	if (mos7840_num_open_ports == 0) {
1252*3f542974SPaul B Schroeder 		if (serial->port[0]->interrupt_in_urb) {
1253*3f542974SPaul B Schroeder 			dbg("%s", "Shutdown interrupt_in_urb\n");
1254*3f542974SPaul B Schroeder 		}
1255*3f542974SPaul B Schroeder 	}
1256*3f542974SPaul B Schroeder 
1257*3f542974SPaul B Schroeder 	if (mos7840_port->write_urb) {
1258*3f542974SPaul B Schroeder 		/* if this urb had a transfer buffer already (old tx) free it */
1259*3f542974SPaul B Schroeder 
1260*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb->transfer_buffer != NULL) {
1261*3f542974SPaul B Schroeder 			kfree(mos7840_port->write_urb->transfer_buffer);
1262*3f542974SPaul B Schroeder 		}
1263*3f542974SPaul B Schroeder 		usb_free_urb(mos7840_port->write_urb);
1264*3f542974SPaul B Schroeder 	}
1265*3f542974SPaul B Schroeder 
1266*3f542974SPaul B Schroeder 	Data = 0x0;
1267*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
1268*3f542974SPaul B Schroeder 
1269*3f542974SPaul B Schroeder 	Data = 0x00;
1270*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
1271*3f542974SPaul B Schroeder 
1272*3f542974SPaul B Schroeder 	mos7840_port->open = 0;
1273*3f542974SPaul B Schroeder 
1274*3f542974SPaul B Schroeder 	dbg("%s \n", "Leaving ............");
1275*3f542974SPaul B Schroeder }
1276*3f542974SPaul B Schroeder 
1277*3f542974SPaul B Schroeder /************************************************************************
1278*3f542974SPaul B Schroeder  *
1279*3f542974SPaul B Schroeder  * mos7840_block_until_chase_response
1280*3f542974SPaul B Schroeder  *
1281*3f542974SPaul B Schroeder  *	This function will block the close until one of the following:
1282*3f542974SPaul B Schroeder  *		1. Response to our Chase comes from mos7840
1283*3f542974SPaul B Schroeder  *		2. A timout of 10 seconds without activity has expired
1284*3f542974SPaul B Schroeder  *		   (1K of mos7840 data @ 2400 baud ==> 4 sec to empty)
1285*3f542974SPaul B Schroeder  *
1286*3f542974SPaul B Schroeder  ************************************************************************/
1287*3f542974SPaul B Schroeder 
1288*3f542974SPaul B Schroeder static void mos7840_block_until_chase_response(struct moschip_port
1289*3f542974SPaul B Schroeder 					       *mos7840_port)
1290*3f542974SPaul B Schroeder {
1291*3f542974SPaul B Schroeder 	int timeout = 1 * HZ;
1292*3f542974SPaul B Schroeder 	int wait = 10;
1293*3f542974SPaul B Schroeder 	int count;
1294*3f542974SPaul B Schroeder 
1295*3f542974SPaul B Schroeder 	while (1) {
1296*3f542974SPaul B Schroeder 		count = mos7840_chars_in_buffer(mos7840_port->port);
1297*3f542974SPaul B Schroeder 
1298*3f542974SPaul B Schroeder 		/* Check for Buffer status */
1299*3f542974SPaul B Schroeder 		if (count <= 0) {
1300*3f542974SPaul B Schroeder 			return;
1301*3f542974SPaul B Schroeder 		}
1302*3f542974SPaul B Schroeder 
1303*3f542974SPaul B Schroeder 		/* Block the thread for a while */
1304*3f542974SPaul B Schroeder 		interruptible_sleep_on_timeout(&mos7840_port->wait_chase,
1305*3f542974SPaul B Schroeder 					       timeout);
1306*3f542974SPaul B Schroeder 		/* No activity.. count down section */
1307*3f542974SPaul B Schroeder 		wait--;
1308*3f542974SPaul B Schroeder 		if (wait == 0) {
1309*3f542974SPaul B Schroeder 			dbg("%s - TIMEOUT", __FUNCTION__);
1310*3f542974SPaul B Schroeder 			return;
1311*3f542974SPaul B Schroeder 		} else {
1312*3f542974SPaul B Schroeder 			/* Reset timout value back to seconds */
1313*3f542974SPaul B Schroeder 			wait = 10;
1314*3f542974SPaul B Schroeder 		}
1315*3f542974SPaul B Schroeder 	}
1316*3f542974SPaul B Schroeder 
1317*3f542974SPaul B Schroeder }
1318*3f542974SPaul B Schroeder 
1319*3f542974SPaul B Schroeder /*****************************************************************************
1320*3f542974SPaul B Schroeder  * mos7840_break
1321*3f542974SPaul B Schroeder  *	this function sends a break to the port
1322*3f542974SPaul B Schroeder  *****************************************************************************/
1323*3f542974SPaul B Schroeder static void mos7840_break(struct usb_serial_port *port, int break_state)
1324*3f542974SPaul B Schroeder {
1325*3f542974SPaul B Schroeder 	unsigned char data;
1326*3f542974SPaul B Schroeder 	struct usb_serial *serial;
1327*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1328*3f542974SPaul B Schroeder 
1329*3f542974SPaul B Schroeder 	dbg("%s \n", "Entering ...........");
1330*3f542974SPaul B Schroeder 	dbg("mos7840_break: Start\n");
1331*3f542974SPaul B Schroeder 
1332*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1333*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
1334*3f542974SPaul B Schroeder 		return;
1335*3f542974SPaul B Schroeder 	}
1336*3f542974SPaul B Schroeder 
1337*3f542974SPaul B Schroeder 	serial = mos7840_get_usb_serial(port, __FUNCTION__);
1338*3f542974SPaul B Schroeder 	if (!serial) {
1339*3f542974SPaul B Schroeder 		dbg("%s", "Serial Paranoia failed \n");
1340*3f542974SPaul B Schroeder 		return;
1341*3f542974SPaul B Schroeder 	}
1342*3f542974SPaul B Schroeder 
1343*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1344*3f542974SPaul B Schroeder 
1345*3f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
1346*3f542974SPaul B Schroeder 		return;
1347*3f542974SPaul B Schroeder 	}
1348*3f542974SPaul B Schroeder 
1349*3f542974SPaul B Schroeder 	if (serial->dev) {
1350*3f542974SPaul B Schroeder 
1351*3f542974SPaul B Schroeder 		/* flush and block until tx is empty */
1352*3f542974SPaul B Schroeder 		mos7840_block_until_chase_response(mos7840_port);
1353*3f542974SPaul B Schroeder 	}
1354*3f542974SPaul B Schroeder 
1355*3f542974SPaul B Schroeder 	if (break_state == -1) {
1356*3f542974SPaul B Schroeder 		data = mos7840_port->shadowLCR | LCR_SET_BREAK;
1357*3f542974SPaul B Schroeder 	} else {
1358*3f542974SPaul B Schroeder 		data = mos7840_port->shadowLCR & ~LCR_SET_BREAK;
1359*3f542974SPaul B Schroeder 	}
1360*3f542974SPaul B Schroeder 
1361*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR = data;
1362*3f542974SPaul B Schroeder 	dbg("mcs7840_break mos7840_port->shadowLCR is %x\n",
1363*3f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
1364*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER,
1365*3f542974SPaul B Schroeder 			     mos7840_port->shadowLCR);
1366*3f542974SPaul B Schroeder 
1367*3f542974SPaul B Schroeder 	return;
1368*3f542974SPaul B Schroeder }
1369*3f542974SPaul B Schroeder 
1370*3f542974SPaul B Schroeder /*****************************************************************************
1371*3f542974SPaul B Schroeder  * mos7840_write_room
1372*3f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to know how many
1373*3f542974SPaul B Schroeder  *	bytes of data we can accept for a specific port.
1374*3f542974SPaul B Schroeder  *	If successful, we return the amount of room that we have for this port
1375*3f542974SPaul B Schroeder  *	Otherwise we return a negative error number.
1376*3f542974SPaul B Schroeder  *****************************************************************************/
1377*3f542974SPaul B Schroeder 
1378*3f542974SPaul B Schroeder static int mos7840_write_room(struct usb_serial_port *port)
1379*3f542974SPaul B Schroeder {
1380*3f542974SPaul B Schroeder 	int i;
1381*3f542974SPaul B Schroeder 	int room = 0;
1382*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1383*3f542974SPaul B Schroeder 
1384*3f542974SPaul B Schroeder 	dbg("%s \n", " mos7840_write_room:entering ...........");
1385*3f542974SPaul B Schroeder 
1386*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1387*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1388*3f542974SPaul B Schroeder 		dbg("%s \n", " mos7840_write_room:leaving ...........");
1389*3f542974SPaul B Schroeder 		return -1;
1390*3f542974SPaul B Schroeder 	}
1391*3f542974SPaul B Schroeder 
1392*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1393*3f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
1394*3f542974SPaul B Schroeder 		dbg("%s \n", "mos7840_break:leaving ...........");
1395*3f542974SPaul B Schroeder 		return -1;
1396*3f542974SPaul B Schroeder 	}
1397*3f542974SPaul B Schroeder 
1398*3f542974SPaul B Schroeder 	for (i = 0; i < NUM_URBS; ++i) {
1399*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb_pool[i]->status != -EINPROGRESS) {
1400*3f542974SPaul B Schroeder 			room += URB_TRANSFER_BUFFER_SIZE;
1401*3f542974SPaul B Schroeder 		}
1402*3f542974SPaul B Schroeder 	}
1403*3f542974SPaul B Schroeder 
1404*3f542974SPaul B Schroeder 	dbg("%s - returns %d", __FUNCTION__, room);
1405*3f542974SPaul B Schroeder 	return (room);
1406*3f542974SPaul B Schroeder 
1407*3f542974SPaul B Schroeder }
1408*3f542974SPaul B Schroeder 
1409*3f542974SPaul B Schroeder /*****************************************************************************
1410*3f542974SPaul B Schroeder  * mos7840_write
1411*3f542974SPaul B Schroeder  *	this function is called by the tty driver when data should be written to
1412*3f542974SPaul B Schroeder  *	the port.
1413*3f542974SPaul B Schroeder  *	If successful, we return the number of bytes written, otherwise we
1414*3f542974SPaul B Schroeder  *      return a negative error number.
1415*3f542974SPaul B Schroeder  *****************************************************************************/
1416*3f542974SPaul B Schroeder 
1417*3f542974SPaul B Schroeder static int mos7840_write(struct usb_serial_port *port,
1418*3f542974SPaul B Schroeder 			 const unsigned char *data, int count)
1419*3f542974SPaul B Schroeder {
1420*3f542974SPaul B Schroeder 	int status;
1421*3f542974SPaul B Schroeder 	int i;
1422*3f542974SPaul B Schroeder 	int bytes_sent = 0;
1423*3f542974SPaul B Schroeder 	int transfer_size;
1424*3f542974SPaul B Schroeder 	int from_user = 0;
1425*3f542974SPaul B Schroeder 
1426*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1427*3f542974SPaul B Schroeder 	struct usb_serial *serial;
1428*3f542974SPaul B Schroeder 	struct urb *urb;
1429*3f542974SPaul B Schroeder 	//__u16 Data;
1430*3f542974SPaul B Schroeder 	const unsigned char *current_position = data;
1431*3f542974SPaul B Schroeder 	unsigned char *data1;
1432*3f542974SPaul B Schroeder 	dbg("%s \n", "entering ...........");
1433*3f542974SPaul B Schroeder 	//dbg("mos7840_write: mos7840_port->shadowLCR is %x\n",mos7840_port->shadowLCR);
1434*3f542974SPaul B Schroeder 
1435*3f542974SPaul B Schroeder #ifdef NOTMOS7840
1436*3f542974SPaul B Schroeder 	Data = 0x00;
1437*3f542974SPaul B Schroeder 	status = 0;
1438*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
1439*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR = Data;
1440*3f542974SPaul B Schroeder 	dbg("mos7840_write: LINE_CONTROL_REGISTER is %x\n", Data);
1441*3f542974SPaul B Schroeder 	dbg("mos7840_write: mos7840_port->shadowLCR is %x\n",
1442*3f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
1443*3f542974SPaul B Schroeder 
1444*3f542974SPaul B Schroeder 	//Data = 0x03;
1445*3f542974SPaul B Schroeder 	//status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data);
1446*3f542974SPaul B Schroeder 	//mos7840_port->shadowLCR=Data;//Need to add later
1447*3f542974SPaul B Schroeder 
1448*3f542974SPaul B Schroeder 	Data |= SERIAL_LCR_DLAB;	//data latch enable in LCR 0x80
1449*3f542974SPaul B Schroeder 	status = 0;
1450*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
1451*3f542974SPaul B Schroeder 
1452*3f542974SPaul B Schroeder 	//Data = 0x0c;
1453*3f542974SPaul B Schroeder 	//status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data);
1454*3f542974SPaul B Schroeder 	Data = 0x00;
1455*3f542974SPaul B Schroeder 	status = 0;
1456*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data);
1457*3f542974SPaul B Schroeder 	dbg("mos7840_write:DLL value is %x\n", Data);
1458*3f542974SPaul B Schroeder 
1459*3f542974SPaul B Schroeder 	Data = 0x0;
1460*3f542974SPaul B Schroeder 	status = 0;
1461*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data);
1462*3f542974SPaul B Schroeder 	dbg("mos7840_write:DLM value is %x\n", Data);
1463*3f542974SPaul B Schroeder 
1464*3f542974SPaul B Schroeder 	Data = Data & ~SERIAL_LCR_DLAB;
1465*3f542974SPaul B Schroeder 	dbg("mos7840_write: mos7840_port->shadowLCR is %x\n",
1466*3f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
1467*3f542974SPaul B Schroeder 	status = 0;
1468*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
1469*3f542974SPaul B Schroeder #endif
1470*3f542974SPaul B Schroeder 
1471*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1472*3f542974SPaul B Schroeder 		dbg("%s", "Port Paranoia failed \n");
1473*3f542974SPaul B Schroeder 		return -1;
1474*3f542974SPaul B Schroeder 	}
1475*3f542974SPaul B Schroeder 
1476*3f542974SPaul B Schroeder 	serial = port->serial;
1477*3f542974SPaul B Schroeder 	if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) {
1478*3f542974SPaul B Schroeder 		dbg("%s", "Serial Paranoia failed \n");
1479*3f542974SPaul B Schroeder 		return -1;
1480*3f542974SPaul B Schroeder 	}
1481*3f542974SPaul B Schroeder 
1482*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1483*3f542974SPaul B Schroeder 	if (mos7840_port == NULL) {
1484*3f542974SPaul B Schroeder 		dbg("%s", "mos7840_port is NULL\n");
1485*3f542974SPaul B Schroeder 		return -1;
1486*3f542974SPaul B Schroeder 	}
1487*3f542974SPaul B Schroeder 
1488*3f542974SPaul B Schroeder 	/* try to find a free urb in the list */
1489*3f542974SPaul B Schroeder 	urb = NULL;
1490*3f542974SPaul B Schroeder 
1491*3f542974SPaul B Schroeder 	for (i = 0; i < NUM_URBS; ++i) {
1492*3f542974SPaul B Schroeder 		if (mos7840_port->write_urb_pool[i]->status != -EINPROGRESS) {
1493*3f542974SPaul B Schroeder 			urb = mos7840_port->write_urb_pool[i];
1494*3f542974SPaul B Schroeder 			dbg("\nURB:%d", i);
1495*3f542974SPaul B Schroeder 			break;
1496*3f542974SPaul B Schroeder 		}
1497*3f542974SPaul B Schroeder 	}
1498*3f542974SPaul B Schroeder 
1499*3f542974SPaul B Schroeder 	if (urb == NULL) {
1500*3f542974SPaul B Schroeder 		dbg("%s - no more free urbs", __FUNCTION__);
1501*3f542974SPaul B Schroeder 		goto exit;
1502*3f542974SPaul B Schroeder 	}
1503*3f542974SPaul B Schroeder 
1504*3f542974SPaul B Schroeder 	if (urb->transfer_buffer == NULL) {
1505*3f542974SPaul B Schroeder 		urb->transfer_buffer =
1506*3f542974SPaul B Schroeder 		    kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);
1507*3f542974SPaul B Schroeder 
1508*3f542974SPaul B Schroeder 		if (urb->transfer_buffer == NULL) {
1509*3f542974SPaul B Schroeder 			err("%s no more kernel memory...", __FUNCTION__);
1510*3f542974SPaul B Schroeder 			goto exit;
1511*3f542974SPaul B Schroeder 		}
1512*3f542974SPaul B Schroeder 	}
1513*3f542974SPaul B Schroeder 	transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE);
1514*3f542974SPaul B Schroeder 
1515*3f542974SPaul B Schroeder 	if (from_user) {
1516*3f542974SPaul B Schroeder 		if (copy_from_user
1517*3f542974SPaul B Schroeder 		    (urb->transfer_buffer, current_position, transfer_size)) {
1518*3f542974SPaul B Schroeder 			bytes_sent = -EFAULT;
1519*3f542974SPaul B Schroeder 			goto exit;
1520*3f542974SPaul B Schroeder 		}
1521*3f542974SPaul B Schroeder 	} else {
1522*3f542974SPaul B Schroeder 		memcpy(urb->transfer_buffer, current_position, transfer_size);
1523*3f542974SPaul B Schroeder 	}
1524*3f542974SPaul B Schroeder 
1525*3f542974SPaul B Schroeder 	/* fill urb with data and submit  */
1526*3f542974SPaul B Schroeder 	usb_fill_bulk_urb(urb,
1527*3f542974SPaul B Schroeder 			  serial->dev,
1528*3f542974SPaul B Schroeder 			  usb_sndbulkpipe(serial->dev,
1529*3f542974SPaul B Schroeder 					  port->bulk_out_endpointAddress),
1530*3f542974SPaul B Schroeder 			  urb->transfer_buffer,
1531*3f542974SPaul B Schroeder 			  transfer_size,
1532*3f542974SPaul B Schroeder 			  mos7840_bulk_out_data_callback, mos7840_port);
1533*3f542974SPaul B Schroeder 
1534*3f542974SPaul B Schroeder 	data1 = urb->transfer_buffer;
1535*3f542974SPaul B Schroeder 	dbg("\nbulkout endpoint is %d", port->bulk_out_endpointAddress);
1536*3f542974SPaul B Schroeder 
1537*3f542974SPaul B Schroeder 	/* send it down the pipe */
1538*3f542974SPaul B Schroeder 	status = usb_submit_urb(urb, GFP_ATOMIC);
1539*3f542974SPaul B Schroeder 
1540*3f542974SPaul B Schroeder 	if (status) {
1541*3f542974SPaul B Schroeder 		err("%s - usb_submit_urb(write bulk) failed with status = %d",
1542*3f542974SPaul B Schroeder 		    __FUNCTION__, status);
1543*3f542974SPaul B Schroeder 		bytes_sent = status;
1544*3f542974SPaul B Schroeder 		goto exit;
1545*3f542974SPaul B Schroeder 	}
1546*3f542974SPaul B Schroeder 	bytes_sent = transfer_size;
1547*3f542974SPaul B Schroeder 	mos7840_port->icount.tx += transfer_size;
1548*3f542974SPaul B Schroeder 	dbg("mos7840_port->icount.tx is %d:\n", mos7840_port->icount.tx);
1549*3f542974SPaul B Schroeder       exit:
1550*3f542974SPaul B Schroeder 
1551*3f542974SPaul B Schroeder 	return bytes_sent;
1552*3f542974SPaul B Schroeder 
1553*3f542974SPaul B Schroeder }
1554*3f542974SPaul B Schroeder 
1555*3f542974SPaul B Schroeder /*****************************************************************************
1556*3f542974SPaul B Schroeder  * mos7840_throttle
1557*3f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to stop the data
1558*3f542974SPaul B Schroeder  *	being read from the port.
1559*3f542974SPaul B Schroeder  *****************************************************************************/
1560*3f542974SPaul B Schroeder 
1561*3f542974SPaul B Schroeder static void mos7840_throttle(struct usb_serial_port *port)
1562*3f542974SPaul B Schroeder {
1563*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1564*3f542974SPaul B Schroeder 	struct tty_struct *tty;
1565*3f542974SPaul B Schroeder 	int status;
1566*3f542974SPaul B Schroeder 
1567*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1568*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1569*3f542974SPaul B Schroeder 		return;
1570*3f542974SPaul B Schroeder 	}
1571*3f542974SPaul B Schroeder 
1572*3f542974SPaul B Schroeder 	dbg("- port %d\n", port->number);
1573*3f542974SPaul B Schroeder 
1574*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1575*3f542974SPaul B Schroeder 
1576*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1577*3f542974SPaul B Schroeder 		return;
1578*3f542974SPaul B Schroeder 
1579*3f542974SPaul B Schroeder 	if (!mos7840_port->open) {
1580*3f542974SPaul B Schroeder 		dbg("%s\n", "port not opened");
1581*3f542974SPaul B Schroeder 		return;
1582*3f542974SPaul B Schroeder 	}
1583*3f542974SPaul B Schroeder 
1584*3f542974SPaul B Schroeder 	dbg("%s", "Entering .......... \n");
1585*3f542974SPaul B Schroeder 
1586*3f542974SPaul B Schroeder 	tty = port->tty;
1587*3f542974SPaul B Schroeder 	if (!tty) {
1588*3f542974SPaul B Schroeder 		dbg("%s - no tty available", __FUNCTION__);
1589*3f542974SPaul B Schroeder 		return;
1590*3f542974SPaul B Schroeder 	}
1591*3f542974SPaul B Schroeder 
1592*3f542974SPaul B Schroeder 	/* if we are implementing XON/XOFF, send the stop character */
1593*3f542974SPaul B Schroeder 	if (I_IXOFF(tty)) {
1594*3f542974SPaul B Schroeder 		unsigned char stop_char = STOP_CHAR(tty);
1595*3f542974SPaul B Schroeder 		status = mos7840_write(port, &stop_char, 1);
1596*3f542974SPaul B Schroeder 		if (status <= 0) {
1597*3f542974SPaul B Schroeder 			return;
1598*3f542974SPaul B Schroeder 		}
1599*3f542974SPaul B Schroeder 	}
1600*3f542974SPaul B Schroeder 
1601*3f542974SPaul B Schroeder 	/* if we are implementing RTS/CTS, toggle that line */
1602*3f542974SPaul B Schroeder 	if (tty->termios->c_cflag & CRTSCTS) {
1603*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR &= ~MCR_RTS;
1604*3f542974SPaul B Schroeder 		status = 0;
1605*3f542974SPaul B Schroeder 		status =
1606*3f542974SPaul B Schroeder 		    mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1607*3f542974SPaul B Schroeder 					 mos7840_port->shadowMCR);
1608*3f542974SPaul B Schroeder 
1609*3f542974SPaul B Schroeder 		if (status < 0) {
1610*3f542974SPaul B Schroeder 			return;
1611*3f542974SPaul B Schroeder 		}
1612*3f542974SPaul B Schroeder 	}
1613*3f542974SPaul B Schroeder 
1614*3f542974SPaul B Schroeder 	return;
1615*3f542974SPaul B Schroeder }
1616*3f542974SPaul B Schroeder 
1617*3f542974SPaul B Schroeder /*****************************************************************************
1618*3f542974SPaul B Schroeder  * mos7840_unthrottle
1619*3f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to resume the data
1620*3f542974SPaul B Schroeder  *	being read from the port (called after SerialThrottle is called)
1621*3f542974SPaul B Schroeder  *****************************************************************************/
1622*3f542974SPaul B Schroeder static void mos7840_unthrottle(struct usb_serial_port *port)
1623*3f542974SPaul B Schroeder {
1624*3f542974SPaul B Schroeder 	struct tty_struct *tty;
1625*3f542974SPaul B Schroeder 	int status;
1626*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port = mos7840_get_port_private(port);
1627*3f542974SPaul B Schroeder 
1628*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1629*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1630*3f542974SPaul B Schroeder 		return;
1631*3f542974SPaul B Schroeder 	}
1632*3f542974SPaul B Schroeder 
1633*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1634*3f542974SPaul B Schroeder 		return;
1635*3f542974SPaul B Schroeder 
1636*3f542974SPaul B Schroeder 	if (!mos7840_port->open) {
1637*3f542974SPaul B Schroeder 		dbg("%s - port not opened", __FUNCTION__);
1638*3f542974SPaul B Schroeder 		return;
1639*3f542974SPaul B Schroeder 	}
1640*3f542974SPaul B Schroeder 
1641*3f542974SPaul B Schroeder 	dbg("%s", "Entering .......... \n");
1642*3f542974SPaul B Schroeder 
1643*3f542974SPaul B Schroeder 	tty = port->tty;
1644*3f542974SPaul B Schroeder 	if (!tty) {
1645*3f542974SPaul B Schroeder 		dbg("%s - no tty available", __FUNCTION__);
1646*3f542974SPaul B Schroeder 		return;
1647*3f542974SPaul B Schroeder 	}
1648*3f542974SPaul B Schroeder 
1649*3f542974SPaul B Schroeder 	/* if we are implementing XON/XOFF, send the start character */
1650*3f542974SPaul B Schroeder 	if (I_IXOFF(tty)) {
1651*3f542974SPaul B Schroeder 		unsigned char start_char = START_CHAR(tty);
1652*3f542974SPaul B Schroeder 		status = mos7840_write(port, &start_char, 1);
1653*3f542974SPaul B Schroeder 		if (status <= 0) {
1654*3f542974SPaul B Schroeder 			return;
1655*3f542974SPaul B Schroeder 		}
1656*3f542974SPaul B Schroeder 	}
1657*3f542974SPaul B Schroeder 
1658*3f542974SPaul B Schroeder 	/* if we are implementing RTS/CTS, toggle that line */
1659*3f542974SPaul B Schroeder 	if (tty->termios->c_cflag & CRTSCTS) {
1660*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= MCR_RTS;
1661*3f542974SPaul B Schroeder 		status = 0;
1662*3f542974SPaul B Schroeder 		status =
1663*3f542974SPaul B Schroeder 		    mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1664*3f542974SPaul B Schroeder 					 mos7840_port->shadowMCR);
1665*3f542974SPaul B Schroeder 		if (status < 0) {
1666*3f542974SPaul B Schroeder 			return;
1667*3f542974SPaul B Schroeder 		}
1668*3f542974SPaul B Schroeder 	}
1669*3f542974SPaul B Schroeder 
1670*3f542974SPaul B Schroeder 	return;
1671*3f542974SPaul B Schroeder }
1672*3f542974SPaul B Schroeder 
1673*3f542974SPaul B Schroeder static int mos7840_tiocmget(struct usb_serial_port *port, struct file *file)
1674*3f542974SPaul B Schroeder {
1675*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1676*3f542974SPaul B Schroeder 	unsigned int result;
1677*3f542974SPaul B Schroeder 	__u16 msr;
1678*3f542974SPaul B Schroeder 	__u16 mcr;
1679*3f542974SPaul B Schroeder 	int status = 0;
1680*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1681*3f542974SPaul B Schroeder 
1682*3f542974SPaul B Schroeder 	dbg("%s - port %d", __FUNCTION__, port->number);
1683*3f542974SPaul B Schroeder 
1684*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1685*3f542974SPaul B Schroeder 		return -ENODEV;
1686*3f542974SPaul B Schroeder 
1687*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, MODEM_STATUS_REGISTER, &msr);
1688*3f542974SPaul B Schroeder 	status = mos7840_get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr);
1689*3f542974SPaul B Schroeder 	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
1690*3f542974SPaul B Schroeder 	    | ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
1691*3f542974SPaul B Schroeder 	    | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0)
1692*3f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0)
1693*3f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0)
1694*3f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0)
1695*3f542974SPaul B Schroeder 	    | ((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0);
1696*3f542974SPaul B Schroeder 
1697*3f542974SPaul B Schroeder 	dbg("%s - 0x%04X", __FUNCTION__, result);
1698*3f542974SPaul B Schroeder 
1699*3f542974SPaul B Schroeder 	return result;
1700*3f542974SPaul B Schroeder }
1701*3f542974SPaul B Schroeder 
1702*3f542974SPaul B Schroeder static int mos7840_tiocmset(struct usb_serial_port *port, struct file *file,
1703*3f542974SPaul B Schroeder 			    unsigned int set, unsigned int clear)
1704*3f542974SPaul B Schroeder {
1705*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
1706*3f542974SPaul B Schroeder 	unsigned int mcr;
1707*3f542974SPaul B Schroeder 	unsigned int status;
1708*3f542974SPaul B Schroeder 
1709*3f542974SPaul B Schroeder 	dbg("%s - port %d", __FUNCTION__, port->number);
1710*3f542974SPaul B Schroeder 
1711*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
1712*3f542974SPaul B Schroeder 
1713*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1714*3f542974SPaul B Schroeder 		return -ENODEV;
1715*3f542974SPaul B Schroeder 
1716*3f542974SPaul B Schroeder 	mcr = mos7840_port->shadowMCR;
1717*3f542974SPaul B Schroeder 	if (clear & TIOCM_RTS)
1718*3f542974SPaul B Schroeder 		mcr &= ~MCR_RTS;
1719*3f542974SPaul B Schroeder 	if (clear & TIOCM_DTR)
1720*3f542974SPaul B Schroeder 		mcr &= ~MCR_DTR;
1721*3f542974SPaul B Schroeder 	if (clear & TIOCM_LOOP)
1722*3f542974SPaul B Schroeder 		mcr &= ~MCR_LOOPBACK;
1723*3f542974SPaul B Schroeder 
1724*3f542974SPaul B Schroeder 	if (set & TIOCM_RTS)
1725*3f542974SPaul B Schroeder 		mcr |= MCR_RTS;
1726*3f542974SPaul B Schroeder 	if (set & TIOCM_DTR)
1727*3f542974SPaul B Schroeder 		mcr |= MCR_DTR;
1728*3f542974SPaul B Schroeder 	if (set & TIOCM_LOOP)
1729*3f542974SPaul B Schroeder 		mcr |= MCR_LOOPBACK;
1730*3f542974SPaul B Schroeder 
1731*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = mcr;
1732*3f542974SPaul B Schroeder 
1733*3f542974SPaul B Schroeder 	status = 0;
1734*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr);
1735*3f542974SPaul B Schroeder 	if (status < 0) {
1736*3f542974SPaul B Schroeder 		dbg("setting MODEM_CONTROL_REGISTER Failed\n");
1737*3f542974SPaul B Schroeder 		return -1;
1738*3f542974SPaul B Schroeder 	}
1739*3f542974SPaul B Schroeder 
1740*3f542974SPaul B Schroeder 	return 0;
1741*3f542974SPaul B Schroeder }
1742*3f542974SPaul B Schroeder 
1743*3f542974SPaul B Schroeder /*****************************************************************************
1744*3f542974SPaul B Schroeder  * mos7840_calc_baud_rate_divisor
1745*3f542974SPaul B Schroeder  *	this function calculates the proper baud rate divisor for the specified
1746*3f542974SPaul B Schroeder  *	baud rate.
1747*3f542974SPaul B Schroeder  *****************************************************************************/
1748*3f542974SPaul B Schroeder static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor,
1749*3f542974SPaul B Schroeder 					  __u16 * clk_sel_val)
1750*3f542974SPaul B Schroeder {
1751*3f542974SPaul B Schroeder 
1752*3f542974SPaul B Schroeder 	dbg("%s - %d", __FUNCTION__, baudRate);
1753*3f542974SPaul B Schroeder 
1754*3f542974SPaul B Schroeder 	if (baudRate <= 115200) {
1755*3f542974SPaul B Schroeder 		*divisor = 115200 / baudRate;
1756*3f542974SPaul B Schroeder 		*clk_sel_val = 0x0;
1757*3f542974SPaul B Schroeder 	}
1758*3f542974SPaul B Schroeder 	if ((baudRate > 115200) && (baudRate <= 230400)) {
1759*3f542974SPaul B Schroeder 		*divisor = 230400 / baudRate;
1760*3f542974SPaul B Schroeder 		*clk_sel_val = 0x10;
1761*3f542974SPaul B Schroeder 	} else if ((baudRate > 230400) && (baudRate <= 403200)) {
1762*3f542974SPaul B Schroeder 		*divisor = 403200 / baudRate;
1763*3f542974SPaul B Schroeder 		*clk_sel_val = 0x20;
1764*3f542974SPaul B Schroeder 	} else if ((baudRate > 403200) && (baudRate <= 460800)) {
1765*3f542974SPaul B Schroeder 		*divisor = 460800 / baudRate;
1766*3f542974SPaul B Schroeder 		*clk_sel_val = 0x30;
1767*3f542974SPaul B Schroeder 	} else if ((baudRate > 460800) && (baudRate <= 806400)) {
1768*3f542974SPaul B Schroeder 		*divisor = 806400 / baudRate;
1769*3f542974SPaul B Schroeder 		*clk_sel_val = 0x40;
1770*3f542974SPaul B Schroeder 	} else if ((baudRate > 806400) && (baudRate <= 921600)) {
1771*3f542974SPaul B Schroeder 		*divisor = 921600 / baudRate;
1772*3f542974SPaul B Schroeder 		*clk_sel_val = 0x50;
1773*3f542974SPaul B Schroeder 	} else if ((baudRate > 921600) && (baudRate <= 1572864)) {
1774*3f542974SPaul B Schroeder 		*divisor = 1572864 / baudRate;
1775*3f542974SPaul B Schroeder 		*clk_sel_val = 0x60;
1776*3f542974SPaul B Schroeder 	} else if ((baudRate > 1572864) && (baudRate <= 3145728)) {
1777*3f542974SPaul B Schroeder 		*divisor = 3145728 / baudRate;
1778*3f542974SPaul B Schroeder 		*clk_sel_val = 0x70;
1779*3f542974SPaul B Schroeder 	}
1780*3f542974SPaul B Schroeder 	return 0;
1781*3f542974SPaul B Schroeder 
1782*3f542974SPaul B Schroeder #ifdef NOTMCS7840
1783*3f542974SPaul B Schroeder 
1784*3f542974SPaul B Schroeder 	for (i = 0; i < ARRAY_SIZE(mos7840_divisor_table); i++) {
1785*3f542974SPaul B Schroeder 		if (mos7840_divisor_table[i].BaudRate == baudrate) {
1786*3f542974SPaul B Schroeder 			*divisor = mos7840_divisor_table[i].Divisor;
1787*3f542974SPaul B Schroeder 			return 0;
1788*3f542974SPaul B Schroeder 		}
1789*3f542974SPaul B Schroeder 	}
1790*3f542974SPaul B Schroeder 
1791*3f542974SPaul B Schroeder 	/* After trying for all the standard baud rates    *
1792*3f542974SPaul B Schroeder 	 * Try calculating the divisor for this baud rate  */
1793*3f542974SPaul B Schroeder 
1794*3f542974SPaul B Schroeder 	if (baudrate > 75 && baudrate < 230400) {
1795*3f542974SPaul B Schroeder 		/* get the divisor */
1796*3f542974SPaul B Schroeder 		custom = (__u16) (230400L / baudrate);
1797*3f542974SPaul B Schroeder 
1798*3f542974SPaul B Schroeder 		/* Check for round off */
1799*3f542974SPaul B Schroeder 		round1 = (__u16) (2304000L / baudrate);
1800*3f542974SPaul B Schroeder 		round = (__u16) (round1 - (custom * 10));
1801*3f542974SPaul B Schroeder 		if (round > 4) {
1802*3f542974SPaul B Schroeder 			custom++;
1803*3f542974SPaul B Schroeder 		}
1804*3f542974SPaul B Schroeder 		*divisor = custom;
1805*3f542974SPaul B Schroeder 
1806*3f542974SPaul B Schroeder 		dbg(" Baud %d = %d\n", baudrate, custom);
1807*3f542974SPaul B Schroeder 		return 0;
1808*3f542974SPaul B Schroeder 	}
1809*3f542974SPaul B Schroeder 
1810*3f542974SPaul B Schroeder 	dbg("%s\n", " Baud calculation Failed...");
1811*3f542974SPaul B Schroeder 	return -1;
1812*3f542974SPaul B Schroeder #endif
1813*3f542974SPaul B Schroeder }
1814*3f542974SPaul B Schroeder 
1815*3f542974SPaul B Schroeder /*****************************************************************************
1816*3f542974SPaul B Schroeder  * mos7840_send_cmd_write_baud_rate
1817*3f542974SPaul B Schroeder  *	this function sends the proper command to change the baud rate of the
1818*3f542974SPaul B Schroeder  *	specified port.
1819*3f542974SPaul B Schroeder  *****************************************************************************/
1820*3f542974SPaul B Schroeder 
1821*3f542974SPaul B Schroeder static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port,
1822*3f542974SPaul B Schroeder 					    int baudRate)
1823*3f542974SPaul B Schroeder {
1824*3f542974SPaul B Schroeder 	int divisor = 0;
1825*3f542974SPaul B Schroeder 	int status;
1826*3f542974SPaul B Schroeder 	__u16 Data;
1827*3f542974SPaul B Schroeder 	unsigned char number;
1828*3f542974SPaul B Schroeder 	__u16 clk_sel_val;
1829*3f542974SPaul B Schroeder 	struct usb_serial_port *port;
1830*3f542974SPaul B Schroeder 
1831*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1832*3f542974SPaul B Schroeder 		return -1;
1833*3f542974SPaul B Schroeder 
1834*3f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
1835*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1836*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1837*3f542974SPaul B Schroeder 		return -1;
1838*3f542974SPaul B Schroeder 	}
1839*3f542974SPaul B Schroeder 
1840*3f542974SPaul B Schroeder 	if (mos7840_serial_paranoia_check(port->serial, __FUNCTION__)) {
1841*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Serial \n");
1842*3f542974SPaul B Schroeder 		return -1;
1843*3f542974SPaul B Schroeder 	}
1844*3f542974SPaul B Schroeder 
1845*3f542974SPaul B Schroeder 	dbg("%s", "Entering .......... \n");
1846*3f542974SPaul B Schroeder 
1847*3f542974SPaul B Schroeder 	number = mos7840_port->port->number - mos7840_port->port->serial->minor;
1848*3f542974SPaul B Schroeder 
1849*3f542974SPaul B Schroeder 	dbg("%s - port = %d, baud = %d", __FUNCTION__,
1850*3f542974SPaul B Schroeder 	    mos7840_port->port->number, baudRate);
1851*3f542974SPaul B Schroeder 	//reset clk_uart_sel in spregOffset
1852*3f542974SPaul B Schroeder 	if (baudRate > 115200) {
1853*3f542974SPaul B Schroeder #ifdef HW_flow_control
1854*3f542974SPaul B Schroeder 		//NOTE: need to see the pther register to modify
1855*3f542974SPaul B Schroeder 		//setting h/w flow control bit to 1;
1856*3f542974SPaul B Schroeder 		status = 0;
1857*3f542974SPaul B Schroeder 		Data = 0x2b;
1858*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR = Data;
1859*3f542974SPaul B Schroeder 		status =
1860*3f542974SPaul B Schroeder 		    mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
1861*3f542974SPaul B Schroeder 		if (status < 0) {
1862*3f542974SPaul B Schroeder 			dbg("Writing spreg failed in set_serial_baud\n");
1863*3f542974SPaul B Schroeder 			return -1;
1864*3f542974SPaul B Schroeder 		}
1865*3f542974SPaul B Schroeder #endif
1866*3f542974SPaul B Schroeder 
1867*3f542974SPaul B Schroeder 	} else {
1868*3f542974SPaul B Schroeder #ifdef HW_flow_control
1869*3f542974SPaul B Schroeder 		//setting h/w flow control bit to 0;
1870*3f542974SPaul B Schroeder 		status = 0;
1871*3f542974SPaul B Schroeder 		Data = 0xb;
1872*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR = Data;
1873*3f542974SPaul B Schroeder 		status =
1874*3f542974SPaul B Schroeder 		    mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
1875*3f542974SPaul B Schroeder 		if (status < 0) {
1876*3f542974SPaul B Schroeder 			dbg("Writing spreg failed in set_serial_baud\n");
1877*3f542974SPaul B Schroeder 			return -1;
1878*3f542974SPaul B Schroeder 		}
1879*3f542974SPaul B Schroeder #endif
1880*3f542974SPaul B Schroeder 
1881*3f542974SPaul B Schroeder 	}
1882*3f542974SPaul B Schroeder 
1883*3f542974SPaul B Schroeder 	if (1)			//baudRate <= 115200)
1884*3f542974SPaul B Schroeder 	{
1885*3f542974SPaul B Schroeder 		clk_sel_val = 0x0;
1886*3f542974SPaul B Schroeder 		Data = 0x0;
1887*3f542974SPaul B Schroeder 		status = 0;
1888*3f542974SPaul B Schroeder 		status =
1889*3f542974SPaul B Schroeder 		    mos7840_calc_baud_rate_divisor(baudRate, &divisor,
1890*3f542974SPaul B Schroeder 						   &clk_sel_val);
1891*3f542974SPaul B Schroeder 		status =
1892*3f542974SPaul B Schroeder 		    mos7840_get_reg_sync(port, mos7840_port->SpRegOffset,
1893*3f542974SPaul B Schroeder 					 &Data);
1894*3f542974SPaul B Schroeder 		if (status < 0) {
1895*3f542974SPaul B Schroeder 			dbg("reading spreg failed in set_serial_baud\n");
1896*3f542974SPaul B Schroeder 			return -1;
1897*3f542974SPaul B Schroeder 		}
1898*3f542974SPaul B Schroeder 		Data = (Data & 0x8f) | clk_sel_val;
1899*3f542974SPaul B Schroeder 		status = 0;
1900*3f542974SPaul B Schroeder 		status =
1901*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
1902*3f542974SPaul B Schroeder 		if (status < 0) {
1903*3f542974SPaul B Schroeder 			dbg("Writing spreg failed in set_serial_baud\n");
1904*3f542974SPaul B Schroeder 			return -1;
1905*3f542974SPaul B Schroeder 		}
1906*3f542974SPaul B Schroeder 		/* Calculate the Divisor */
1907*3f542974SPaul B Schroeder 
1908*3f542974SPaul B Schroeder 		if (status) {
1909*3f542974SPaul B Schroeder 			err("%s - bad baud rate", __FUNCTION__);
1910*3f542974SPaul B Schroeder 			dbg("%s\n", "bad baud rate");
1911*3f542974SPaul B Schroeder 			return status;
1912*3f542974SPaul B Schroeder 		}
1913*3f542974SPaul B Schroeder 		/* Enable access to divisor latch */
1914*3f542974SPaul B Schroeder 		Data = mos7840_port->shadowLCR | SERIAL_LCR_DLAB;
1915*3f542974SPaul B Schroeder 		mos7840_port->shadowLCR = Data;
1916*3f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
1917*3f542974SPaul B Schroeder 
1918*3f542974SPaul B Schroeder 		/* Write the divisor */
1919*3f542974SPaul B Schroeder 		Data = (unsigned char)(divisor & 0xff);
1920*3f542974SPaul B Schroeder 		dbg("set_serial_baud Value to write DLL is %x\n", Data);
1921*3f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);
1922*3f542974SPaul B Schroeder 
1923*3f542974SPaul B Schroeder 		Data = (unsigned char)((divisor & 0xff00) >> 8);
1924*3f542974SPaul B Schroeder 		dbg("set_serial_baud Value to write DLM is %x\n", Data);
1925*3f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);
1926*3f542974SPaul B Schroeder 
1927*3f542974SPaul B Schroeder 		/* Disable access to divisor latch */
1928*3f542974SPaul B Schroeder 		Data = mos7840_port->shadowLCR & ~SERIAL_LCR_DLAB;
1929*3f542974SPaul B Schroeder 		mos7840_port->shadowLCR = Data;
1930*3f542974SPaul B Schroeder 		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
1931*3f542974SPaul B Schroeder 
1932*3f542974SPaul B Schroeder 	}
1933*3f542974SPaul B Schroeder 
1934*3f542974SPaul B Schroeder 	return status;
1935*3f542974SPaul B Schroeder }
1936*3f542974SPaul B Schroeder 
1937*3f542974SPaul B Schroeder /*****************************************************************************
1938*3f542974SPaul B Schroeder  * mos7840_change_port_settings
1939*3f542974SPaul B Schroeder  *	This routine is called to set the UART on the device to match
1940*3f542974SPaul B Schroeder  *      the specified new settings.
1941*3f542974SPaul B Schroeder  *****************************************************************************/
1942*3f542974SPaul B Schroeder 
1943*3f542974SPaul B Schroeder static void mos7840_change_port_settings(struct moschip_port *mos7840_port,
1944*3f542974SPaul B Schroeder 					 struct termios *old_termios)
1945*3f542974SPaul B Schroeder {
1946*3f542974SPaul B Schroeder 	struct tty_struct *tty;
1947*3f542974SPaul B Schroeder 	int baud;
1948*3f542974SPaul B Schroeder 	unsigned cflag;
1949*3f542974SPaul B Schroeder 	unsigned iflag;
1950*3f542974SPaul B Schroeder 	__u8 lData;
1951*3f542974SPaul B Schroeder 	__u8 lParity;
1952*3f542974SPaul B Schroeder 	__u8 lStop;
1953*3f542974SPaul B Schroeder 	int status;
1954*3f542974SPaul B Schroeder 	__u16 Data;
1955*3f542974SPaul B Schroeder 	struct usb_serial_port *port;
1956*3f542974SPaul B Schroeder 	struct usb_serial *serial;
1957*3f542974SPaul B Schroeder 
1958*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
1959*3f542974SPaul B Schroeder 		return;
1960*3f542974SPaul B Schroeder 
1961*3f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
1962*3f542974SPaul B Schroeder 
1963*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
1964*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
1965*3f542974SPaul B Schroeder 		return;
1966*3f542974SPaul B Schroeder 	}
1967*3f542974SPaul B Schroeder 
1968*3f542974SPaul B Schroeder 	if (mos7840_serial_paranoia_check(port->serial, __FUNCTION__)) {
1969*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Serial \n");
1970*3f542974SPaul B Schroeder 		return;
1971*3f542974SPaul B Schroeder 	}
1972*3f542974SPaul B Schroeder 
1973*3f542974SPaul B Schroeder 	serial = port->serial;
1974*3f542974SPaul B Schroeder 
1975*3f542974SPaul B Schroeder 	dbg("%s - port %d", __FUNCTION__, mos7840_port->port->number);
1976*3f542974SPaul B Schroeder 
1977*3f542974SPaul B Schroeder 	if (!mos7840_port->open) {
1978*3f542974SPaul B Schroeder 		dbg("%s - port not opened", __FUNCTION__);
1979*3f542974SPaul B Schroeder 		return;
1980*3f542974SPaul B Schroeder 	}
1981*3f542974SPaul B Schroeder 
1982*3f542974SPaul B Schroeder 	tty = mos7840_port->port->tty;
1983*3f542974SPaul B Schroeder 
1984*3f542974SPaul B Schroeder 	if ((!tty) || (!tty->termios)) {
1985*3f542974SPaul B Schroeder 		dbg("%s - no tty structures", __FUNCTION__);
1986*3f542974SPaul B Schroeder 		return;
1987*3f542974SPaul B Schroeder 	}
1988*3f542974SPaul B Schroeder 
1989*3f542974SPaul B Schroeder 	dbg("%s", "Entering .......... \n");
1990*3f542974SPaul B Schroeder 
1991*3f542974SPaul B Schroeder 	lData = LCR_BITS_8;
1992*3f542974SPaul B Schroeder 	lStop = LCR_STOP_1;
1993*3f542974SPaul B Schroeder 	lParity = LCR_PAR_NONE;
1994*3f542974SPaul B Schroeder 
1995*3f542974SPaul B Schroeder 	cflag = tty->termios->c_cflag;
1996*3f542974SPaul B Schroeder 	iflag = tty->termios->c_iflag;
1997*3f542974SPaul B Schroeder 
1998*3f542974SPaul B Schroeder 	/* Change the number of bits */
1999*3f542974SPaul B Schroeder 	if (cflag & CSIZE) {
2000*3f542974SPaul B Schroeder 		switch (cflag & CSIZE) {
2001*3f542974SPaul B Schroeder 		case CS5:
2002*3f542974SPaul B Schroeder 			lData = LCR_BITS_5;
2003*3f542974SPaul B Schroeder 			break;
2004*3f542974SPaul B Schroeder 
2005*3f542974SPaul B Schroeder 		case CS6:
2006*3f542974SPaul B Schroeder 			lData = LCR_BITS_6;
2007*3f542974SPaul B Schroeder 			break;
2008*3f542974SPaul B Schroeder 
2009*3f542974SPaul B Schroeder 		case CS7:
2010*3f542974SPaul B Schroeder 			lData = LCR_BITS_7;
2011*3f542974SPaul B Schroeder 			break;
2012*3f542974SPaul B Schroeder 		default:
2013*3f542974SPaul B Schroeder 		case CS8:
2014*3f542974SPaul B Schroeder 			lData = LCR_BITS_8;
2015*3f542974SPaul B Schroeder 			break;
2016*3f542974SPaul B Schroeder 		}
2017*3f542974SPaul B Schroeder 	}
2018*3f542974SPaul B Schroeder 	/* Change the Parity bit */
2019*3f542974SPaul B Schroeder 	if (cflag & PARENB) {
2020*3f542974SPaul B Schroeder 		if (cflag & PARODD) {
2021*3f542974SPaul B Schroeder 			lParity = LCR_PAR_ODD;
2022*3f542974SPaul B Schroeder 			dbg("%s - parity = odd", __FUNCTION__);
2023*3f542974SPaul B Schroeder 		} else {
2024*3f542974SPaul B Schroeder 			lParity = LCR_PAR_EVEN;
2025*3f542974SPaul B Schroeder 			dbg("%s - parity = even", __FUNCTION__);
2026*3f542974SPaul B Schroeder 		}
2027*3f542974SPaul B Schroeder 
2028*3f542974SPaul B Schroeder 	} else {
2029*3f542974SPaul B Schroeder 		dbg("%s - parity = none", __FUNCTION__);
2030*3f542974SPaul B Schroeder 	}
2031*3f542974SPaul B Schroeder 
2032*3f542974SPaul B Schroeder 	if (cflag & CMSPAR) {
2033*3f542974SPaul B Schroeder 		lParity = lParity | 0x20;
2034*3f542974SPaul B Schroeder 	}
2035*3f542974SPaul B Schroeder 
2036*3f542974SPaul B Schroeder 	/* Change the Stop bit */
2037*3f542974SPaul B Schroeder 	if (cflag & CSTOPB) {
2038*3f542974SPaul B Schroeder 		lStop = LCR_STOP_2;
2039*3f542974SPaul B Schroeder 		dbg("%s - stop bits = 2", __FUNCTION__);
2040*3f542974SPaul B Schroeder 	} else {
2041*3f542974SPaul B Schroeder 		lStop = LCR_STOP_1;
2042*3f542974SPaul B Schroeder 		dbg("%s - stop bits = 1", __FUNCTION__);
2043*3f542974SPaul B Schroeder 	}
2044*3f542974SPaul B Schroeder 
2045*3f542974SPaul B Schroeder 	/* Update the LCR with the correct value */
2046*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR &=
2047*3f542974SPaul B Schroeder 	    ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK);
2048*3f542974SPaul B Schroeder 	mos7840_port->shadowLCR |= (lData | lParity | lStop);
2049*3f542974SPaul B Schroeder 
2050*3f542974SPaul B Schroeder 	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is %x\n",
2051*3f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
2052*3f542974SPaul B Schroeder 	/* Disable Interrupts */
2053*3f542974SPaul B Schroeder 	Data = 0x00;
2054*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
2055*3f542974SPaul B Schroeder 
2056*3f542974SPaul B Schroeder 	Data = 0x00;
2057*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
2058*3f542974SPaul B Schroeder 
2059*3f542974SPaul B Schroeder 	Data = 0xcf;
2060*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
2061*3f542974SPaul B Schroeder 
2062*3f542974SPaul B Schroeder 	/* Send the updated LCR value to the mos7840 */
2063*3f542974SPaul B Schroeder 	Data = mos7840_port->shadowLCR;
2064*3f542974SPaul B Schroeder 
2065*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
2066*3f542974SPaul B Schroeder 
2067*3f542974SPaul B Schroeder 	Data = 0x00b;
2068*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = Data;
2069*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
2070*3f542974SPaul B Schroeder 	Data = 0x00b;
2071*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
2072*3f542974SPaul B Schroeder 
2073*3f542974SPaul B Schroeder 	/* set up the MCR register and send it to the mos7840 */
2074*3f542974SPaul B Schroeder 
2075*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = MCR_MASTER_IE;
2076*3f542974SPaul B Schroeder 	if (cflag & CBAUD) {
2077*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS);
2078*3f542974SPaul B Schroeder 	}
2079*3f542974SPaul B Schroeder 
2080*3f542974SPaul B Schroeder 	if (cflag & CRTSCTS) {
2081*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR |= (MCR_XON_ANY);
2082*3f542974SPaul B Schroeder 
2083*3f542974SPaul B Schroeder 	} else {
2084*3f542974SPaul B Schroeder 		mos7840_port->shadowMCR &= ~(MCR_XON_ANY);
2085*3f542974SPaul B Schroeder 	}
2086*3f542974SPaul B Schroeder 
2087*3f542974SPaul B Schroeder 	Data = mos7840_port->shadowMCR;
2088*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
2089*3f542974SPaul B Schroeder 
2090*3f542974SPaul B Schroeder 	/* Determine divisor based on baud rate */
2091*3f542974SPaul B Schroeder 	baud = tty_get_baud_rate(tty);
2092*3f542974SPaul B Schroeder 
2093*3f542974SPaul B Schroeder 	if (!baud) {
2094*3f542974SPaul B Schroeder 		/* pick a default, any default... */
2095*3f542974SPaul B Schroeder 		dbg("%s\n", "Picked default baud...");
2096*3f542974SPaul B Schroeder 		baud = 9600;
2097*3f542974SPaul B Schroeder 	}
2098*3f542974SPaul B Schroeder 
2099*3f542974SPaul B Schroeder 	dbg("%s - baud rate = %d", __FUNCTION__, baud);
2100*3f542974SPaul B Schroeder 	status = mos7840_send_cmd_write_baud_rate(mos7840_port, baud);
2101*3f542974SPaul B Schroeder 
2102*3f542974SPaul B Schroeder 	/* Enable Interrupts */
2103*3f542974SPaul B Schroeder 	Data = 0x0c;
2104*3f542974SPaul B Schroeder 	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
2105*3f542974SPaul B Schroeder 
2106*3f542974SPaul B Schroeder 	if (mos7840_port->read_urb->status != -EINPROGRESS) {
2107*3f542974SPaul B Schroeder 		mos7840_port->read_urb->dev = serial->dev;
2108*3f542974SPaul B Schroeder 
2109*3f542974SPaul B Schroeder 		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
2110*3f542974SPaul B Schroeder 
2111*3f542974SPaul B Schroeder 		if (status) {
2112*3f542974SPaul B Schroeder 			dbg(" usb_submit_urb(read bulk) failed, status = %d",
2113*3f542974SPaul B Schroeder 			    status);
2114*3f542974SPaul B Schroeder 		}
2115*3f542974SPaul B Schroeder 	}
2116*3f542974SPaul B Schroeder 	wake_up(&mos7840_port->delta_msr_wait);
2117*3f542974SPaul B Schroeder 	mos7840_port->delta_msr_cond = 1;
2118*3f542974SPaul B Schroeder 	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is End %x\n",
2119*3f542974SPaul B Schroeder 	    mos7840_port->shadowLCR);
2120*3f542974SPaul B Schroeder 
2121*3f542974SPaul B Schroeder 	return;
2122*3f542974SPaul B Schroeder }
2123*3f542974SPaul B Schroeder 
2124*3f542974SPaul B Schroeder /*****************************************************************************
2125*3f542974SPaul B Schroeder  * mos7840_set_termios
2126*3f542974SPaul B Schroeder  *	this function is called by the tty driver when it wants to change
2127*3f542974SPaul B Schroeder  *	the termios structure
2128*3f542974SPaul B Schroeder  *****************************************************************************/
2129*3f542974SPaul B Schroeder 
2130*3f542974SPaul B Schroeder static void mos7840_set_termios(struct usb_serial_port *port,
2131*3f542974SPaul B Schroeder 				struct termios *old_termios)
2132*3f542974SPaul B Schroeder {
2133*3f542974SPaul B Schroeder 	int status;
2134*3f542974SPaul B Schroeder 	unsigned int cflag;
2135*3f542974SPaul B Schroeder 	struct usb_serial *serial;
2136*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
2137*3f542974SPaul B Schroeder 	struct tty_struct *tty;
2138*3f542974SPaul B Schroeder 	dbg("mos7840_set_termios: START\n");
2139*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
2140*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
2141*3f542974SPaul B Schroeder 		return;
2142*3f542974SPaul B Schroeder 	}
2143*3f542974SPaul B Schroeder 
2144*3f542974SPaul B Schroeder 	serial = port->serial;
2145*3f542974SPaul B Schroeder 
2146*3f542974SPaul B Schroeder 	if (mos7840_serial_paranoia_check(serial, __FUNCTION__)) {
2147*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Serial \n");
2148*3f542974SPaul B Schroeder 		return;
2149*3f542974SPaul B Schroeder 	}
2150*3f542974SPaul B Schroeder 
2151*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
2152*3f542974SPaul B Schroeder 
2153*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
2154*3f542974SPaul B Schroeder 		return;
2155*3f542974SPaul B Schroeder 
2156*3f542974SPaul B Schroeder 	tty = port->tty;
2157*3f542974SPaul B Schroeder 
2158*3f542974SPaul B Schroeder 	if (!port->tty || !port->tty->termios) {
2159*3f542974SPaul B Schroeder 		dbg("%s - no tty or termios", __FUNCTION__);
2160*3f542974SPaul B Schroeder 		return;
2161*3f542974SPaul B Schroeder 	}
2162*3f542974SPaul B Schroeder 
2163*3f542974SPaul B Schroeder 	if (!mos7840_port->open) {
2164*3f542974SPaul B Schroeder 		dbg("%s - port not opened", __FUNCTION__);
2165*3f542974SPaul B Schroeder 		return;
2166*3f542974SPaul B Schroeder 	}
2167*3f542974SPaul B Schroeder 
2168*3f542974SPaul B Schroeder 	dbg("%s\n", "setting termios - ");
2169*3f542974SPaul B Schroeder 
2170*3f542974SPaul B Schroeder 	cflag = tty->termios->c_cflag;
2171*3f542974SPaul B Schroeder 
2172*3f542974SPaul B Schroeder 	if (!cflag) {
2173*3f542974SPaul B Schroeder 		dbg("%s %s\n", __FUNCTION__, "cflag is NULL");
2174*3f542974SPaul B Schroeder 		return;
2175*3f542974SPaul B Schroeder 	}
2176*3f542974SPaul B Schroeder 
2177*3f542974SPaul B Schroeder 	/* check that they really want us to change something */
2178*3f542974SPaul B Schroeder 	if (old_termios) {
2179*3f542974SPaul B Schroeder 		if ((cflag == old_termios->c_cflag) &&
2180*3f542974SPaul B Schroeder 		    (RELEVANT_IFLAG(tty->termios->c_iflag) ==
2181*3f542974SPaul B Schroeder 		     RELEVANT_IFLAG(old_termios->c_iflag))) {
2182*3f542974SPaul B Schroeder 			dbg("%s\n", "Nothing to change");
2183*3f542974SPaul B Schroeder 			return;
2184*3f542974SPaul B Schroeder 		}
2185*3f542974SPaul B Schroeder 	}
2186*3f542974SPaul B Schroeder 
2187*3f542974SPaul B Schroeder 	dbg("%s - clfag %08x iflag %08x", __FUNCTION__,
2188*3f542974SPaul B Schroeder 	    tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag));
2189*3f542974SPaul B Schroeder 
2190*3f542974SPaul B Schroeder 	if (old_termios) {
2191*3f542974SPaul B Schroeder 		dbg("%s - old clfag %08x old iflag %08x", __FUNCTION__,
2192*3f542974SPaul B Schroeder 		    old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag));
2193*3f542974SPaul B Schroeder 	}
2194*3f542974SPaul B Schroeder 
2195*3f542974SPaul B Schroeder 	dbg("%s - port %d", __FUNCTION__, port->number);
2196*3f542974SPaul B Schroeder 
2197*3f542974SPaul B Schroeder 	/* change the port settings to the new ones specified */
2198*3f542974SPaul B Schroeder 
2199*3f542974SPaul B Schroeder 	mos7840_change_port_settings(mos7840_port, old_termios);
2200*3f542974SPaul B Schroeder 
2201*3f542974SPaul B Schroeder 	if (!mos7840_port->read_urb) {
2202*3f542974SPaul B Schroeder 		dbg("%s", "URB KILLED !!!!!\n");
2203*3f542974SPaul B Schroeder 		return;
2204*3f542974SPaul B Schroeder 	}
2205*3f542974SPaul B Schroeder 
2206*3f542974SPaul B Schroeder 	if (mos7840_port->read_urb->status != -EINPROGRESS) {
2207*3f542974SPaul B Schroeder 		mos7840_port->read_urb->dev = serial->dev;
2208*3f542974SPaul B Schroeder 		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
2209*3f542974SPaul B Schroeder 		if (status) {
2210*3f542974SPaul B Schroeder 			dbg(" usb_submit_urb(read bulk) failed, status = %d",
2211*3f542974SPaul B Schroeder 			    status);
2212*3f542974SPaul B Schroeder 		}
2213*3f542974SPaul B Schroeder 	}
2214*3f542974SPaul B Schroeder 	return;
2215*3f542974SPaul B Schroeder }
2216*3f542974SPaul B Schroeder 
2217*3f542974SPaul B Schroeder /*****************************************************************************
2218*3f542974SPaul B Schroeder  * mos7840_get_lsr_info - get line status register info
2219*3f542974SPaul B Schroeder  *
2220*3f542974SPaul B Schroeder  * Purpose: Let user call ioctl() to get info when the UART physically
2221*3f542974SPaul B Schroeder  * 	    is emptied.  On bus types like RS485, the transmitter must
2222*3f542974SPaul B Schroeder  * 	    release the bus after transmitting. This must be done when
2223*3f542974SPaul B Schroeder  * 	    the transmit shift register is empty, not be done when the
2224*3f542974SPaul B Schroeder  * 	    transmit holding register is empty.  This functionality
2225*3f542974SPaul B Schroeder  * 	    allows an RS485 driver to be written in user space.
2226*3f542974SPaul B Schroeder  *****************************************************************************/
2227*3f542974SPaul B Schroeder 
2228*3f542974SPaul B Schroeder static int mos7840_get_lsr_info(struct moschip_port *mos7840_port,
2229*3f542974SPaul B Schroeder 				unsigned int *value)
2230*3f542974SPaul B Schroeder {
2231*3f542974SPaul B Schroeder 	int count;
2232*3f542974SPaul B Schroeder 	unsigned int result = 0;
2233*3f542974SPaul B Schroeder 
2234*3f542974SPaul B Schroeder 	count = mos7840_chars_in_buffer(mos7840_port->port);
2235*3f542974SPaul B Schroeder 	if (count == 0) {
2236*3f542974SPaul B Schroeder 		dbg("%s -- Empty", __FUNCTION__);
2237*3f542974SPaul B Schroeder 		result = TIOCSER_TEMT;
2238*3f542974SPaul B Schroeder 	}
2239*3f542974SPaul B Schroeder 
2240*3f542974SPaul B Schroeder 	if (copy_to_user(value, &result, sizeof(int)))
2241*3f542974SPaul B Schroeder 		return -EFAULT;
2242*3f542974SPaul B Schroeder 	return 0;
2243*3f542974SPaul B Schroeder }
2244*3f542974SPaul B Schroeder 
2245*3f542974SPaul B Schroeder /*****************************************************************************
2246*3f542974SPaul B Schroeder  * mos7840_get_bytes_avail - get number of bytes available
2247*3f542974SPaul B Schroeder  *
2248*3f542974SPaul B Schroeder  * Purpose: Let user call ioctl to get the count of number of bytes available.
2249*3f542974SPaul B Schroeder  *****************************************************************************/
2250*3f542974SPaul B Schroeder 
2251*3f542974SPaul B Schroeder static int mos7840_get_bytes_avail(struct moschip_port *mos7840_port,
2252*3f542974SPaul B Schroeder 				   unsigned int *value)
2253*3f542974SPaul B Schroeder {
2254*3f542974SPaul B Schroeder 	unsigned int result = 0;
2255*3f542974SPaul B Schroeder 	struct tty_struct *tty = mos7840_port->port->tty;
2256*3f542974SPaul B Schroeder 
2257*3f542974SPaul B Schroeder 	if (!tty)
2258*3f542974SPaul B Schroeder 		return -ENOIOCTLCMD;
2259*3f542974SPaul B Schroeder 
2260*3f542974SPaul B Schroeder 	result = tty->read_cnt;
2261*3f542974SPaul B Schroeder 
2262*3f542974SPaul B Schroeder 	dbg("%s(%d) = %d", __FUNCTION__, mos7840_port->port->number, result);
2263*3f542974SPaul B Schroeder 	if (copy_to_user(value, &result, sizeof(int)))
2264*3f542974SPaul B Schroeder 		return -EFAULT;
2265*3f542974SPaul B Schroeder 
2266*3f542974SPaul B Schroeder 	return -ENOIOCTLCMD;
2267*3f542974SPaul B Schroeder }
2268*3f542974SPaul B Schroeder 
2269*3f542974SPaul B Schroeder /*****************************************************************************
2270*3f542974SPaul B Schroeder  * mos7840_set_modem_info
2271*3f542974SPaul B Schroeder  *      function to set modem info
2272*3f542974SPaul B Schroeder  *****************************************************************************/
2273*3f542974SPaul B Schroeder 
2274*3f542974SPaul B Schroeder static int mos7840_set_modem_info(struct moschip_port *mos7840_port,
2275*3f542974SPaul B Schroeder 				  unsigned int cmd, unsigned int *value)
2276*3f542974SPaul B Schroeder {
2277*3f542974SPaul B Schroeder 	unsigned int mcr;
2278*3f542974SPaul B Schroeder 	unsigned int arg;
2279*3f542974SPaul B Schroeder 	__u16 Data;
2280*3f542974SPaul B Schroeder 	int status;
2281*3f542974SPaul B Schroeder 	struct usb_serial_port *port;
2282*3f542974SPaul B Schroeder 
2283*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
2284*3f542974SPaul B Schroeder 		return -1;
2285*3f542974SPaul B Schroeder 
2286*3f542974SPaul B Schroeder 	port = (struct usb_serial_port *)mos7840_port->port;
2287*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
2288*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
2289*3f542974SPaul B Schroeder 		return -1;
2290*3f542974SPaul B Schroeder 	}
2291*3f542974SPaul B Schroeder 
2292*3f542974SPaul B Schroeder 	mcr = mos7840_port->shadowMCR;
2293*3f542974SPaul B Schroeder 
2294*3f542974SPaul B Schroeder 	if (copy_from_user(&arg, value, sizeof(int)))
2295*3f542974SPaul B Schroeder 		return -EFAULT;
2296*3f542974SPaul B Schroeder 
2297*3f542974SPaul B Schroeder 	switch (cmd) {
2298*3f542974SPaul B Schroeder 	case TIOCMBIS:
2299*3f542974SPaul B Schroeder 		if (arg & TIOCM_RTS)
2300*3f542974SPaul B Schroeder 			mcr |= MCR_RTS;
2301*3f542974SPaul B Schroeder 		if (arg & TIOCM_DTR)
2302*3f542974SPaul B Schroeder 			mcr |= MCR_RTS;
2303*3f542974SPaul B Schroeder 		if (arg & TIOCM_LOOP)
2304*3f542974SPaul B Schroeder 			mcr |= MCR_LOOPBACK;
2305*3f542974SPaul B Schroeder 		break;
2306*3f542974SPaul B Schroeder 
2307*3f542974SPaul B Schroeder 	case TIOCMBIC:
2308*3f542974SPaul B Schroeder 		if (arg & TIOCM_RTS)
2309*3f542974SPaul B Schroeder 			mcr &= ~MCR_RTS;
2310*3f542974SPaul B Schroeder 		if (arg & TIOCM_DTR)
2311*3f542974SPaul B Schroeder 			mcr &= ~MCR_RTS;
2312*3f542974SPaul B Schroeder 		if (arg & TIOCM_LOOP)
2313*3f542974SPaul B Schroeder 			mcr &= ~MCR_LOOPBACK;
2314*3f542974SPaul B Schroeder 		break;
2315*3f542974SPaul B Schroeder 
2316*3f542974SPaul B Schroeder 	case TIOCMSET:
2317*3f542974SPaul B Schroeder 		/* turn off the RTS and DTR and LOOPBACK
2318*3f542974SPaul B Schroeder 		 * and then only turn on what was asked to */
2319*3f542974SPaul B Schroeder 		mcr &= ~(MCR_RTS | MCR_DTR | MCR_LOOPBACK);
2320*3f542974SPaul B Schroeder 		mcr |= ((arg & TIOCM_RTS) ? MCR_RTS : 0);
2321*3f542974SPaul B Schroeder 		mcr |= ((arg & TIOCM_DTR) ? MCR_DTR : 0);
2322*3f542974SPaul B Schroeder 		mcr |= ((arg & TIOCM_LOOP) ? MCR_LOOPBACK : 0);
2323*3f542974SPaul B Schroeder 		break;
2324*3f542974SPaul B Schroeder 	}
2325*3f542974SPaul B Schroeder 
2326*3f542974SPaul B Schroeder 	mos7840_port->shadowMCR = mcr;
2327*3f542974SPaul B Schroeder 
2328*3f542974SPaul B Schroeder 	Data = mos7840_port->shadowMCR;
2329*3f542974SPaul B Schroeder 	status = 0;
2330*3f542974SPaul B Schroeder 	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
2331*3f542974SPaul B Schroeder 	if (status < 0) {
2332*3f542974SPaul B Schroeder 		dbg("setting MODEM_CONTROL_REGISTER Failed\n");
2333*3f542974SPaul B Schroeder 		return -1;
2334*3f542974SPaul B Schroeder 	}
2335*3f542974SPaul B Schroeder 
2336*3f542974SPaul B Schroeder 	return 0;
2337*3f542974SPaul B Schroeder }
2338*3f542974SPaul B Schroeder 
2339*3f542974SPaul B Schroeder /*****************************************************************************
2340*3f542974SPaul B Schroeder  * mos7840_get_modem_info
2341*3f542974SPaul B Schroeder  *      function to get modem info
2342*3f542974SPaul B Schroeder  *****************************************************************************/
2343*3f542974SPaul B Schroeder 
2344*3f542974SPaul B Schroeder static int mos7840_get_modem_info(struct moschip_port *mos7840_port,
2345*3f542974SPaul B Schroeder 				  unsigned int *value)
2346*3f542974SPaul B Schroeder {
2347*3f542974SPaul B Schroeder 	unsigned int result = 0;
2348*3f542974SPaul B Schroeder 	__u16 msr;
2349*3f542974SPaul B Schroeder 	unsigned int mcr = mos7840_port->shadowMCR;
2350*3f542974SPaul B Schroeder 	int status = 0;
2351*3f542974SPaul B Schroeder 	status =
2352*3f542974SPaul B Schroeder 	    mos7840_get_uart_reg(mos7840_port->port, MODEM_STATUS_REGISTER,
2353*3f542974SPaul B Schroeder 				 &msr);
2354*3f542974SPaul B Schroeder 	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)	/* 0x002 */
2355*3f542974SPaul B Schroeder 	    |((mcr & MCR_RTS) ? TIOCM_RTS : 0)	/* 0x004 */
2356*3f542974SPaul B Schroeder 	    |((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0)	/* 0x020 */
2357*3f542974SPaul B Schroeder 	    |((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0)	/* 0x040 */
2358*3f542974SPaul B Schroeder 	    |((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0)	/* 0x080 */
2359*3f542974SPaul B Schroeder 	    |((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0);	/* 0x100 */
2360*3f542974SPaul B Schroeder 
2361*3f542974SPaul B Schroeder 	dbg("%s -- %x", __FUNCTION__, result);
2362*3f542974SPaul B Schroeder 
2363*3f542974SPaul B Schroeder 	if (copy_to_user(value, &result, sizeof(int)))
2364*3f542974SPaul B Schroeder 		return -EFAULT;
2365*3f542974SPaul B Schroeder 	return 0;
2366*3f542974SPaul B Schroeder }
2367*3f542974SPaul B Schroeder 
2368*3f542974SPaul B Schroeder /*****************************************************************************
2369*3f542974SPaul B Schroeder  * mos7840_get_serial_info
2370*3f542974SPaul B Schroeder  *      function to get information about serial port
2371*3f542974SPaul B Schroeder  *****************************************************************************/
2372*3f542974SPaul B Schroeder 
2373*3f542974SPaul B Schroeder static int mos7840_get_serial_info(struct moschip_port *mos7840_port,
2374*3f542974SPaul B Schroeder 				   struct serial_struct *retinfo)
2375*3f542974SPaul B Schroeder {
2376*3f542974SPaul B Schroeder 	struct serial_struct tmp;
2377*3f542974SPaul B Schroeder 
2378*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
2379*3f542974SPaul B Schroeder 		return -1;
2380*3f542974SPaul B Schroeder 
2381*3f542974SPaul B Schroeder 	if (!retinfo)
2382*3f542974SPaul B Schroeder 		return -EFAULT;
2383*3f542974SPaul B Schroeder 
2384*3f542974SPaul B Schroeder 	memset(&tmp, 0, sizeof(tmp));
2385*3f542974SPaul B Schroeder 
2386*3f542974SPaul B Schroeder 	tmp.type = PORT_16550A;
2387*3f542974SPaul B Schroeder 	tmp.line = mos7840_port->port->serial->minor;
2388*3f542974SPaul B Schroeder 	tmp.port = mos7840_port->port->number;
2389*3f542974SPaul B Schroeder 	tmp.irq = 0;
2390*3f542974SPaul B Schroeder 	tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
2391*3f542974SPaul B Schroeder 	tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE;
2392*3f542974SPaul B Schroeder 	tmp.baud_base = 9600;
2393*3f542974SPaul B Schroeder 	tmp.close_delay = 5 * HZ;
2394*3f542974SPaul B Schroeder 	tmp.closing_wait = 30 * HZ;
2395*3f542974SPaul B Schroeder 
2396*3f542974SPaul B Schroeder 	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
2397*3f542974SPaul B Schroeder 		return -EFAULT;
2398*3f542974SPaul B Schroeder 	return 0;
2399*3f542974SPaul B Schroeder }
2400*3f542974SPaul B Schroeder 
2401*3f542974SPaul B Schroeder /*****************************************************************************
2402*3f542974SPaul B Schroeder  * SerialIoctl
2403*3f542974SPaul B Schroeder  *	this function handles any ioctl calls to the driver
2404*3f542974SPaul B Schroeder  *****************************************************************************/
2405*3f542974SPaul B Schroeder 
2406*3f542974SPaul B Schroeder static int mos7840_ioctl(struct usb_serial_port *port, struct file *file,
2407*3f542974SPaul B Schroeder 			 unsigned int cmd, unsigned long arg)
2408*3f542974SPaul B Schroeder {
2409*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
2410*3f542974SPaul B Schroeder 	struct tty_struct *tty;
2411*3f542974SPaul B Schroeder 
2412*3f542974SPaul B Schroeder 	struct async_icount cnow;
2413*3f542974SPaul B Schroeder 	struct async_icount cprev;
2414*3f542974SPaul B Schroeder 	struct serial_icounter_struct icount;
2415*3f542974SPaul B Schroeder 	int mosret = 0;
2416*3f542974SPaul B Schroeder 	int retval;
2417*3f542974SPaul B Schroeder 	struct tty_ldisc *ld;
2418*3f542974SPaul B Schroeder 
2419*3f542974SPaul B Schroeder 	if (mos7840_port_paranoia_check(port, __FUNCTION__)) {
2420*3f542974SPaul B Schroeder 		dbg("%s", "Invalid port \n");
2421*3f542974SPaul B Schroeder 		return -1;
2422*3f542974SPaul B Schroeder 	}
2423*3f542974SPaul B Schroeder 
2424*3f542974SPaul B Schroeder 	mos7840_port = mos7840_get_port_private(port);
2425*3f542974SPaul B Schroeder 	tty = mos7840_port->port->tty;
2426*3f542974SPaul B Schroeder 
2427*3f542974SPaul B Schroeder 	if (mos7840_port == NULL)
2428*3f542974SPaul B Schroeder 		return -1;
2429*3f542974SPaul B Schroeder 
2430*3f542974SPaul B Schroeder 	dbg("%s - port %d, cmd = 0x%x", __FUNCTION__, port->number, cmd);
2431*3f542974SPaul B Schroeder 
2432*3f542974SPaul B Schroeder 	switch (cmd) {
2433*3f542974SPaul B Schroeder 		/* return number of bytes available */
2434*3f542974SPaul B Schroeder 
2435*3f542974SPaul B Schroeder 	case TIOCINQ:
2436*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCINQ", __FUNCTION__, port->number);
2437*3f542974SPaul B Schroeder 		return mos7840_get_bytes_avail(mos7840_port,
2438*3f542974SPaul B Schroeder 					       (unsigned int *)arg);
2439*3f542974SPaul B Schroeder 		break;
2440*3f542974SPaul B Schroeder 
2441*3f542974SPaul B Schroeder 	case TIOCOUTQ:
2442*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCOUTQ", __FUNCTION__, port->number);
2443*3f542974SPaul B Schroeder 		return put_user(tty->driver->chars_in_buffer ?
2444*3f542974SPaul B Schroeder 				tty->driver->chars_in_buffer(tty) : 0,
2445*3f542974SPaul B Schroeder 				(int __user *)arg);
2446*3f542974SPaul B Schroeder 		break;
2447*3f542974SPaul B Schroeder 
2448*3f542974SPaul B Schroeder 	case TCFLSH:
2449*3f542974SPaul B Schroeder 		retval = tty_check_change(tty);
2450*3f542974SPaul B Schroeder 		if (retval)
2451*3f542974SPaul B Schroeder 			return retval;
2452*3f542974SPaul B Schroeder 
2453*3f542974SPaul B Schroeder 		ld = tty_ldisc_ref(tty);
2454*3f542974SPaul B Schroeder 		switch (arg) {
2455*3f542974SPaul B Schroeder 		case TCIFLUSH:
2456*3f542974SPaul B Schroeder 			if (ld && ld->flush_buffer)
2457*3f542974SPaul B Schroeder 				ld->flush_buffer(tty);
2458*3f542974SPaul B Schroeder 			break;
2459*3f542974SPaul B Schroeder 		case TCIOFLUSH:
2460*3f542974SPaul B Schroeder 			if (ld && ld->flush_buffer)
2461*3f542974SPaul B Schroeder 				ld->flush_buffer(tty);
2462*3f542974SPaul B Schroeder 			/* fall through */
2463*3f542974SPaul B Schroeder 		case TCOFLUSH:
2464*3f542974SPaul B Schroeder 			if (tty->driver->flush_buffer)
2465*3f542974SPaul B Schroeder 				tty->driver->flush_buffer(tty);
2466*3f542974SPaul B Schroeder 			break;
2467*3f542974SPaul B Schroeder 		default:
2468*3f542974SPaul B Schroeder 			tty_ldisc_deref(ld);
2469*3f542974SPaul B Schroeder 			return -EINVAL;
2470*3f542974SPaul B Schroeder 		}
2471*3f542974SPaul B Schroeder 		tty_ldisc_deref(ld);
2472*3f542974SPaul B Schroeder 		return 0;
2473*3f542974SPaul B Schroeder 
2474*3f542974SPaul B Schroeder 	case TCGETS:
2475*3f542974SPaul B Schroeder 		if (kernel_termios_to_user_termios
2476*3f542974SPaul B Schroeder 		    ((struct termios __user *)arg, tty->termios))
2477*3f542974SPaul B Schroeder 			return -EFAULT;
2478*3f542974SPaul B Schroeder 		return 0;
2479*3f542974SPaul B Schroeder 
2480*3f542974SPaul B Schroeder 	case TIOCSERGETLSR:
2481*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCSERGETLSR", __FUNCTION__, port->number);
2482*3f542974SPaul B Schroeder 		return mos7840_get_lsr_info(mos7840_port, (unsigned int *)arg);
2483*3f542974SPaul B Schroeder 		return 0;
2484*3f542974SPaul B Schroeder 
2485*3f542974SPaul B Schroeder 	case TIOCMBIS:
2486*3f542974SPaul B Schroeder 	case TIOCMBIC:
2487*3f542974SPaul B Schroeder 	case TIOCMSET:
2488*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCMSET/TIOCMBIC/TIOCMSET", __FUNCTION__,
2489*3f542974SPaul B Schroeder 		    port->number);
2490*3f542974SPaul B Schroeder 		mosret =
2491*3f542974SPaul B Schroeder 		    mos7840_set_modem_info(mos7840_port, cmd,
2492*3f542974SPaul B Schroeder 					   (unsigned int *)arg);
2493*3f542974SPaul B Schroeder 		return mosret;
2494*3f542974SPaul B Schroeder 
2495*3f542974SPaul B Schroeder 	case TIOCMGET:
2496*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCMGET", __FUNCTION__, port->number);
2497*3f542974SPaul B Schroeder 		return mos7840_get_modem_info(mos7840_port,
2498*3f542974SPaul B Schroeder 					      (unsigned int *)arg);
2499*3f542974SPaul B Schroeder 
2500*3f542974SPaul B Schroeder 	case TIOCGSERIAL:
2501*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCGSERIAL", __FUNCTION__, port->number);
2502*3f542974SPaul B Schroeder 		return mos7840_get_serial_info(mos7840_port,
2503*3f542974SPaul B Schroeder 					       (struct serial_struct *)arg);
2504*3f542974SPaul B Schroeder 
2505*3f542974SPaul B Schroeder 	case TIOCSSERIAL:
2506*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCSSERIAL", __FUNCTION__, port->number);
2507*3f542974SPaul B Schroeder 		break;
2508*3f542974SPaul B Schroeder 
2509*3f542974SPaul B Schroeder 	case TIOCMIWAIT:
2510*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCMIWAIT", __FUNCTION__, port->number);
2511*3f542974SPaul B Schroeder 		cprev = mos7840_port->icount;
2512*3f542974SPaul B Schroeder 		while (1) {
2513*3f542974SPaul B Schroeder 			//interruptible_sleep_on(&mos7840_port->delta_msr_wait);
2514*3f542974SPaul B Schroeder 			mos7840_port->delta_msr_cond = 0;
2515*3f542974SPaul B Schroeder 			wait_event_interruptible(mos7840_port->delta_msr_wait,
2516*3f542974SPaul B Schroeder 						 (mos7840_port->
2517*3f542974SPaul B Schroeder 						  delta_msr_cond == 1));
2518*3f542974SPaul B Schroeder 
2519*3f542974SPaul B Schroeder 			/* see if a signal did it */
2520*3f542974SPaul B Schroeder 			if (signal_pending(current))
2521*3f542974SPaul B Schroeder 				return -ERESTARTSYS;
2522*3f542974SPaul B Schroeder 			cnow = mos7840_port->icount;
2523*3f542974SPaul B Schroeder 			if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
2524*3f542974SPaul B Schroeder 			    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
2525*3f542974SPaul B Schroeder 				return -EIO;	/* no change => error */
2526*3f542974SPaul B Schroeder 			if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
2527*3f542974SPaul B Schroeder 			    ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
2528*3f542974SPaul B Schroeder 			    ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
2529*3f542974SPaul B Schroeder 			    ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
2530*3f542974SPaul B Schroeder 				return 0;
2531*3f542974SPaul B Schroeder 			}
2532*3f542974SPaul B Schroeder 			cprev = cnow;
2533*3f542974SPaul B Schroeder 		}
2534*3f542974SPaul B Schroeder 		/* NOTREACHED */
2535*3f542974SPaul B Schroeder 		break;
2536*3f542974SPaul B Schroeder 
2537*3f542974SPaul B Schroeder 	case TIOCGICOUNT:
2538*3f542974SPaul B Schroeder 		cnow = mos7840_port->icount;
2539*3f542974SPaul B Schroeder 		icount.cts = cnow.cts;
2540*3f542974SPaul B Schroeder 		icount.dsr = cnow.dsr;
2541*3f542974SPaul B Schroeder 		icount.rng = cnow.rng;
2542*3f542974SPaul B Schroeder 		icount.dcd = cnow.dcd;
2543*3f542974SPaul B Schroeder 		icount.rx = cnow.rx;
2544*3f542974SPaul B Schroeder 		icount.tx = cnow.tx;
2545*3f542974SPaul B Schroeder 		icount.frame = cnow.frame;
2546*3f542974SPaul B Schroeder 		icount.overrun = cnow.overrun;
2547*3f542974SPaul B Schroeder 		icount.parity = cnow.parity;
2548*3f542974SPaul B Schroeder 		icount.brk = cnow.brk;
2549*3f542974SPaul B Schroeder 		icount.buf_overrun = cnow.buf_overrun;
2550*3f542974SPaul B Schroeder 
2551*3f542974SPaul B Schroeder 		dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __FUNCTION__,
2552*3f542974SPaul B Schroeder 		    port->number, icount.rx, icount.tx);
2553*3f542974SPaul B Schroeder 		if (copy_to_user((void *)arg, &icount, sizeof(icount)))
2554*3f542974SPaul B Schroeder 			return -EFAULT;
2555*3f542974SPaul B Schroeder 		return 0;
2556*3f542974SPaul B Schroeder 
2557*3f542974SPaul B Schroeder 	case TIOCEXBAUD:
2558*3f542974SPaul B Schroeder 		return 0;
2559*3f542974SPaul B Schroeder 	default:
2560*3f542974SPaul B Schroeder 		break;
2561*3f542974SPaul B Schroeder 	}
2562*3f542974SPaul B Schroeder 
2563*3f542974SPaul B Schroeder 	return -ENOIOCTLCMD;
2564*3f542974SPaul B Schroeder }
2565*3f542974SPaul B Schroeder 
2566*3f542974SPaul B Schroeder static int mos7840_calc_num_ports(struct usb_serial *serial)
2567*3f542974SPaul B Schroeder {
2568*3f542974SPaul B Schroeder 
2569*3f542974SPaul B Schroeder 	dbg("numberofendpoints: %d \n",
2570*3f542974SPaul B Schroeder 	    (int)serial->interface->cur_altsetting->desc.bNumEndpoints);
2571*3f542974SPaul B Schroeder 	dbg("numberofendpoints: %d \n",
2572*3f542974SPaul B Schroeder 	    (int)serial->interface->altsetting->desc.bNumEndpoints);
2573*3f542974SPaul B Schroeder 	if (serial->interface->cur_altsetting->desc.bNumEndpoints == 5) {
2574*3f542974SPaul B Schroeder 		mos7840_num_ports = 2;
2575*3f542974SPaul B Schroeder 		serial->type->num_ports = 2;
2576*3f542974SPaul B Schroeder 	} else if (serial->interface->cur_altsetting->desc.bNumEndpoints == 9) {
2577*3f542974SPaul B Schroeder 		mos7840_num_ports = 4;
2578*3f542974SPaul B Schroeder 		serial->type->num_bulk_in = 4;
2579*3f542974SPaul B Schroeder 		serial->type->num_bulk_out = 4;
2580*3f542974SPaul B Schroeder 		serial->type->num_ports = 4;
2581*3f542974SPaul B Schroeder 	}
2582*3f542974SPaul B Schroeder 
2583*3f542974SPaul B Schroeder 	return mos7840_num_ports;
2584*3f542974SPaul B Schroeder }
2585*3f542974SPaul B Schroeder 
2586*3f542974SPaul B Schroeder /****************************************************************************
2587*3f542974SPaul B Schroeder  * mos7840_startup
2588*3f542974SPaul B Schroeder  ****************************************************************************/
2589*3f542974SPaul B Schroeder 
2590*3f542974SPaul B Schroeder static int mos7840_startup(struct usb_serial *serial)
2591*3f542974SPaul B Schroeder {
2592*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
2593*3f542974SPaul B Schroeder 	struct usb_device *dev;
2594*3f542974SPaul B Schroeder 	int i, status;
2595*3f542974SPaul B Schroeder 
2596*3f542974SPaul B Schroeder 	__u16 Data;
2597*3f542974SPaul B Schroeder 	dbg("%s \n", " mos7840_startup :entering..........");
2598*3f542974SPaul B Schroeder 
2599*3f542974SPaul B Schroeder 	if (!serial) {
2600*3f542974SPaul B Schroeder 		dbg("%s\n", "Invalid Handler");
2601*3f542974SPaul B Schroeder 		return -1;
2602*3f542974SPaul B Schroeder 	}
2603*3f542974SPaul B Schroeder 
2604*3f542974SPaul B Schroeder 	dev = serial->dev;
2605*3f542974SPaul B Schroeder 
2606*3f542974SPaul B Schroeder 	dbg("%s\n", "Entering...");
2607*3f542974SPaul B Schroeder 
2608*3f542974SPaul B Schroeder 	/* we set up the pointers to the endpoints in the mos7840_open *
2609*3f542974SPaul B Schroeder 	 * function, as the structures aren't created yet.             */
2610*3f542974SPaul B Schroeder 
2611*3f542974SPaul B Schroeder 	/* set up port private structures */
2612*3f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; ++i) {
2613*3f542974SPaul B Schroeder 		mos7840_port = kmalloc(sizeof(struct moschip_port), GFP_KERNEL);
2614*3f542974SPaul B Schroeder 		if (mos7840_port == NULL) {
2615*3f542974SPaul B Schroeder 			err("%s - Out of memory", __FUNCTION__);
2616*3f542974SPaul B Schroeder 			return -ENOMEM;
2617*3f542974SPaul B Schroeder 		}
2618*3f542974SPaul B Schroeder 		memset(mos7840_port, 0, sizeof(struct moschip_port));
2619*3f542974SPaul B Schroeder 
2620*3f542974SPaul B Schroeder 		/* Initialize all port interrupt end point to port 0 int endpoint *
2621*3f542974SPaul B Schroeder 		 * Our device has only one interrupt end point comman to all port */
2622*3f542974SPaul B Schroeder 
2623*3f542974SPaul B Schroeder 		mos7840_port->port = serial->port[i];
2624*3f542974SPaul B Schroeder 		mos7840_set_port_private(serial->port[i], mos7840_port);
2625*3f542974SPaul B Schroeder 
2626*3f542974SPaul B Schroeder 		mos7840_port->port_num = ((serial->port[i]->number -
2627*3f542974SPaul B Schroeder 					   (serial->port[i]->serial->minor)) +
2628*3f542974SPaul B Schroeder 					  1);
2629*3f542974SPaul B Schroeder 
2630*3f542974SPaul B Schroeder 		if (mos7840_port->port_num == 1) {
2631*3f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0x0;
2632*3f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0x1;
2633*3f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x4;
2634*3f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 2)
2635*3f542974SPaul B Schroeder 			   && (mos7840_num_ports == 4)) {
2636*3f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0x8;
2637*3f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0x9;
2638*3f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x16;
2639*3f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 2)
2640*3f542974SPaul B Schroeder 			   && (mos7840_num_ports == 2)) {
2641*3f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xa;
2642*3f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xb;
2643*3f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x19;
2644*3f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 3)
2645*3f542974SPaul B Schroeder 			   && (mos7840_num_ports == 4)) {
2646*3f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xa;
2647*3f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xb;
2648*3f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x19;
2649*3f542974SPaul B Schroeder 		} else if ((mos7840_port->port_num == 4)
2650*3f542974SPaul B Schroeder 			   && (mos7840_num_ports == 4)) {
2651*3f542974SPaul B Schroeder 			mos7840_port->SpRegOffset = 0xc;
2652*3f542974SPaul B Schroeder 			mos7840_port->ControlRegOffset = 0xd;
2653*3f542974SPaul B Schroeder 			mos7840_port->DcrRegOffset = 0x1c;
2654*3f542974SPaul B Schroeder 		}
2655*3f542974SPaul B Schroeder 		mos7840_dump_serial_port(mos7840_port);
2656*3f542974SPaul B Schroeder 
2657*3f542974SPaul B Schroeder 		mos7840_set_port_private(serial->port[i], mos7840_port);
2658*3f542974SPaul B Schroeder 
2659*3f542974SPaul B Schroeder 		//enable rx_disable bit in control register
2660*3f542974SPaul B Schroeder 
2661*3f542974SPaul B Schroeder 		status =
2662*3f542974SPaul B Schroeder 		    mos7840_get_reg_sync(serial->port[i],
2663*3f542974SPaul B Schroeder 					 mos7840_port->ControlRegOffset, &Data);
2664*3f542974SPaul B Schroeder 		if (status < 0) {
2665*3f542974SPaul B Schroeder 			dbg("Reading ControlReg failed status-0x%x\n", status);
2666*3f542974SPaul B Schroeder 			break;
2667*3f542974SPaul B Schroeder 		} else
2668*3f542974SPaul B Schroeder 			dbg("ControlReg Reading success val is %x, status%d\n",
2669*3f542974SPaul B Schroeder 			    Data, status);
2670*3f542974SPaul B Schroeder 		Data |= 0x08;	//setting driver done bit
2671*3f542974SPaul B Schroeder 		Data |= 0x04;	//sp1_bit to have cts change reflect in modem status reg
2672*3f542974SPaul B Schroeder 
2673*3f542974SPaul B Schroeder 		//Data |= 0x20; //rx_disable bit
2674*3f542974SPaul B Schroeder 		status = 0;
2675*3f542974SPaul B Schroeder 		status =
2676*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i],
2677*3f542974SPaul B Schroeder 					 mos7840_port->ControlRegOffset, Data);
2678*3f542974SPaul B Schroeder 		if (status < 0) {
2679*3f542974SPaul B Schroeder 			dbg("Writing ControlReg failed(rx_disable) status-0x%x\n", status);
2680*3f542974SPaul B Schroeder 			break;
2681*3f542974SPaul B Schroeder 		} else
2682*3f542974SPaul B Schroeder 			dbg("ControlReg Writing success(rx_disable) status%d\n",
2683*3f542974SPaul B Schroeder 			    status);
2684*3f542974SPaul B Schroeder 
2685*3f542974SPaul B Schroeder 		//Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2 and 0x24 in DCR3
2686*3f542974SPaul B Schroeder 		Data = 0x01;
2687*3f542974SPaul B Schroeder 		status = 0;
2688*3f542974SPaul B Schroeder 		status =
2689*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i],
2690*3f542974SPaul B Schroeder 					 (__u16) (mos7840_port->DcrRegOffset +
2691*3f542974SPaul B Schroeder 						  0), Data);
2692*3f542974SPaul B Schroeder 		if (status < 0) {
2693*3f542974SPaul B Schroeder 			dbg("Writing DCR0 failed status-0x%x\n", status);
2694*3f542974SPaul B Schroeder 			break;
2695*3f542974SPaul B Schroeder 		} else
2696*3f542974SPaul B Schroeder 			dbg("DCR0 Writing success status%d\n", status);
2697*3f542974SPaul B Schroeder 
2698*3f542974SPaul B Schroeder 		Data = 0x05;
2699*3f542974SPaul B Schroeder 		status = 0;
2700*3f542974SPaul B Schroeder 		status =
2701*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i],
2702*3f542974SPaul B Schroeder 					 (__u16) (mos7840_port->DcrRegOffset +
2703*3f542974SPaul B Schroeder 						  1), Data);
2704*3f542974SPaul B Schroeder 		if (status < 0) {
2705*3f542974SPaul B Schroeder 			dbg("Writing DCR1 failed status-0x%x\n", status);
2706*3f542974SPaul B Schroeder 			break;
2707*3f542974SPaul B Schroeder 		} else
2708*3f542974SPaul B Schroeder 			dbg("DCR1 Writing success status%d\n", status);
2709*3f542974SPaul B Schroeder 
2710*3f542974SPaul B Schroeder 		Data = 0x24;
2711*3f542974SPaul B Schroeder 		status = 0;
2712*3f542974SPaul B Schroeder 		status =
2713*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i],
2714*3f542974SPaul B Schroeder 					 (__u16) (mos7840_port->DcrRegOffset +
2715*3f542974SPaul B Schroeder 						  2), Data);
2716*3f542974SPaul B Schroeder 		if (status < 0) {
2717*3f542974SPaul B Schroeder 			dbg("Writing DCR2 failed status-0x%x\n", status);
2718*3f542974SPaul B Schroeder 			break;
2719*3f542974SPaul B Schroeder 		} else
2720*3f542974SPaul B Schroeder 			dbg("DCR2 Writing success status%d\n", status);
2721*3f542974SPaul B Schroeder 
2722*3f542974SPaul B Schroeder 		// write values in clkstart0x0 and clkmulti 0x20
2723*3f542974SPaul B Schroeder 		Data = 0x0;
2724*3f542974SPaul B Schroeder 		status = 0;
2725*3f542974SPaul B Schroeder 		status =
2726*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i],
2727*3f542974SPaul B Schroeder 					 CLK_START_VALUE_REGISTER, Data);
2728*3f542974SPaul B Schroeder 		if (status < 0) {
2729*3f542974SPaul B Schroeder 			dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x\n", status);
2730*3f542974SPaul B Schroeder 			break;
2731*3f542974SPaul B Schroeder 		} else
2732*3f542974SPaul B Schroeder 			dbg("CLK_START_VALUE_REGISTER Writing success status%d\n", status);
2733*3f542974SPaul B Schroeder 
2734*3f542974SPaul B Schroeder 		Data = 0x20;
2735*3f542974SPaul B Schroeder 		status = 0;
2736*3f542974SPaul B Schroeder 		status =
2737*3f542974SPaul B Schroeder 		    mos7840_set_reg_sync(serial->port[i], CLK_MULTI_REGISTER,
2738*3f542974SPaul B Schroeder 					 Data);
2739*3f542974SPaul B Schroeder 		if (status < 0) {
2740*3f542974SPaul B Schroeder 			dbg("Writing CLK_MULTI_REGISTER failed status-0x%x\n",
2741*3f542974SPaul B Schroeder 			    status);
2742*3f542974SPaul B Schroeder 			break;
2743*3f542974SPaul B Schroeder 		} else
2744*3f542974SPaul B Schroeder 			dbg("CLK_MULTI_REGISTER Writing success status%d\n",
2745*3f542974SPaul B Schroeder 			    status);
2746*3f542974SPaul B Schroeder 
2747*3f542974SPaul B Schroeder 		//write value 0x0 to scratchpad register
2748*3f542974SPaul B Schroeder 		Data = 0x00;
2749*3f542974SPaul B Schroeder 		status = 0;
2750*3f542974SPaul B Schroeder 		status =
2751*3f542974SPaul B Schroeder 		    mos7840_set_uart_reg(serial->port[i], SCRATCH_PAD_REGISTER,
2752*3f542974SPaul B Schroeder 					 Data);
2753*3f542974SPaul B Schroeder 		if (status < 0) {
2754*3f542974SPaul B Schroeder 			dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x\n",
2755*3f542974SPaul B Schroeder 			    status);
2756*3f542974SPaul B Schroeder 			break;
2757*3f542974SPaul B Schroeder 		} else
2758*3f542974SPaul B Schroeder 			dbg("SCRATCH_PAD_REGISTER Writing success status%d\n",
2759*3f542974SPaul B Schroeder 			    status);
2760*3f542974SPaul B Schroeder 
2761*3f542974SPaul B Schroeder 		//Zero Length flag register
2762*3f542974SPaul B Schroeder 		if ((mos7840_port->port_num != 1)
2763*3f542974SPaul B Schroeder 		    && (mos7840_num_ports == 2)) {
2764*3f542974SPaul B Schroeder 
2765*3f542974SPaul B Schroeder 			Data = 0xff;
2766*3f542974SPaul B Schroeder 			status = 0;
2767*3f542974SPaul B Schroeder 			status = mos7840_set_reg_sync(serial->port[i],
2768*3f542974SPaul B Schroeder 						      (__u16) (ZLP_REG1 +
2769*3f542974SPaul B Schroeder 							       ((__u16)
2770*3f542974SPaul B Schroeder 								mos7840_port->
2771*3f542974SPaul B Schroeder 								port_num)),
2772*3f542974SPaul B Schroeder 						      Data);
2773*3f542974SPaul B Schroeder 			dbg("ZLIP offset%x\n",
2774*3f542974SPaul B Schroeder 			    (__u16) (ZLP_REG1 +
2775*3f542974SPaul B Schroeder 				     ((__u16) mos7840_port->port_num)));
2776*3f542974SPaul B Schroeder 			if (status < 0) {
2777*3f542974SPaul B Schroeder 				dbg("Writing ZLP_REG%d failed status-0x%x\n",
2778*3f542974SPaul B Schroeder 				    i + 2, status);
2779*3f542974SPaul B Schroeder 				break;
2780*3f542974SPaul B Schroeder 			} else
2781*3f542974SPaul B Schroeder 				dbg("ZLP_REG%d Writing success status%d\n",
2782*3f542974SPaul B Schroeder 				    i + 2, status);
2783*3f542974SPaul B Schroeder 		} else {
2784*3f542974SPaul B Schroeder 			Data = 0xff;
2785*3f542974SPaul B Schroeder 			status = 0;
2786*3f542974SPaul B Schroeder 			status = mos7840_set_reg_sync(serial->port[i],
2787*3f542974SPaul B Schroeder 						      (__u16) (ZLP_REG1 +
2788*3f542974SPaul B Schroeder 							       ((__u16)
2789*3f542974SPaul B Schroeder 								mos7840_port->
2790*3f542974SPaul B Schroeder 								port_num) -
2791*3f542974SPaul B Schroeder 							       0x1), Data);
2792*3f542974SPaul B Schroeder 			dbg("ZLIP offset%x\n",
2793*3f542974SPaul B Schroeder 			    (__u16) (ZLP_REG1 +
2794*3f542974SPaul B Schroeder 				     ((__u16) mos7840_port->port_num) - 0x1));
2795*3f542974SPaul B Schroeder 			if (status < 0) {
2796*3f542974SPaul B Schroeder 				dbg("Writing ZLP_REG%d failed status-0x%x\n",
2797*3f542974SPaul B Schroeder 				    i + 1, status);
2798*3f542974SPaul B Schroeder 				break;
2799*3f542974SPaul B Schroeder 			} else
2800*3f542974SPaul B Schroeder 				dbg("ZLP_REG%d Writing success status%d\n",
2801*3f542974SPaul B Schroeder 				    i + 1, status);
2802*3f542974SPaul B Schroeder 
2803*3f542974SPaul B Schroeder 		}
2804*3f542974SPaul B Schroeder 		mos7840_port->control_urb = usb_alloc_urb(0, SLAB_ATOMIC);
2805*3f542974SPaul B Schroeder 		mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL);
2806*3f542974SPaul B Schroeder 
2807*3f542974SPaul B Schroeder 	}
2808*3f542974SPaul B Schroeder 
2809*3f542974SPaul B Schroeder 	//Zero Length flag enable
2810*3f542974SPaul B Schroeder 	Data = 0x0f;
2811*3f542974SPaul B Schroeder 	status = 0;
2812*3f542974SPaul B Schroeder 	status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data);
2813*3f542974SPaul B Schroeder 	if (status < 0) {
2814*3f542974SPaul B Schroeder 		dbg("Writing ZLP_REG5 failed status-0x%x\n", status);
2815*3f542974SPaul B Schroeder 		return -1;
2816*3f542974SPaul B Schroeder 	} else
2817*3f542974SPaul B Schroeder 		dbg("ZLP_REG5 Writing success status%d\n", status);
2818*3f542974SPaul B Schroeder 
2819*3f542974SPaul B Schroeder 	/* setting configuration feature to one */
2820*3f542974SPaul B Schroeder 	usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
2821*3f542974SPaul B Schroeder 			(__u8) 0x03, 0x00, 0x01, 0x00, 0x00, 0x00, 5 * HZ);
2822*3f542974SPaul B Schroeder 	return 0;
2823*3f542974SPaul B Schroeder }
2824*3f542974SPaul B Schroeder 
2825*3f542974SPaul B Schroeder /****************************************************************************
2826*3f542974SPaul B Schroeder  * mos7840_shutdown
2827*3f542974SPaul B Schroeder  *	This function is called whenever the device is removed from the usb bus.
2828*3f542974SPaul B Schroeder  ****************************************************************************/
2829*3f542974SPaul B Schroeder 
2830*3f542974SPaul B Schroeder static void mos7840_shutdown(struct usb_serial *serial)
2831*3f542974SPaul B Schroeder {
2832*3f542974SPaul B Schroeder 	int i;
2833*3f542974SPaul B Schroeder 	struct moschip_port *mos7840_port;
2834*3f542974SPaul B Schroeder 	dbg("%s \n", " shutdown :entering..........");
2835*3f542974SPaul B Schroeder 
2836*3f542974SPaul B Schroeder 	if (!serial) {
2837*3f542974SPaul B Schroeder 		dbg("%s", "Invalid Handler \n");
2838*3f542974SPaul B Schroeder 		return;
2839*3f542974SPaul B Schroeder 	}
2840*3f542974SPaul B Schroeder 
2841*3f542974SPaul B Schroeder 	/*      check for the ports to be closed,close the ports and disconnect         */
2842*3f542974SPaul B Schroeder 
2843*3f542974SPaul B Schroeder 	/* free private structure allocated for serial port  *
2844*3f542974SPaul B Schroeder 	 * stop reads and writes on all ports                */
2845*3f542974SPaul B Schroeder 
2846*3f542974SPaul B Schroeder 	for (i = 0; i < serial->num_ports; ++i) {
2847*3f542974SPaul B Schroeder 		mos7840_port = mos7840_get_port_private(serial->port[i]);
2848*3f542974SPaul B Schroeder 		kfree(mos7840_port->ctrl_buf);
2849*3f542974SPaul B Schroeder 		usb_kill_urb(mos7840_port->control_urb);
2850*3f542974SPaul B Schroeder 		kfree(mos7840_port);
2851*3f542974SPaul B Schroeder 		mos7840_set_port_private(serial->port[i], NULL);
2852*3f542974SPaul B Schroeder 	}
2853*3f542974SPaul B Schroeder 
2854*3f542974SPaul B Schroeder 	dbg("%s\n", "Thank u :: ");
2855*3f542974SPaul B Schroeder 
2856*3f542974SPaul B Schroeder }
2857*3f542974SPaul B Schroeder 
2858*3f542974SPaul B Schroeder static struct usb_serial_driver moschip7840_4port_device = {
2859*3f542974SPaul B Schroeder 	.driver = {
2860*3f542974SPaul B Schroeder 		   .owner = THIS_MODULE,
2861*3f542974SPaul B Schroeder 		   .name = "mos7840",
2862*3f542974SPaul B Schroeder 		   },
2863*3f542974SPaul B Schroeder 	.description = DRIVER_DESC,
2864*3f542974SPaul B Schroeder 	.id_table = moschip_port_id_table,
2865*3f542974SPaul B Schroeder 	.num_interrupt_in = 1,	//NUM_DONT_CARE,//1,
2866*3f542974SPaul B Schroeder #ifdef check
2867*3f542974SPaul B Schroeder 	.num_bulk_in = 4,
2868*3f542974SPaul B Schroeder 	.num_bulk_out = 4,
2869*3f542974SPaul B Schroeder 	.num_ports = 4,
2870*3f542974SPaul B Schroeder #endif
2871*3f542974SPaul B Schroeder 	.open = mos7840_open,
2872*3f542974SPaul B Schroeder 	.close = mos7840_close,
2873*3f542974SPaul B Schroeder 	.write = mos7840_write,
2874*3f542974SPaul B Schroeder 	.write_room = mos7840_write_room,
2875*3f542974SPaul B Schroeder 	.chars_in_buffer = mos7840_chars_in_buffer,
2876*3f542974SPaul B Schroeder 	.throttle = mos7840_throttle,
2877*3f542974SPaul B Schroeder 	.unthrottle = mos7840_unthrottle,
2878*3f542974SPaul B Schroeder 	.calc_num_ports = mos7840_calc_num_ports,
2879*3f542974SPaul B Schroeder #ifdef MCSSerialProbe
2880*3f542974SPaul B Schroeder 	.probe = mos7840_serial_probe,
2881*3f542974SPaul B Schroeder #endif
2882*3f542974SPaul B Schroeder 	.ioctl = mos7840_ioctl,
2883*3f542974SPaul B Schroeder 	.set_termios = mos7840_set_termios,
2884*3f542974SPaul B Schroeder 	.break_ctl = mos7840_break,
2885*3f542974SPaul B Schroeder 	.tiocmget = mos7840_tiocmget,
2886*3f542974SPaul B Schroeder 	.tiocmset = mos7840_tiocmset,
2887*3f542974SPaul B Schroeder 	.attach = mos7840_startup,
2888*3f542974SPaul B Schroeder 	.shutdown = mos7840_shutdown,
2889*3f542974SPaul B Schroeder 	.read_bulk_callback = mos7840_bulk_in_callback,
2890*3f542974SPaul B Schroeder 	.read_int_callback = mos7840_interrupt_callback,
2891*3f542974SPaul B Schroeder };
2892*3f542974SPaul B Schroeder 
2893*3f542974SPaul B Schroeder static struct usb_driver io_driver = {
2894*3f542974SPaul B Schroeder 	.name = "mos7840",
2895*3f542974SPaul B Schroeder 	.probe = usb_serial_probe,
2896*3f542974SPaul B Schroeder 	.disconnect = usb_serial_disconnect,
2897*3f542974SPaul B Schroeder 	.id_table = moschip_id_table_combined,
2898*3f542974SPaul B Schroeder };
2899*3f542974SPaul B Schroeder 
2900*3f542974SPaul B Schroeder /****************************************************************************
2901*3f542974SPaul B Schroeder  * moschip7840_init
2902*3f542974SPaul B Schroeder  *	This is called by the module subsystem, or on startup to initialize us
2903*3f542974SPaul B Schroeder  ****************************************************************************/
2904*3f542974SPaul B Schroeder static int __init moschip7840_init(void)
2905*3f542974SPaul B Schroeder {
2906*3f542974SPaul B Schroeder 	int retval;
2907*3f542974SPaul B Schroeder 
2908*3f542974SPaul B Schroeder 	dbg("%s \n", " mos7840_init :entering..........");
2909*3f542974SPaul B Schroeder 
2910*3f542974SPaul B Schroeder 	/* Register with the usb serial */
2911*3f542974SPaul B Schroeder 	retval = usb_serial_register(&moschip7840_4port_device);
2912*3f542974SPaul B Schroeder 
2913*3f542974SPaul B Schroeder 	if (retval)
2914*3f542974SPaul B Schroeder 		goto failed_port_device_register;
2915*3f542974SPaul B Schroeder 
2916*3f542974SPaul B Schroeder 	dbg("%s\n", "Entring...");
2917*3f542974SPaul B Schroeder 	info(DRIVER_DESC " " DRIVER_VERSION);
2918*3f542974SPaul B Schroeder 
2919*3f542974SPaul B Schroeder 	/* Register with the usb */
2920*3f542974SPaul B Schroeder 	retval = usb_register(&io_driver);
2921*3f542974SPaul B Schroeder 
2922*3f542974SPaul B Schroeder 	if (retval)
2923*3f542974SPaul B Schroeder 		goto failed_usb_register;
2924*3f542974SPaul B Schroeder 
2925*3f542974SPaul B Schroeder 	if (retval == 0) {
2926*3f542974SPaul B Schroeder 		dbg("%s\n", "Leaving...");
2927*3f542974SPaul B Schroeder 		return 0;
2928*3f542974SPaul B Schroeder 	}
2929*3f542974SPaul B Schroeder 
2930*3f542974SPaul B Schroeder       failed_usb_register:
2931*3f542974SPaul B Schroeder 	usb_serial_deregister(&moschip7840_4port_device);
2932*3f542974SPaul B Schroeder 
2933*3f542974SPaul B Schroeder       failed_port_device_register:
2934*3f542974SPaul B Schroeder 
2935*3f542974SPaul B Schroeder 	return retval;
2936*3f542974SPaul B Schroeder }
2937*3f542974SPaul B Schroeder 
2938*3f542974SPaul B Schroeder /****************************************************************************
2939*3f542974SPaul B Schroeder  * moschip7840_exit
2940*3f542974SPaul B Schroeder  *	Called when the driver is about to be unloaded.
2941*3f542974SPaul B Schroeder  ****************************************************************************/
2942*3f542974SPaul B Schroeder static void __exit moschip7840_exit(void)
2943*3f542974SPaul B Schroeder {
2944*3f542974SPaul B Schroeder 
2945*3f542974SPaul B Schroeder 	dbg("%s \n", " mos7840_exit :entering..........");
2946*3f542974SPaul B Schroeder 
2947*3f542974SPaul B Schroeder 	usb_deregister(&io_driver);
2948*3f542974SPaul B Schroeder 
2949*3f542974SPaul B Schroeder 	usb_serial_deregister(&moschip7840_4port_device);
2950*3f542974SPaul B Schroeder 
2951*3f542974SPaul B Schroeder 	dbg("%s\n", "Entring...");
2952*3f542974SPaul B Schroeder }
2953*3f542974SPaul B Schroeder 
2954*3f542974SPaul B Schroeder module_init(moschip7840_init);
2955*3f542974SPaul B Schroeder module_exit(moschip7840_exit);
2956*3f542974SPaul B Schroeder 
2957*3f542974SPaul B Schroeder /* Module information */
2958*3f542974SPaul B Schroeder MODULE_DESCRIPTION(DRIVER_DESC);
2959*3f542974SPaul B Schroeder MODULE_LICENSE("GPL");
2960*3f542974SPaul B Schroeder 
2961*3f542974SPaul B Schroeder module_param(debug, bool, S_IRUGO | S_IWUSR);
2962*3f542974SPaul B Schroeder MODULE_PARM_DESC(debug, "Debug enabled or not");
2963