mos7840.c 80.9 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35
/*
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 * Clean ups from Moschip version and a few ioctl implementations by:
 *	Paul B Schroeder <pschroeder "at" uplogix "dot" com>
 *
 * Originally based on drivers/usb/serial/io_edgeport.c which is:
 *      Copyright (C) 2000 Inside Out Networks, All rights reserved.
 *      Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com>
 *
 */

#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/serial.h>
#include <linux/usb.h>
#include <linux/usb/serial.h>
36
#include <linux/uaccess.h>
37 38 39 40

/*
 * Version Information
 */
41
#define DRIVER_VERSION "1.3.2"
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84
#define DRIVER_DESC "Moschip 7840/7820 USB Serial Driver"

/*
 * 16C50 UART register defines
 */

#define LCR_BITS_5             0x00	/* 5 bits/char */
#define LCR_BITS_6             0x01	/* 6 bits/char */
#define LCR_BITS_7             0x02	/* 7 bits/char */
#define LCR_BITS_8             0x03	/* 8 bits/char */
#define LCR_BITS_MASK          0x03	/* Mask for bits/char field */

#define LCR_STOP_1             0x00	/* 1 stop bit */
#define LCR_STOP_1_5           0x04	/* 1.5 stop bits (if 5   bits/char) */
#define LCR_STOP_2             0x04	/* 2 stop bits   (if 6-8 bits/char) */
#define LCR_STOP_MASK          0x04	/* Mask for stop bits field */

#define LCR_PAR_NONE           0x00	/* No parity */
#define LCR_PAR_ODD            0x08	/* Odd parity */
#define LCR_PAR_EVEN           0x18	/* Even parity */
#define LCR_PAR_MARK           0x28	/* Force parity bit to 1 */
#define LCR_PAR_SPACE          0x38	/* Force parity bit to 0 */
#define LCR_PAR_MASK           0x38	/* Mask for parity field */

#define LCR_SET_BREAK          0x40	/* Set Break condition */
#define LCR_DL_ENABLE          0x80	/* Enable access to divisor latch */

#define MCR_DTR                0x01	/* Assert DTR */
#define MCR_RTS                0x02	/* Assert RTS */
#define MCR_OUT1               0x04	/* Loopback only: Sets state of RI */
#define MCR_MASTER_IE          0x08	/* Enable interrupt outputs */
#define MCR_LOOPBACK           0x10	/* Set internal (digital) loopback mode */
#define MCR_XON_ANY            0x20	/* Enable any char to exit XOFF mode */

#define MOS7840_MSR_CTS        0x10	/* Current state of CTS */
#define MOS7840_MSR_DSR        0x20	/* Current state of DSR */
#define MOS7840_MSR_RI         0x40	/* Current state of RI */
#define MOS7840_MSR_CD         0x80	/* Current state of CD */

/*
 * Defines used for sending commands to port
 */

85 86
#define WAIT_FOR_EVER   (HZ * 0)	/* timeout urb is wait for ever */
#define MOS_WDR_TIMEOUT (HZ * 5)	/* default urb timeout */
87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104

#define MOS_PORT1       0x0200
#define MOS_PORT2       0x0300
#define MOS_VENREG      0x0000
#define MOS_MAX_PORT	0x02
#define MOS_WRITE       0x0E
#define MOS_READ        0x0D

/* Requests */
#define MCS_RD_RTYPE    0xC0
#define MCS_WR_RTYPE    0x40
#define MCS_RDREQ       0x0D
#define MCS_WRREQ       0x0E
#define MCS_CTRL_TIMEOUT        500
#define VENDOR_READ_LENGTH      (0x01)

#define MAX_NAME_LEN    64

105 106
#define ZLP_REG1  0x3A		/* Zero_Flag_Reg1    58 */
#define ZLP_REG5  0x3E		/* Zero_Flag_Reg5    62 */
107 108 109 110 111 112

/* For higher baud Rates use TIOCEXBAUD */
#define TIOCEXBAUD     0x5462

/* vendor id and device id defines */

113
/* The native mos7840/7820 component */
114 115 116
#define USB_VENDOR_ID_MOSCHIP           0x9710
#define MOSCHIP_DEVICE_ID_7840          0x7840
#define MOSCHIP_DEVICE_ID_7820          0x7820
117
#define MOSCHIP_DEVICE_ID_7810          0x7810
118 119 120 121 122
/* The native component can have its vendor/device id's overridden
 * in vendor-specific implementations.  Such devices can be handled
 * by making a change here, in moschip_port_id_table, and in
 * moschip_id_table_combined
 */
123 124 125 126 127 128 129 130 131 132 133 134 135 136
#define USB_VENDOR_ID_BANDB              0x0856
#define BANDB_DEVICE_ID_USO9ML2_2        0xAC22
#define BANDB_DEVICE_ID_USO9ML2_2P       0xBC00
#define BANDB_DEVICE_ID_USO9ML2_4        0xAC24
#define BANDB_DEVICE_ID_USO9ML2_4P       0xBC01
#define BANDB_DEVICE_ID_US9ML2_2         0xAC29
#define BANDB_DEVICE_ID_US9ML2_4         0xAC30
#define BANDB_DEVICE_ID_USPTL4_2         0xAC31
#define BANDB_DEVICE_ID_USPTL4_4         0xAC32
#define BANDB_DEVICE_ID_USOPTL4_2        0xAC42
#define BANDB_DEVICE_ID_USOPTL4_2P       0xBC02
#define BANDB_DEVICE_ID_USOPTL4_4        0xAC44
#define BANDB_DEVICE_ID_USOPTL4_4P       0xBC03
#define BANDB_DEVICE_ID_USOPTL2_4        0xAC24
137

138 139 140 141
/* This driver also supports
 * ATEN UC2324 device using Moschip MCS7840
 * ATEN UC2322 device using Moschip MCS7820
 */
T
Tony Cook 已提交
142 143
#define USB_VENDOR_ID_ATENINTL		0x0557
#define ATENINTL_DEVICE_ID_UC2324	0x2011
144
#define ATENINTL_DEVICE_ID_UC2322	0x7820
T
Tony Cook 已提交
145

146
/* Interrupt Routine Defines    */
147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164

#define SERIAL_IIR_RLS      0x06
#define SERIAL_IIR_MS       0x00

/*
 *  Emulation of the bit mask on the LINE STATUS REGISTER.
 */
#define SERIAL_LSR_DR       0x0001
#define SERIAL_LSR_OE       0x0002
#define SERIAL_LSR_PE       0x0004
#define SERIAL_LSR_FE       0x0008
#define SERIAL_LSR_BI       0x0010

#define MOS_MSR_DELTA_CTS   0x10
#define MOS_MSR_DELTA_DSR   0x20
#define MOS_MSR_DELTA_RI    0x40
#define MOS_MSR_DELTA_CD    0x80

165
/* Serial Port register Address */
166 167 168 169 170 171 172 173 174 175 176 177
#define INTERRUPT_ENABLE_REGISTER  ((__u16)(0x01))
#define FIFO_CONTROL_REGISTER      ((__u16)(0x02))
#define LINE_CONTROL_REGISTER      ((__u16)(0x03))
#define MODEM_CONTROL_REGISTER     ((__u16)(0x04))
#define LINE_STATUS_REGISTER       ((__u16)(0x05))
#define MODEM_STATUS_REGISTER      ((__u16)(0x06))
#define SCRATCH_PAD_REGISTER       ((__u16)(0x07))
#define DIVISOR_LATCH_LSB          ((__u16)(0x00))
#define DIVISOR_LATCH_MSB          ((__u16)(0x01))

#define CLK_MULTI_REGISTER         ((__u16)(0x02))
#define CLK_START_VALUE_REGISTER   ((__u16)(0x03))
178
#define GPIO_REGISTER              ((__u16)(0x07))
179 180 181 182 183 184 185 186 187

#define SERIAL_LCR_DLAB            ((__u16)(0x0080))

/*
 * URB POOL related defines
 */
#define NUM_URBS                        16	/* URB Count */
#define URB_TRANSFER_BUFFER_SIZE        32	/* URB Size  */

188 189 190 191 192
/* LED on/off milliseconds*/
#define LED_ON_MS	500
#define LED_OFF_MS	500

static int device_type;
193

194
static const struct usb_device_id moschip_port_id_table[] = {
195 196
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
197
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7810)},
198
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_2)},
199
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_2P)},
200
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_4)},
201
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_4P)},
202 203 204 205
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_US9ML2_2)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_US9ML2_4)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USPTL4_2)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USPTL4_4)},
206
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
207
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2P)},
208
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
209
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4P)},
210
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL2_4)},
T
Tony Cook 已提交
211
	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
212
	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
213 214 215
	{}			/* terminating entry */
};

216
static const struct usb_device_id moschip_id_table_combined[] __devinitconst = {
217 218
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7840)},
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7820)},
219
	{USB_DEVICE(USB_VENDOR_ID_MOSCHIP, MOSCHIP_DEVICE_ID_7810)},
220
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_2)},
221
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_2P)},
222
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_4)},
223
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USO9ML2_4P)},
224 225 226 227
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_US9ML2_2)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_US9ML2_4)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USPTL4_2)},
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USPTL4_4)},
228
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2)},
229
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_2P)},
230
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4)},
231
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL4_4P)},
232
	{USB_DEVICE(USB_VENDOR_ID_BANDB, BANDB_DEVICE_ID_USOPTL2_4)},
T
Tony Cook 已提交
233
	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2324)},
234
	{USB_DEVICE(USB_VENDOR_ID_ATENINTL, ATENINTL_DEVICE_ID_UC2322)},
235 236 237 238 239 240 241 242 243 244 245
	{}			/* terminating entry */
};

MODULE_DEVICE_TABLE(usb, moschip_id_table_combined);

/* This structure holds all of the local port information */

struct moschip_port {
	int port_num;		/*Actual port number in the device(1,2,etc) */
	struct urb *write_urb;	/* write URB for this port */
	struct urb *read_urb;	/* read URB for this port */
O
Oliver Neukum 已提交
246
	struct urb *int_urb;
247 248 249
	__u8 shadowLCR;		/* last LCR value received */
	__u8 shadowMCR;		/* last MCR value received */
	char open;
O
Oliver Neukum 已提交
250 251
	char open_ports;
	char zombie;
252 253 254 255 256 257
	wait_queue_head_t wait_chase;	/* for handling sleeping while waiting for chase to finish */
	wait_queue_head_t delta_msr_wait;	/* for handling sleeping while waiting for msr change to happen */
	int delta_msr_cond;
	struct async_icount icount;
	struct usb_serial_port *port;	/* loop back to the owner of this object */

258
	/* Offsets */
259 260 261
	__u8 SpRegOffset;
	__u8 ControlRegOffset;
	__u8 DcrRegOffset;
262
	/* for processing control URBS in interrupt context */
263
	struct urb *control_urb;
O
Oliver Neukum 已提交
264
	struct usb_ctrlrequest *dr;
265 266 267
	char *ctrl_buf;
	int MsrLsr;

O
Oliver Neukum 已提交
268
	spinlock_t pool_lock;
269
	struct urb *write_urb_pool[NUM_URBS];
O
Oliver Neukum 已提交
270
	char busy[NUM_URBS];
271
	bool read_urb_busy;
272

273 274 275 276 277 278
	/* For device(s) with LED indicator */
	bool has_led;
	bool led_flag;
	struct timer_list led_timer1;	/* Timer for LED on */
	struct timer_list led_timer2;	/* Timer for LED off */
};
279

280
static bool debug;
281 282 283 284 285 286 287 288 289 290 291 292

/*
 * mos7840_set_reg_sync
 * 	To set the Control register by calling usb_fill_control_urb function
 *	by passing usb_sndctrlpipe function as parameter.
 */

static int mos7840_set_reg_sync(struct usb_serial_port *port, __u16 reg,
				__u16 val)
{
	struct usb_device *dev = port->serial->dev;
	val = val & 0x00ff;
T
Tony Cook 已提交
293
	dbg("mos7840_set_reg_sync offset is %x, value %x", reg, val);
294 295 296 297 298 299 300 301 302 303 304 305 306

	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
			       MCS_WR_RTYPE, val, reg, NULL, 0,
			       MOS_WDR_TIMEOUT);
}

/*
 * mos7840_get_reg_sync
 * 	To set the Uart register by calling usb_fill_control_urb function by
 *	passing usb_rcvctrlpipe function as parameter.
 */

static int mos7840_get_reg_sync(struct usb_serial_port *port, __u16 reg,
307
				__u16 *val)
308 309 310
{
	struct usb_device *dev = port->serial->dev;
	int ret = 0;
311 312 313 314 315
	u8 *buf;

	buf = kmalloc(VENDOR_READ_LENGTH, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;
316 317

	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
318
			      MCS_RD_RTYPE, 0, reg, buf, VENDOR_READ_LENGTH,
319
			      MOS_WDR_TIMEOUT);
320
	*val = buf[0];
T
Tony Cook 已提交
321
	dbg("mos7840_get_reg_sync offset is %x, return val %x", reg, *val);
322 323

	kfree(buf);
324 325 326 327 328 329 330 331 332 333 334 335 336 337 338
	return ret;
}

/*
 * mos7840_set_uart_reg
 *	To set the Uart register by calling usb_fill_control_urb function by
 *	passing usb_sndctrlpipe function as parameter.
 */

static int mos7840_set_uart_reg(struct usb_serial_port *port, __u16 reg,
				__u16 val)
{

	struct usb_device *dev = port->serial->dev;
	val = val & 0x00ff;
339 340
	/* For the UART control registers, the application number need
	   to be Or'ed */
O
Oliver Neukum 已提交
341
	if (port->serial->num_ports == 4) {
342 343
		val |= (((__u16) port->number -
				(__u16) (port->serial->minor)) + 1) << 8;
T
Tony Cook 已提交
344
		dbg("mos7840_set_uart_reg application number is %x", val);
345 346
	} else {
		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
347
			val |= (((__u16) port->number -
348
			      (__u16) (port->serial->minor)) + 1) << 8;
T
Tony Cook 已提交
349
			dbg("mos7840_set_uart_reg application number is %x",
350 351 352 353 354
			    val);
		} else {
			val |=
			    (((__u16) port->number -
			      (__u16) (port->serial->minor)) + 2) << 8;
T
Tony Cook 已提交
355
			dbg("mos7840_set_uart_reg application number is %x",
356 357 358 359 360 361 362 363 364 365 366 367 368 369 370
			    val);
		}
	}
	return usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ,
			       MCS_WR_RTYPE, val, reg, NULL, 0,
			       MOS_WDR_TIMEOUT);

}

/*
 * mos7840_get_uart_reg
 *	To set the Control register by calling usb_fill_control_urb function
 *	by passing usb_rcvctrlpipe function as parameter.
 */
static int mos7840_get_uart_reg(struct usb_serial_port *port, __u16 reg,
371
				__u16 *val)
372 373 374 375
{
	struct usb_device *dev = port->serial->dev;
	int ret = 0;
	__u16 Wval;
376 377 378 379 380
	u8 *buf;

	buf = kmalloc(VENDOR_READ_LENGTH, GFP_KERNEL);
	if (!buf)
		return -ENOMEM;
381

T
Tony Cook 已提交
382
	/* dbg("application number is %4x",
383 384
	    (((__u16)port->number - (__u16)(port->serial->minor))+1)<<8); */
	/* Wval  is same as application number */
O
Oliver Neukum 已提交
385
	if (port->serial->num_ports == 4) {
386 387 388
		Wval =
		    (((__u16) port->number - (__u16) (port->serial->minor)) +
		     1) << 8;
T
Tony Cook 已提交
389
		dbg("mos7840_get_uart_reg application number is %x", Wval);
390 391
	} else {
		if (((__u16) port->number - (__u16) (port->serial->minor)) == 0) {
392
			Wval = (((__u16) port->number -
393
			      (__u16) (port->serial->minor)) + 1) << 8;
T
Tony Cook 已提交
394
			dbg("mos7840_get_uart_reg application number is %x",
395 396
			    Wval);
		} else {
397
			Wval = (((__u16) port->number -
398
			      (__u16) (port->serial->minor)) + 2) << 8;
T
Tony Cook 已提交
399
			dbg("mos7840_get_uart_reg application number is %x",
400 401 402 403
			    Wval);
		}
	}
	ret = usb_control_msg(dev, usb_rcvctrlpipe(dev, 0), MCS_RDREQ,
404
			      MCS_RD_RTYPE, Wval, reg, buf, VENDOR_READ_LENGTH,
405
			      MOS_WDR_TIMEOUT);
406 407 408
	*val = buf[0];

	kfree(buf);
409 410 411 412 413 414
	return ret;
}

static void mos7840_dump_serial_port(struct moschip_port *mos7840_port)
{

T
Tony Cook 已提交
415 416 417 418 419
	dbg("***************************************");
	dbg("SpRegOffset is %2x", mos7840_port->SpRegOffset);
	dbg("ControlRegOffset is %2x", mos7840_port->ControlRegOffset);
	dbg("DCRRegOffset is %2x", mos7840_port->DcrRegOffset);
	dbg("***************************************");
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442

}

/************************************************************************/
/************************************************************************/
/*             I N T E R F A C E   F U N C T I O N S			*/
/*             I N T E R F A C E   F U N C T I O N S			*/
/************************************************************************/
/************************************************************************/

static inline void mos7840_set_port_private(struct usb_serial_port *port,
					    struct moschip_port *data)
{
	usb_set_serial_port_data(port, (void *)data);
}

static inline struct moschip_port *mos7840_get_port_private(struct
							    usb_serial_port
							    *port)
{
	return (struct moschip_port *)usb_get_serial_port_data(port);
}

O
Oliver Neukum 已提交
443
static void mos7840_handle_new_msr(struct moschip_port *port, __u8 new_msr)
444 445 446 447 448 449 450 451 452 453 454 455 456
{
	struct moschip_port *mos7840_port;
	struct async_icount *icount;
	mos7840_port = port;
	icount = &mos7840_port->icount;
	if (new_msr &
	    (MOS_MSR_DELTA_CTS | MOS_MSR_DELTA_DSR | MOS_MSR_DELTA_RI |
	     MOS_MSR_DELTA_CD)) {
		icount = &mos7840_port->icount;

		/* update input line counters */
		if (new_msr & MOS_MSR_DELTA_CTS) {
			icount->cts++;
O
Oliver Neukum 已提交
457
			smp_wmb();
458 459 460
		}
		if (new_msr & MOS_MSR_DELTA_DSR) {
			icount->dsr++;
O
Oliver Neukum 已提交
461
			smp_wmb();
462 463 464
		}
		if (new_msr & MOS_MSR_DELTA_CD) {
			icount->dcd++;
O
Oliver Neukum 已提交
465
			smp_wmb();
466 467 468
		}
		if (new_msr & MOS_MSR_DELTA_RI) {
			icount->rng++;
O
Oliver Neukum 已提交
469
			smp_wmb();
470 471 472 473
		}
	}
}

O
Oliver Neukum 已提交
474
static void mos7840_handle_new_lsr(struct moschip_port *port, __u8 new_lsr)
475 476 477
{
	struct async_icount *icount;

478
	dbg("%s - %02x", __func__, new_lsr);
479 480

	if (new_lsr & SERIAL_LSR_BI) {
481 482 483 484 485
		/*
		 * Parity and Framing errors only count if they
		 * occur exclusive of a break being
		 * received.
		 */
486 487 488 489 490 491 492
		new_lsr &= (__u8) (SERIAL_LSR_OE | SERIAL_LSR_BI);
	}

	/* update input line counters */
	icount = &port->icount;
	if (new_lsr & SERIAL_LSR_BI) {
		icount->brk++;
O
Oliver Neukum 已提交
493
		smp_wmb();
494 495 496
	}
	if (new_lsr & SERIAL_LSR_OE) {
		icount->overrun++;
O
Oliver Neukum 已提交
497
		smp_wmb();
498 499 500
	}
	if (new_lsr & SERIAL_LSR_PE) {
		icount->parity++;
O
Oliver Neukum 已提交
501
		smp_wmb();
502 503 504
	}
	if (new_lsr & SERIAL_LSR_FE) {
		icount->frame++;
O
Oliver Neukum 已提交
505
		smp_wmb();
506 507 508 509 510 511 512 513 514 515
	}
}

/************************************************************************/
/************************************************************************/
/*            U S B  C A L L B A C K   F U N C T I O N S                */
/*            U S B  C A L L B A C K   F U N C T I O N S                */
/************************************************************************/
/************************************************************************/

516
static void mos7840_control_callback(struct urb *urb)
517 518 519 520
{
	unsigned char *data;
	struct moschip_port *mos7840_port;
	__u8 regval = 0x0;
O
Oliver Neukum 已提交
521
	int result = 0;
522
	int status = urb->status;
523

524
	mos7840_port = urb->context;
O
Oliver Neukum 已提交
525

526
	switch (status) {
527 528 529 530 531 532 533
	case 0:
		/* success */
		break;
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* this urb is terminated, clean up */
534
		dbg("%s - urb shutting down with status: %d", __func__,
535
		    status);
536 537
		return;
	default:
538
		dbg("%s - nonzero urb status received: %d", __func__,
539
		    status);
540 541 542
		goto exit;
	}

T
Tony Cook 已提交
543 544
	dbg("%s urb buffer size is %d", __func__, urb->actual_length);
	dbg("%s mos7840_port->MsrLsr is %d port %d", __func__,
545 546 547
	    mos7840_port->MsrLsr, mos7840_port->port_num);
	data = urb->transfer_buffer;
	regval = (__u8) data[0];
T
Tony Cook 已提交
548
	dbg("%s data is %x", __func__, regval);
549 550 551 552 553
	if (mos7840_port->MsrLsr == 0)
		mos7840_handle_new_msr(mos7840_port, regval);
	else if (mos7840_port->MsrLsr == 1)
		mos7840_handle_new_lsr(mos7840_port, regval);

O
Oliver Neukum 已提交
554 555 556 557 558 559 560 561
exit:
	spin_lock(&mos7840_port->pool_lock);
	if (!mos7840_port->zombie)
		result = usb_submit_urb(mos7840_port->int_urb, GFP_ATOMIC);
	spin_unlock(&mos7840_port->pool_lock);
	if (result) {
		dev_err(&urb->dev->dev,
			"%s - Error %d submitting interrupt urb\n",
562
			__func__, result);
O
Oliver Neukum 已提交
563
	}
564 565 566
}

static int mos7840_get_reg(struct moschip_port *mcs, __u16 Wval, __u16 reg,
567
			   __u16 *val)
568 569
{
	struct usb_device *dev = mcs->port->serial->dev;
O
Oliver Neukum 已提交
570 571 572
	struct usb_ctrlrequest *dr = mcs->dr;
	unsigned char *buffer = mcs->ctrl_buf;
	int ret;
573 574 575

	dr->bRequestType = MCS_RD_RTYPE;
	dr->bRequest = MCS_RDREQ;
576
	dr->wValue = cpu_to_le16(Wval);	/* 0 */
577 578 579 580 581 582 583 584 585 586 587
	dr->wIndex = cpu_to_le16(reg);
	dr->wLength = cpu_to_le16(2);

	usb_fill_control_urb(mcs->control_urb, dev, usb_rcvctrlpipe(dev, 0),
			     (unsigned char *)dr, buffer, 2,
			     mos7840_control_callback, mcs);
	mcs->control_urb->transfer_buffer_length = 2;
	ret = usb_submit_urb(mcs->control_urb, GFP_ATOMIC);
	return ret;
}

588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650
static void mos7840_set_led_callback(struct urb *urb)
{
	switch (urb->status) {
	case 0:
		/* Success */
		break;
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* This urb is terminated, clean up */
		dbg("%s - urb shutting down with status: %d", __func__,
			urb->status);
		break;
	default:
		dbg("%s - nonzero urb status received: %d", __func__,
			urb->status);
	}
}

static void mos7840_set_led_async(struct moschip_port *mcs, __u16 wval,
				__u16 reg)
{
	struct usb_device *dev = mcs->port->serial->dev;
	struct usb_ctrlrequest *dr = mcs->dr;

	dr->bRequestType = MCS_WR_RTYPE;
	dr->bRequest = MCS_WRREQ;
	dr->wValue = cpu_to_le16(wval);
	dr->wIndex = cpu_to_le16(reg);
	dr->wLength = cpu_to_le16(0);

	usb_fill_control_urb(mcs->control_urb, dev, usb_sndctrlpipe(dev, 0),
		(unsigned char *)dr, NULL, 0, mos7840_set_led_callback, NULL);

	usb_submit_urb(mcs->control_urb, GFP_ATOMIC);
}

static void mos7840_set_led_sync(struct usb_serial_port *port, __u16 reg,
				__u16 val)
{
	struct usb_device *dev = port->serial->dev;

	usb_control_msg(dev, usb_sndctrlpipe(dev, 0), MCS_WRREQ, MCS_WR_RTYPE,
			val, reg, NULL, 0, MOS_WDR_TIMEOUT);
}

static void mos7840_led_off(unsigned long arg)
{
	struct moschip_port *mcs = (struct moschip_port *) arg;

	/* Turn off LED */
	mos7840_set_led_async(mcs, 0x0300, MODEM_CONTROL_REGISTER);
	mod_timer(&mcs->led_timer2,
				jiffies + msecs_to_jiffies(LED_OFF_MS));
}

static void mos7840_led_flag_off(unsigned long arg)
{
	struct moschip_port *mcs = (struct moschip_port *) arg;

	mcs->led_flag = false;
}

651 652 653 654 655 656
/*****************************************************************************
 * mos7840_interrupt_callback
 *	this is the callback function for when we have received data on the
 *	interrupt endpoint.
 *****************************************************************************/

657
static void mos7840_interrupt_callback(struct urb *urb)
658 659 660 661 662 663 664 665
{
	int result;
	int length;
	struct moschip_port *mos7840_port;
	struct usb_serial *serial;
	__u16 Data;
	unsigned char *data;
	__u8 sp[5], st;
O
Oliver Neukum 已提交
666 667
	int i, rv = 0;
	__u16 wval, wreg = 0;
668
	int status = urb->status;
669

T
Tony Cook 已提交
670
	dbg("%s", " : Entering");
671

672
	switch (status) {
673 674 675 676 677 678 679
	case 0:
		/* success */
		break;
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* this urb is terminated, clean up */
680
		dbg("%s - urb shutting down with status: %d", __func__,
681
		    status);
682 683
		return;
	default:
684
		dbg("%s - nonzero urb status received: %d", __func__,
685
		    status);
686 687 688 689 690 691
		goto exit;
	}

	length = urb->actual_length;
	data = urb->transfer_buffer;

692
	serial = urb->context;
693 694 695 696 697 698 699 700 701

	/* Moschip get 5 bytes
	 * Byte 1 IIR Port 1 (port.number is 0)
	 * Byte 2 IIR Port 2 (port.number is 1)
	 * Byte 3 IIR Port 3 (port.number is 2)
	 * Byte 4 IIR Port 4 (port.number is 3)
	 * Byte 5 FIFO status for both */

	if (length && length > 5) {
T
Tony Cook 已提交
702
		dbg("%s", "Wrong data !!!");
703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718
		return;
	}

	sp[0] = (__u8) data[0];
	sp[1] = (__u8) data[1];
	sp[2] = (__u8) data[2];
	sp[3] = (__u8) data[3];
	st = (__u8) data[4];

	for (i = 0; i < serial->num_ports; i++) {
		mos7840_port = mos7840_get_port_private(serial->port[i]);
		wval =
		    (((__u16) serial->port[i]->number -
		      (__u16) (serial->minor)) + 1) << 8;
		if (mos7840_port->open) {
			if (sp[i] & 0x01) {
T
Tony Cook 已提交
719
				dbg("SP%d No Interrupt !!!", i);
720 721 722 723
			} else {
				switch (sp[i] & 0x0f) {
				case SERIAL_IIR_RLS:
					dbg("Serial Port %d: Receiver status error or ", i);
T
Tony Cook 已提交
724
					dbg("address bit detected in 9-bit mode");
725
					mos7840_port->MsrLsr = 1;
O
Oliver Neukum 已提交
726
					wreg = LINE_STATUS_REGISTER;
727 728
					break;
				case SERIAL_IIR_MS:
T
Tony Cook 已提交
729
					dbg("Serial Port %d: Modem status change", i);
730
					mos7840_port->MsrLsr = 0;
O
Oliver Neukum 已提交
731
					wreg = MODEM_STATUS_REGISTER;
732 733
					break;
				}
O
Oliver Neukum 已提交
734 735 736 737 738 739 740 741
				spin_lock(&mos7840_port->pool_lock);
				if (!mos7840_port->zombie) {
					rv = mos7840_get_reg(mos7840_port, wval, wreg, &Data);
				} else {
					spin_unlock(&mos7840_port->pool_lock);
					return;
				}
				spin_unlock(&mos7840_port->pool_lock);
742 743 744
			}
		}
	}
745 746
	if (!(rv < 0))
		/* the completion handler for the control urb will resubmit */
O
Oliver Neukum 已提交
747 748
		return;
exit:
749 750 751 752
	result = usb_submit_urb(urb, GFP_ATOMIC);
	if (result) {
		dev_err(&urb->dev->dev,
			"%s - Error %d submitting interrupt urb\n",
753
			__func__, result);
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794
	}
}

static int mos7840_port_paranoia_check(struct usb_serial_port *port,
				       const char *function)
{
	if (!port) {
		dbg("%s - port == NULL", function);
		return -1;
	}
	if (!port->serial) {
		dbg("%s - port->serial == NULL", function);
		return -1;
	}

	return 0;
}

/* Inline functions to check the sanity of a pointer that is passed to us */
static int mos7840_serial_paranoia_check(struct usb_serial *serial,
					 const char *function)
{
	if (!serial) {
		dbg("%s - serial == NULL", function);
		return -1;
	}
	if (!serial->type) {
		dbg("%s - serial->type == NULL!", function);
		return -1;
	}

	return 0;
}

static struct usb_serial *mos7840_get_usb_serial(struct usb_serial_port *port,
						 const char *function)
{
	/* if no port was specified, or it fails a paranoia check */
	if (!port ||
	    mos7840_port_paranoia_check(port, function) ||
	    mos7840_serial_paranoia_check(port->serial, function)) {
795 796
		/* then say that we don't have a valid usb_serial thing,
		 * which will end up genrating -ENODEV return values */
797 798 799 800 801 802 803 804 805 806 807 808
		return NULL;
	}

	return port->serial;
}

/*****************************************************************************
 * mos7840_bulk_in_callback
 *	this is the callback function for when we have received data on the
 *	bulk in endpoint.
 *****************************************************************************/

809
static void mos7840_bulk_in_callback(struct urb *urb)
810
{
811
	int retval;
812 813 814 815 816
	unsigned char *data;
	struct usb_serial *serial;
	struct usb_serial_port *port;
	struct moschip_port *mos7840_port;
	struct tty_struct *tty;
817
	int status = urb->status;
818

819
	mos7840_port = urb->context;
820
	if (!mos7840_port) {
T
Tony Cook 已提交
821
		dbg("%s", "NULL mos7840_port pointer");
822 823 824 825 826 827
		return;
	}

	if (status) {
		dbg("nonzero read bulk status received: %d", status);
		mos7840_port->read_urb_busy = false;
828 829 830 831
		return;
	}

	port = (struct usb_serial_port *)mos7840_port->port;
832
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
833
		dbg("%s", "Port Paranoia failed");
834
		mos7840_port->read_urb_busy = false;
835 836 837
		return;
	}

838
	serial = mos7840_get_usb_serial(port, __func__);
839
	if (!serial) {
T
Tony Cook 已提交
840
		dbg("%s", "Bad serial pointer");
841
		mos7840_port->read_urb_busy = false;
842 843 844
		return;
	}

T
Tony Cook 已提交
845
	dbg("%s", "Entering... ");
846 847 848

	data = urb->transfer_buffer;

T
Tony Cook 已提交
849
	dbg("%s", "Entering ...........");
850 851

	if (urb->actual_length) {
A
Alan Cox 已提交
852
		tty = tty_port_tty_get(&mos7840_port->port->port);
853 854
		if (tty) {
			tty_insert_flip_string(tty, data, urb->actual_length);
T
Tony Cook 已提交
855
			dbg(" %s ", data);
856
			tty_flip_buffer_push(tty);
A
Alan Cox 已提交
857
			tty_kref_put(tty);
858 859
		}
		mos7840_port->icount.rx += urb->actual_length;
O
Oliver Neukum 已提交
860
		smp_wmb();
T
Tony Cook 已提交
861
		dbg("mos7840_port->icount.rx is %d:",
862 863 864 865
		    mos7840_port->icount.rx);
	}

	if (!mos7840_port->read_urb) {
T
Tony Cook 已提交
866
		dbg("%s", "URB KILLED !!!");
867
		mos7840_port->read_urb_busy = false;
868 869 870
		return;
	}

871 872 873 874 875 876 877 878
	/* Turn on LED */
	if (mos7840_port->has_led && !mos7840_port->led_flag) {
		mos7840_port->led_flag = true;
		mos7840_set_led_async(mos7840_port, 0x0301,
					MODEM_CONTROL_REGISTER);
		mod_timer(&mos7840_port->led_timer1,
				jiffies + msecs_to_jiffies(LED_ON_MS));
	}
879

880
	mos7840_port->read_urb_busy = true;
881
	retval = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
O
Oliver Neukum 已提交
882

883
	if (retval) {
884 885
		dbg("usb_submit_urb(read bulk) failed, retval = %d", retval);
		mos7840_port->read_urb_busy = false;
886 887 888 889 890
	}
}

/*****************************************************************************
 * mos7840_bulk_out_data_callback
891 892
 *	this is the callback function for when we have finished sending
 *	serial data on the bulk out endpoint.
893 894
 *****************************************************************************/

895
static void mos7840_bulk_out_data_callback(struct urb *urb)
896 897 898
{
	struct moschip_port *mos7840_port;
	struct tty_struct *tty;
899
	int status = urb->status;
O
Oliver Neukum 已提交
900 901
	int i;

902
	mos7840_port = urb->context;
O
Oliver Neukum 已提交
903 904 905 906 907 908 909 910 911
	spin_lock(&mos7840_port->pool_lock);
	for (i = 0; i < NUM_URBS; i++) {
		if (urb == mos7840_port->write_urb_pool[i]) {
			mos7840_port->busy[i] = 0;
			break;
		}
	}
	spin_unlock(&mos7840_port->pool_lock);

912
	if (status) {
T
Tony Cook 已提交
913
		dbg("nonzero write bulk status received:%d", status);
914 915 916
		return;
	}

917
	if (mos7840_port_paranoia_check(mos7840_port->port, __func__)) {
T
Tony Cook 已提交
918
		dbg("%s", "Port Paranoia failed");
919 920 921
		return;
	}

T
Tony Cook 已提交
922
	dbg("%s", "Entering .........");
923

A
Alan Cox 已提交
924
	tty = tty_port_tty_get(&mos7840_port->port->port);
J
Jiri Slaby 已提交
925 926
	if (tty && mos7840_port->open)
		tty_wakeup(tty);
A
Alan Cox 已提交
927
	tty_kref_put(tty);
928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953

}

/************************************************************************/
/*       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       */
/************************************************************************/
#ifdef MCSSerialProbe
static int mos7840_serial_probe(struct usb_serial *serial,
				const struct usb_device_id *id)
{

	/*need to implement the mode_reg reading and updating\
	   structures usb_serial_ device_type\
	   (i.e num_ports, num_bulkin,bulkout etc) */
	/* Also we can update the changes  attach */
	return 1;
}
#endif

/*****************************************************************************
 * mos7840_open
 *	this function is called by the tty driver when a port is opened
 *	If successful, we return 0
 *	Otherwise we return a negative error number.
 *****************************************************************************/

954
static int mos7840_open(struct tty_struct *tty, struct usb_serial_port *port)
955 956 957 958 959 960 961 962
{
	int response;
	int j;
	struct usb_serial *serial;
	struct urb *urb;
	__u16 Data;
	int status;
	struct moschip_port *mos7840_port;
O
Oliver Neukum 已提交
963
	struct moschip_port *port0;
964

T
Tony Cook 已提交
965 966
	dbg ("%s enter", __func__);

967
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
968
		dbg("%s", "Port Paranoia failed");
969 970 971 972 973
		return -ENODEV;
	}

	serial = port->serial;

974
	if (mos7840_serial_paranoia_check(serial, __func__)) {
T
Tony Cook 已提交
975
		dbg("%s", "Serial Paranoia failed");
976 977 978 979
		return -ENODEV;
	}

	mos7840_port = mos7840_get_port_private(port);
O
Oliver Neukum 已提交
980
	port0 = mos7840_get_port_private(serial->port[0]);
981

O
Oliver Neukum 已提交
982
	if (mos7840_port == NULL || port0 == NULL)
983 984 985 986
		return -ENODEV;

	usb_clear_halt(serial->dev, port->write_urb->pipe);
	usb_clear_halt(serial->dev, port->read_urb->pipe);
O
Oliver Neukum 已提交
987
	port0->open_ports++;
988 989 990

	/* Initialising the write urb pool */
	for (j = 0; j < NUM_URBS; ++j) {
O
Oliver Neukum 已提交
991
		urb = usb_alloc_urb(0, GFP_KERNEL);
992 993 994
		mos7840_port->write_urb_pool[j] = urb;

		if (urb == NULL) {
995
			dev_err(&port->dev, "No more urbs???\n");
996 997 998
			continue;
		}

999 1000
		urb->transfer_buffer = kmalloc(URB_TRANSFER_BUFFER_SIZE,
								GFP_KERNEL);
1001
		if (!urb->transfer_buffer) {
O
Oliver Neukum 已提交
1002 1003
			usb_free_urb(urb);
			mos7840_port->write_urb_pool[j] = NULL;
1004 1005 1006
			dev_err(&port->dev,
				"%s-out of memory for urb buffers.\n",
				__func__);
1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022
			continue;
		}
	}

/*****************************************************************************
 * Initialize MCS7840 -- Write Init values to corresponding Registers
 *
 * Register Index
 * 1 : IER
 * 2 : FCR
 * 3 : LCR
 * 4 : MCR
 *
 * 0x08 : SP1/2 Control Reg
 *****************************************************************************/

1023
	/* NEED to check the following Block */
1024 1025 1026 1027

	Data = 0x0;
	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);
	if (status < 0) {
T
Tony Cook 已提交
1028
		dbg("Reading Spreg failed");
1029 1030 1031 1032 1033
		return -1;
	}
	Data |= 0x80;
	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
	if (status < 0) {
T
Tony Cook 已提交
1034
		dbg("writing Spreg failed");
1035 1036 1037 1038 1039 1040
		return -1;
	}

	Data &= ~0x80;
	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
	if (status < 0) {
T
Tony Cook 已提交
1041
		dbg("writing Spreg failed");
1042 1043
		return -1;
	}
1044
	/* End of block to be checked */
1045 1046

	Data = 0x0;
1047 1048
	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
									&Data);
1049
	if (status < 0) {
T
Tony Cook 已提交
1050
		dbg("Reading Controlreg failed");
1051 1052
		return -1;
	}
1053 1054 1055 1056
	Data |= 0x08;		/* Driver done bit */
	Data |= 0x20;		/* rx_disable */
	status = mos7840_set_reg_sync(port,
				mos7840_port->ControlRegOffset, Data);
1057
	if (status < 0) {
T
Tony Cook 已提交
1058
		dbg("writing Controlreg failed");
1059 1060
		return -1;
	}
1061 1062 1063 1064 1065
	/* do register settings here */
	/* Set all regs to the device default values. */
	/***********************************
	 * First Disable all interrupts.
	 ***********************************/
1066 1067 1068
	Data = 0x00;
	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);
	if (status < 0) {
T
Tony Cook 已提交
1069
		dbg("disabling interrupts failed");
1070 1071
		return -1;
	}
1072
	/* Set FIFO_CONTROL_REGISTER to the default value */
1073 1074 1075
	Data = 0x00;
	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
	if (status < 0) {
T
Tony Cook 已提交
1076
		dbg("Writing FIFO_CONTROL_REGISTER  failed");
1077 1078 1079 1080 1081 1082
		return -1;
	}

	Data = 0xcf;
	status = mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);
	if (status < 0) {
T
Tony Cook 已提交
1083
		dbg("Writing FIFO_CONTROL_REGISTER  failed");
1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098
		return -1;
	}

	Data = 0x03;
	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
	mos7840_port->shadowLCR = Data;

	Data = 0x0b;
	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
	mos7840_port->shadowMCR = Data;

	Data = 0x00;
	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
	mos7840_port->shadowLCR = Data;

1099
	Data |= SERIAL_LCR_DLAB;	/* data latch enable in LCR 0x80 */
1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);

	Data = 0x0c;
	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);

	Data = 0x0;
	status = mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);

	Data = 0x00;
	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);

	Data = Data & ~SERIAL_LCR_DLAB;
	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
	mos7840_port->shadowLCR = Data;

1115
	/* clearing Bulkin and Bulkout Fifo */
1116 1117 1118 1119 1120 1121 1122 1123
	Data = 0x0;
	status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset, &Data);

	Data = Data | 0x0c;
	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);

	Data = Data & ~0x0c;
	status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset, Data);
1124
	/* Finally enable all interrupts */
1125 1126 1127
	Data = 0x0c;
	status = mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);

1128
	/* clearing rx_disable */
1129
	Data = 0x0;
1130 1131
	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
									&Data);
1132
	Data = Data & ~0x20;
1133 1134
	status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset,
									Data);
1135

1136
	/* rx_negate */
1137
	Data = 0x0;
1138 1139
	status = mos7840_get_reg_sync(port, mos7840_port->ControlRegOffset,
									&Data);
1140
	Data = Data | 0x10;
1141 1142
	status = mos7840_set_reg_sync(port, mos7840_port->ControlRegOffset,
									Data);
1143

1144 1145 1146
	/* Check to see if we've set up our endpoint info yet    *
	 * (can't set it up in mos7840_startup as the structures *
	 * were not set up at that time.)                        */
O
Oliver Neukum 已提交
1147
	if (port0->open_ports == 1) {
1148 1149 1150
		if (serial->port[0]->interrupt_in_buffer == NULL) {
			/* set up interrupt urb */
			usb_fill_int_urb(serial->port[0]->interrupt_in_urb,
1151 1152 1153 1154 1155 1156 1157 1158 1159
				serial->dev,
				usb_rcvintpipe(serial->dev,
				serial->port[0]->interrupt_in_endpointAddress),
				serial->port[0]->interrupt_in_buffer,
				serial->port[0]->interrupt_in_urb->
				transfer_buffer_length,
				mos7840_interrupt_callback,
				serial,
				serial->port[0]->interrupt_in_urb->interval);
1160 1161 1162 1163 1164 1165 1166 1167

			/* start interrupt read for mos7840               *
			 * will continue as long as mos7840 is connected  */

			response =
			    usb_submit_urb(serial->port[0]->interrupt_in_urb,
					   GFP_KERNEL);
			if (response) {
1168 1169
				dev_err(&port->dev, "%s - Error %d submitting "
					"interrupt urb\n", __func__, response);
1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
			}

		}

	}

	/* see if we've set up our endpoint info yet   *
	 * (can't set it up in mos7840_startup as the  *
	 * structures were not set up at that time.)   */

T
Tony Cook 已提交
1180 1181 1182 1183 1184 1185
	dbg("port number is %d", port->number);
	dbg("serial number is %d", port->serial->minor);
	dbg("Bulkin endpoint is %d", port->bulk_in_endpointAddress);
	dbg("BulkOut endpoint is %d", port->bulk_out_endpointAddress);
	dbg("Interrupt endpoint is %d", port->interrupt_in_endpointAddress);
	dbg("port's number in the device is %d", mos7840_port->port_num);
1186 1187 1188
	mos7840_port->read_urb = port->read_urb;

	/* set up our bulk in urb */
1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
	if ((serial->num_ports == 2)
		&& ((((__u16)port->number -
			(__u16)(port->serial->minor)) % 2) != 0)) {
		usb_fill_bulk_urb(mos7840_port->read_urb,
			serial->dev,
			usb_rcvbulkpipe(serial->dev,
				(port->bulk_in_endpointAddress) + 2),
			port->bulk_in_buffer,
			mos7840_port->read_urb->transfer_buffer_length,
			mos7840_bulk_in_callback, mos7840_port);
	} else {
		usb_fill_bulk_urb(mos7840_port->read_urb,
			serial->dev,
			usb_rcvbulkpipe(serial->dev,
				port->bulk_in_endpointAddress),
			port->bulk_in_buffer,
			mos7840_port->read_urb->transfer_buffer_length,
			mos7840_bulk_in_callback, mos7840_port);
	}
1208

T
Tony Cook 已提交
1209
	dbg("mos7840_open: bulkin endpoint is %d",
1210
	    port->bulk_in_endpointAddress);
1211
	mos7840_port->read_urb_busy = true;
1212 1213
	response = usb_submit_urb(mos7840_port->read_urb, GFP_KERNEL);
	if (response) {
1214 1215
		dev_err(&port->dev, "%s - Error %d submitting control urb\n",
			__func__, response);
1216
		mos7840_port->read_urb_busy = false;
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
	}

	/* initialize our wait queues */
	init_waitqueue_head(&mos7840_port->wait_chase);
	init_waitqueue_head(&mos7840_port->delta_msr_wait);

	/* initialize our icount structure */
	memset(&(mos7840_port->icount), 0x00, sizeof(mos7840_port->icount));

	/* initialize our port settings */
1227 1228
	/* Must set to enable ints! */
	mos7840_port->shadowMCR = MCR_MASTER_IE;
1229 1230
	/* send a open port command */
	mos7840_port->open = 1;
1231
	/* mos7840_change_port_settings(mos7840_port,old_termios); */
1232 1233 1234
	mos7840_port->icount.tx = 0;
	mos7840_port->icount.rx = 0;

T
Tony Cook 已提交
1235
	dbg("usb_serial serial:%p       mos7840_port:%p\n      usb_serial_port port:%p",
1236
				serial, mos7840_port, port);
1237

T
Tony Cook 已提交
1238 1239
	dbg ("%s leave", __func__);

1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250
	return 0;

}

/*****************************************************************************
 * mos7840_chars_in_buffer
 *	this function is called by the tty driver when it wants to know how many
 *	bytes of data we currently have outstanding in the port (data that has
 *	been written, but hasn't made it out the port yet)
 *	If successful, we return the number of bytes left to be written in the
 *	system,
A
Alan Cox 已提交
1251
 *	Otherwise we return zero.
1252 1253
 *****************************************************************************/

A
Alan Cox 已提交
1254
static int mos7840_chars_in_buffer(struct tty_struct *tty)
1255
{
A
Alan Cox 已提交
1256
	struct usb_serial_port *port = tty->driver_data;
1257 1258
	int i;
	int chars = 0;
O
Oliver Neukum 已提交
1259
	unsigned long flags;
1260 1261
	struct moschip_port *mos7840_port;

T
Tony Cook 已提交
1262
	dbg("%s", " mos7840_chars_in_buffer:entering ...........");
1263

1264
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1265
		dbg("%s", "Invalid port");
A
Alan Cox 已提交
1266
		return 0;
1267 1268 1269 1270
	}

	mos7840_port = mos7840_get_port_private(port);
	if (mos7840_port == NULL) {
T
Tony Cook 已提交
1271
		dbg("%s", "mos7840_break:leaving ...........");
A
Alan Cox 已提交
1272
		return 0;
1273 1274
	}

1275
	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
A
Alan Cox 已提交
1276 1277
	for (i = 0; i < NUM_URBS; ++i)
		if (mos7840_port->busy[i])
1278
			chars += URB_TRANSFER_BUFFER_SIZE;
1279
	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
1280
	dbg("%s - returns %d", __func__, chars);
O
Oliver Neukum 已提交
1281
	return chars;
1282 1283 1284 1285 1286 1287 1288 1289

}

/*****************************************************************************
 * mos7840_close
 *	this function is called by the tty driver when a port is closed
 *****************************************************************************/

1290
static void mos7840_close(struct usb_serial_port *port)
1291 1292 1293
{
	struct usb_serial *serial;
	struct moschip_port *mos7840_port;
O
Oliver Neukum 已提交
1294
	struct moschip_port *port0;
1295 1296 1297
	int j;
	__u16 Data;

T
Tony Cook 已提交
1298
	dbg("%s", "mos7840_close:entering...");
1299

1300
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1301
		dbg("%s", "Port Paranoia failed");
1302 1303 1304
		return;
	}

1305
	serial = mos7840_get_usb_serial(port, __func__);
1306
	if (!serial) {
T
Tony Cook 已提交
1307
		dbg("%s", "Serial Paranoia failed");
1308 1309 1310 1311
		return;
	}

	mos7840_port = mos7840_get_port_private(port);
O
Oliver Neukum 已提交
1312
	port0 = mos7840_get_port_private(serial->port[0]);
1313

O
Oliver Neukum 已提交
1314
	if (mos7840_port == NULL || port0 == NULL)
1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334
		return;

	for (j = 0; j < NUM_URBS; ++j)
		usb_kill_urb(mos7840_port->write_urb_pool[j]);

	/* Freeing Write URBs */
	for (j = 0; j < NUM_URBS; ++j) {
		if (mos7840_port->write_urb_pool[j]) {
			if (mos7840_port->write_urb_pool[j]->transfer_buffer)
				kfree(mos7840_port->write_urb_pool[j]->
				      transfer_buffer);

			usb_free_urb(mos7840_port->write_urb_pool[j]);
		}
	}

	/* While closing port, shutdown all bulk read, write  *
	 * and interrupt read if they exists                  */
	if (serial->dev) {
		if (mos7840_port->write_urb) {
T
Tony Cook 已提交
1335
			dbg("%s", "Shutdown bulk write");
1336 1337 1338
			usb_kill_urb(mos7840_port->write_urb);
		}
		if (mos7840_port->read_urb) {
T
Tony Cook 已提交
1339
			dbg("%s", "Shutdown bulk read");
1340
			usb_kill_urb(mos7840_port->read_urb);
1341
			mos7840_port->read_urb_busy = false;
1342 1343
		}
		if ((&mos7840_port->control_urb)) {
T
Tony Cook 已提交
1344
			dbg("%s", "Shutdown control read");
1345
			/*/      usb_kill_urb (mos7840_port->control_urb); */
1346 1347
		}
	}
1348 1349
/*      if(mos7840_port->ctrl_buf != NULL) */
/*              kfree(mos7840_port->ctrl_buf); */
O
Oliver Neukum 已提交
1350
	port0->open_ports--;
T
Tony Cook 已提交
1351
	dbg("mos7840_num_open_ports in close%d:in port%d",
O
Oliver Neukum 已提交
1352 1353
	    port0->open_ports, port->number);
	if (port0->open_ports == 0) {
1354
		if (serial->port[0]->interrupt_in_urb) {
T
Tony Cook 已提交
1355
			dbg("%s", "Shutdown interrupt_in_urb");
O
Oliver Neukum 已提交
1356
			usb_kill_urb(serial->port[0]->interrupt_in_urb);
1357 1358 1359 1360 1361
		}
	}

	if (mos7840_port->write_urb) {
		/* if this urb had a transfer buffer already (old tx) free it */
1362
		if (mos7840_port->write_urb->transfer_buffer != NULL)
1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374
			kfree(mos7840_port->write_urb->transfer_buffer);
		usb_free_urb(mos7840_port->write_urb);
	}

	Data = 0x0;
	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);

	Data = 0x00;
	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);

	mos7840_port->open = 0;

T
Tony Cook 已提交
1375
	dbg("%s", "Leaving ............");
1376 1377 1378 1379 1380 1381 1382 1383
}

/************************************************************************
 *
 * mos7840_block_until_chase_response
 *
 *	This function will block the close until one of the following:
 *		1. Response to our Chase comes from mos7840
J
Joe Perches 已提交
1384
 *		2. A timeout of 10 seconds without activity has expired
1385 1386 1387 1388
 *		   (1K of mos7840 data @ 2400 baud ==> 4 sec to empty)
 *
 ************************************************************************/

A
Alan Cox 已提交
1389 1390
static void mos7840_block_until_chase_response(struct tty_struct *tty,
					struct moschip_port *mos7840_port)
1391 1392 1393 1394 1395 1396
{
	int timeout = 1 * HZ;
	int wait = 10;
	int count;

	while (1) {
A
Alan Cox 已提交
1397
		count = mos7840_chars_in_buffer(tty);
1398 1399

		/* Check for Buffer status */
1400
		if (count <= 0)
1401 1402 1403 1404 1405 1406 1407 1408
			return;

		/* Block the thread for a while */
		interruptible_sleep_on_timeout(&mos7840_port->wait_chase,
					       timeout);
		/* No activity.. count down section */
		wait--;
		if (wait == 0) {
1409
			dbg("%s - TIMEOUT", __func__);
1410 1411
			return;
		} else {
J
Joe Perches 已提交
1412
			/* Reset timeout value back to seconds */
1413 1414 1415 1416 1417 1418 1419 1420 1421 1422
			wait = 10;
		}
	}

}

/*****************************************************************************
 * mos7840_break
 *	this function sends a break to the port
 *****************************************************************************/
A
Alan Cox 已提交
1423
static void mos7840_break(struct tty_struct *tty, int break_state)
1424
{
A
Alan Cox 已提交
1425
	struct usb_serial_port *port = tty->driver_data;
1426 1427 1428 1429
	unsigned char data;
	struct usb_serial *serial;
	struct moschip_port *mos7840_port;

T
Tony Cook 已提交
1430 1431
	dbg("%s", "Entering ...........");
	dbg("mos7840_break: Start");
1432

1433
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1434
		dbg("%s", "Port Paranoia failed");
1435 1436 1437
		return;
	}

1438
	serial = mos7840_get_usb_serial(port, __func__);
1439
	if (!serial) {
T
Tony Cook 已提交
1440
		dbg("%s", "Serial Paranoia failed");
1441 1442 1443 1444 1445
		return;
	}

	mos7840_port = mos7840_get_port_private(port);

1446
	if (mos7840_port == NULL)
1447 1448
		return;

A
Alan Cox 已提交
1449
	if (serial->dev)
1450
		/* flush and block until tx is empty */
A
Alan Cox 已提交
1451
		mos7840_block_until_chase_response(tty, mos7840_port);
1452

A
Alan Cox 已提交
1453
	if (break_state == -1)
1454
		data = mos7840_port->shadowLCR | LCR_SET_BREAK;
A
Alan Cox 已提交
1455
	else
1456 1457
		data = mos7840_port->shadowLCR & ~LCR_SET_BREAK;

1458
	/* FIXME: no locking on shadowLCR anywhere in driver */
1459
	mos7840_port->shadowLCR = data;
T
Tony Cook 已提交
1460
	dbg("mcs7840_break mos7840_port->shadowLCR is %x",
1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473
	    mos7840_port->shadowLCR);
	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER,
			     mos7840_port->shadowLCR);
}

/*****************************************************************************
 * mos7840_write_room
 *	this function is called by the tty driver when it wants to know how many
 *	bytes of data we can accept for a specific port.
 *	If successful, we return the amount of room that we have for this port
 *	Otherwise we return a negative error number.
 *****************************************************************************/

A
Alan Cox 已提交
1474
static int mos7840_write_room(struct tty_struct *tty)
1475
{
A
Alan Cox 已提交
1476
	struct usb_serial_port *port = tty->driver_data;
1477 1478
	int i;
	int room = 0;
O
Oliver Neukum 已提交
1479
	unsigned long flags;
1480 1481
	struct moschip_port *mos7840_port;

T
Tony Cook 已提交
1482
	dbg("%s", " mos7840_write_room:entering ...........");
1483

1484
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1485 1486
		dbg("%s", "Invalid port");
		dbg("%s", " mos7840_write_room:leaving ...........");
1487 1488 1489 1490 1491
		return -1;
	}

	mos7840_port = mos7840_get_port_private(port);
	if (mos7840_port == NULL) {
T
Tony Cook 已提交
1492
		dbg("%s", "mos7840_break:leaving ...........");
1493 1494 1495
		return -1;
	}

O
Oliver Neukum 已提交
1496
	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
1497
	for (i = 0; i < NUM_URBS; ++i) {
1498
		if (!mos7840_port->busy[i])
1499 1500
			room += URB_TRANSFER_BUFFER_SIZE;
	}
O
Oliver Neukum 已提交
1501
	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
1502

O
Oliver Neukum 已提交
1503
	room = (room == 0) ? 0 : room - URB_TRANSFER_BUFFER_SIZE + 1;
1504
	dbg("%s - returns %d", __func__, room);
O
Oliver Neukum 已提交
1505
	return room;
1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516

}

/*****************************************************************************
 * mos7840_write
 *	this function is called by the tty driver when data should be written to
 *	the port.
 *	If successful, we return the number of bytes written, otherwise we
 *      return a negative error number.
 *****************************************************************************/

A
Alan Cox 已提交
1517
static int mos7840_write(struct tty_struct *tty, struct usb_serial_port *port,
1518 1519 1520 1521 1522 1523
			 const unsigned char *data, int count)
{
	int status;
	int i;
	int bytes_sent = 0;
	int transfer_size;
O
Oliver Neukum 已提交
1524
	unsigned long flags;
1525 1526 1527 1528

	struct moschip_port *mos7840_port;
	struct usb_serial *serial;
	struct urb *urb;
1529
	/* __u16 Data; */
1530 1531
	const unsigned char *current_position = data;
	unsigned char *data1;
T
Tony Cook 已提交
1532 1533
	dbg("%s", "entering ...........");
	/* dbg("mos7840_write: mos7840_port->shadowLCR is %x",
1534
					mos7840_port->shadowLCR); */
1535 1536 1537 1538 1539

#ifdef NOTMOS7840
	Data = 0x00;
	status = mos7840_get_uart_reg(port, LINE_CONTROL_REGISTER, &Data);
	mos7840_port->shadowLCR = Data;
T
Tony Cook 已提交
1540 1541
	dbg("mos7840_write: LINE_CONTROL_REGISTER is %x", Data);
	dbg("mos7840_write: mos7840_port->shadowLCR is %x",
1542 1543
	    mos7840_port->shadowLCR);

1544 1545 1546
	/* Data = 0x03; */
	/* status = mos7840_set_uart_reg(port,LINE_CONTROL_REGISTER,Data); */
	/* mos7840_port->shadowLCR=Data;//Need to add later */
1547

1548
	Data |= SERIAL_LCR_DLAB;	/* data latch enable in LCR 0x80 */
1549 1550
	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);

1551 1552
	/* Data = 0x0c; */
	/* status = mos7840_set_uart_reg(port,DIVISOR_LATCH_LSB,Data); */
1553 1554
	Data = 0x00;
	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_LSB, &Data);
T
Tony Cook 已提交
1555
	dbg("mos7840_write:DLL value is %x", Data);
1556 1557 1558

	Data = 0x0;
	status = mos7840_get_uart_reg(port, DIVISOR_LATCH_MSB, &Data);
T
Tony Cook 已提交
1559
	dbg("mos7840_write:DLM value is %x", Data);
1560 1561

	Data = Data & ~SERIAL_LCR_DLAB;
T
Tony Cook 已提交
1562
	dbg("mos7840_write: mos7840_port->shadowLCR is %x",
1563 1564 1565 1566
	    mos7840_port->shadowLCR);
	status = mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);
#endif

1567
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1568
		dbg("%s", "Port Paranoia failed");
1569 1570 1571 1572
		return -1;
	}

	serial = port->serial;
1573
	if (mos7840_serial_paranoia_check(serial, __func__)) {
T
Tony Cook 已提交
1574
		dbg("%s", "Serial Paranoia failed");
1575 1576 1577 1578 1579
		return -1;
	}

	mos7840_port = mos7840_get_port_private(port);
	if (mos7840_port == NULL) {
T
Tony Cook 已提交
1580
		dbg("%s", "mos7840_port is NULL");
1581 1582 1583 1584 1585 1586
		return -1;
	}

	/* try to find a free urb in the list */
	urb = NULL;

O
Oliver Neukum 已提交
1587
	spin_lock_irqsave(&mos7840_port->pool_lock, flags);
1588
	for (i = 0; i < NUM_URBS; ++i) {
O
Oliver Neukum 已提交
1589 1590
		if (!mos7840_port->busy[i]) {
			mos7840_port->busy[i] = 1;
1591
			urb = mos7840_port->write_urb_pool[i];
T
Tony Cook 已提交
1592
			dbg("URB:%d", i);
1593 1594 1595
			break;
		}
	}
O
Oliver Neukum 已提交
1596
	spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
1597 1598

	if (urb == NULL) {
1599
		dbg("%s - no more free urbs", __func__);
1600 1601 1602 1603 1604 1605 1606 1607
		goto exit;
	}

	if (urb->transfer_buffer == NULL) {
		urb->transfer_buffer =
		    kmalloc(URB_TRANSFER_BUFFER_SIZE, GFP_KERNEL);

		if (urb->transfer_buffer == NULL) {
1608
			dev_err_console(port, "%s no more kernel memory...\n",
1609
				__func__);
1610 1611 1612 1613 1614
			goto exit;
		}
	}
	transfer_size = min(count, URB_TRANSFER_BUFFER_SIZE);

A
Al Viro 已提交
1615
	memcpy(urb->transfer_buffer, current_position, transfer_size);
1616 1617

	/* fill urb with data and submit  */
1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636
	if ((serial->num_ports == 2)
		&& ((((__u16)port->number -
			(__u16)(port->serial->minor)) % 2) != 0)) {
		usb_fill_bulk_urb(urb,
			serial->dev,
			usb_sndbulkpipe(serial->dev,
				(port->bulk_out_endpointAddress) + 2),
			urb->transfer_buffer,
			transfer_size,
			mos7840_bulk_out_data_callback, mos7840_port);
	} else {
		usb_fill_bulk_urb(urb,
			serial->dev,
			usb_sndbulkpipe(serial->dev,
				port->bulk_out_endpointAddress),
			urb->transfer_buffer,
			transfer_size,
			mos7840_bulk_out_data_callback, mos7840_port);
	}
1637 1638

	data1 = urb->transfer_buffer;
T
Tony Cook 已提交
1639
	dbg("bulkout endpoint is %d", port->bulk_out_endpointAddress);
1640

1641 1642 1643 1644 1645 1646 1647 1648
	/* Turn on LED */
	if (mos7840_port->has_led && !mos7840_port->led_flag) {
		mos7840_port->led_flag = true;
		mos7840_set_led_sync(port, MODEM_CONTROL_REGISTER, 0x0301);
		mod_timer(&mos7840_port->led_timer1,
				jiffies + msecs_to_jiffies(LED_ON_MS));
	}

1649 1650 1651 1652
	/* send it down the pipe */
	status = usb_submit_urb(urb, GFP_ATOMIC);

	if (status) {
O
Oliver Neukum 已提交
1653
		mos7840_port->busy[i] = 0;
1654
		dev_err_console(port, "%s - usb_submit_urb(write bulk) failed "
1655
			"with status = %d\n", __func__, status);
1656 1657 1658 1659 1660
		bytes_sent = status;
		goto exit;
	}
	bytes_sent = transfer_size;
	mos7840_port->icount.tx += transfer_size;
O
Oliver Neukum 已提交
1661
	smp_wmb();
T
Tony Cook 已提交
1662
	dbg("mos7840_port->icount.tx is %d:", mos7840_port->icount.tx);
A
Alan Cox 已提交
1663
exit:
1664 1665 1666 1667 1668 1669 1670 1671 1672 1673
	return bytes_sent;

}

/*****************************************************************************
 * mos7840_throttle
 *	this function is called by the tty driver when it wants to stop the data
 *	being read from the port.
 *****************************************************************************/

A
Alan Cox 已提交
1674
static void mos7840_throttle(struct tty_struct *tty)
1675
{
A
Alan Cox 已提交
1676
	struct usb_serial_port *port = tty->driver_data;
1677 1678 1679
	struct moschip_port *mos7840_port;
	int status;

1680
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1681
		dbg("%s", "Invalid port");
1682 1683 1684
		return;
	}

T
Tony Cook 已提交
1685
	dbg("- port %d", port->number);
1686 1687 1688 1689 1690 1691 1692

	mos7840_port = mos7840_get_port_private(port);

	if (mos7840_port == NULL)
		return;

	if (!mos7840_port->open) {
T
Tony Cook 已提交
1693
		dbg("%s", "port not opened");
1694 1695 1696
		return;
	}

T
Tony Cook 已提交
1697
	dbg("%s", "Entering ..........");
1698 1699 1700 1701

	/* if we are implementing XON/XOFF, send the stop character */
	if (I_IXOFF(tty)) {
		unsigned char stop_char = STOP_CHAR(tty);
A
Alan Cox 已提交
1702 1703
		status = mos7840_write(tty, port, &stop_char, 1);
		if (status <= 0)
1704 1705 1706 1707 1708
			return;
	}
	/* if we are implementing RTS/CTS, toggle that line */
	if (tty->termios->c_cflag & CRTSCTS) {
		mos7840_port->shadowMCR &= ~MCR_RTS;
A
Alan Cox 已提交
1709
		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1710
					 mos7840_port->shadowMCR);
A
Alan Cox 已提交
1711
		if (status < 0)
1712 1713 1714 1715 1716 1717
			return;
	}
}

/*****************************************************************************
 * mos7840_unthrottle
1718 1719 1720
 *	this function is called by the tty driver when it wants to resume
 *	the data being read from the port (called after mos7840_throttle is
 *	called)
1721
 *****************************************************************************/
A
Alan Cox 已提交
1722
static void mos7840_unthrottle(struct tty_struct *tty)
1723
{
A
Alan Cox 已提交
1724
	struct usb_serial_port *port = tty->driver_data;
1725 1726 1727
	int status;
	struct moschip_port *mos7840_port = mos7840_get_port_private(port);

1728
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1729
		dbg("%s", "Invalid port");
1730 1731 1732 1733 1734 1735 1736
		return;
	}

	if (mos7840_port == NULL)
		return;

	if (!mos7840_port->open) {
1737
		dbg("%s - port not opened", __func__);
1738 1739 1740
		return;
	}

T
Tony Cook 已提交
1741
	dbg("%s", "Entering ..........");
1742 1743 1744 1745

	/* if we are implementing XON/XOFF, send the start character */
	if (I_IXOFF(tty)) {
		unsigned char start_char = START_CHAR(tty);
A
Alan Cox 已提交
1746 1747
		status = mos7840_write(tty, port, &start_char, 1);
		if (status <= 0)
1748 1749 1750 1751 1752 1753
			return;
	}

	/* if we are implementing RTS/CTS, toggle that line */
	if (tty->termios->c_cflag & CRTSCTS) {
		mos7840_port->shadowMCR |= MCR_RTS;
A
Alan Cox 已提交
1754
		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
1755
					 mos7840_port->shadowMCR);
A
Alan Cox 已提交
1756
		if (status < 0)
1757 1758 1759 1760
			return;
	}
}

1761
static int mos7840_tiocmget(struct tty_struct *tty)
1762
{
A
Alan Cox 已提交
1763
	struct usb_serial_port *port = tty->driver_data;
1764 1765 1766 1767
	struct moschip_port *mos7840_port;
	unsigned int result;
	__u16 msr;
	__u16 mcr;
1768
	int status;
1769 1770
	mos7840_port = mos7840_get_port_private(port);

1771
	dbg("%s - port %d", __func__, port->number);
1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785

	if (mos7840_port == NULL)
		return -ENODEV;

	status = mos7840_get_uart_reg(port, MODEM_STATUS_REGISTER, &msr);
	status = mos7840_get_uart_reg(port, MODEM_CONTROL_REGISTER, &mcr);
	result = ((mcr & MCR_DTR) ? TIOCM_DTR : 0)
	    | ((mcr & MCR_RTS) ? TIOCM_RTS : 0)
	    | ((mcr & MCR_LOOPBACK) ? TIOCM_LOOP : 0)
	    | ((msr & MOS7840_MSR_CTS) ? TIOCM_CTS : 0)
	    | ((msr & MOS7840_MSR_CD) ? TIOCM_CAR : 0)
	    | ((msr & MOS7840_MSR_RI) ? TIOCM_RI : 0)
	    | ((msr & MOS7840_MSR_DSR) ? TIOCM_DSR : 0);

1786
	dbg("%s - 0x%04X", __func__, result);
1787 1788 1789 1790

	return result;
}

1791
static int mos7840_tiocmset(struct tty_struct *tty,
1792 1793
			    unsigned int set, unsigned int clear)
{
A
Alan Cox 已提交
1794
	struct usb_serial_port *port = tty->driver_data;
1795 1796
	struct moschip_port *mos7840_port;
	unsigned int mcr;
1797
	int status;
1798

1799
	dbg("%s - port %d", __func__, port->number);
1800 1801 1802 1803 1804 1805

	mos7840_port = mos7840_get_port_private(port);

	if (mos7840_port == NULL)
		return -ENODEV;

1806
	/* FIXME: What locks the port registers ? */
1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825
	mcr = mos7840_port->shadowMCR;
	if (clear & TIOCM_RTS)
		mcr &= ~MCR_RTS;
	if (clear & TIOCM_DTR)
		mcr &= ~MCR_DTR;
	if (clear & TIOCM_LOOP)
		mcr &= ~MCR_LOOPBACK;

	if (set & TIOCM_RTS)
		mcr |= MCR_RTS;
	if (set & TIOCM_DTR)
		mcr |= MCR_DTR;
	if (set & TIOCM_LOOP)
		mcr |= MCR_LOOPBACK;

	mos7840_port->shadowMCR = mcr;

	status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, mcr);
	if (status < 0) {
T
Tony Cook 已提交
1826
		dbg("setting MODEM_CONTROL_REGISTER Failed");
1827
		return status;
1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838
	}

	return 0;
}

/*****************************************************************************
 * mos7840_calc_baud_rate_divisor
 *	this function calculates the proper baud rate divisor for the specified
 *	baud rate.
 *****************************************************************************/
static int mos7840_calc_baud_rate_divisor(int baudRate, int *divisor,
1839
					  __u16 *clk_sel_val)
1840 1841
{

1842
	dbg("%s - %d", __func__, baudRate);
1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890

	if (baudRate <= 115200) {
		*divisor = 115200 / baudRate;
		*clk_sel_val = 0x0;
	}
	if ((baudRate > 115200) && (baudRate <= 230400)) {
		*divisor = 230400 / baudRate;
		*clk_sel_val = 0x10;
	} else if ((baudRate > 230400) && (baudRate <= 403200)) {
		*divisor = 403200 / baudRate;
		*clk_sel_val = 0x20;
	} else if ((baudRate > 403200) && (baudRate <= 460800)) {
		*divisor = 460800 / baudRate;
		*clk_sel_val = 0x30;
	} else if ((baudRate > 460800) && (baudRate <= 806400)) {
		*divisor = 806400 / baudRate;
		*clk_sel_val = 0x40;
	} else if ((baudRate > 806400) && (baudRate <= 921600)) {
		*divisor = 921600 / baudRate;
		*clk_sel_val = 0x50;
	} else if ((baudRate > 921600) && (baudRate <= 1572864)) {
		*divisor = 1572864 / baudRate;
		*clk_sel_val = 0x60;
	} else if ((baudRate > 1572864) && (baudRate <= 3145728)) {
		*divisor = 3145728 / baudRate;
		*clk_sel_val = 0x70;
	}
	return 0;

#ifdef NOTMCS7840

	for (i = 0; i < ARRAY_SIZE(mos7840_divisor_table); i++) {
		if (mos7840_divisor_table[i].BaudRate == baudrate) {
			*divisor = mos7840_divisor_table[i].Divisor;
			return 0;
		}
	}

	/* After trying for all the standard baud rates    *
	 * Try calculating the divisor for this baud rate  */

	if (baudrate > 75 && baudrate < 230400) {
		/* get the divisor */
		custom = (__u16) (230400L / baudrate);

		/* Check for round off */
		round1 = (__u16) (2304000L / baudrate);
		round = (__u16) (round1 - (custom * 10));
1891
		if (round > 4)
1892 1893 1894
			custom++;
		*divisor = custom;

T
Tony Cook 已提交
1895
		dbg(" Baud %d = %d", baudrate, custom);
1896 1897 1898
		return 0;
	}

T
Tony Cook 已提交
1899
	dbg("%s", " Baud calculation Failed...");
1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923
	return -1;
#endif
}

/*****************************************************************************
 * mos7840_send_cmd_write_baud_rate
 *	this function sends the proper command to change the baud rate of the
 *	specified port.
 *****************************************************************************/

static int mos7840_send_cmd_write_baud_rate(struct moschip_port *mos7840_port,
					    int baudRate)
{
	int divisor = 0;
	int status;
	__u16 Data;
	unsigned char number;
	__u16 clk_sel_val;
	struct usb_serial_port *port;

	if (mos7840_port == NULL)
		return -1;

	port = (struct usb_serial_port *)mos7840_port->port;
1924
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
1925
		dbg("%s", "Invalid port");
1926 1927 1928
		return -1;
	}

1929
	if (mos7840_serial_paranoia_check(port->serial, __func__)) {
T
Tony Cook 已提交
1930
		dbg("%s", "Invalid Serial");
1931 1932 1933
		return -1;
	}

T
Tony Cook 已提交
1934
	dbg("%s", "Entering ..........");
1935 1936 1937

	number = mos7840_port->port->number - mos7840_port->port->serial->minor;

1938
	dbg("%s - port = %d, baud = %d", __func__,
1939
	    mos7840_port->port->number, baudRate);
1940
	/* reset clk_uart_sel in spregOffset */
1941 1942
	if (baudRate > 115200) {
#ifdef HW_flow_control
1943 1944
		/* NOTE: need to see the pther register to modify */
		/* setting h/w flow control bit to 1 */
1945 1946
		Data = 0x2b;
		mos7840_port->shadowMCR = Data;
1947 1948
		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
									Data);
1949
		if (status < 0) {
T
Tony Cook 已提交
1950
			dbg("Writing spreg failed in set_serial_baud");
1951 1952 1953 1954 1955 1956
			return -1;
		}
#endif

	} else {
#ifdef HW_flow_control
1957
		/* setting h/w flow control bit to 0 */
1958 1959
		Data = 0xb;
		mos7840_port->shadowMCR = Data;
1960 1961
		status = mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER,
									Data);
1962
		if (status < 0) {
T
Tony Cook 已提交
1963
			dbg("Writing spreg failed in set_serial_baud");
1964 1965 1966 1967 1968 1969
			return -1;
		}
#endif

	}

1970
	if (1) {		/* baudRate <= 115200) */
1971 1972
		clk_sel_val = 0x0;
		Data = 0x0;
1973
		status = mos7840_calc_baud_rate_divisor(baudRate, &divisor,
1974
						   &clk_sel_val);
1975 1976
		status = mos7840_get_reg_sync(port, mos7840_port->SpRegOffset,
								 &Data);
1977
		if (status < 0) {
T
Tony Cook 已提交
1978
			dbg("reading spreg failed in set_serial_baud");
1979 1980 1981
			return -1;
		}
		Data = (Data & 0x8f) | clk_sel_val;
1982 1983
		status = mos7840_set_reg_sync(port, mos7840_port->SpRegOffset,
								Data);
1984
		if (status < 0) {
T
Tony Cook 已提交
1985
			dbg("Writing spreg failed in set_serial_baud");
1986 1987 1988 1989 1990
			return -1;
		}
		/* Calculate the Divisor */

		if (status) {
1991
			dev_err(&port->dev, "%s - bad baud rate\n", __func__);
1992 1993 1994 1995 1996 1997 1998 1999 2000
			return status;
		}
		/* Enable access to divisor latch */
		Data = mos7840_port->shadowLCR | SERIAL_LCR_DLAB;
		mos7840_port->shadowLCR = Data;
		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);

		/* Write the divisor */
		Data = (unsigned char)(divisor & 0xff);
T
Tony Cook 已提交
2001
		dbg("set_serial_baud Value to write DLL is %x", Data);
2002 2003 2004
		mos7840_set_uart_reg(port, DIVISOR_LATCH_LSB, Data);

		Data = (unsigned char)((divisor & 0xff00) >> 8);
T
Tony Cook 已提交
2005
		dbg("set_serial_baud Value to write DLM is %x", Data);
2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022
		mos7840_set_uart_reg(port, DIVISOR_LATCH_MSB, Data);

		/* Disable access to divisor latch */
		Data = mos7840_port->shadowLCR & ~SERIAL_LCR_DLAB;
		mos7840_port->shadowLCR = Data;
		mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);

	}
	return status;
}

/*****************************************************************************
 * mos7840_change_port_settings
 *	This routine is called to set the UART on the device to match
 *      the specified new settings.
 *****************************************************************************/

A
Alan Cox 已提交
2023 2024
static void mos7840_change_port_settings(struct tty_struct *tty,
	struct moschip_port *mos7840_port, struct ktermios *old_termios)
2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041
{
	int baud;
	unsigned cflag;
	unsigned iflag;
	__u8 lData;
	__u8 lParity;
	__u8 lStop;
	int status;
	__u16 Data;
	struct usb_serial_port *port;
	struct usb_serial *serial;

	if (mos7840_port == NULL)
		return;

	port = (struct usb_serial_port *)mos7840_port->port;

2042
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
2043
		dbg("%s", "Invalid port");
2044 2045 2046
		return;
	}

2047
	if (mos7840_serial_paranoia_check(port->serial, __func__)) {
T
Tony Cook 已提交
2048
		dbg("%s", "Invalid Serial");
2049 2050 2051 2052 2053
		return;
	}

	serial = port->serial;

2054
	dbg("%s - port %d", __func__, mos7840_port->port->number);
2055 2056

	if (!mos7840_port->open) {
2057
		dbg("%s - port not opened", __func__);
2058 2059 2060
		return;
	}

T
Tony Cook 已提交
2061
	dbg("%s", "Entering ..........");
2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093

	lData = LCR_BITS_8;
	lStop = LCR_STOP_1;
	lParity = LCR_PAR_NONE;

	cflag = tty->termios->c_cflag;
	iflag = tty->termios->c_iflag;

	/* Change the number of bits */
	if (cflag & CSIZE) {
		switch (cflag & CSIZE) {
		case CS5:
			lData = LCR_BITS_5;
			break;

		case CS6:
			lData = LCR_BITS_6;
			break;

		case CS7:
			lData = LCR_BITS_7;
			break;
		default:
		case CS8:
			lData = LCR_BITS_8;
			break;
		}
	}
	/* Change the Parity bit */
	if (cflag & PARENB) {
		if (cflag & PARODD) {
			lParity = LCR_PAR_ODD;
2094
			dbg("%s - parity = odd", __func__);
2095 2096
		} else {
			lParity = LCR_PAR_EVEN;
2097
			dbg("%s - parity = even", __func__);
2098 2099 2100
		}

	} else {
2101
		dbg("%s - parity = none", __func__);
2102 2103
	}

2104
	if (cflag & CMSPAR)
2105 2106 2107 2108 2109
		lParity = lParity | 0x20;

	/* Change the Stop bit */
	if (cflag & CSTOPB) {
		lStop = LCR_STOP_2;
2110
		dbg("%s - stop bits = 2", __func__);
2111 2112
	} else {
		lStop = LCR_STOP_1;
2113
		dbg("%s - stop bits = 1", __func__);
2114 2115 2116 2117 2118 2119 2120
	}

	/* Update the LCR with the correct value */
	mos7840_port->shadowLCR &=
	    ~(LCR_BITS_MASK | LCR_STOP_MASK | LCR_PAR_MASK);
	mos7840_port->shadowLCR |= (lData | lParity | lStop);

T
Tony Cook 已提交
2121
	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is %x",
2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146
	    mos7840_port->shadowLCR);
	/* Disable Interrupts */
	Data = 0x00;
	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);

	Data = 0x00;
	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);

	Data = 0xcf;
	mos7840_set_uart_reg(port, FIFO_CONTROL_REGISTER, Data);

	/* Send the updated LCR value to the mos7840 */
	Data = mos7840_port->shadowLCR;

	mos7840_set_uart_reg(port, LINE_CONTROL_REGISTER, Data);

	Data = 0x00b;
	mos7840_port->shadowMCR = Data;
	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);
	Data = 0x00b;
	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);

	/* set up the MCR register and send it to the mos7840 */

	mos7840_port->shadowMCR = MCR_MASTER_IE;
2147
	if (cflag & CBAUD)
2148 2149
		mos7840_port->shadowMCR |= (MCR_DTR | MCR_RTS);

2150
	if (cflag & CRTSCTS)
2151
		mos7840_port->shadowMCR |= (MCR_XON_ANY);
2152
	else
2153 2154 2155 2156 2157 2158 2159 2160 2161 2162
		mos7840_port->shadowMCR &= ~(MCR_XON_ANY);

	Data = mos7840_port->shadowMCR;
	mos7840_set_uart_reg(port, MODEM_CONTROL_REGISTER, Data);

	/* Determine divisor based on baud rate */
	baud = tty_get_baud_rate(tty);

	if (!baud) {
		/* pick a default, any default... */
T
Tony Cook 已提交
2163
		dbg("%s", "Picked default baud...");
2164 2165 2166
		baud = 9600;
	}

2167
	dbg("%s - baud rate = %d", __func__, baud);
2168 2169 2170 2171 2172 2173
	status = mos7840_send_cmd_write_baud_rate(mos7840_port, baud);

	/* Enable Interrupts */
	Data = 0x0c;
	mos7840_set_uart_reg(port, INTERRUPT_ENABLE_REGISTER, Data);

2174 2175
	if (mos7840_port->read_urb_busy == false) {
		mos7840_port->read_urb_busy = true;
2176 2177
		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
		if (status) {
2178
			dbg("usb_submit_urb(read bulk) failed, status = %d",
2179
			    status);
2180
			mos7840_port->read_urb_busy = false;
2181 2182 2183 2184
		}
	}
	wake_up(&mos7840_port->delta_msr_wait);
	mos7840_port->delta_msr_cond = 1;
T
Tony Cook 已提交
2185
	dbg("mos7840_change_port_settings mos7840_port->shadowLCR is End %x",
2186 2187 2188 2189 2190 2191 2192 2193 2194
	    mos7840_port->shadowLCR);
}

/*****************************************************************************
 * mos7840_set_termios
 *	this function is called by the tty driver when it wants to change
 *	the termios structure
 *****************************************************************************/

A
Alan Cox 已提交
2195 2196
static void mos7840_set_termios(struct tty_struct *tty,
				struct usb_serial_port *port,
A
Alan Cox 已提交
2197
				struct ktermios *old_termios)
2198 2199 2200 2201 2202
{
	int status;
	unsigned int cflag;
	struct usb_serial *serial;
	struct moschip_port *mos7840_port;
T
Tony Cook 已提交
2203
	dbg("mos7840_set_termios: START");
2204
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
2205
		dbg("%s", "Invalid port");
2206 2207 2208 2209 2210
		return;
	}

	serial = port->serial;

2211
	if (mos7840_serial_paranoia_check(serial, __func__)) {
T
Tony Cook 已提交
2212
		dbg("%s", "Invalid Serial");
2213 2214 2215 2216 2217 2218 2219 2220 2221
		return;
	}

	mos7840_port = mos7840_get_port_private(port);

	if (mos7840_port == NULL)
		return;

	if (!mos7840_port->open) {
2222
		dbg("%s - port not opened", __func__);
2223 2224 2225
		return;
	}

T
Tony Cook 已提交
2226
	dbg("%s", "setting termios - ");
2227 2228 2229

	cflag = tty->termios->c_cflag;

2230
	dbg("%s - clfag %08x iflag %08x", __func__,
2231
	    tty->termios->c_cflag, RELEVANT_IFLAG(tty->termios->c_iflag));
2232
	dbg("%s - old clfag %08x old iflag %08x", __func__,
2233
	    old_termios->c_cflag, RELEVANT_IFLAG(old_termios->c_iflag));
2234
	dbg("%s - port %d", __func__, port->number);
2235 2236 2237

	/* change the port settings to the new ones specified */

A
Alan Cox 已提交
2238
	mos7840_change_port_settings(tty, mos7840_port, old_termios);
2239 2240

	if (!mos7840_port->read_urb) {
T
Tony Cook 已提交
2241
		dbg("%s", "URB KILLED !!!!!");
2242 2243 2244
		return;
	}

2245 2246
	if (mos7840_port->read_urb_busy == false) {
		mos7840_port->read_urb_busy = true;
2247 2248
		status = usb_submit_urb(mos7840_port->read_urb, GFP_ATOMIC);
		if (status) {
2249
			dbg("usb_submit_urb(read bulk) failed, status = %d",
2250
			    status);
2251
			mos7840_port->read_urb_busy = false;
2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266
		}
	}
}

/*****************************************************************************
 * mos7840_get_lsr_info - get line status register info
 *
 * Purpose: Let user call ioctl() to get info when the UART physically
 * 	    is emptied.  On bus types like RS485, the transmitter must
 * 	    release the bus after transmitting. This must be done when
 * 	    the transmit shift register is empty, not be done when the
 * 	    transmit holding register is empty.  This functionality
 * 	    allows an RS485 driver to be written in user space.
 *****************************************************************************/

A
Alan Cox 已提交
2267
static int mos7840_get_lsr_info(struct tty_struct *tty,
A
Al Viro 已提交
2268
				unsigned int __user *value)
2269 2270 2271 2272
{
	int count;
	unsigned int result = 0;

A
Alan Cox 已提交
2273
	count = mos7840_chars_in_buffer(tty);
2274
	if (count == 0) {
2275
		dbg("%s -- Empty", __func__);
2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289
		result = TIOCSER_TEMT;
	}

	if (copy_to_user(value, &result, sizeof(int)))
		return -EFAULT;
	return 0;
}

/*****************************************************************************
 * mos7840_get_serial_info
 *      function to get information about serial port
 *****************************************************************************/

static int mos7840_get_serial_info(struct moschip_port *mos7840_port,
A
Al Viro 已提交
2290
				   struct serial_struct __user *retinfo)
2291 2292 2293 2294 2295 2296 2297 2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316
{
	struct serial_struct tmp;

	if (mos7840_port == NULL)
		return -1;

	if (!retinfo)
		return -EFAULT;

	memset(&tmp, 0, sizeof(tmp));

	tmp.type = PORT_16550A;
	tmp.line = mos7840_port->port->serial->minor;
	tmp.port = mos7840_port->port->number;
	tmp.irq = 0;
	tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
	tmp.xmit_fifo_size = NUM_URBS * URB_TRANSFER_BUFFER_SIZE;
	tmp.baud_base = 9600;
	tmp.close_delay = 5 * HZ;
	tmp.closing_wait = 30 * HZ;

	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
		return -EFAULT;
	return 0;
}

2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344
static int mos7840_get_icount(struct tty_struct *tty,
			struct serial_icounter_struct *icount)
{
	struct usb_serial_port *port = tty->driver_data;
	struct moschip_port *mos7840_port;
	struct async_icount cnow;

	mos7840_port = mos7840_get_port_private(port);
	cnow = mos7840_port->icount;

	smp_rmb();
	icount->cts = cnow.cts;
	icount->dsr = cnow.dsr;
	icount->rng = cnow.rng;
	icount->dcd = cnow.dcd;
	icount->rx = cnow.rx;
	icount->tx = cnow.tx;
	icount->frame = cnow.frame;
	icount->overrun = cnow.overrun;
	icount->parity = cnow.parity;
	icount->brk = cnow.brk;
	icount->buf_overrun = cnow.buf_overrun;

	dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d", __func__,
		port->number, icount->rx, icount->tx);
	return 0;
}

2345 2346 2347 2348 2349
/*****************************************************************************
 * SerialIoctl
 *	this function handles any ioctl calls to the driver
 *****************************************************************************/

2350
static int mos7840_ioctl(struct tty_struct *tty,
2351 2352
			 unsigned int cmd, unsigned long arg)
{
A
Alan Cox 已提交
2353
	struct usb_serial_port *port = tty->driver_data;
A
Al Viro 已提交
2354
	void __user *argp = (void __user *)arg;
2355 2356 2357 2358 2359
	struct moschip_port *mos7840_port;

	struct async_icount cnow;
	struct async_icount cprev;

2360
	if (mos7840_port_paranoia_check(port, __func__)) {
T
Tony Cook 已提交
2361
		dbg("%s", "Invalid port");
2362 2363 2364 2365 2366 2367 2368 2369
		return -1;
	}

	mos7840_port = mos7840_get_port_private(port);

	if (mos7840_port == NULL)
		return -1;

2370
	dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd);
2371 2372 2373 2374 2375

	switch (cmd) {
		/* return number of bytes available */

	case TIOCSERGETLSR:
2376
		dbg("%s (%d) TIOCSERGETLSR", __func__, port->number);
A
Alan Cox 已提交
2377
		return mos7840_get_lsr_info(tty, argp);
2378 2379

	case TIOCGSERIAL:
2380
		dbg("%s (%d) TIOCGSERIAL", __func__, port->number);
A
Al Viro 已提交
2381
		return mos7840_get_serial_info(mos7840_port, argp);
2382 2383

	case TIOCSSERIAL:
2384
		dbg("%s (%d) TIOCSSERIAL", __func__, port->number);
2385 2386 2387
		break;

	case TIOCMIWAIT:
2388
		dbg("%s (%d) TIOCMIWAIT", __func__, port->number);
2389 2390
		cprev = mos7840_port->icount;
		while (1) {
2391
			/* interruptible_sleep_on(&mos7840_port->delta_msr_wait); */
2392 2393 2394 2395 2396 2397 2398 2399 2400
			mos7840_port->delta_msr_cond = 0;
			wait_event_interruptible(mos7840_port->delta_msr_wait,
						 (mos7840_port->
						  delta_msr_cond == 1));

			/* see if a signal did it */
			if (signal_pending(current))
				return -ERESTARTSYS;
			cnow = mos7840_port->icount;
O
Oliver Neukum 已提交
2401
			smp_rmb();
2402 2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421
			if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
			    cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
				return -EIO;	/* no change => error */
			if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
			    ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
			    ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
			    ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
				return 0;
			}
			cprev = cnow;
		}
		/* NOTREACHED */
		break;

	default:
		break;
	}
	return -ENOIOCTLCMD;
}

2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450 2451 2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462
static int mos7810_check(struct usb_serial *serial)
{
	int i, pass_count = 0;
	__u16 data = 0, mcr_data = 0;
	__u16 test_pattern = 0x55AA;

	/* Store MCR setting */
	usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
		MCS_RDREQ, MCS_RD_RTYPE, 0x0300, MODEM_CONTROL_REGISTER,
		&mcr_data, VENDOR_READ_LENGTH, MOS_WDR_TIMEOUT);

	for (i = 0; i < 16; i++) {
		/* Send the 1-bit test pattern out to MCS7810 test pin */
		usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
			MCS_WRREQ, MCS_WR_RTYPE,
			(0x0300 | (((test_pattern >> i) & 0x0001) << 1)),
			MODEM_CONTROL_REGISTER, NULL, 0, MOS_WDR_TIMEOUT);

		/* Read the test pattern back */
		usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
			MCS_RDREQ, MCS_RD_RTYPE, 0, GPIO_REGISTER, &data,
			VENDOR_READ_LENGTH, MOS_WDR_TIMEOUT);

		/* If this is a MCS7810 device, both test patterns must match */
		if (((test_pattern >> i) ^ (~data >> 1)) & 0x0001)
			break;

		pass_count++;
	}

	/* Restore MCR setting */
	usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0), MCS_WRREQ,
		MCS_WR_RTYPE, 0x0300 | mcr_data, MODEM_CONTROL_REGISTER, NULL,
		0, MOS_WDR_TIMEOUT);

	if (pass_count == 16)
		return 1;

	return 0;
}

2463 2464
static int mos7840_calc_num_ports(struct usb_serial *serial)
{
2465
	__u16 data = 0x00;
2466 2467
	int mos7840_num_ports;

2468 2469
	usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
		MCS_RDREQ, MCS_RD_RTYPE, 0, GPIO_REGISTER, &data,
2470 2471
		VENDOR_READ_LENGTH, MOS_WDR_TIMEOUT);

2472 2473 2474
	if (serial->dev->descriptor.idProduct == MOSCHIP_DEVICE_ID_7810 ||
		serial->dev->descriptor.idProduct == MOSCHIP_DEVICE_ID_7820) {
		device_type = serial->dev->descriptor.idProduct;
2475
	} else {
2476 2477 2478 2479 2480 2481 2482
		/* For a MCS7840 device GPIO0 must be set to 1 */
		if ((data & 0x01) == 1)
			device_type = MOSCHIP_DEVICE_ID_7840;
		else if (mos7810_check(serial))
			device_type = MOSCHIP_DEVICE_ID_7810;
		else
			device_type = MOSCHIP_DEVICE_ID_7820;
2483
	}
2484

2485 2486 2487 2488 2489
	mos7840_num_ports = (device_type >> 4) & 0x000F;
	serial->num_bulk_in = mos7840_num_ports;
	serial->num_bulk_out = mos7840_num_ports;
	serial->num_ports = mos7840_num_ports;

2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503
	return mos7840_num_ports;
}

/****************************************************************************
 * mos7840_startup
 ****************************************************************************/

static int mos7840_startup(struct usb_serial *serial)
{
	struct moschip_port *mos7840_port;
	struct usb_device *dev;
	int i, status;

	__u16 Data;
T
Tony Cook 已提交
2504
	dbg("%s", "mos7840_startup :Entering..........");
2505 2506

	if (!serial) {
T
Tony Cook 已提交
2507
		dbg("%s", "Invalid Handler");
2508 2509 2510 2511 2512
		return -1;
	}

	dev = serial->dev;

T
Tony Cook 已提交
2513 2514
	dbg("%s", "Entering...");
	dbg ("mos7840_startup: serial = %p", serial);
2515 2516 2517 2518 2519 2520

	/* we set up the pointers to the endpoints in the mos7840_open *
	 * function, as the structures aren't created yet.             */

	/* set up port private structures */
	for (i = 0; i < serial->num_ports; ++i) {
T
Tony Cook 已提交
2521
		dbg ("mos7840_startup: configuring port %d............", i);
2522
		mos7840_port = kzalloc(sizeof(struct moschip_port), GFP_KERNEL);
2523
		if (mos7840_port == NULL) {
2524
			dev_err(&dev->dev, "%s - Out of memory\n", __func__);
O
Oliver Neukum 已提交
2525 2526 2527
			status = -ENOMEM;
			i--; /* don't follow NULL pointer cleaning up */
			goto error;
2528 2529
		}

2530 2531 2532
		/* Initialize all port interrupt end point to port 0 int
		 * endpoint. Our device has only one interrupt end point
		 * common to all port */
2533 2534 2535

		mos7840_port->port = serial->port[i];
		mos7840_set_port_private(serial->port[i], mos7840_port);
O
Oliver Neukum 已提交
2536
		spin_lock_init(&mos7840_port->pool_lock);
2537

2538 2539 2540 2541 2542 2543 2544 2545
		/* minor is not initialised until later by
		 * usb-serial.c:get_free_serial() and cannot therefore be used
		 * to index device instances */
		mos7840_port->port_num = i + 1;
		dbg ("serial->port[i]->number = %d", serial->port[i]->number);
		dbg ("serial->port[i]->serial->minor = %d", serial->port[i]->serial->minor);
		dbg ("mos7840_port->port_num = %d", mos7840_port->port_num);
		dbg ("serial->minor = %d", serial->minor);
2546 2547 2548 2549 2550 2551

		if (mos7840_port->port_num == 1) {
			mos7840_port->SpRegOffset = 0x0;
			mos7840_port->ControlRegOffset = 0x1;
			mos7840_port->DcrRegOffset = 0x4;
		} else if ((mos7840_port->port_num == 2)
O
Oliver Neukum 已提交
2552
			   && (serial->num_ports == 4)) {
2553 2554 2555 2556
			mos7840_port->SpRegOffset = 0x8;
			mos7840_port->ControlRegOffset = 0x9;
			mos7840_port->DcrRegOffset = 0x16;
		} else if ((mos7840_port->port_num == 2)
O
Oliver Neukum 已提交
2557
			   && (serial->num_ports == 2)) {
2558 2559 2560 2561
			mos7840_port->SpRegOffset = 0xa;
			mos7840_port->ControlRegOffset = 0xb;
			mos7840_port->DcrRegOffset = 0x19;
		} else if ((mos7840_port->port_num == 3)
O
Oliver Neukum 已提交
2562
			   && (serial->num_ports == 4)) {
2563 2564 2565 2566
			mos7840_port->SpRegOffset = 0xa;
			mos7840_port->ControlRegOffset = 0xb;
			mos7840_port->DcrRegOffset = 0x19;
		} else if ((mos7840_port->port_num == 4)
O
Oliver Neukum 已提交
2567
			   && (serial->num_ports == 4)) {
2568 2569 2570 2571 2572 2573 2574
			mos7840_port->SpRegOffset = 0xc;
			mos7840_port->ControlRegOffset = 0xd;
			mos7840_port->DcrRegOffset = 0x1c;
		}
		mos7840_dump_serial_port(mos7840_port);
		mos7840_set_port_private(serial->port[i], mos7840_port);

2575 2576 2577
		/* enable rx_disable bit in control register */
		status = mos7840_get_reg_sync(serial->port[i],
				 mos7840_port->ControlRegOffset, &Data);
2578
		if (status < 0) {
T
Tony Cook 已提交
2579
			dbg("Reading ControlReg failed status-0x%x", status);
2580 2581
			break;
		} else
T
Tony Cook 已提交
2582
			dbg("ControlReg Reading success val is %x, status%d",
2583
			    Data, status);
2584 2585 2586
		Data |= 0x08;	/* setting driver done bit */
		Data |= 0x04;	/* sp1_bit to have cts change reflect in
				   modem status reg */
2587

2588 2589
		/* Data |= 0x20; //rx_disable bit */
		status = mos7840_set_reg_sync(serial->port[i],
2590 2591
					 mos7840_port->ControlRegOffset, Data);
		if (status < 0) {
T
Tony Cook 已提交
2592
			dbg("Writing ControlReg failed(rx_disable) status-0x%x", status);
2593 2594
			break;
		} else
T
Tony Cook 已提交
2595
			dbg("ControlReg Writing success(rx_disable) status%d",
2596 2597
			    status);

2598 2599
		/* Write default values in DCR (i.e 0x01 in DCR0, 0x05 in DCR2
		   and 0x24 in DCR3 */
2600
		Data = 0x01;
2601 2602
		status = mos7840_set_reg_sync(serial->port[i],
			 (__u16) (mos7840_port->DcrRegOffset + 0), Data);
2603
		if (status < 0) {
T
Tony Cook 已提交
2604
			dbg("Writing DCR0 failed status-0x%x", status);
2605 2606
			break;
		} else
T
Tony Cook 已提交
2607
			dbg("DCR0 Writing success status%d", status);
2608 2609

		Data = 0x05;
2610 2611
		status = mos7840_set_reg_sync(serial->port[i],
			 (__u16) (mos7840_port->DcrRegOffset + 1), Data);
2612
		if (status < 0) {
T
Tony Cook 已提交
2613
			dbg("Writing DCR1 failed status-0x%x", status);
2614 2615
			break;
		} else
T
Tony Cook 已提交
2616
			dbg("DCR1 Writing success status%d", status);
2617 2618

		Data = 0x24;
2619 2620
		status = mos7840_set_reg_sync(serial->port[i],
			 (__u16) (mos7840_port->DcrRegOffset + 2), Data);
2621
		if (status < 0) {
T
Tony Cook 已提交
2622
			dbg("Writing DCR2 failed status-0x%x", status);
2623 2624
			break;
		} else
T
Tony Cook 已提交
2625
			dbg("DCR2 Writing success status%d", status);
2626

2627
		/* write values in clkstart0x0 and clkmulti 0x20 */
2628
		Data = 0x0;
2629
		status = mos7840_set_reg_sync(serial->port[i],
2630 2631
					 CLK_START_VALUE_REGISTER, Data);
		if (status < 0) {
T
Tony Cook 已提交
2632
			dbg("Writing CLK_START_VALUE_REGISTER failed status-0x%x", status);
2633 2634
			break;
		} else
T
Tony Cook 已提交
2635
			dbg("CLK_START_VALUE_REGISTER Writing success status%d", status);
2636 2637

		Data = 0x20;
2638 2639
		status = mos7840_set_reg_sync(serial->port[i],
					CLK_MULTI_REGISTER, Data);
2640
		if (status < 0) {
T
Tony Cook 已提交
2641
			dbg("Writing CLK_MULTI_REGISTER failed status-0x%x",
2642
			    status);
O
Oliver Neukum 已提交
2643
			goto error;
2644
		} else
T
Tony Cook 已提交
2645
			dbg("CLK_MULTI_REGISTER Writing success status%d",
2646 2647
			    status);

2648
		/* write value 0x0 to scratchpad register */
2649
		Data = 0x00;
2650 2651
		status = mos7840_set_uart_reg(serial->port[i],
						SCRATCH_PAD_REGISTER, Data);
2652
		if (status < 0) {
T
Tony Cook 已提交
2653
			dbg("Writing SCRATCH_PAD_REGISTER failed status-0x%x",
2654 2655 2656
			    status);
			break;
		} else
T
Tony Cook 已提交
2657
			dbg("SCRATCH_PAD_REGISTER Writing success status%d",
2658 2659
			    status);

2660
		/* Zero Length flag register */
2661
		if ((mos7840_port->port_num != 1)
O
Oliver Neukum 已提交
2662
		    && (serial->num_ports == 2)) {
2663 2664 2665

			Data = 0xff;
			status = mos7840_set_reg_sync(serial->port[i],
2666 2667
				      (__u16) (ZLP_REG1 +
				      ((__u16)mos7840_port->port_num)), Data);
T
Tony Cook 已提交
2668
			dbg("ZLIP offset %x",
2669
			    (__u16) (ZLP_REG1 +
2670
					((__u16) mos7840_port->port_num)));
2671
			if (status < 0) {
T
Tony Cook 已提交
2672
				dbg("Writing ZLP_REG%d failed status-0x%x",
2673 2674 2675
				    i + 2, status);
				break;
			} else
T
Tony Cook 已提交
2676
				dbg("ZLP_REG%d Writing success status%d",
2677 2678 2679 2680
				    i + 2, status);
		} else {
			Data = 0xff;
			status = mos7840_set_reg_sync(serial->port[i],
2681 2682
			      (__u16) (ZLP_REG1 +
			      ((__u16)mos7840_port->port_num) - 0x1), Data);
T
Tony Cook 已提交
2683
			dbg("ZLIP offset %x",
2684 2685 2686
			    (__u16) (ZLP_REG1 +
				     ((__u16) mos7840_port->port_num) - 0x1));
			if (status < 0) {
T
Tony Cook 已提交
2687
				dbg("Writing ZLP_REG%d failed status-0x%x",
2688 2689 2690
				    i + 1, status);
				break;
			} else
T
Tony Cook 已提交
2691
				dbg("ZLP_REG%d Writing success status%d",
2692 2693 2694
				    i + 1, status);

		}
O
Oliver Neukum 已提交
2695
		mos7840_port->control_urb = usb_alloc_urb(0, GFP_KERNEL);
2696
		mos7840_port->ctrl_buf = kmalloc(16, GFP_KERNEL);
2697 2698 2699 2700
		mos7840_port->dr = kmalloc(sizeof(struct usb_ctrlrequest),
								GFP_KERNEL);
		if (!mos7840_port->control_urb || !mos7840_port->ctrl_buf ||
							!mos7840_port->dr) {
O
Oliver Neukum 已提交
2701 2702 2703
			status = -ENOMEM;
			goto error;
		}
2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731

		mos7840_port->has_led = false;

		/* Initialize LED timers */
		if (device_type == MOSCHIP_DEVICE_ID_7810) {
			mos7840_port->has_led = true;

			init_timer(&mos7840_port->led_timer1);
			mos7840_port->led_timer1.function = mos7840_led_off;
			mos7840_port->led_timer1.expires =
					jiffies + msecs_to_jiffies(LED_ON_MS);
			mos7840_port->led_timer1.data =
						(unsigned long)mos7840_port;

			init_timer(&mos7840_port->led_timer2);
			mos7840_port->led_timer2.function =
						mos7840_led_flag_off;
			mos7840_port->led_timer2.expires =
					jiffies + msecs_to_jiffies(LED_OFF_MS);
			mos7840_port->led_timer2.data =
						(unsigned long)mos7840_port;

			mos7840_port->led_flag = false;

			/* Turn off LED */
			mos7840_set_led_sync(serial->port[i],
						MODEM_CONTROL_REGISTER, 0x0300);
		}
2732
	}
T
Tony Cook 已提交
2733
	dbg ("mos7840_startup: all ports configured...........");
2734

2735
	/* Zero Length flag enable */
2736 2737 2738
	Data = 0x0f;
	status = mos7840_set_reg_sync(serial->port[0], ZLP_REG5, Data);
	if (status < 0) {
T
Tony Cook 已提交
2739
		dbg("Writing ZLP_REG5 failed status-0x%x", status);
2740
		goto error;
2741
	} else
T
Tony Cook 已提交
2742
		dbg("ZLP_REG5 Writing success status%d", status);
2743 2744 2745

	/* setting configuration feature to one */
	usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
A
Al Viro 已提交
2746
			(__u8) 0x03, 0x00, 0x01, 0x00, NULL, 0x00, 5 * HZ);
2747
	return 0;
O
Oliver Neukum 已提交
2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758
error:
	for (/* nothing */; i >= 0; i--) {
		mos7840_port = mos7840_get_port_private(serial->port[i]);

		kfree(mos7840_port->dr);
		kfree(mos7840_port->ctrl_buf);
		usb_free_urb(mos7840_port->control_urb);
		kfree(mos7840_port);
		serial->port[i] = NULL;
	}
	return status;
2759 2760 2761
}

/****************************************************************************
2762
 * mos7840_disconnect
2763 2764 2765
 *	This function is called whenever the device is removed from the usb bus.
 ****************************************************************************/

2766
static void mos7840_disconnect(struct usb_serial *serial)
2767 2768
{
	int i;
O
Oliver Neukum 已提交
2769
	unsigned long flags;
2770
	struct moschip_port *mos7840_port;
2771
	dbg("%s", " disconnect :entering..........");
2772 2773

	if (!serial) {
T
Tony Cook 已提交
2774
		dbg("%s", "Invalid Handler");
2775 2776 2777
		return;
	}

2778
	/* check for the ports to be closed,close the ports and disconnect */
2779 2780 2781 2782 2783 2784

	/* free private structure allocated for serial port  *
	 * stop reads and writes on all ports                */

	for (i = 0; i < serial->num_ports; ++i) {
		mos7840_port = mos7840_get_port_private(serial->port[i]);
2785 2786 2787 2788 2789 2790
		dbg ("mos7840_port %d = %p", i, mos7840_port);
		if (mos7840_port) {
			spin_lock_irqsave(&mos7840_port->pool_lock, flags);
			mos7840_port->zombie = 1;
			spin_unlock_irqrestore(&mos7840_port->pool_lock, flags);
			usb_kill_urb(mos7840_port->control_urb);
2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822
		}
	}

	dbg("%s", "Thank u :: ");

}

/****************************************************************************
 * mos7840_release
 *	This function is called when the usb_serial structure is freed.
 ****************************************************************************/

static void mos7840_release(struct usb_serial *serial)
{
	int i;
	struct moschip_port *mos7840_port;
	dbg("%s", " release :entering..........");

	if (!serial) {
		dbg("%s", "Invalid Handler");
		return;
	}

	/* check for the ports to be closed,close the ports and disconnect */

	/* free private structure allocated for serial port  *
	 * stop reads and writes on all ports                */

	for (i = 0; i < serial->num_ports; ++i) {
		mos7840_port = mos7840_get_port_private(serial->port[i]);
		dbg("mos7840_port %d = %p", i, mos7840_port);
		if (mos7840_port) {
2823 2824 2825 2826 2827 2828 2829 2830
			if (mos7840_port->has_led) {
				/* Turn off LED */
				mos7840_set_led_sync(mos7840_port->port,
						MODEM_CONTROL_REGISTER, 0x0300);

				del_timer_sync(&mos7840_port->led_timer1);
				del_timer_sync(&mos7840_port->led_timer2);
			}
2831 2832 2833 2834
			kfree(mos7840_port->ctrl_buf);
			kfree(mos7840_port->dr);
			kfree(mos7840_port);
		}
2835 2836
	}

T
Tony Cook 已提交
2837
	dbg("%s", "Thank u :: ");
2838 2839 2840

}

2841 2842 2843 2844 2845 2846 2847
static struct usb_driver io_driver = {
	.name = "mos7840",
	.probe = usb_serial_probe,
	.disconnect = usb_serial_disconnect,
	.id_table = moschip_id_table_combined,
};

2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871
static struct usb_serial_driver moschip7840_4port_device = {
	.driver = {
		   .owner = THIS_MODULE,
		   .name = "mos7840",
		   },
	.description = DRIVER_DESC,
	.id_table = moschip_port_id_table,
	.num_ports = 4,
	.open = mos7840_open,
	.close = mos7840_close,
	.write = mos7840_write,
	.write_room = mos7840_write_room,
	.chars_in_buffer = mos7840_chars_in_buffer,
	.throttle = mos7840_throttle,
	.unthrottle = mos7840_unthrottle,
	.calc_num_ports = mos7840_calc_num_ports,
#ifdef MCSSerialProbe
	.probe = mos7840_serial_probe,
#endif
	.ioctl = mos7840_ioctl,
	.set_termios = mos7840_set_termios,
	.break_ctl = mos7840_break,
	.tiocmget = mos7840_tiocmget,
	.tiocmset = mos7840_tiocmset,
2872
	.get_icount = mos7840_get_icount,
2873
	.attach = mos7840_startup,
2874 2875
	.disconnect = mos7840_disconnect,
	.release = mos7840_release,
2876 2877 2878 2879
	.read_bulk_callback = mos7840_bulk_in_callback,
	.read_int_callback = mos7840_interrupt_callback,
};

2880 2881 2882 2883
static struct usb_serial_driver * const serial_drivers[] = {
	&moschip7840_4port_device, NULL
};

2884
module_usb_serial_driver(io_driver, serial_drivers);
2885 2886 2887 2888 2889 2890

MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");

module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug enabled or not");