sierra.c 20.8 KB
Newer Older
1
/*
K
Kevin Lloyd 已提交
2 3
  USB Driver for Sierra Wireless

K
Kevin Lloyd 已提交
4
  Copyright (C) 2006, 2007, 2008  Kevin Lloyd <klloyd@sierrawireless.com>
K
Kevin Lloyd 已提交
5 6 7 8 9 10 11 12 13 14 15 16

  IMPORTANT DISCLAIMER: This driver is not commercially supported by
  Sierra Wireless. Use at your own risk.

  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 based on the option driver by Matthias Urlichs <smurf@smurf.noris.de>
  Whom based his on the Keyspan driver by Hugh Blemings <hugh@blemings.org>
*/

K
Kevin Lloyd 已提交
17 18
#define DRIVER_VERSION "v.1.2.9c"
#define DRIVER_AUTHOR "Kevin Lloyd <klloyd@sierrawireless.com>"
K
Kevin Lloyd 已提交
19
#define DRIVER_DESC "USB Driver for Sierra Wireless USB modems"
20 21

#include <linux/kernel.h>
K
Kevin Lloyd 已提交
22 23
#include <linux/jiffies.h>
#include <linux/errno.h>
24
#include <linux/tty.h>
K
Kevin Lloyd 已提交
25
#include <linux/tty_flip.h>
26 27
#include <linux/module.h>
#include <linux/usb.h>
28
#include <linux/usb/serial.h>
29
#include <linux/usb/ch9.h>
30

31 32
#define SWIMS_USB_REQUEST_SetPower	0x00
#define SWIMS_USB_REQUEST_SetNmea	0x07
33 34 35 36 37 38 39 40 41
#define SWIMS_USB_REQUEST_SetMode	0x0B
#define SWIMS_SET_MODE_Modem		0x0001

/* per port private data */
#define N_IN_URB	4
#define N_OUT_URB	4
#define IN_BUFLEN	4096

static int debug;
42 43
static int nmea;
static int truinstall = 1;
44 45 46 47 48 49 50

enum devicetype {
	DEVICE_3_PORT =		0,
	DEVICE_1_PORT =		1,
	DEVICE_INSTALLER =	2,
};

51
static int sierra_set_power_state(struct usb_device *udev, __u16 swiState)
52 53
{
	int result;
K
Kevin Lloyd 已提交
54
	dev_dbg(&udev->dev, "%s", __func__);
55
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
56
			SWIMS_USB_REQUEST_SetPower,	/* __u8 request      */
K
Kevin Lloyd 已提交
57
			USB_TYPE_VENDOR,		/* __u8 request type */
58 59 60 61 62
			swiState,			/* __u16 value       */
			0,				/* __u16 index       */
			NULL,				/* void *data        */
			0,				/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout 	     */
63 64 65
	return result;
}

66
static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode)
67 68
{
	int result;
K
Kevin Lloyd 已提交
69
	dev_dbg(&udev->dev,  "%s", __func__);
70 71
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
			SWIMS_USB_REQUEST_SetMode,	/* __u8 request      */
K
Kevin Lloyd 已提交
72
			USB_TYPE_VENDOR,		/* __u8 request type */
73 74
			eSWocMode,			/* __u16 value       */
			0x0000,				/* __u16 index       */
75 76 77 78 79 80
			NULL,				/* void *data        */
			0,				/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout       */
	return result;
}

81
static int sierra_vsc_set_nmea(struct usb_device *udev, __u16 enable)
82 83
{
	int result;
K
Kevin Lloyd 已提交
84
	dev_dbg(&udev->dev, "%s", __func__);
85 86
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
			SWIMS_USB_REQUEST_SetNmea,	/* __u8 request      */
K
Kevin Lloyd 已提交
87
			USB_TYPE_VENDOR,		/* __u8 request type */
88 89 90 91 92 93 94 95 96 97 98 99
			enable,				/* __u16 value       */
			0x0000,				/* __u16 index       */
			NULL,				/* void *data        */
			0,				/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout       */
	return result;
}

static int sierra_calc_num_ports(struct usb_serial *serial)
{
	int result;
	int *num_ports = usb_get_serial_data(serial);
K
Kevin Lloyd 已提交
100
	dev_dbg(&serial->dev->dev, "%s", __func__);
101 102 103 104 105 106 107 108 109 110 111

	result = *num_ports;

	if (result) {
		kfree(num_ports);
		usb_set_serial_data(serial, NULL);
	}

	return result;
}

112 113
static int sierra_calc_interface(struct usb_serial *serial)
{
K
Kevin Lloyd 已提交
114 115 116 117
	int interface;
	struct usb_interface *p_interface;
	struct usb_host_interface *p_host_interface;
	dev_dbg(&serial->dev->dev, "%s", __func__);
118

K
Kevin Lloyd 已提交
119 120
	/* Get the interface structure pointer from the serial struct */
	p_interface = serial->interface;
121

K
Kevin Lloyd 已提交
122 123
	/* Get a pointer to the host interface structure */
	p_host_interface = p_interface->cur_altsetting;
124

K
Kevin Lloyd 已提交
125 126 127 128
	/* read the interface descriptor for this active altsetting
	 * to find out the interface number we are on
	*/
	interface = p_host_interface->desc.bInterfaceNumber;
129

K
Kevin Lloyd 已提交
130
	return interface;
131 132
}

133 134 135 136
static int sierra_probe(struct usb_serial *serial,
			const struct usb_device_id *id)
{
	int result = 0;
137
	struct usb_device *udev;
138 139
	int *num_ports;
	u8 ifnum;
K
Kevin Lloyd 已提交
140
	dev_dbg(&serial->dev->dev, "%s", __func__);
141

142 143 144 145 146 147
	num_ports = kmalloc(sizeof(*num_ports), GFP_KERNEL);
	if (!num_ports)
		return -ENOMEM;

	ifnum = serial->interface->cur_altsetting->desc.bInterfaceNumber;
	udev = serial->dev;
148

149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
		/* Figure out the interface number from the serial structure */
		ifnum = sierra_calc_interface(serial);

		/*
		 * If this interface supports more than 1 alternate
		 * select the 2nd one
		 */
		if (serial->interface->num_altsetting == 2) {
			dev_dbg(&udev->dev,
				"Selecting alt setting for interface %d\n",
				ifnum);

			/* We know the alternate setting is 1 for the MC8785 */
			usb_set_interface(udev, ifnum, 1);
		}

165
	/* Check if in installer mode */
166 167
	if (truinstall && id->driver_info == DEVICE_INSTALLER) {
		dev_dbg(&udev->dev, "%s", "FOUND TRU-INSTALL DEVICE(SW)\n");
168
		result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
169 170
		/* Don't bind to the device when in installer mode */
		kfree(num_ports);
171
		return -EIO;
172 173 174 175 176 177 178 179 180 181 182
	} else if (id->driver_info == DEVICE_1_PORT)
		*num_ports = 1;
	else if (ifnum == 0x99)
		*num_ports = 0;
	else
		*num_ports = 3;
	/*
	 * save off our num_ports info so that we can use it in the
	 * calc_num_ports callback
	 */
	usb_set_serial_data(serial, (void *)num_ports);
183

184
	return result;
185
}
K
Kevin Lloyd 已提交
186

187
static struct usb_device_id id_table [] = {
K
Kevin Lloyd 已提交
188
	{ USB_DEVICE(0x1199, 0x0017) },	/* Sierra Wireless EM5625 */
189
	{ USB_DEVICE(0x1199, 0x0018) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
190
	{ USB_DEVICE(0x1199, 0x0218) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
191
	{ USB_DEVICE(0x0f30, 0x1b1d) },	/* Sierra Wireless MC5720 */
192
	{ USB_DEVICE(0x1199, 0x0020) },	/* Sierra Wireless MC5725 */
K
Kevin Lloyd 已提交
193
	{ USB_DEVICE(0x1199, 0x0024) },	/* Sierra Wireless MC5727 */
194
	{ USB_DEVICE(0x1199, 0x0220) },	/* Sierra Wireless MC5725 */
195
	{ USB_DEVICE(0x1199, 0x0019) },	/* Sierra Wireless AirCard 595 */
K
Kevin Lloyd 已提交
196
	{ USB_DEVICE(0x1199, 0x0021) },	/* Sierra Wireless AirCard 597E */
K
Kevin Lloyd 已提交
197
	{ USB_DEVICE(0x1199, 0x0120) },	/* Sierra Wireless USB Dongle 595U */
K
Kevin Lloyd 已提交
198 199
	 /* Sierra Wireless C597 */
	{ USB_DEVICE_AND_INTERFACE_INFO(0x1199, 0x0023, 0xFF, 0xFF, 0xFF) },
K
Kevin Lloyd 已提交
200

201
	{ USB_DEVICE(0x1199, 0x6802) },	/* Sierra Wireless MC8755 */
K
Kevin Lloyd 已提交
202
	{ USB_DEVICE(0x1199, 0x6804) },	/* Sierra Wireless MC8755 */
203
	{ USB_DEVICE(0x1199, 0x6803) },	/* Sierra Wireless MC8765 */
K
Kevin Lloyd 已提交
204
	{ USB_DEVICE(0x1199, 0x6812) },	/* Sierra Wireless MC8775 & AC 875U */
K
Kevin Lloyd 已提交
205
	{ USB_DEVICE(0x1199, 0x6813) },	/* Sierra Wireless MC8775 (Lenovo) */
K
Kevin Lloyd 已提交
206
	{ USB_DEVICE(0x1199, 0x6815) },	/* Sierra Wireless MC8775 */
207
	{ USB_DEVICE(0x03f0, 0x1e1d) },	/* HP hs2300 a.k.a MC8775 */
208
	{ USB_DEVICE(0x1199, 0x6820) },	/* Sierra Wireless AirCard 875 */
209
	{ USB_DEVICE(0x1199, 0x6821) },	/* Sierra Wireless AirCard 875U */
K
Kevin Lloyd 已提交
210 211 212
	{ USB_DEVICE(0x1199, 0x6832) },	/* Sierra Wireless MC8780 */
	{ USB_DEVICE(0x1199, 0x6833) },	/* Sierra Wireless MC8781 */
	{ USB_DEVICE(0x1199, 0x683B), .driver_info = DEVICE_1_PORT },	/* Sierra Wireless MC8785 Composite */
K
Kevin Lloyd 已提交
213 214 215 216
	{ USB_DEVICE(0x1199, 0x6850) },	/* Sierra Wireless AirCard 880 */
	{ USB_DEVICE(0x1199, 0x6851) },	/* Sierra Wireless AirCard 881 */
	{ USB_DEVICE(0x1199, 0x6852) },	/* Sierra Wireless AirCard 880 E */
	{ USB_DEVICE(0x1199, 0x6853) },	/* Sierra Wireless AirCard 881 E */
K
Kevin Lloyd 已提交
217
	{ USB_DEVICE(0x1199, 0x6855) },	/* Sierra Wireless AirCard 880 U */
218
	{ USB_DEVICE(0x1199, 0x6856) },	/* Sierra Wireless AirCard 881 U */
219 220
	{ USB_DEVICE(0x1199, 0x6859), .driver_info = DEVICE_1_PORT },	/* Sierra Wireless AirCard 885 E */
	{ USB_DEVICE(0x1199, 0x685A), .driver_info = DEVICE_1_PORT },	/* Sierra Wireless AirCard 885 E */
K
Kevin Lloyd 已提交
221

222 223 224 225
	{ USB_DEVICE(0x1199, 0x0112), .driver_info = DEVICE_1_PORT }, /* Sierra Wireless AirCard 580 */
	{ USB_DEVICE(0x0F3D, 0x0112), .driver_info = DEVICE_1_PORT }, /* Airprime/Sierra PC 5220 */

	{ USB_DEVICE(0x1199, 0x0FFF), .driver_info = DEVICE_INSTALLER},
K
Kevin Lloyd 已提交
226 227
	{ }
};
228
MODULE_DEVICE_TABLE(usb, id_table);
K
Kevin Lloyd 已提交
229

230
static struct usb_driver sierra_driver = {
K
Kevin Lloyd 已提交
231
	.name       = "sierra",
232
	.probe      = usb_serial_probe,
K
Kevin Lloyd 已提交
233 234
	.disconnect = usb_serial_disconnect,
	.id_table   = id_table,
235
	.no_dynamic_id = 	1,
K
Kevin Lloyd 已提交
236 237 238
};

struct sierra_port_private {
239 240 241
	spinlock_t lock;	/* lock the structure */
	int outstanding_urbs;	/* number of out urbs in flight */

O
Oliver Neukum 已提交
242
	/* Input endpoints and buffers for this port */
K
Kevin Lloyd 已提交
243
	struct urb *in_urbs[N_IN_URB];
O
Oliver Neukum 已提交
244
	char *in_buffer[N_IN_URB];
K
Kevin Lloyd 已提交
245 246 247 248 249 250 251 252 253 254

	/* Settings for the port */
	int rts_state;	/* Handshaking pins (outputs) */
	int dtr_state;
	int cts_state;	/* Handshaking pins (inputs) */
	int dsr_state;
	int dcd_state;
	int ri_state;
};

A
Alan Cox 已提交
255 256
static int sierra_send_setup(struct tty_struct *tty,
						struct usb_serial_port *port)
257
{
258 259
	struct usb_serial *serial = port->serial;
	struct sierra_port_private *portdata;
260
	__u16 interface = 0;
K
Kevin Lloyd 已提交
261

262
	dbg("%s", __func__);
K
Kevin Lloyd 已提交
263

264
	portdata = usb_get_serial_port_data(port);
K
Kevin Lloyd 已提交
265

A
Alan Cox 已提交
266
	if (tty) {
267 268 269 270 271
		int val = 0;
		if (portdata->dtr_state)
			val |= 0x01;
		if (portdata->rts_state)
			val |= 0x02;
K
Kevin Lloyd 已提交
272

273 274 275 276 277 278 279 280
		/* Determine which port is targeted */
		if (port->bulk_out_endpointAddress == 2)
			interface = 0;
		else if (port->bulk_out_endpointAddress == 4)
			interface = 1;
		else if (port->bulk_out_endpointAddress == 5)
			interface = 2;

281 282
		return usb_control_msg(serial->dev,
				usb_rcvctrlpipe(serial->dev, 0),
283 284
				0x22, 0x21, val, interface,
				NULL, 0, USB_CTRL_SET_TIMEOUT);
285
	}
286

287
	return 0;
288 289
}

A
Alan Cox 已提交
290 291
static void sierra_set_termios(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios)
K
Kevin Lloyd 已提交
292
{
293
	dbg("%s", __func__);
A
Alan Cox 已提交
294 295
	tty_termios_copy_hw(tty->termios, old_termios);
	sierra_send_setup(tty, port);
K
Kevin Lloyd 已提交
296 297
}

A
Alan Cox 已提交
298
static int sierra_tiocmget(struct tty_struct *tty, struct file *file)
K
Kevin Lloyd 已提交
299
{
A
Alan Cox 已提交
300
	struct usb_serial_port *port = tty->driver_data;
K
Kevin Lloyd 已提交
301 302 303 304 305 306 307 308 309 310 311 312 313 314 315
	unsigned int value;
	struct sierra_port_private *portdata;

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

A
Alan Cox 已提交
316
static int sierra_tiocmset(struct tty_struct *tty, struct file *file,
K
Kevin Lloyd 已提交
317 318
			unsigned int set, unsigned int clear)
{
A
Alan Cox 已提交
319
	struct usb_serial_port *port = tty->driver_data;
K
Kevin Lloyd 已提交
320 321 322 323 324 325 326 327 328 329 330 331 332
	struct sierra_port_private *portdata;

	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;
A
Alan Cox 已提交
333
	return sierra_send_setup(tty, port);
K
Kevin Lloyd 已提交
334 335
}

336 337 338 339 340 341 342
static void sierra_outdat_callback(struct urb *urb)
{
	struct usb_serial_port *port = urb->context;
	struct sierra_port_private *portdata = usb_get_serial_port_data(port);
	int status = urb->status;
	unsigned long flags;

343
	dbg("%s - port %d", __func__, port->number);
344 345 346 347 348 349

	/* free up the transfer buffer, as usb_free_urb() does not do this */
	kfree(urb->transfer_buffer);

	if (status)
		dbg("%s - nonzero write bulk status received: %d",
350
		    __func__, status);
351 352 353 354 355 356 357 358

	spin_lock_irqsave(&portdata->lock, flags);
	--portdata->outstanding_urbs;
	spin_unlock_irqrestore(&portdata->lock, flags);

	usb_serial_port_softint(port);
}

K
Kevin Lloyd 已提交
359
/* Write */
A
Alan Cox 已提交
360 361
static int sierra_write(struct tty_struct *tty, struct usb_serial_port *port,
					const unsigned char *buf, int count)
K
Kevin Lloyd 已提交
362
{
363 364 365 366 367 368
	struct sierra_port_private *portdata = usb_get_serial_port_data(port);
	struct usb_serial *serial = port->serial;
	unsigned long flags;
	unsigned char *buffer;
	struct urb *urb;
	int status;
K
Kevin Lloyd 已提交
369 370 371

	portdata = usb_get_serial_port_data(port);

372
	dbg("%s: write (%d chars)", __func__, count);
K
Kevin Lloyd 已提交
373

374 375 376
	spin_lock_irqsave(&portdata->lock, flags);
	if (portdata->outstanding_urbs > N_OUT_URB) {
		spin_unlock_irqrestore(&portdata->lock, flags);
377
		dbg("%s - write limit hit\n", __func__);
378 379 380 381 382 383 384 385 386 387 388
		return 0;
	}
	portdata->outstanding_urbs++;
	spin_unlock_irqrestore(&portdata->lock, flags);

	buffer = kmalloc(count, GFP_ATOMIC);
	if (!buffer) {
		dev_err(&port->dev, "out of memory\n");
		count = -ENOMEM;
		goto error_no_buffer;
	}
K
Kevin Lloyd 已提交
389

390 391 392 393 394 395
	urb = usb_alloc_urb(0, GFP_ATOMIC);
	if (!urb) {
		dev_err(&port->dev, "no more free urbs\n");
		count = -ENOMEM;
		goto error_no_urb;
	}
K
Kevin Lloyd 已提交
396

397
	memcpy(buffer, buf, count);
K
Kevin Lloyd 已提交
398

399
	usb_serial_debug_data(debug, &port->dev, __func__, count, buffer);
400 401 402 403 404 405 406 407 408 409

	usb_fill_bulk_urb(urb, serial->dev,
			  usb_sndbulkpipe(serial->dev,
					  port->bulk_out_endpointAddress),
			  buffer, count, sierra_outdat_callback, port);

	/* send it down the pipe */
	status = usb_submit_urb(urb, GFP_ATOMIC);
	if (status) {
		dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed "
410
			"with status = %d\n", __func__, status);
411 412
		count = status;
		goto error;
K
Kevin Lloyd 已提交
413 414
	}

415 416 417 418 419 420 421 422 423 424 425 426 427
	/* we are done with this urb, so let the host driver
	 * really free it when it is finished with it */
	usb_free_urb(urb);

	return count;
error:
	usb_free_urb(urb);
error_no_urb:
	kfree(buffer);
error_no_buffer:
	spin_lock_irqsave(&portdata->lock, flags);
	--portdata->outstanding_urbs;
	spin_unlock_irqrestore(&portdata->lock, flags);
K
Kevin Lloyd 已提交
428 429 430 431 432 433 434 435 436 437
	return count;
}

static void sierra_indat_callback(struct urb *urb)
{
	int err;
	int endpoint;
	struct usb_serial_port *port;
	struct tty_struct *tty;
	unsigned char *data = urb->transfer_buffer;
438
	int status = urb->status;
K
Kevin Lloyd 已提交
439

440
	dbg("%s: %p", __func__, urb);
K
Kevin Lloyd 已提交
441 442

	endpoint = usb_pipeendpoint(urb->pipe);
443
	port =  urb->context;
K
Kevin Lloyd 已提交
444

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

		/* Resubmit urb so we continue receiving */
A
Alan Cox 已提交
459
		if (port->port.count && status != -ESHUTDOWN) {
K
Kevin Lloyd 已提交
460 461
			err = usb_submit_urb(urb, GFP_ATOMIC);
			if (err)
462
				dev_err(&port->dev, "resubmit read urb failed."
463
					"(%d)\n", err);
K
Kevin Lloyd 已提交
464 465 466 467 468 469 470 471
		}
	}
	return;
}

static void sierra_instat_callback(struct urb *urb)
{
	int err;
472
	int status = urb->status;
473
	struct usb_serial_port *port =  urb->context;
K
Kevin Lloyd 已提交
474 475 476
	struct sierra_port_private *portdata = usb_get_serial_port_data(port);
	struct usb_serial *serial = port->serial;

477 478
	dbg("%s", __func__);
	dbg("%s: urb %p port %p has data %p", __func__, urb, port, portdata);
K
Kevin Lloyd 已提交
479

480
	if (status == 0) {
K
Kevin Lloyd 已提交
481 482 483 484
		struct usb_ctrlrequest *req_pkt =
				(struct usb_ctrlrequest *)urb->transfer_buffer;

		if (!req_pkt) {
485
			dbg("%s: NULL req_pkt\n", __func__);
K
Kevin Lloyd 已提交
486 487 488 489 490 491 492 493 494
			return;
		}
		if ((req_pkt->bRequestType == 0xA1) &&
				(req_pkt->bRequest == 0x20)) {
			int old_dcd_state;
			unsigned char signals = *((unsigned char *)
					urb->transfer_buffer +
					sizeof(struct usb_ctrlrequest));

495
			dbg("%s: signal x%x", __func__, signals);
K
Kevin Lloyd 已提交
496 497 498 499 500 501 502

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

A
Alan Cox 已提交
503
			if (port->port.tty && !C_CLOCAL(port->port.tty) &&
K
Kevin Lloyd 已提交
504
					old_dcd_state && !portdata->dcd_state)
A
Alan Cox 已提交
505
				tty_hangup(port->port.tty);
K
Kevin Lloyd 已提交
506
		} else {
507
			dbg("%s: type %x req %x", __func__,
K
Kevin Lloyd 已提交
508
				req_pkt->bRequestType, req_pkt->bRequest);
K
Kevin Lloyd 已提交
509 510
		}
	} else
511
		dbg("%s: error %d", __func__, status);
K
Kevin Lloyd 已提交
512 513

	/* Resubmit urb so we continue receiving IRQ data */
514
	if (status != -ESHUTDOWN) {
K
Kevin Lloyd 已提交
515 516 517 518
		urb->dev = serial->dev;
		err = usb_submit_urb(urb, GFP_ATOMIC);
		if (err)
			dbg("%s: resubmit intr urb failed. (%d)",
519
				__func__, err);
K
Kevin Lloyd 已提交
520 521 522
	}
}

A
Alan Cox 已提交
523
static int sierra_write_room(struct tty_struct *tty)
K
Kevin Lloyd 已提交
524
{
A
Alan Cox 已提交
525
	struct usb_serial_port *port = tty->driver_data;
526 527
	struct sierra_port_private *portdata = usb_get_serial_port_data(port);
	unsigned long flags;
K
Kevin Lloyd 已提交
528

529
	dbg("%s - port %d", __func__, port->number);
K
Kevin Lloyd 已提交
530

531 532 533 534 535
	/* try to give a good number back based on if we have any free urbs at
	 * this point in time */
	spin_lock_irqsave(&portdata->lock, flags);
	if (portdata->outstanding_urbs > N_OUT_URB * 2 / 3) {
		spin_unlock_irqrestore(&portdata->lock, flags);
536
		dbg("%s - write limit hit\n", __func__);
537
		return 0;
K
Kevin Lloyd 已提交
538
	}
539
	spin_unlock_irqrestore(&portdata->lock, flags);
K
Kevin Lloyd 已提交
540

541
	return 2048;
K
Kevin Lloyd 已提交
542 543
}

A
Alan Cox 已提交
544 545
static int sierra_open(struct tty_struct *tty,
			struct usb_serial_port *port, struct file *filp)
K
Kevin Lloyd 已提交
546 547 548
{
	struct sierra_port_private *portdata;
	struct usb_serial *serial = port->serial;
549
	int i;
K
Kevin Lloyd 已提交
550
	struct urb *urb;
K
Kevin Lloyd 已提交
551
	int result;
K
Kevin Lloyd 已提交
552 553 554

	portdata = usb_get_serial_port_data(port);

555
	dbg("%s", __func__);
K
Kevin Lloyd 已提交
556 557 558 559 560 561 562 563

	/* 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];
564
		if (!urb)
K
Kevin Lloyd 已提交
565 566
			continue;
		if (urb->dev != serial->dev) {
567
			dbg("%s: dev %p != %p", __func__,
K
Kevin Lloyd 已提交
568 569 570 571 572 573 574 575 576 577
				urb->dev, serial->dev);
			continue;
		}

		/*
		 * make sure endpoint data toggle is synchronized with the
		 * device
		 */
		usb_clear_halt(urb->dev, urb->pipe);

578 579
		result = usb_submit_urb(urb, GFP_KERNEL);
		if (result) {
580
			dev_err(&port->dev, "submit urb %d failed (%d) %d\n",
581
				i, result, urb->transfer_buffer_length);
K
Kevin Lloyd 已提交
582 583 584
		}
	}

A
Alan Cox 已提交
585 586
	if (tty)
		tty->low_latency = 1;
K
Kevin Lloyd 已提交
587

A
Alan Cox 已提交
588
	sierra_send_setup(tty, port);
K
Kevin Lloyd 已提交
589

590 591 592 593
	/* start up the interrupt endpoint if we have one */
	if (port->interrupt_in_urb) {
		result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
		if (result)
594
			dev_err(&port->dev, "submit irq_in urb failed %d\n",
595 596 597
				result);
	}
	return 0;
K
Kevin Lloyd 已提交
598 599
}

A
Alan Cox 已提交
600 601
static void sierra_close(struct tty_struct *tty,
			struct usb_serial_port *port, struct file *filp)
K
Kevin Lloyd 已提交
602 603 604 605 606
{
	int i;
	struct usb_serial *serial = port->serial;
	struct sierra_port_private *portdata;

607
	dbg("%s", __func__);
K
Kevin Lloyd 已提交
608 609 610 611 612 613
	portdata = usb_get_serial_port_data(port);

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

	if (serial->dev) {
614 615
		mutex_lock(&serial->disc_mutex);
		if (!serial->disconnected)
A
Alan Cox 已提交
616
			sierra_send_setup(tty, port);
617
		mutex_unlock(&serial->disc_mutex);
K
Kevin Lloyd 已提交
618 619 620

		/* Stop reading/writing urbs */
		for (i = 0; i < N_IN_URB; i++)
621
			usb_kill_urb(portdata->in_urbs[i]);
K
Kevin Lloyd 已提交
622 623
	}

624
	usb_kill_urb(port->interrupt_in_urb);
K
Kevin Lloyd 已提交
625

A
Alan Cox 已提交
626
	port->port.tty = NULL;	/* FIXME */
K
Kevin Lloyd 已提交
627 628 629 630 631 632
}

static int sierra_startup(struct usb_serial *serial)
{
	struct usb_serial_port *port;
	struct sierra_port_private *portdata;
633 634 635
	struct urb *urb;
	int i;
	int j;
K
Kevin Lloyd 已提交
636

637
	dbg("%s", __func__);
K
Kevin Lloyd 已提交
638

639
	/* Set Device mode to D0 */
640 641
	sierra_set_power_state(serial->dev, 0x0000);

642 643 644 645
	/* Check NMEA and set */
	if (nmea)
		sierra_vsc_set_nmea(serial->dev, 1);

K
Kevin Lloyd 已提交
646 647 648 649 650 651
	/* Now setup per port private data */
	for (i = 0; i < serial->num_ports; i++) {
		port = serial->port[i];
		portdata = kzalloc(sizeof(*portdata), GFP_KERNEL);
		if (!portdata) {
			dbg("%s: kmalloc for sierra_port_private (%d) failed!.",
652
					__func__, i);
653
			return -ENOMEM;
K
Kevin Lloyd 已提交
654
		}
655
		spin_lock_init(&portdata->lock);
O
Oliver Neukum 已提交
656 657 658 659 660 661 662 663 664
		for (j = 0; j < N_IN_URB; j++) {
			portdata->in_buffer[j] = kmalloc(IN_BUFLEN, GFP_KERNEL);
			if (!portdata->in_buffer[j]) {
				for (--j; j >= 0; j--)
					kfree(portdata->in_buffer[j]);
				kfree(portdata);
				return -ENOMEM;
			}
		}
K
Kevin Lloyd 已提交
665 666 667

		usb_set_serial_port_data(port, portdata);

668 669 670 671 672
		/* initialize the in urbs */
		for (j = 0; j < N_IN_URB; ++j) {
			urb = usb_alloc_urb(0, GFP_KERNEL);
			if (urb == NULL) {
				dbg("%s: alloc for in port failed.",
673
				    __func__);
674 675 676 677 678 679 680 681 682 683
				continue;
			}
			/* Fill URB using supplied data. */
			usb_fill_bulk_urb(urb, serial->dev,
					  usb_rcvbulkpipe(serial->dev,
						port->bulk_in_endpointAddress),
					  portdata->in_buffer[j], IN_BUFLEN,
					  sierra_indat_callback, port);
			portdata->in_urbs[j] = urb;
		}
K
Kevin Lloyd 已提交
684 685
	}

686
	return 0;
K
Kevin Lloyd 已提交
687 688 689 690 691 692 693 694
}

static void sierra_shutdown(struct usb_serial *serial)
{
	int i, j;
	struct usb_serial_port *port;
	struct sierra_port_private *portdata;

695
	dbg("%s", __func__);
K
Kevin Lloyd 已提交
696 697 698

	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
699 700
		if (!port)
			continue;
K
Kevin Lloyd 已提交
701
		portdata = usb_get_serial_port_data(port);
702 703
		if (!portdata)
			continue;
K
Kevin Lloyd 已提交
704 705

		for (j = 0; j < N_IN_URB; j++) {
706 707
			usb_kill_urb(portdata->in_urbs[j]);
			usb_free_urb(portdata->in_urbs[j]);
O
Oliver Neukum 已提交
708
			kfree(portdata->in_buffer[j]);
K
Kevin Lloyd 已提交
709
		}
710 711
		kfree(portdata);
		usb_set_serial_port_data(port, NULL);
K
Kevin Lloyd 已提交
712 713 714
	}
}

715
static struct usb_serial_driver sierra_device = {
716 717
	.driver = {
		.owner =	THIS_MODULE,
K
Kevin Lloyd 已提交
718
		.name =		"sierra",
719
	},
720 721
	.description       = "Sierra USB modem",
	.id_table          = id_table,
722
	.usb_driver        = &sierra_driver,
723 724
	.calc_num_ports	   = sierra_calc_num_ports,
	.probe		   = sierra_probe,
725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740
	.open              = sierra_open,
	.close             = sierra_close,
	.write             = sierra_write,
	.write_room        = sierra_write_room,
	.set_termios       = sierra_set_termios,
	.tiocmget          = sierra_tiocmget,
	.tiocmset          = sierra_tiocmset,
	.attach            = sierra_startup,
	.shutdown          = sierra_shutdown,
	.read_int_callback = sierra_instat_callback,
};

/* Functions used by new usb-serial code. */
static int __init sierra_init(void)
{
	int retval;
741
	retval = usb_serial_register(&sierra_device);
742
	if (retval)
743
		goto failed_device_register;
744 745 746 747 748 749 750 751 752 753 754


	retval = usb_register(&sierra_driver);
	if (retval)
		goto failed_driver_register;

	info(DRIVER_DESC ": " DRIVER_VERSION);

	return 0;

failed_driver_register:
755 756
	usb_serial_deregister(&sierra_device);
failed_device_register:
757 758 759 760 761
	return retval;
}

static void __exit sierra_exit(void)
{
A
Alan Cox 已提交
762
	usb_deregister(&sierra_driver);
763
	usb_serial_deregister(&sierra_device);
764 765 766 767 768
}

module_init(sierra_init);
module_exit(sierra_exit);

K
Kevin Lloyd 已提交
769 770 771
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_VERSION(DRIVER_VERSION);
772
MODULE_LICENSE("GPL");
K
Kevin Lloyd 已提交
773

K
Kevin Lloyd 已提交
774
module_param(nmea, bool, S_IRUGO | S_IWUSR);
775 776
MODULE_PARM_DESC(nmea, "NMEA streaming");

K
Kevin Lloyd 已提交
777 778 779 780
#ifdef CONFIG_USB_DEBUG
module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug messages");
#endif