option.c 25.6 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 117 118
#define KYOCERA_VENDOR_ID			0x0c88
#define KYOCERA_PRODUCT_KPC680			0x180a

119
#define ANYDATA_VENDOR_ID			0x16d5
120 121
#define ANYDATA_PRODUCT_ADU_E100A		0x6501
#define ANYDATA_PRODUCT_ADU_500A		0x6502
122

123 124 125 126
#define BANDRICH_VENDOR_ID			0x1A8D
#define BANDRICH_PRODUCT_C100_1			0x1002
#define BANDRICH_PRODUCT_C100_2			0x1003

127
static struct usb_device_id option_ids[] = {
128 129 130 131 132 133 134 135 136
	{ 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) },
137
	{ USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_COBRA) },
138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162
	{ 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) },
163
	{ USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E600) },
164 165
	{ USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E220, 0xff, 0xff, 0xff) },
	{ USB_DEVICE_AND_INTERFACE_INFO(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E220BIS, 0xff, 0xff, 0xff) },
166 167 168 169 170 171 172 173 174 175 176 177
	{ 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 */
178 179
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x4100) }, /* Novatel U727 */
	{ USB_DEVICE(NOVATELWIRELESS_VENDOR_ID, 0x4400) }, /* Novatel MC950 */
180 181 182 183 184 185
	{ 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 */
186
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8129) },	/* Dell Wireless 5700 Mobile Broadband CDMA/EVDO Mini-Card == Novatel Expedite ET620 CDMA/EV-DO */
187 188
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8133) }, /* Dell Wireless 5720 == Novatel EV620 CDMA/EV-DO */
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8136) },	/* Dell Wireless HSDPA 5520 == Novatel Expedite EU860D */
189
	{ USB_DEVICE(DELL_VENDOR_ID, 0x8137) },	/* Dell Wireless HSDPA 5520 */
190 191
	{ USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_E100A) },
	{ USB_DEVICE(ANYDATA_VENDOR_ID, ANYDATA_PRODUCT_ADU_500A) },
192 193
	{ USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_1) },
	{ USB_DEVICE(BANDRICH_VENDOR_ID, BANDRICH_PRODUCT_C100_2) },
194
	{ USB_DEVICE(KYOCERA_VENDOR_ID, KYOCERA_PRODUCT_KPC680) },
195 196
	{ } /* Terminating entry */
};
197 198 199 200 201 202 203
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,
204
	.no_dynamic_id = 	1,
205 206
};

U
Uwe Zeisberger 已提交
207
/* The card has three separate interfaces, which the serial driver
208 209
 * recognizes separately, thus num_port=1.
 */
210 211 212 213

static struct usb_serial_driver option_1port_device = {
	.driver = {
		.owner =	THIS_MODULE,
214
		.name =		"option1",
215 216
	},
	.description       = "GSM modem (1-port)",
217
	.usb_driver        = &option_driver,
218
	.id_table          = option_ids,
219 220 221
	.num_interrupt_in  = NUM_DONT_CARE,
	.num_bulk_in       = NUM_DONT_CARE,
	.num_bulk_out      = NUM_DONT_CARE,
222
	.num_ports         = 1,
223 224 225 226 227 228 229 230 231 232 233 234 235 236 237
	.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,
238 239
};

240
#ifdef CONFIG_USB_DEBUG
241
static int debug;
242 243 244 245
#else
#define debug 0
#endif

246 247
/* per port private data */

248 249
#define N_IN_URB 4
#define N_OUT_URB 1
250
#define IN_BUFLEN 4096
251
#define OUT_BUFLEN 128
252 253 254

struct option_port_private {
	/* Input endpoints and buffer for this port */
255
	struct urb *in_urbs[N_IN_URB];
256
	u8 *in_buffer[N_IN_URB];
257
	/* Output endpoints and buffer for this port */
258
	struct urb *out_urbs[N_OUT_URB];
259
	u8 *out_buffer[N_OUT_URB];
260
	unsigned long out_busy;		/* Bit vector of URBs in use */
261 262

	/* Settings for the port */
263 264 265 266 267 268 269 270
	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];
271 272 273
};

/* Functions used by new usb-serial code. */
274
static int __init option_init(void)
275 276
{
	int retval;
277 278 279
	retval = usb_serial_register(&option_1port_device);
	if (retval)
		goto failed_1port_device_register;
280 281 282 283 284 285 286 287 288
	retval = usb_register(&option_driver);
	if (retval)
		goto failed_driver_register;

	info(DRIVER_DESC ": " DRIVER_VERSION);

	return 0;

failed_driver_register:
289 290
	usb_serial_deregister (&option_1port_device);
failed_1port_device_register:
291 292 293
	return retval;
}

294
static void __exit option_exit(void)
295 296
{
	usb_deregister (&option_driver);
297
	usb_serial_deregister (&option_1port_device);
298 299 300 301 302
}

module_init(option_init);
module_exit(option_exit);

303
static void option_rx_throttle(struct usb_serial_port *port)
304 305 306 307
{
	dbg("%s", __FUNCTION__);
}

308
static void option_rx_unthrottle(struct usb_serial_port *port)
309 310 311 312
{
	dbg("%s", __FUNCTION__);
}

313
static void option_break_ctl(struct usb_serial_port *port, int break_state)
314 315
{
	/* Unfortunately, I don't know how to send a break */
316
	dbg("%s", __FUNCTION__);
317 318
}

319
static void option_set_termios(struct usb_serial_port *port,
A
Alan Cox 已提交
320
			struct ktermios *old_termios)
321 322
{
	dbg("%s", __FUNCTION__);
A
Alan Cox 已提交
323 324
	/* Doesn't support option setting */
	tty_termios_copy_hw(port->tty->termios, old_termios);
325 326 327
	option_send_setup(port);
}

328
static int option_tiocmget(struct usb_serial_port *port, struct file *file)
329
{
330 331
	unsigned int value;
	struct option_port_private *portdata;
332 333 334 335 336 337 338 339 340 341 342 343 344

	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;
}

345 346
static int option_tiocmset(struct usb_serial_port *port, struct file *file,
			unsigned int set, unsigned int clear)
347
{
348
	struct option_port_private *portdata;
349 350 351 352 353 354 355 356 357 358 359 360 361 362 363

	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);
}

364 365
static int option_ioctl(struct usb_serial_port *port, struct file *file,
			unsigned int cmd, unsigned long arg)
366 367 368 369 370
{
	return -ENOIOCTLCMD;
}

/* Write */
371 372
static int option_write(struct usb_serial_port *port,
			const unsigned char *buf, int count)
373
{
374 375 376 377 378
	struct option_port_private *portdata;
	int i;
	int left, todo;
	struct urb *this_urb = NULL; /* spurious */
	int err;
379 380 381 382 383 384 385

	portdata = usb_get_serial_port_data(port);

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

	i = 0;
	left = count;
386
	for (i=0; left > 0 && i < N_OUT_URB; i++) {
387 388 389 390
		todo = left;
		if (todo > OUT_BUFLEN)
			todo = OUT_BUFLEN;

391
		this_urb = portdata->out_urbs[i];
392
		if (test_and_set_bit(i, &portdata->out_busy)) {
393 394
			if (time_before(jiffies,
					portdata->tx_start_time[i] + 10 * HZ))
395 396
				continue;
			usb_unlink_urb(this_urb);
397
			continue;
398
		}
399
		if (this_urb->status != 0)
400 401
			dbg("usb_write %p failed (err=%d)",
				this_urb, this_urb->status);
402

403 404
		dbg("%s: endpoint %d buf %d", __FUNCTION__,
			usb_pipeendpoint(this_urb->pipe), i);
405

406
		/* send the data */
407 408 409 410 411 412
		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) {
413 414 415
			dbg("usb_submit_urb %p (write bulk) failed "
				"(%d, has %d)", this_urb,
				err, this_urb->status);
416
			clear_bit(i, &portdata->out_busy);
417 418 419 420 421 422 423 424 425 426 427 428
			continue;
		}
		portdata->tx_start_time[i] = jiffies;
		buf += todo;
		left -= todo;
	}

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

429
static void option_indat_callback(struct urb *urb)
430
{
A
Alan Cox 已提交
431
	int err;
432 433 434 435
	int endpoint;
	struct usb_serial_port *port;
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
436
	int status = urb->status;
437 438 439 440 441 442

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

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

443
	if (status) {
444
		dbg("%s: nonzero status: %d on endpoint %02x.",
445
		    __FUNCTION__, status, endpoint);
446 447 448
	} else {
		tty = port->tty;
		if (urb->actual_length) {
A
Alan Cox 已提交
449 450
			tty_buffer_request_room(tty, urb->actual_length);
			tty_insert_flip_string(tty, data, urb->actual_length);
451 452 453 454 455 456
			tty_flip_buffer_push(tty);
		} else {
			dbg("%s: empty read urb received", __FUNCTION__);
		}

		/* Resubmit urb so we continue receiving */
457
		if (port->open_count && status != -ESHUTDOWN) {
458 459
			err = usb_submit_urb(urb, GFP_ATOMIC);
			if (err)
460 461
				printk(KERN_ERR "%s: resubmit read urb failed. "
					"(%d)", __FUNCTION__, err);
462 463 464 465 466
		}
	}
	return;
}

467
static void option_outdat_callback(struct urb *urb)
468 469
{
	struct usb_serial_port *port;
470 471
	struct option_port_private *portdata;
	int i;
472 473 474 475 476

	dbg("%s", __FUNCTION__);

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

477
	usb_serial_port_softint(port);
478 479 480 481 482 483 484 485 486

	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;
		}
	}
487 488
}

489
static void option_instat_callback(struct urb *urb)
490 491
{
	int err;
492
	int status = urb->status;
493 494 495 496 497 498 499
	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);

500
	if (status == 0) {
501 502 503 504 505 506 507
		struct usb_ctrlrequest *req_pkt =
				(struct usb_ctrlrequest *)urb->transfer_buffer;

		if (!req_pkt) {
			dbg("%s: NULL req_pkt\n", __FUNCTION__);
			return;
		}
508 509
		if ((req_pkt->bRequestType == 0xA1) &&
				(req_pkt->bRequest == 0x20)) {
510 511
			int old_dcd_state;
			unsigned char signals = *((unsigned char *)
512 513
					urb->transfer_buffer +
					sizeof(struct usb_ctrlrequest));
514 515 516 517 518 519 520 521 522

			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);

523 524
			if (port->tty && !C_CLOCAL(port->tty) &&
					old_dcd_state && !portdata->dcd_state)
525
				tty_hangup(port->tty);
526 527 528 529
		} else {
			dbg("%s: type %x req %x", __FUNCTION__,
				req_pkt->bRequestType,req_pkt->bRequest);
		}
530
	} else
531
		dbg("%s: error %d", __FUNCTION__, status);
532 533

	/* Resubmit urb so we continue receiving IRQ data */
534
	if (status != -ESHUTDOWN) {
535 536 537
		urb->dev = serial->dev;
		err = usb_submit_urb(urb, GFP_ATOMIC);
		if (err)
538 539
			dbg("%s: resubmit intr urb failed. (%d)",
				__FUNCTION__, err);
540 541 542
	}
}

543
static int option_write_room(struct usb_serial_port *port)
544 545 546 547 548 549 550 551
{
	struct option_port_private *portdata;
	int i;
	int data_len = 0;
	struct urb *this_urb;

	portdata = usb_get_serial_port_data(port);

552
	for (i=0; i < N_OUT_URB; i++) {
553
		this_urb = portdata->out_urbs[i];
554
		if (this_urb && !test_bit(i, &portdata->out_busy))
555
			data_len += OUT_BUFLEN;
556
	}
557 558 559 560 561

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

562
static int option_chars_in_buffer(struct usb_serial_port *port)
563 564 565 566 567 568 569 570
{
	struct option_port_private *portdata;
	int i;
	int data_len = 0;
	struct urb *this_urb;

	portdata = usb_get_serial_port_data(port);

571
	for (i=0; i < N_OUT_URB; i++) {
572
		this_urb = portdata->out_urbs[i];
573
		if (this_urb && test_bit(i, &portdata->out_busy))
574
			data_len += this_urb->transfer_buffer_length;
575
	}
576 577 578 579
	dbg("%s: %d", __FUNCTION__, data_len);
	return data_len;
}

580
static int option_open(struct usb_serial_port *port, struct file *filp)
581
{
582 583 584 585
	struct option_port_private *portdata;
	struct usb_serial *serial = port->serial;
	int i, err;
	struct urb *urb;
586 587 588 589 590 591 592 593 594 595 596 597 598 599 600

	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) {
601 602
			dbg("%s: dev %p != %p", __FUNCTION__,
				urb->dev, serial->dev);
603 604 605
			continue;
		}

606 607 608 609
		/*
		 * make sure endpoint data toggle is synchronized with the
		 * device
		 */
610 611 612 613
		usb_clear_halt(urb->dev, urb->pipe);

		err = usb_submit_urb(urb, GFP_KERNEL);
		if (err) {
614 615
			dbg("%s: submit urb %d failed (%d) %d",
				__FUNCTION__, i, err,
616 617 618 619 620 621 622 623 624 625
				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;
626 627
		/* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
				usb_pipeout(urb->pipe), 0); */
628 629 630 631 632 633 634 635 636
	}

	port->tty->low_latency = 1;

	option_send_setup(port);

	return (0);
}

637
static void option_close(struct usb_serial_port *port, struct file *filp)
638
{
639 640 641
	int i;
	struct usb_serial *serial = port->serial;
	struct option_port_private *portdata;
642 643 644 645 646 647 648 649

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

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

	if (serial->dev) {
650 651 652 653
		mutex_lock(&serial->disc_mutex);
		if (!serial->disconnected)
			option_send_setup(port);
		mutex_unlock(&serial->disc_mutex);
654 655 656

		/* Stop reading/writing urbs */
		for (i = 0; i < N_IN_URB; i++)
O
Oliver Neukum 已提交
657
			usb_kill_urb(portdata->in_urbs[i]);
658
		for (i = 0; i < N_OUT_URB; i++)
O
Oliver Neukum 已提交
659
			usb_kill_urb(portdata->out_urbs[i]);
660 661 662 663 664
	}
	port->tty = NULL;
}

/* Helper functions used by option_setup_urbs */
665 666
static struct urb *option_setup_urb(struct usb_serial *serial, int endpoint,
		int dir, void *ctx, char *buf, int len,
667
		void (*callback)(struct urb *))
668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688
{
	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 */
689
static void option_setup_urbs(struct usb_serial *serial)
690
{
691
	int i,j;
692 693
	struct usb_serial_port *port;
	struct option_port_private *portdata;
694 695 696

	dbg("%s", __FUNCTION__);

697 698 699
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
		portdata = usb_get_serial_port_data(port);
700 701

	/* Do indat endpoints first */
702 703 704 705 706
		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);
		}
707

708 709 710 711 712 713
		/* 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);
		}
714 715 716
	}
}

717
static int option_send_setup(struct usb_serial_port *port)
718 719 720 721 722 723
{
	struct usb_serial *serial = port->serial;
	struct option_port_private *portdata;

	dbg("%s", __FUNCTION__);

724 725 726
	if (port->number != 0)
		return 0;

727 728 729 730 731 732 733 734 735
	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;

736 737 738
		return usb_control_msg(serial->dev,
				usb_rcvctrlpipe(serial->dev, 0),
				0x22,0x21,val,0,NULL,0,USB_CTRL_SET_TIMEOUT);
739 740 741 742 743
	}

	return 0;
}

744
static int option_startup(struct usb_serial *serial)
745
{
746
	int i, j, err;
747 748
	struct usb_serial_port *port;
	struct option_port_private *portdata;
749
	u8 *buffer;
750 751 752 753 754 755

	dbg("%s", __FUNCTION__);

	/* Now setup per port private data */
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
756
		portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
757
		if (!portdata) {
758 759
			dbg("%s: kmalloc for option_port_private (%d) failed!.",
					__FUNCTION__, i);
760 761 762
			return (1);
		}

763 764 765 766 767 768 769 770 771 772 773 774 775 776
		for (j = 0; j < N_IN_URB; j++) {
			buffer = (u8 *)__get_free_page(GFP_KERNEL);
			if (!buffer)
				goto bail_out_error;
			portdata->in_buffer[j] = buffer;
		}

		for (j = 0; j < N_OUT_URB; j++) {
			buffer = kmalloc(OUT_BUFLEN, GFP_KERNEL);
			if (!buffer)
				goto bail_out_error2;
			portdata->out_buffer[j] = buffer;
		}

777 778 779 780 781 782
		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)
783 784
			dbg("%s: submit irq_in urb failed %d",
				__FUNCTION__, err);
785 786 787 788 789
	}

	option_setup_urbs(serial);

	return (0);
790 791 792 793 794 795 796 797 798 799

bail_out_error2:
	for (j = 0; j < N_OUT_URB; j++)
		kfree(portdata->out_buffer[j]);
bail_out_error:
	for (j = 0; j < N_IN_URB; j++)
		if (portdata->in_buffer[j])
			free_page((unsigned long)portdata->in_buffer[j]);
	kfree(portdata);
	return 1;
800 801
}

802
static void option_shutdown(struct usb_serial *serial)
803
{
804 805 806
	int i, j;
	struct usb_serial_port *port;
	struct option_port_private *portdata;
807 808 809 810 811 812 813 814

	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 已提交
815
			usb_kill_urb(portdata->in_urbs[j]);
816
		for (j = 0; j < N_OUT_URB; j++)
O
Oliver Neukum 已提交
817
			usb_kill_urb(portdata->out_urbs[j]);
818 819 820 821 822 823 824 825 826 827
	}

	/* 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]);
828
				free_page((unsigned long)portdata->in_buffer[j]);
829 830 831 832 833 834
				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]);
835
				kfree(portdata->out_buffer[j]);
836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852
				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");

853
#ifdef CONFIG_USB_DEBUG
854 855
module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug messages");
856
#endif
857