mct_u232.c 24.6 KB
Newer Older
L
Linus Torvalds 已提交
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
/*
 * MCT (Magic Control Technology Corp.) USB RS232 Converter Driver
 *
 *   Copyright (C) 2000 Wolfgang Grandegger (wolfgang@ces.ch)
 *
 *   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 largely derived from the Belkin USB Serial Adapter Driver
 * (see belkin_sa.[ch]). All of the information about the device was acquired
 * by using SniffUSB on Windows98. For technical details see mct_u232.h.
 *
 * William G. Greathouse and Greg Kroah-Hartman provided great help on how to
 * do the reverse engineering and how to write a USB serial device driver.
 *
 * TO BE DONE, TO BE CHECKED:
 *   DTR/RTS signal handling may be incomplete or incorrect. I have mainly
 *   implemented what I have seen with SniffUSB or found in belkin_sa.c.
 *   For further TODOs check also belkin_sa.c.
 */

#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/spinlock.h>
A
Alan Cox 已提交
33
#include <linux/uaccess.h>
34
#include <asm/unaligned.h>
L
Linus Torvalds 已提交
35
#include <linux/usb.h>
36
#include <linux/usb/serial.h>
37 38
#include <linux/serial.h>
#include <linux/ioctl.h>
L
Linus Torvalds 已提交
39 40 41 42 43 44 45 46
#include "mct_u232.h"

#define DRIVER_AUTHOR "Wolfgang Grandegger <wolfgang@ces.ch>"
#define DRIVER_DESC "Magic Control Technology USB-RS232 converter driver"

/*
 * Function prototypes
 */
A
Alan Cox 已提交
47
static int  mct_u232_startup(struct usb_serial *serial);
48 49
static int  mct_u232_port_probe(struct usb_serial_port *port);
static int  mct_u232_port_remove(struct usb_serial_port *remove);
50
static int  mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port);
51 52
static void mct_u232_close(struct usb_serial_port *port);
static void mct_u232_dtr_rts(struct usb_serial_port *port, int on);
A
Alan Cox 已提交
53 54 55 56
static void mct_u232_read_int_callback(struct urb *urb);
static void mct_u232_set_termios(struct tty_struct *tty,
			struct usb_serial_port *port, struct ktermios *old);
static void mct_u232_break_ctl(struct tty_struct *tty, int break_state);
57
static int  mct_u232_tiocmget(struct tty_struct *tty);
58
static int  mct_u232_tiocmset(struct tty_struct *tty,
A
Alan Cox 已提交
59
			unsigned int set, unsigned int clear);
60
static int  mct_u232_ioctl(struct tty_struct *tty,
61 62 63
			unsigned int cmd, unsigned long arg);
static int  mct_u232_get_icount(struct tty_struct *tty,
			struct serial_icounter_struct *icount);
A
Alan Cox 已提交
64 65
static void mct_u232_throttle(struct tty_struct *tty);
static void mct_u232_unthrottle(struct tty_struct *tty);
66 67


L
Linus Torvalds 已提交
68 69 70
/*
 * All of the device info needed for the MCT USB-RS232 converter.
 */
71
static const struct usb_device_id id_table[] = {
L
Linus Torvalds 已提交
72 73 74 75 76 77
	{ USB_DEVICE(MCT_U232_VID, MCT_U232_PID) },
	{ USB_DEVICE(MCT_U232_VID, MCT_U232_SITECOM_PID) },
	{ USB_DEVICE(MCT_U232_VID, MCT_U232_DU_H3SP_PID) },
	{ USB_DEVICE(MCT_U232_BELKIN_F5U109_VID, MCT_U232_BELKIN_F5U109_PID) },
	{ }		/* Terminating entry */
};
78
MODULE_DEVICE_TABLE(usb, id_table);
L
Linus Torvalds 已提交
79

80
static struct usb_serial_driver mct_u232_device = {
81 82
	.driver = {
		.owner =	THIS_MODULE,
83
		.name =		"mct_u232",
84
	},
85
	.description =	     "MCT U232",
86
	.id_table =	     id_table,
L
Linus Torvalds 已提交
87 88 89
	.num_ports =	     1,
	.open =		     mct_u232_open,
	.close =	     mct_u232_close,
90
	.dtr_rts =	     mct_u232_dtr_rts,
91 92
	.throttle =	     mct_u232_throttle,
	.unthrottle =	     mct_u232_unthrottle,
L
Linus Torvalds 已提交
93 94 95 96 97 98
	.read_int_callback = mct_u232_read_int_callback,
	.set_termios =	     mct_u232_set_termios,
	.break_ctl =	     mct_u232_break_ctl,
	.tiocmget =	     mct_u232_tiocmget,
	.tiocmset =	     mct_u232_tiocmset,
	.attach =	     mct_u232_startup,
99 100
	.port_probe =        mct_u232_port_probe,
	.port_remove =       mct_u232_port_remove,
101 102
	.ioctl =             mct_u232_ioctl,
	.get_icount =        mct_u232_get_icount,
L
Linus Torvalds 已提交
103 104
};

105 106 107 108
static struct usb_serial_driver * const serial_drivers[] = {
	&mct_u232_device, NULL
};

L
Linus Torvalds 已提交
109 110 111 112 113 114
struct mct_u232_private {
	spinlock_t lock;
	unsigned int	     control_state; /* Modem Line Setting (TIOCM) */
	unsigned char        last_lcr;      /* Line Control Register */
	unsigned char	     last_lsr;      /* Line Status Register */
	unsigned char	     last_msr;      /* Modem Status Register */
115
	unsigned int	     rx_flags;      /* Throttling flags */
116 117 118
	struct async_icount  icount;
	wait_queue_head_t    msr_wait;	/* for handling sleeping while waiting
						for msr change to happen */
L
Linus Torvalds 已提交
119 120
};

121 122
#define THROTTLED		0x01

L
Linus Torvalds 已提交
123 124 125 126 127 128 129 130 131 132
/*
 * Handle vendor specific USB requests
 */

#define WDR_TIMEOUT 5000 /* default urb timeout */

/*
 * Later day 2.6.0-test kernels have new baud rates like B230400 which
 * we do not know how to support. We ignore them for the moment.
 */
A
Alan Cox 已提交
133 134
static int mct_u232_calculate_baud_rate(struct usb_serial *serial,
					speed_t value, speed_t *result)
L
Linus Torvalds 已提交
135
{
136 137
	*result = value;

L
Linus Torvalds 已提交
138
	if (le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_SITECOM_PID
A
Alan Cox 已提交
139
		|| le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_BELKIN_F5U109_PID) {
L
Linus Torvalds 已提交
140
		switch (value) {
A
Alan Cox 已提交
141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160
		case 300:
			return 0x01;
		case 600:
			return 0x02; /* this one not tested */
		case 1200:
			return 0x03;
		case 2400:
			return 0x04;
		case 4800:
			return 0x06;
		case 9600:
			return 0x08;
		case 19200:
			return 0x09;
		case 38400:
			return 0x0a;
		case 57600:
			return 0x0b;
		case 115200:
			return 0x0c;
L
Linus Torvalds 已提交
161
		default:
162
			*result = 9600;
L
Linus Torvalds 已提交
163 164 165
			return 0x08;
		}
	} else {
166 167 168
		/* FIXME: Can we use any divider - should we do
		   divider = 115200/value;
		   real baud = 115200/divider */
L
Linus Torvalds 已提交
169
		switch (value) {
170 171 172 173 174 175 176 177 178 179 180 181
		case 300: break;
		case 600: break;
		case 1200: break;
		case 2400: break;
		case 4800: break;
		case 9600: break;
		case 19200: break;
		case 38400: break;
		case 57600: break;
		case 115200: break;
		default:
			value = 9600;
182
			*result = 9600;
L
Linus Torvalds 已提交
183 184 185 186 187
		}
		return 115200/value;
	}
}

A
Alan Cox 已提交
188 189
static int mct_u232_set_baud_rate(struct tty_struct *tty,
	struct usb_serial *serial, struct usb_serial_port *port, speed_t value)
L
Linus Torvalds 已提交
190
{
191
	unsigned int divisor;
A
Alan Cox 已提交
192
	int rc;
193
	unsigned char *buf;
A
Alan Cox 已提交
194 195 196
	unsigned char cts_enable_byte = 0;
	speed_t speed;

197 198 199
	buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;
A
Alan Cox 已提交
200

201 202
	divisor = mct_u232_calculate_baud_rate(serial, value, &speed);
	put_unaligned_le32(cpu_to_le32(divisor), buf);
A
Alan Cox 已提交
203 204 205
	rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
				MCT_U232_SET_BAUD_RATE_REQUEST,
				MCT_U232_SET_REQUEST_TYPE,
206
				0, 0, buf, MCT_U232_SET_BAUD_RATE_SIZE,
A
Alan Cox 已提交
207
				WDR_TIMEOUT);
208
	if (rc < 0)	/*FIXME: What value speed results */
209 210
		dev_err(&port->dev, "Set BAUD RATE %d failed (error = %d)\n",
			value, rc);
211
	else
A
Alan Cox 已提交
212
		tty_encode_baud_rate(tty, speed, speed);
213
	dev_dbg(&port->dev, "set_baud_rate: value: 0x%x, divisor: 0x%x\n", value, divisor);
L
Linus Torvalds 已提交
214 215 216 217 218 219

	/* Mimic the MCT-supplied Windows driver (version 1.21P.0104), which
	   always sends two extra USB 'device request' messages after the
	   'baud rate change' message.  The actual functionality of the
	   request codes in these messages is not fully understood but these
	   particular codes are never seen in any operation besides a baud
220 221 222 223 224 225 226
	   rate change.  Both of these messages send a single byte of data.
	   In the first message, the value of this byte is always zero.

	   The second message has been determined experimentally to control
	   whether data will be transmitted to a device which is not asserting
	   the 'CTS' signal.  If the second message's data byte is zero, data
	   will be transmitted even if 'CTS' is not asserted (i.e. no hardware
A
Alan Cox 已提交
227 228 229
	   flow control).  if the second message's data byte is nonzero (a
	   value of 1 is used by this driver), data will not be transmitted to
	   a device which is not asserting 'CTS'.
230
	*/
L
Linus Torvalds 已提交
231

232
	buf[0] = 0;
L
Linus Torvalds 已提交
233
	rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
A
Alan Cox 已提交
234 235
				MCT_U232_SET_UNKNOWN1_REQUEST,
				MCT_U232_SET_REQUEST_TYPE,
236
				0, 0, buf, MCT_U232_SET_UNKNOWN1_SIZE,
A
Alan Cox 已提交
237
				WDR_TIMEOUT);
L
Linus Torvalds 已提交
238
	if (rc < 0)
239 240 241
		dev_err(&port->dev, "Sending USB device request code %d "
			"failed (error = %d)\n", MCT_U232_SET_UNKNOWN1_REQUEST,
			rc);
L
Linus Torvalds 已提交
242

A
Alan Cox 已提交
243
	if (port && C_CRTSCTS(tty))
244 245
	   cts_enable_byte = 1;

246 247
	dev_dbg(&port->dev, "set_baud_rate: send second control message, data = %02X\n",
		cts_enable_byte);
248
	buf[0] = cts_enable_byte;
L
Linus Torvalds 已提交
249
	rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
A
Alan Cox 已提交
250 251
			MCT_U232_SET_CTS_REQUEST,
			MCT_U232_SET_REQUEST_TYPE,
252
			0, 0, buf, MCT_U232_SET_CTS_SIZE,
A
Alan Cox 已提交
253
			WDR_TIMEOUT);
L
Linus Torvalds 已提交
254
	if (rc < 0)
255 256
		dev_err(&port->dev, "Sending USB device request code %d "
			"failed (error = %d)\n", MCT_U232_SET_CTS_REQUEST, rc);
L
Linus Torvalds 已提交
257

258
	kfree(buf);
A
Alan Cox 已提交
259
	return rc;
L
Linus Torvalds 已提交
260 261
} /* mct_u232_set_baud_rate */

262 263
static int mct_u232_set_line_ctrl(struct usb_serial_port *port,
				  unsigned char lcr)
L
Linus Torvalds 已提交
264
{
A
Alan Cox 已提交
265
	int rc;
266 267 268 269 270 271 272
	unsigned char *buf;

	buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;

	buf[0] = lcr;
273
	rc = usb_control_msg(port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
A
Alan Cox 已提交
274 275
			MCT_U232_SET_LINE_CTRL_REQUEST,
			MCT_U232_SET_REQUEST_TYPE,
276
			0, 0, buf, MCT_U232_SET_LINE_CTRL_SIZE,
A
Alan Cox 已提交
277
			WDR_TIMEOUT);
L
Linus Torvalds 已提交
278
	if (rc < 0)
279 280
		dev_err(&port->dev, "Set LINE CTRL 0x%x failed (error = %d)\n", lcr, rc);
	dev_dbg(&port->dev, "set_line_ctrl: 0x%x\n", lcr);
281
	kfree(buf);
A
Alan Cox 已提交
282
	return rc;
L
Linus Torvalds 已提交
283 284
} /* mct_u232_set_line_ctrl */

285
static int mct_u232_set_modem_ctrl(struct usb_serial_port *port,
L
Linus Torvalds 已提交
286 287
				   unsigned int control_state)
{
A
Alan Cox 已提交
288
	int rc;
289 290 291 292 293 294
	unsigned char mcr;
	unsigned char *buf;

	buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
	if (buf == NULL)
		return -ENOMEM;
L
Linus Torvalds 已提交
295

296
	mcr = MCT_U232_MCR_NONE;
L
Linus Torvalds 已提交
297 298 299 300 301
	if (control_state & TIOCM_DTR)
		mcr |= MCT_U232_MCR_DTR;
	if (control_state & TIOCM_RTS)
		mcr |= MCT_U232_MCR_RTS;

302
	buf[0] = mcr;
303
	rc = usb_control_msg(port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
A
Alan Cox 已提交
304 305
			MCT_U232_SET_MODEM_CTRL_REQUEST,
			MCT_U232_SET_REQUEST_TYPE,
306
			0, 0, buf, MCT_U232_SET_MODEM_CTRL_SIZE,
A
Alan Cox 已提交
307
			WDR_TIMEOUT);
308 309
	kfree(buf);

310
	dev_dbg(&port->dev, "set_modem_ctrl: state=0x%x ==> mcr=0x%x\n", control_state, mcr);
L
Linus Torvalds 已提交
311

312
	if (rc < 0) {
313
		dev_err(&port->dev, "Set MODEM CTRL 0x%x failed (error = %d)\n", mcr, rc);
314 315 316
		return rc;
	}
	return 0;
L
Linus Torvalds 已提交
317 318
} /* mct_u232_set_modem_ctrl */

319 320
static int mct_u232_get_modem_stat(struct usb_serial_port *port,
				   unsigned char *msr)
L
Linus Torvalds 已提交
321
{
A
Alan Cox 已提交
322
	int rc;
323 324 325 326 327 328 329
	unsigned char *buf;

	buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
	if (buf == NULL) {
		*msr = 0;
		return -ENOMEM;
	}
330
	rc = usb_control_msg(port->serial->dev, usb_rcvctrlpipe(port->serial->dev, 0),
A
Alan Cox 已提交
331 332
			MCT_U232_GET_MODEM_STAT_REQUEST,
			MCT_U232_GET_REQUEST_TYPE,
333
			0, 0, buf, MCT_U232_GET_MODEM_STAT_SIZE,
A
Alan Cox 已提交
334
			WDR_TIMEOUT);
L
Linus Torvalds 已提交
335
	if (rc < 0) {
336
		dev_err(&port->dev, "Get MODEM STATus failed (error = %d)\n", rc);
L
Linus Torvalds 已提交
337
		*msr = 0;
338 339
	} else {
		*msr = buf[0];
L
Linus Torvalds 已提交
340
	}
341
	dev_dbg(&port->dev, "get_modem_stat: 0x%x\n", *msr);
342
	kfree(buf);
A
Alan Cox 已提交
343
	return rc;
L
Linus Torvalds 已提交
344 345
} /* mct_u232_get_modem_stat */

346 347 348 349 350 351 352 353 354 355 356 357 358 359
static void mct_u232_msr_to_icount(struct async_icount *icount,
						unsigned char msr)
{
	/* Translate Control Line states */
	if (msr & MCT_U232_MSR_DDSR)
		icount->dsr++;
	if (msr & MCT_U232_MSR_DCTS)
		icount->cts++;
	if (msr & MCT_U232_MSR_DRI)
		icount->rng++;
	if (msr & MCT_U232_MSR_DCD)
		icount->dcd++;
} /* mct_u232_msr_to_icount */

360 361
static void mct_u232_msr_to_state(struct usb_serial_port *port,
				  unsigned int *control_state, unsigned char msr)
L
Linus Torvalds 已提交
362
{
A
Alan Cox 已提交
363
	/* Translate Control Line states */
L
Linus Torvalds 已提交
364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379
	if (msr & MCT_U232_MSR_DSR)
		*control_state |=  TIOCM_DSR;
	else
		*control_state &= ~TIOCM_DSR;
	if (msr & MCT_U232_MSR_CTS)
		*control_state |=  TIOCM_CTS;
	else
		*control_state &= ~TIOCM_CTS;
	if (msr & MCT_U232_MSR_RI)
		*control_state |=  TIOCM_RI;
	else
		*control_state &= ~TIOCM_RI;
	if (msr & MCT_U232_MSR_CD)
		*control_state |=  TIOCM_CD;
	else
		*control_state &= ~TIOCM_CD;
380
	dev_dbg(&port->dev, "msr_to_state: msr=0x%x ==> state=0x%x\n", msr, *control_state);
L
Linus Torvalds 已提交
381 382 383 384 385 386
} /* mct_u232_msr_to_state */

/*
 * Driver's tty interface functions
 */

A
Alan Cox 已提交
387
static int mct_u232_startup(struct usb_serial *serial)
L
Linus Torvalds 已提交
388 389 390 391 392 393
{
	struct usb_serial_port *port, *rport;

	/* Puh, that's dirty */
	port = serial->port[0];
	rport = serial->port[1];
M
Mariusz Kozlowski 已提交
394 395
	/* No unlinking, it wasn't submitted yet. */
	usb_free_urb(port->read_urb);
L
Linus Torvalds 已提交
396 397 398 399
	port->read_urb = rport->interrupt_in_urb;
	rport->interrupt_in_urb = NULL;
	port->read_urb->context = port;

A
Alan Cox 已提交
400
	return 0;
L
Linus Torvalds 已提交
401 402
} /* mct_u232_startup */

403 404 405 406 407 408 409
static int mct_u232_port_probe(struct usb_serial_port *port)
{
	struct mct_u232_private *priv;

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;
L
Linus Torvalds 已提交
410

411 412 413 414 415 416 417 418 419
	spin_lock_init(&priv->lock);
	init_waitqueue_head(&priv->msr_wait);

	usb_set_serial_port_data(port, priv);

	return 0;
}

static int mct_u232_port_remove(struct usb_serial_port *port)
L
Linus Torvalds 已提交
420 421
{
	struct mct_u232_private *priv;
A
Alan Cox 已提交
422

423 424 425 426 427
	priv = usb_get_serial_port_data(port);
	kfree(priv);

	return 0;
}
L
Linus Torvalds 已提交
428

429
static int  mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port)
L
Linus Torvalds 已提交
430 431 432 433 434 435 436 437 438 439 440 441 442 443
{
	struct usb_serial *serial = port->serial;
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	int retval = 0;
	unsigned int control_state;
	unsigned long flags;
	unsigned char last_lcr;
	unsigned char last_msr;

	/* Compensate for a hardware bug: although the Sitecom U232-P25
	 * device reports a maximum output packet size of 32 bytes,
	 * it seems to be able to accept only 16 bytes (and that's what
	 * SniffUSB says too...)
	 */
A
Alan Cox 已提交
444 445
	if (le16_to_cpu(serial->dev->descriptor.idProduct)
						== MCT_U232_SITECOM_PID)
L
Linus Torvalds 已提交
446 447
		port->bulk_out_size = 16;

A
Alan Cox 已提交
448
	/* Do a defined restart: the normal serial device seems to
L
Linus Torvalds 已提交
449 450 451 452 453
	 * always turn on DTR and RTS here, so do the same. I'm not
	 * sure if this is really necessary. But it should not harm
	 * either.
	 */
	spin_lock_irqsave(&priv->lock, flags);
454
	if (tty && (tty->termios.c_cflag & CBAUD))
L
Linus Torvalds 已提交
455 456 457
		priv->control_state = TIOCM_DTR | TIOCM_RTS;
	else
		priv->control_state = 0;
A
Alan Cox 已提交
458 459

	priv->last_lcr = (MCT_U232_DATA_BITS_8 |
L
Linus Torvalds 已提交
460 461 462 463 464
			  MCT_U232_PARITY_NONE |
			  MCT_U232_STOP_BITS_1);
	control_state = priv->control_state;
	last_lcr = priv->last_lcr;
	spin_unlock_irqrestore(&priv->lock, flags);
465 466
	mct_u232_set_modem_ctrl(port, control_state);
	mct_u232_set_line_ctrl(port, last_lcr);
L
Linus Torvalds 已提交
467 468

	/* Read modem status and update control state */
469
	mct_u232_get_modem_stat(port, &last_msr);
L
Linus Torvalds 已提交
470 471
	spin_lock_irqsave(&priv->lock, flags);
	priv->last_msr = last_msr;
472
	mct_u232_msr_to_state(port, &priv->control_state, priv->last_msr);
L
Linus Torvalds 已提交
473 474 475 476
	spin_unlock_irqrestore(&priv->lock, flags);

	retval = usb_submit_urb(port->read_urb, GFP_KERNEL);
	if (retval) {
477 478 479
		dev_err(&port->dev,
			"usb_submit_urb(read bulk) failed pipe 0x%x err %d\n",
			port->read_urb->pipe, retval);
480
		goto error;
L
Linus Torvalds 已提交
481 482 483
	}

	retval = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
484 485
	if (retval) {
		usb_kill_urb(port->read_urb);
486 487 488
		dev_err(&port->dev,
			"usb_submit_urb(read int) failed pipe 0x%x err %d",
			port->interrupt_in_urb->pipe, retval);
489 490
		goto error;
	}
L
Linus Torvalds 已提交
491
	return 0;
492 493 494

error:
	return retval;
L
Linus Torvalds 已提交
495 496
} /* mct_u232_open */

497
static void mct_u232_dtr_rts(struct usb_serial_port *port, int on)
L
Linus Torvalds 已提交
498
{
499 500
	unsigned int control_state;
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
L
Linus Torvalds 已提交
501

502 503 504 505 506 507 508 509 510
	spin_lock_irq(&priv->lock);
	if (on)
		priv->control_state |= TIOCM_DTR | TIOCM_RTS;
	else
		priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS);
	control_state = priv->control_state;
	spin_unlock_irq(&priv->lock);

	mct_u232_set_modem_ctrl(port, control_state);
511
}
512

513 514
static void mct_u232_close(struct usb_serial_port *port)
{
J
Johan Hovold 已提交
515 516 517 518 519 520 521 522
	/*
	 * Must kill the read urb as it is actually an interrupt urb, which
	 * generic close thus fails to kill.
	 */
	usb_kill_urb(port->read_urb);
	usb_kill_urb(port->interrupt_in_urb);

	usb_serial_generic_close(port);
L
Linus Torvalds 已提交
523 524 525
} /* mct_u232_close */


A
Alan Cox 已提交
526
static void mct_u232_read_int_callback(struct urb *urb)
L
Linus Torvalds 已提交
527
{
528
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
529 530 531
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
532 533
	int retval;
	int status = urb->status;
L
Linus Torvalds 已提交
534 535
	unsigned long flags;

536
	switch (status) {
L
Linus Torvalds 已提交
537 538 539 540 541 542 543
	case 0:
		/* success */
		break;
	case -ECONNRESET:
	case -ENOENT:
	case -ESHUTDOWN:
		/* this urb is terminated, clean up */
544 545
		dev_dbg(&port->dev, "%s - urb shutting down with status: %d\n",
			__func__, status);
L
Linus Torvalds 已提交
546 547
		return;
	default:
548 549
		dev_dbg(&port->dev, "%s - nonzero urb status received: %d\n",
			__func__, status);
L
Linus Torvalds 已提交
550 551 552
		goto exit;
	}

553
	usb_serial_debug_data(&port->dev, __func__, urb->actual_length, data);
L
Linus Torvalds 已提交
554 555 556 557 558 559

	/*
	 * Work-a-round: handle the 'usual' bulk-in pipe here
	 */
	if (urb->transfer_buffer_length > 2) {
		if (urb->actual_length) {
560 561 562 563 564 565
			tty = tty_port_tty_get(&port->port);
			if (tty) {
				tty_insert_flip_string(tty, data,
						urb->actual_length);
				tty_flip_buffer_push(tty);
			}
A
Alan Cox 已提交
566
			tty_kref_put(tty);
L
Linus Torvalds 已提交
567 568 569
		}
		goto exit;
	}
A
Alan Cox 已提交
570

L
Linus Torvalds 已提交
571 572 573 574 575 576
	/*
	 * The interrupt-in pipe signals exceptional conditions (modem line
	 * signal changes and errors). data[0] holds MSR, data[1] holds LSR.
	 */
	spin_lock_irqsave(&priv->lock, flags);
	priv->last_msr = data[MCT_U232_MSR_INDEX];
A
Alan Cox 已提交
577

L
Linus Torvalds 已提交
578
	/* Record Control Line states */
579
	mct_u232_msr_to_state(port, &priv->control_state, priv->last_msr);
L
Linus Torvalds 已提交
580

581 582
	mct_u232_msr_to_icount(&priv->icount, priv->last_msr);

L
Linus Torvalds 已提交
583
#if 0
A
Alan Cox 已提交
584
	/* Not yet handled. See belkin_sa.c for further information */
L
Linus Torvalds 已提交
585 586 587 588 589 590 591 592
	/* Now to report any errors */
	priv->last_lsr = data[MCT_U232_LSR_INDEX];
	/*
	 * fill in the flip buffer here, but I do not know the relation
	 * to the current/next receive buffer or characters.  I need
	 * to look in to this before committing any code.
	 */
	if (priv->last_lsr & MCT_U232_LSR_ERR) {
A
Alan Cox 已提交
593
		tty = tty_port_tty_get(&port->port);
L
Linus Torvalds 已提交
594 595 596 597 598 599 600 601 602 603 604 605
		/* Overrun Error */
		if (priv->last_lsr & MCT_U232_LSR_OE) {
		}
		/* Parity Error */
		if (priv->last_lsr & MCT_U232_LSR_PE) {
		}
		/* Framing Error */
		if (priv->last_lsr & MCT_U232_LSR_FE) {
		}
		/* Break Indicator */
		if (priv->last_lsr & MCT_U232_LSR_BI) {
		}
A
Alan Cox 已提交
606
		tty_kref_put(tty);
L
Linus Torvalds 已提交
607 608
	}
#endif
609
	wake_up_interruptible(&priv->msr_wait);
L
Linus Torvalds 已提交
610 611
	spin_unlock_irqrestore(&priv->lock, flags);
exit:
A
Alan Cox 已提交
612
	retval = usb_submit_urb(urb, GFP_ATOMIC);
613
	if (retval)
614 615 616
		dev_err(&port->dev,
			"%s - usb_submit_urb failed with result %d\n",
			__func__, retval);
L
Linus Torvalds 已提交
617 618
} /* mct_u232_read_int_callback */

A
Alan Cox 已提交
619 620 621
static void mct_u232_set_termios(struct tty_struct *tty,
				 struct usb_serial_port *port,
				 struct ktermios *old_termios)
L
Linus Torvalds 已提交
622 623 624
{
	struct usb_serial *serial = port->serial;
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
625
	struct ktermios *termios = &tty->termios;
626
	unsigned int cflag = termios->c_cflag;
L
Linus Torvalds 已提交
627 628
	unsigned int old_cflag = old_termios->c_cflag;
	unsigned long flags;
629
	unsigned int control_state;
L
Linus Torvalds 已提交
630 631 632 633 634 635 636 637 638 639 640 641 642 643 644
	unsigned char last_lcr;

	/* get a local copy of the current port settings */
	spin_lock_irqsave(&priv->lock, flags);
	control_state = priv->control_state;
	spin_unlock_irqrestore(&priv->lock, flags);
	last_lcr = 0;

	/*
	 * Update baud rate.
	 * Do not attempt to cache old rates and skip settings,
	 * disconnects screw such tricks up completely.
	 * Premature optimization is the root of all evil.
	 */

A
Alan Cox 已提交
645
	/* reassert DTR and RTS on transition from B0 */
L
Linus Torvalds 已提交
646
	if ((old_cflag & CBAUD) == B0) {
647
		dev_dbg(&port->dev, "%s: baud was B0\n", __func__);
648
		control_state |= TIOCM_DTR | TIOCM_RTS;
649
		mct_u232_set_modem_ctrl(port, control_state);
L
Linus Torvalds 已提交
650 651
	}

A
Alan Cox 已提交
652
	mct_u232_set_baud_rate(tty, serial, port, tty_get_baud_rate(tty));
L
Linus Torvalds 已提交
653

A
Alan Cox 已提交
654
	if ((cflag & CBAUD) == B0) {
655
		dev_dbg(&port->dev, "%s: baud is B0\n", __func__);
L
Linus Torvalds 已提交
656 657
		/* Drop RTS and DTR */
		control_state &= ~(TIOCM_DTR | TIOCM_RTS);
658
		mct_u232_set_modem_ctrl(port, control_state);
L
Linus Torvalds 已提交
659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682
	}

	/*
	 * Update line control register (LCR)
	 */

	/* set the parity */
	if (cflag & PARENB)
		last_lcr |= (cflag & PARODD) ?
			MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN;
	else
		last_lcr |= MCT_U232_PARITY_NONE;

	/* set the number of data bits */
	switch (cflag & CSIZE) {
	case CS5:
		last_lcr |= MCT_U232_DATA_BITS_5; break;
	case CS6:
		last_lcr |= MCT_U232_DATA_BITS_6; break;
	case CS7:
		last_lcr |= MCT_U232_DATA_BITS_7; break;
	case CS8:
		last_lcr |= MCT_U232_DATA_BITS_8; break;
	default:
683 684
		dev_err(&port->dev,
			"CSIZE was not CS5-CS8, using default of 8\n");
L
Linus Torvalds 已提交
685 686 687 688
		last_lcr |= MCT_U232_DATA_BITS_8;
		break;
	}

689 690
	termios->c_cflag &= ~CMSPAR;

L
Linus Torvalds 已提交
691 692 693 694
	/* set the number of stop bits */
	last_lcr |= (cflag & CSTOPB) ?
		MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1;

695
	mct_u232_set_line_ctrl(port, last_lcr);
L
Linus Torvalds 已提交
696 697 698 699 700 701 702 703

	/* save off the modified port settings */
	spin_lock_irqsave(&priv->lock, flags);
	priv->control_state = control_state;
	priv->last_lcr = last_lcr;
	spin_unlock_irqrestore(&priv->lock, flags);
} /* mct_u232_set_termios */

A
Alan Cox 已提交
704
static void mct_u232_break_ctl(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
705
{
A
Alan Cox 已提交
706
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
707 708 709 710 711 712 713 714 715
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	unsigned char lcr;
	unsigned long flags;

	spin_lock_irqsave(&priv->lock, flags);
	lcr = priv->last_lcr;

	if (break_state)
		lcr |= MCT_U232_SET_BREAK;
716
	spin_unlock_irqrestore(&priv->lock, flags);
L
Linus Torvalds 已提交
717

718
	mct_u232_set_line_ctrl(port, lcr);
L
Linus Torvalds 已提交
719 720 721
} /* mct_u232_break_ctl */


722
static int mct_u232_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
723
{
A
Alan Cox 已提交
724
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
725 726 727
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	unsigned int control_state;
	unsigned long flags;
A
Alan Cox 已提交
728

L
Linus Torvalds 已提交
729 730 731 732 733 734 735
	spin_lock_irqsave(&priv->lock, flags);
	control_state = priv->control_state;
	spin_unlock_irqrestore(&priv->lock, flags);

	return control_state;
}

736
static int mct_u232_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
737 738
			      unsigned int set, unsigned int clear)
{
A
Alan Cox 已提交
739
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
740 741 742
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	unsigned int control_state;
	unsigned long flags;
A
Alan Cox 已提交
743

L
Linus Torvalds 已提交
744 745 746 747 748 749 750 751 752 753 754 755 756 757
	spin_lock_irqsave(&priv->lock, flags);
	control_state = priv->control_state;

	if (set & TIOCM_RTS)
		control_state |= TIOCM_RTS;
	if (set & TIOCM_DTR)
		control_state |= TIOCM_DTR;
	if (clear & TIOCM_RTS)
		control_state &= ~TIOCM_RTS;
	if (clear & TIOCM_DTR)
		control_state &= ~TIOCM_DTR;

	priv->control_state = control_state;
	spin_unlock_irqrestore(&priv->lock, flags);
758
	return mct_u232_set_modem_ctrl(port, control_state);
L
Linus Torvalds 已提交
759 760
}

A
Alan Cox 已提交
761
static void mct_u232_throttle(struct tty_struct *tty)
762
{
A
Alan Cox 已提交
763
	struct usb_serial_port *port = tty->driver_data;
764 765 766
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	unsigned int control_state;

767
	spin_lock_irq(&priv->lock);
768 769
	priv->rx_flags |= THROTTLED;
	if (C_CRTSCTS(tty)) {
A
Alan Cox 已提交
770 771
		priv->control_state &= ~TIOCM_RTS;
		control_state = priv->control_state;
772
		spin_unlock_irq(&priv->lock);
773
		mct_u232_set_modem_ctrl(port, control_state);
774
	} else {
775
		spin_unlock_irq(&priv->lock);
776 777 778
	}
}

A
Alan Cox 已提交
779
static void mct_u232_unthrottle(struct tty_struct *tty)
780
{
A
Alan Cox 已提交
781
	struct usb_serial_port *port = tty->driver_data;
782 783 784
	struct mct_u232_private *priv = usb_get_serial_port_data(port);
	unsigned int control_state;

785
	spin_lock_irq(&priv->lock);
786
	if ((priv->rx_flags & THROTTLED) && C_CRTSCTS(tty)) {
A
Alan Cox 已提交
787 788 789
		priv->rx_flags &= ~THROTTLED;
		priv->control_state |= TIOCM_RTS;
		control_state = priv->control_state;
790
		spin_unlock_irq(&priv->lock);
791
		mct_u232_set_modem_ctrl(port, control_state);
792
	} else {
793
		spin_unlock_irq(&priv->lock);
794 795
	}
}
L
Linus Torvalds 已提交
796

797
static int  mct_u232_ioctl(struct tty_struct *tty,
798 799 800 801 802 803 804 805
			unsigned int cmd, unsigned long arg)
{
	DEFINE_WAIT(wait);
	struct usb_serial_port *port = tty->driver_data;
	struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
	struct async_icount cnow, cprev;
	unsigned long flags;

806
	dev_dbg(&port->dev, "%s - cmd = 0x%x\n", __func__, cmd);
807 808 809 810 811

	switch (cmd) {

	case TIOCMIWAIT:

812
		dev_dbg(&port->dev, "%s TIOCMIWAIT", __func__);
813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867

		spin_lock_irqsave(&mct_u232_port->lock, flags);
		cprev = mct_u232_port->icount;
		spin_unlock_irqrestore(&mct_u232_port->lock, flags);
		for ( ; ; ) {
			prepare_to_wait(&mct_u232_port->msr_wait,
					&wait, TASK_INTERRUPTIBLE);
			schedule();
			finish_wait(&mct_u232_port->msr_wait, &wait);
			/* see if a signal did it */
			if (signal_pending(current))
				return -ERESTARTSYS;
			spin_lock_irqsave(&mct_u232_port->lock, flags);
			cnow = mct_u232_port->icount;
			spin_unlock_irqrestore(&mct_u232_port->lock, flags);
			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;
		}

	}
	return -ENOIOCTLCMD;
}

static int  mct_u232_get_icount(struct tty_struct *tty,
			struct serial_icounter_struct *icount)
{
	struct usb_serial_port *port = tty->driver_data;
	struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
	struct async_icount *ic = &mct_u232_port->icount;
	unsigned long flags;

	spin_lock_irqsave(&mct_u232_port->lock, flags);

	icount->cts = ic->cts;
	icount->dsr = ic->dsr;
	icount->rng = ic->rng;
	icount->dcd = ic->dcd;
	icount->rx = ic->rx;
	icount->tx = ic->tx;
	icount->frame = ic->frame;
	icount->overrun = ic->overrun;
	icount->parity = ic->parity;
	icount->brk = ic->brk;
	icount->buf_overrun = ic->buf_overrun;

	spin_unlock_irqrestore(&mct_u232_port->lock, flags);

868 869
	dev_dbg(&port->dev, "%s TIOCGICOUNT RX=%d, TX=%d\n",
		__func__,  icount->rx, icount->tx);
870 871 872
	return 0;
}

873
module_usb_serial_driver(serial_drivers, id_table);
L
Linus Torvalds 已提交
874

A
Alan Cox 已提交
875 876
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
877
MODULE_LICENSE("GPL");