option.c 24.2 KB
Newer Older
1
/*
2
  USB Driver for GSM modems
3 4 5 6 7 8 9 10 11

  Copyright (C) 2005  Matthias Urlichs <smurf@smurf.noris.de>

  This driver is free software; you can redistribute it and/or modify
  it under the terms of Version 2 of the GNU General Public License as
  published by the Free Software Foundation.

  Portions copied from the Keyspan driver by Hugh Blemings <hugh@blemings.org>

12
  History: see the git log.
13 14 15

  Work sponsored by: Sigos GmbH, Germany <info@sigos.de>

16 17 18
  This driver exists because the "normal" serial driver doesn't work too well
  with GSM modems. Issues:
  - data loss -- one single Receive URB is not nearly enough
19
  - nonstandard flow (Option devices) control
20 21 22 23 24 25 26 27 28
  - controlling the baud rate doesn't make sense

  This driver is named "option" because the most common device it's
  used for is a PC-Card (with an internal OHCI-USB interface, behind
  which the GSM interface sits), made by Option Inc.

  Some of the "one port" devices actually exhibit multiple USB instances
  on the USB bus. This is not a bug, these ports are used for different
  device features.
29
*/
30

31
#define DRIVER_VERSION "v0.7.1"
32
#define DRIVER_AUTHOR "Matthias Urlichs <smurf@smurf.noris.de>"
33
#define DRIVER_DESC "USB Driver for GSM modems"
34 35 36 37 38 39 40

#include <linux/kernel.h>
#include <linux/jiffies.h>
#include <linux/errno.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
41
#include <linux/bitops.h>
42
#include <linux/usb.h>
43
#include <linux/usb/serial.h>
44 45

/* Function prototypes */
46 47 48 49 50 51 52
static int  option_open(struct usb_serial_port *port, struct file *filp);
static void option_close(struct usb_serial_port *port, struct file *filp);
static int  option_startup(struct usb_serial *serial);
static void option_shutdown(struct usb_serial *serial);
static void option_rx_throttle(struct usb_serial_port *port);
static void option_rx_unthrottle(struct usb_serial_port *port);
static int  option_write_room(struct usb_serial_port *port);
53

54
static void option_instat_callback(struct urb *urb);
55

56 57
static int option_write(struct usb_serial_port *port,
			const unsigned char *buf, int count);
58

59 60 61 62
static int  option_chars_in_buffer(struct usb_serial_port *port);
static int  option_ioctl(struct usb_serial_port *port, struct file *file,
			unsigned int cmd, unsigned long arg);
static void option_set_termios(struct usb_serial_port *port,
A
Alan Cox 已提交
63
				struct ktermios *old);
64 65 66 67 68
static void option_break_ctl(struct usb_serial_port *port, int break_state);
static int  option_tiocmget(struct usb_serial_port *port, struct file *file);
static int  option_tiocmset(struct usb_serial_port *port, struct file *file,
				unsigned int set, unsigned int clear);
static int  option_send_setup(struct usb_serial_port *port);
69 70

/* Vendor and product IDs */
71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110
#define OPTION_VENDOR_ID			0x0AF0
#define OPTION_PRODUCT_COLT			0x5000
#define OPTION_PRODUCT_RICOLA			0x6000
#define OPTION_PRODUCT_RICOLA_LIGHT		0x6100
#define OPTION_PRODUCT_RICOLA_QUAD		0x6200
#define OPTION_PRODUCT_RICOLA_QUAD_LIGHT	0x6300
#define OPTION_PRODUCT_RICOLA_NDIS		0x6050
#define OPTION_PRODUCT_RICOLA_NDIS_LIGHT	0x6150
#define OPTION_PRODUCT_RICOLA_NDIS_QUAD		0x6250
#define OPTION_PRODUCT_RICOLA_NDIS_QUAD_LIGHT	0x6350
#define OPTION_PRODUCT_COBRA			0x6500
#define OPTION_PRODUCT_COBRA_BUS		0x6501
#define OPTION_PRODUCT_VIPER			0x6600
#define OPTION_PRODUCT_VIPER_BUS		0x6601
#define OPTION_PRODUCT_GT_MAX_READY		0x6701
#define OPTION_PRODUCT_GT_MAX			0x6711
#define OPTION_PRODUCT_FUJI_MODEM_LIGHT		0x6721
#define OPTION_PRODUCT_FUJI_MODEM_GT		0x6741
#define OPTION_PRODUCT_FUJI_MODEM_EX		0x6761
#define OPTION_PRODUCT_FUJI_NETWORK_LIGHT	0x6731
#define OPTION_PRODUCT_FUJI_NETWORK_GT		0x6751
#define OPTION_PRODUCT_FUJI_NETWORK_EX		0x6771
#define OPTION_PRODUCT_KOI_MODEM		0x6800
#define OPTION_PRODUCT_KOI_NETWORK		0x6811
#define OPTION_PRODUCT_SCORPION_MODEM		0x6901
#define OPTION_PRODUCT_SCORPION_NETWORK		0x6911
#define OPTION_PRODUCT_ETNA_MODEM		0x7001
#define OPTION_PRODUCT_ETNA_NETWORK		0x7011
#define OPTION_PRODUCT_ETNA_MODEM_LITE		0x7021
#define OPTION_PRODUCT_ETNA_MODEM_GT		0x7041
#define OPTION_PRODUCT_ETNA_MODEM_EX		0x7061
#define OPTION_PRODUCT_ETNA_NETWORK_LITE	0x7031
#define OPTION_PRODUCT_ETNA_NETWORK_GT		0x7051
#define OPTION_PRODUCT_ETNA_NETWORK_EX		0x7071
#define OPTION_PRODUCT_ETNA_KOI_MODEM		0x7100
#define OPTION_PRODUCT_ETNA_KOI_NETWORK		0x7111

#define HUAWEI_VENDOR_ID			0x12D1
#define HUAWEI_PRODUCT_E600			0x1001
#define HUAWEI_PRODUCT_E220			0x1003
111
#define HUAWEI_PRODUCT_E220BIS			0x1004
112 113

#define NOVATELWIRELESS_VENDOR_ID		0x1410
114
#define DELL_VENDOR_ID				0x413C
115 116

#define ANYDATA_VENDOR_ID			0x16d5
117 118
#define ANYDATA_PRODUCT_ADU_E100A		0x6501
#define ANYDATA_PRODUCT_ADU_500A		0x6502
119

120 121 122 123
#define BANDRICH_VENDOR_ID			0x1A8D
#define BANDRICH_PRODUCT_C100_1			0x1002
#define BANDRICH_PRODUCT_C100_2			0x1003

124
static struct usb_device_id option_ids[] = {
125 126 127 128 129 130 131 132 133
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_COLT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_LIGHT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_QUAD) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_QUAD_LIGHT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_NDIS) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_NDIS_LIGHT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_NDIS_QUAD) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_RICOLA_NDIS_QUAD_LIGHT) },
134
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_COBRA) },
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_COBRA_BUS) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_VIPER) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_VIPER_BUS) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_GT_MAX_READY) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_GT_MAX) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_MODEM_LIGHT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_MODEM_GT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_MODEM_EX) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_NETWORK_LIGHT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_NETWORK_GT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUJI_NETWORK_EX) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_KOI_MODEM) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_KOI_NETWORK) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_SCORPION_MODEM) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_SCORPION_NETWORK) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_MODEM) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_NETWORK) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_MODEM_LITE) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_MODEM_GT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_MODEM_EX) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_NETWORK_LITE) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_NETWORK_GT) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_NETWORK_EX) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_KOI_MODEM) },
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_ETNA_KOI_NETWORK) },
160
	{ USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E600) },
161
	{ USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E220) },
162
	{ USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E220BIS) },
163 164 165 166 167 168 169 170 171 172 173 174
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1100) }, /* Novatel Merlin XS620/S640 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1110) }, /* Novatel Merlin S620 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1120) }, /* Novatel Merlin EX720 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1130) }, /* Novatel Merlin S720 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1400) }, /* Novatel U730 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1410) }, /* Novatel U740 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1420) }, /* Novatel EU870 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x1430) }, /* Novatel Merlin XU870 HSDPA/3G */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x2100) }, /* Novatel EV620 CDMA/EV-DO */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x2110) }, /* Novatel Merlin ES620 / Merlin ES720 / Ovation U720 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x2130) }, /* Novatel Merlin ES620 SM Bus */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x2410) }, /* Novatel EU740 */
175 176
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x4100) }, /* Novatel U727 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x4400) }, /* Novatel MC950 */
177 178 179 180 181 182
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8114) },	/* Dell Wireless 5700 Mobile Broadband CDMA/EVDO Mini-Card == Novatel Expedite EV620 CDMA/EV-DO */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8115) },	/* Dell Wireless 5500 Mobile Broadband HSDPA Mini-Card == Novatel Expedite EU740 HSDPA/3G */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8116) },	/* Dell Wireless 5505 Mobile Broadband HSDPA Mini-Card == Novatel Expedite EU740 HSDPA/3G */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8117) },	/* Dell Wireless 5700 Mobile Broadband CDMA/EVDO ExpressCard == Novatel Merlin XV620 CDMA/EV-DO */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8118) },	/* Dell Wireless 5510 Mobile Broadband HSDPA ExpressCard == Novatel Merlin XU870 HSDPA/3G */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8128) },	/* Dell Wireless 5700 Mobile Broadband CDMA/EVDO Mini-Card == Novatel Expedite E720 CDMA/EV-DO */
183
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8137) },	/* Dell Wireless HSDPA 5520 */
184 185
	{ USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_E100A) },
	{ USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_500A) },
186 187
	{ USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_1) },
	{ USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_2) },
188 189
	{ } /* Terminating entry */
};
190 191 192 193 194 195 196
MODULE_DEVICE_TABLE(usb, option_ids);

static struct usb_driver option_driver = {
	.name       = "option",
	.probe      = usb_serial_probe,
	.disconnect = usb_serial_disconnect,
	.id_table   = option_ids,
197
	.no_dynamic_id = 	1,
198 199
};

U
Uwe Zeisberger 已提交
200
/* The card has three separate interfaces, which the serial driver
201 202
 * recognizes separately, thus num_port=1.
 */
203 204 205 206

static struct usb_serial_driver option_1port_device = {
	.driver = {
		.owner =	THIS_MODULE,
207
		.name =		"option1",
208 209
	},
	.description       = "GSM modem (1-port)",
210
	.usb_driver        = &option_driver,
211
	.id_table          = option_ids,
212 213 214
	.num_interrupt_in  = NUM_DONT_CARE,
	.num_bulk_in       = NUM_DONT_CARE,
	.num_bulk_out      = NUM_DONT_CARE,
215
	.num_ports         = 1,
216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
	.open              = option_open,
	.close             = option_close,
	.write             = option_write,
	.write_room        = option_write_room,
	.chars_in_buffer   = option_chars_in_buffer,
	.throttle          = option_rx_throttle,
	.unthrottle        = option_rx_unthrottle,
	.ioctl             = option_ioctl,
	.set_termios       = option_set_termios,
	.break_ctl         = option_break_ctl,
	.tiocmget          = option_tiocmget,
	.tiocmset          = option_tiocmset,
	.attach            = option_startup,
	.shutdown          = option_shutdown,
	.read_int_callback = option_instat_callback,
231 232
};

233
#ifdef CONFIG_USB_DEBUG
234
static int debug;
235 236 237 238
#else
#define debug 0
#endif

239 240
/* per port private data */

241 242
#define N_IN_URB 4
#define N_OUT_URB 1
243
#define IN_BUFLEN 4096
244
#define OUT_BUFLEN 128
245 246 247

struct option_port_private {
	/* Input endpoints and buffer for this port */
248 249
	struct urb *in_urbs[N_IN_URB];
	char in_buffer[N_IN_URB][IN_BUFLEN];
250
	/* Output endpoints and buffer for this port */
251 252
	struct urb *out_urbs[N_OUT_URB];
	char out_buffer[N_OUT_URB][OUT_BUFLEN];
253
	unsigned long out_busy;		/* Bit vector of URBs in use */
254 255

	/* Settings for the port */
256 257 258 259 260 261 262 263
	int rts_state;	/* Handshaking pins (outputs) */
	int dtr_state;
	int cts_state;	/* Handshaking pins (inputs) */
	int dsr_state;
	int dcd_state;
	int ri_state;

	unsigned long tx_start_time[N_OUT_URB];
264 265 266
};

/* Functions used by new usb-serial code. */
267
static int __init option_init(void)
268 269
{
	int retval;
270 271 272
	retval = usb_serial_register(&option_1port_device);
	if (retval)
		goto failed_1port_device_register;
273 274 275 276 277 278 279 280 281
	retval = usb_register(&option_driver);
	if (retval)
		goto failed_driver_register;

	info(DRIVER_DESC ": " DRIVER_VERSION);

	return 0;

failed_driver_register:
282 283
	usb_serial_deregister (&option_1port_device);
failed_1port_device_register:
284 285 286
	return retval;
}

287
static void __exit option_exit(void)
288 289
{
	usb_deregister (&option_driver);
290
	usb_serial_deregister (&option_1port_device);
291 292 293 294 295
}

module_init(option_init);
module_exit(option_exit);

296
static void option_rx_throttle(struct usb_serial_port *port)
297 298 299 300
{
	dbg("%s", __FUNCTION__);
}

301
static void option_rx_unthrottle(struct usb_serial_port *port)
302 303 304 305
{
	dbg("%s", __FUNCTION__);
}

306
static void option_break_ctl(struct usb_serial_port *port, int break_state)
307 308
{
	/* Unfortunately, I don't know how to send a break */
309
	dbg("%s", __FUNCTION__);
310 311
}

312
static void option_set_termios(struct usb_serial_port *port,
A
Alan Cox 已提交
313
			struct ktermios *old_termios)
314 315 316 317 318 319
{
	dbg("%s", __FUNCTION__);

	option_send_setup(port);
}

320
static int option_tiocmget(struct usb_serial_port *port, struct file *file)
321
{
322 323
	unsigned int value;
	struct option_port_private *portdata;
324 325 326 327 328 329 330 331 332 333 334 335 336

	portdata = usb_get_serial_port_data(port);

	value = ((portdata->rts_state) ? TIOCM_RTS : 0) |
		((portdata->dtr_state) ? TIOCM_DTR : 0) |
		((portdata->cts_state) ? TIOCM_CTS : 0) |
		((portdata->dsr_state) ? TIOCM_DSR : 0) |
		((portdata->dcd_state) ? TIOCM_CAR : 0) |
		((portdata->ri_state) ? TIOCM_RNG : 0);

	return value;
}

337 338
static int option_tiocmset(struct usb_serial_port *port, struct file *file,
			unsigned int set, unsigned int clear)
339
{
340
	struct option_port_private *portdata;
341 342 343 344 345 346 347 348 349 350 351 352 353 354 355

	portdata = usb_get_serial_port_data(port);

	if (set & TIOCM_RTS)
		portdata->rts_state = 1;
	if (set & TIOCM_DTR)
		portdata->dtr_state = 1;

	if (clear & TIOCM_RTS)
		portdata->rts_state = 0;
	if (clear & TIOCM_DTR)
		portdata->dtr_state = 0;
	return option_send_setup(port);
}

356 357
static int option_ioctl(struct usb_serial_port *port, struct file *file,
			unsigned int cmd, unsigned long arg)
358 359 360 361 362
{
	return -ENOIOCTLCMD;
}

/* Write */
363 364
static int option_write(struct usb_serial_port *port,
			const unsigned char *buf, int count)
365
{
366 367 368 369 370
	struct option_port_private *portdata;
	int i;
	int left, todo;
	struct urb *this_urb = NULL; /* spurious */
	int err;
371 372 373 374 375 376 377

	portdata = usb_get_serial_port_data(port);

	dbg("%s: write (%d chars)", __FUNCTION__, count);

	i = 0;
	left = count;
378
	for (i=0; left > 0 && i < N_OUT_URB; i++) {
379 380 381 382
		todo = left;
		if (todo > OUT_BUFLEN)
			todo = OUT_BUFLEN;

383
		this_urb = portdata->out_urbs[i];
384
		if (test_and_set_bit(i, &portdata->out_busy)) {
385 386
			if (time_before(jiffies,
					portdata->tx_start_time[i] + 10 * HZ))
387 388
				continue;
			usb_unlink_urb(this_urb);
389
			continue;
390
		}
391
		if (this_urb->status != 0)
392 393
			dbg("usb_write %p failed (err=%d)",
				this_urb, this_urb->status);
394

395 396
		dbg("%s: endpoint %d buf %d", __FUNCTION__,
			usb_pipeendpoint(this_urb->pipe), i);
397

398
		/* send the data */
399 400 401 402 403 404
		memcpy (this_urb->transfer_buffer, buf, todo);
		this_urb->transfer_buffer_length = todo;

		this_urb->dev = port->serial->dev;
		err = usb_submit_urb(this_urb, GFP_ATOMIC);
		if (err) {
405 406 407
			dbg("usb_submit_urb %p (write bulk) failed "
				"(%d, has %d)", this_urb,
				err, this_urb->status);
408
			clear_bit(i, &portdata->out_busy);
409 410 411 412 413 414 415 416 417 418 419 420
			continue;
		}
		portdata->tx_start_time[i] = jiffies;
		buf += todo;
		left -= todo;
	}

	count -= left;
	dbg("%s: wrote (did %d)", __FUNCTION__, count);
	return count;
}

421
static void option_indat_callback(struct urb *urb)
422
{
A
Alan Cox 已提交
423
	int err;
424 425 426 427
	int endpoint;
	struct usb_serial_port *port;
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
428
	int status = urb->status;
429 430 431 432 433 434

	dbg("%s: %p", __FUNCTION__, urb);

	endpoint = usb_pipeendpoint(urb->pipe);
	port = (struct usb_serial_port *) urb->context;

435
	if (status) {
436
		dbg("%s: nonzero status: %d on endpoint %02x.",
437
		    __FUNCTION__, status, endpoint);
438 439 440
	} else {
		tty = port->tty;
		if (urb->actual_length) {
A
Alan Cox 已提交
441 442
			tty_buffer_request_room(tty, urb->actual_length);
			tty_insert_flip_string(tty, data, urb->actual_length);
443 444 445 446 447 448
			tty_flip_buffer_push(tty);
		} else {
			dbg("%s: empty read urb received", __FUNCTION__);
		}

		/* Resubmit urb so we continue receiving */
449
		if (port->open_count && status != -ESHUTDOWN) {
450 451
			err = usb_submit_urb(urb, GFP_ATOMIC);
			if (err)
452 453
				printk(KERN_ERR "%s: resubmit read urb failed. "
					"(%d)", __FUNCTION__, err);
454 455 456 457 458
		}
	}
	return;
}

459
static void option_outdat_callback(struct urb *urb)
460 461
{
	struct usb_serial_port *port;
462 463
	struct option_port_private *portdata;
	int i;
464 465 466 467 468

	dbg("%s", __FUNCTION__);

	port = (struct usb_serial_port *) urb->context;

469
	usb_serial_port_softint(port);
470 471 472 473 474 475 476 477 478

	portdata = usb_get_serial_port_data(port);
	for (i = 0; i < N_OUT_URB; ++i) {
		if (portdata->out_urbs[i] == urb) {
			smp_mb__before_clear_bit();
			clear_bit(i, &portdata->out_busy);
			break;
		}
	}
479 480
}

481
static void option_instat_callback(struct urb *urb)
482 483
{
	int err;
484
	int status = urb->status;
485 486 487 488 489 490 491
	struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
	struct option_port_private *portdata = usb_get_serial_port_data(port);
	struct usb_serial *serial = port->serial;

	dbg("%s", __FUNCTION__);
	dbg("%s: urb %p port %p has data %p", __FUNCTION__,urb,port,portdata);

492
	if (status == 0) {
493 494 495 496 497 498 499
		struct usb_ctrlrequest *req_pkt =
				(struct usb_ctrlrequest *)urb->transfer_buffer;

		if (!req_pkt) {
			dbg("%s: NULL req_pkt\n", __FUNCTION__);
			return;
		}
500 501
		if ((req_pkt->bRequestType == 0xA1) &&
				(req_pkt->bRequest == 0x20)) {
502 503
			int old_dcd_state;
			unsigned char signals = *((unsigned char *)
504 505
					urb->transfer_buffer +
					sizeof(struct usb_ctrlrequest));
506 507 508 509 510 511 512 513 514

			dbg("%s: signal x%x", __FUNCTION__, signals);

			old_dcd_state = portdata->dcd_state;
			portdata->cts_state = 1;
			portdata->dcd_state = ((signals & 0x01) ? 1 : 0);
			portdata->dsr_state = ((signals & 0x02) ? 1 : 0);
			portdata->ri_state = ((signals & 0x08) ? 1 : 0);

515 516
			if (port->tty && !C_CLOCAL(port->tty) &&
					old_dcd_state && !portdata->dcd_state)
517
				tty_hangup(port->tty);
518 519 520 521
		} else {
			dbg("%s: type %x req %x", __FUNCTION__,
				req_pkt->bRequestType,req_pkt->bRequest);
		}
522
	} else
523
		dbg("%s: error %d", __FUNCTION__, status);
524 525

	/* Resubmit urb so we continue receiving IRQ data */
526
	if (status != -ESHUTDOWN) {
527 528 529
		urb->dev = serial->dev;
		err = usb_submit_urb(urb, GFP_ATOMIC);
		if (err)
530 531
			dbg("%s: resubmit intr urb failed. (%d)",
				__FUNCTION__, err);
532 533 534
	}
}

535
static int option_write_room(struct usb_serial_port *port)
536 537 538 539 540 541 542 543
{
	struct option_port_private *portdata;
	int i;
	int data_len = 0;
	struct urb *this_urb;

	portdata = usb_get_serial_port_data(port);

544
	for (i=0; i < N_OUT_URB; i++) {
545
		this_urb = portdata->out_urbs[i];
546
		if (this_urb && !test_bit(i, &portdata->out_busy))
547
			data_len += OUT_BUFLEN;
548
	}
549 550 551 552 553

	dbg("%s: %d", __FUNCTION__, data_len);
	return data_len;
}

554
static int option_chars_in_buffer(struct usb_serial_port *port)
555 556 557 558 559 560 561 562
{
	struct option_port_private *portdata;
	int i;
	int data_len = 0;
	struct urb *this_urb;

	portdata = usb_get_serial_port_data(port);

563
	for (i=0; i < N_OUT_URB; i++) {
564
		this_urb = portdata->out_urbs[i];
565
		if (this_urb && test_bit(i, &portdata->out_busy))
566
			data_len += this_urb->transfer_buffer_length;
567
	}
568 569 570 571
	dbg("%s: %d", __FUNCTION__, data_len);
	return data_len;
}

572
static int option_open(struct usb_serial_port *port, struct file *filp)
573
{
574 575 576 577
	struct option_port_private *portdata;
	struct usb_serial *serial = port->serial;
	int i, err;
	struct urb *urb;
578 579 580 581 582 583 584 585 586 587 588 589 590 591 592

	portdata = usb_get_serial_port_data(port);

	dbg("%s", __FUNCTION__);

	/* Set some sane defaults */
	portdata->rts_state = 1;
	portdata->dtr_state = 1;

	/* Reset low level data toggle and start reading from endpoints */
	for (i = 0; i < N_IN_URB; i++) {
		urb = portdata->in_urbs[i];
		if (! urb)
			continue;
		if (urb->dev != serial->dev) {
593 594
			dbg("%s: dev %p != %p", __FUNCTION__,
				urb->dev, serial->dev);
595 596 597
			continue;
		}

598 599 600 601
		/*
		 * make sure endpoint data toggle is synchronized with the
		 * device
		 */
602 603 604 605
		usb_clear_halt(urb->dev, urb->pipe);

		err = usb_submit_urb(urb, GFP_KERNEL);
		if (err) {
606 607
			dbg("%s: submit urb %d failed (%d) %d",
				__FUNCTION__, i, err,
608 609 610 611 612 613 614 615 616 617
				urb->transfer_buffer_length);
		}
	}

	/* Reset low level data toggle on out endpoints */
	for (i = 0; i < N_OUT_URB; i++) {
		urb = portdata->out_urbs[i];
		if (! urb)
			continue;
		urb->dev = serial->dev;
618 619
		/* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
				usb_pipeout(urb->pipe), 0); */
620 621 622 623 624 625 626 627 628
	}

	port->tty->low_latency = 1;

	option_send_setup(port);

	return (0);
}

629
static void option_close(struct usb_serial_port *port, struct file *filp)
630
{
631 632 633
	int i;
	struct usb_serial *serial = port->serial;
	struct option_port_private *portdata;
634 635 636 637 638 639 640 641 642 643 644 645

	dbg("%s", __FUNCTION__);
	portdata = usb_get_serial_port_data(port);

	portdata->rts_state = 0;
	portdata->dtr_state = 0;

	if (serial->dev) {
		option_send_setup(port);

		/* Stop reading/writing urbs */
		for (i = 0; i < N_IN_URB; i++)
O
Oliver Neukum 已提交
646
			usb_kill_urb(portdata->in_urbs[i]);
647
		for (i = 0; i < N_OUT_URB; i++)
O
Oliver Neukum 已提交
648
			usb_kill_urb(portdata->out_urbs[i]);
649 650 651 652 653
	}
	port->tty = NULL;
}

/* Helper functions used by option_setup_urbs */
654 655
static struct urb *option_setup_urb(struct usb_serial *serial, int endpoint,
		int dir, void *ctx, char *buf, int len,
656
		void (*callback)(struct urb *))
657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677
{
	struct urb *urb;

	if (endpoint == -1)
		return NULL;		/* endpoint not needed */

	urb = usb_alloc_urb(0, GFP_KERNEL);		/* No ISO */
	if (urb == NULL) {
		dbg("%s: alloc for endpoint %d failed.", __FUNCTION__, endpoint);
		return NULL;
	}

		/* Fill URB using supplied data. */
	usb_fill_bulk_urb(urb, serial->dev,
		      usb_sndbulkpipe(serial->dev, endpoint) | dir,
		      buf, len, callback, ctx);

	return urb;
}

/* Setup urbs */
678
static void option_setup_urbs(struct usb_serial *serial)
679
{
680
	int i,j;
681 682
	struct usb_serial_port *port;
	struct option_port_private *portdata;
683 684 685

	dbg("%s", __FUNCTION__);

686 687 688
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
		portdata = usb_get_serial_port_data(port);
689 690

	/* Do indat endpoints first */
691 692 693 694 695
		for (j = 0; j < N_IN_URB; ++j) {
			portdata->in_urbs[j] = option_setup_urb (serial,
                  	port->bulk_in_endpointAddress, USB_DIR_IN, port,
                  	portdata->in_buffer[j], IN_BUFLEN, option_indat_callback);
		}
696

697 698 699 700 701 702
		/* outdat endpoints */
		for (j = 0; j < N_OUT_URB; ++j) {
			portdata->out_urbs[j] = option_setup_urb (serial,
                  	port->bulk_out_endpointAddress, USB_DIR_OUT, port,
                  	portdata->out_buffer[j], OUT_BUFLEN, option_outdat_callback);
		}
703 704 705
	}
}

706
static int option_send_setup(struct usb_serial_port *port)
707 708 709 710 711 712
{
	struct usb_serial *serial = port->serial;
	struct option_port_private *portdata;

	dbg("%s", __FUNCTION__);

713 714 715
	if (port->number != 0)
		return 0;

716 717 718 719 720 721 722 723 724
	portdata = usb_get_serial_port_data(port);

	if (port->tty) {
		int val = 0;
		if (portdata->dtr_state)
			val |= 0x01;
		if (portdata->rts_state)
			val |= 0x02;

725 726 727
		return usb_control_msg(serial->dev,
				usb_rcvctrlpipe(serial->dev, 0),
				0x22,0x21,val,0,NULL,0,USB_CTRL_SET_TIMEOUT);
728 729 730 731 732
	}

	return 0;
}

733
static int option_startup(struct usb_serial *serial)
734
{
735 736 737
	int i, err;
	struct usb_serial_port *port;
	struct option_port_private *portdata;
738 739 740 741 742 743

	dbg("%s", __FUNCTION__);

	/* Now setup per port private data */
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
744
		portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
745
		if (!portdata) {
746 747
			dbg("%s: kmalloc for option_port_private (%d) failed!.",
					__FUNCTION__, i);
748 749 750 751 752 753 754 755 756
			return (1);
		}

		usb_set_serial_port_data(port, portdata);

		if (! port->interrupt_in_urb)
			continue;
		err = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
		if (err)
757 758
			dbg("%s: submit irq_in urb failed %d",
				__FUNCTION__, err);
759 760 761 762 763 764 765
	}

	option_setup_urbs(serial);

	return (0);
}

766
static void option_shutdown(struct usb_serial *serial)
767
{
768 769 770
	int i, j;
	struct usb_serial_port *port;
	struct option_port_private *portdata;
771 772 773 774 775 776 777 778

	dbg("%s", __FUNCTION__);

	/* Stop reading/writing urbs */
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		portdata = usb_get_serial_port_data(port);
		for (j = 0; j < N_IN_URB; j++)
O
Oliver Neukum 已提交
779
			usb_kill_urb(portdata->in_urbs[j]);
780
		for (j = 0; j < N_OUT_URB; j++)
O
Oliver Neukum 已提交
781
			usb_kill_urb(portdata->out_urbs[j]);
782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814
	}

	/* Now free them */
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		portdata = usb_get_serial_port_data(port);

		for (j = 0; j < N_IN_URB; j++) {
			if (portdata->in_urbs[j]) {
				usb_free_urb(portdata->in_urbs[j]);
				portdata->in_urbs[j] = NULL;
			}
		}
		for (j = 0; j < N_OUT_URB; j++) {
			if (portdata->out_urbs[j]) {
				usb_free_urb(portdata->out_urbs[j]);
				portdata->out_urbs[j] = NULL;
			}
		}
	}

	/* Now free per port private data */
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
		kfree(usb_get_serial_port_data(port));
	}
}

MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_VERSION(DRIVER_VERSION);
MODULE_LICENSE("GPL");

815
#ifdef CONFIG_USB_DEBUG
816 817
module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug messages");
818
#endif
819