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

4
  Copyright (C) 2006, 2007  Kevin Lloyd <linux@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
#define DRIVER_VERSION "v.1.2.5b"
K
Kevin Lloyd 已提交
18 19
#define DRIVER_AUTHOR "Kevin Lloyd <linux@sierrawireless.com>"
#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

30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47
#define SWIMS_USB_REQUEST_SetMode	0x0B
#define SWIMS_USB_REQUEST_TYPE_SetMode	0x40
#define SWIMS_USB_INDEX_SetMode		0x0000
#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;

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

48
static int sierra_set_power_state(struct usb_device *udev, __u16 swiState)
49 50
{
	int result;
51
	dev_dbg(&udev->dev, "%s", "SET POWER STATE\n");
52 53 54 55 56 57 58 59 60 61 62
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
			0x00,			/* __u8 request      */
			0x40,			/* __u8 request type */
			swiState,		/* __u16 value       */
			0,			/* __u16 index       */
			NULL,			/* void *data        */
			0,			/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);	/* int timeout 	     */
	return result;
}

63
static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSocMode)
64 65
{
	int result;
66
	dev_dbg(&udev->dev, "%s", "DEVICE MODE SWITCH\n");
67 68 69 70 71 72 73 74 75 76 77
	result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
			SWIMS_USB_REQUEST_SetMode,	/* __u8 request      */
			SWIMS_USB_REQUEST_TYPE_SetMode,	/* __u8 request type */
			eSocMode,			/* __u16 value       */
			SWIMS_USB_INDEX_SetMode,	/* __u16 index       */
			NULL,				/* void *data        */
			0,				/* __u16 size 	     */
			USB_CTRL_SET_TIMEOUT);		/* int timeout       */
	return result;
}

78 79
static int sierra_probe(struct usb_interface *iface,
			const struct usb_device_id *id)
80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95
{
	int result;
	struct usb_device *udev;

	udev = usb_get_dev(interface_to_usbdev(iface));

	/* Check if in installer mode */
	if (id->driver_info == DEVICE_INSTALLER) {
		dev_dbg(&udev->dev, "%s", "FOUND DEVICE(SW)\n");
		result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem);
		/*We do not want to bind to the device when in installer mode*/
		return -EIO;
	}

	return usb_serial_probe(iface, id);
}
K
Kevin Lloyd 已提交
96

97
static struct usb_device_id id_table [] = {
K
Kevin Lloyd 已提交
98
	{ USB_DEVICE(0x1199, 0x0017) },	/* Sierra Wireless EM5625 */
99
	{ USB_DEVICE(0x1199, 0x0018) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
100
	{ USB_DEVICE(0x1199, 0x0218) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
101
	{ USB_DEVICE(0x0f30, 0x1b1d) },	/* Sierra Wireless MC5720 */
102
	{ USB_DEVICE(0x1199, 0x0020) },	/* Sierra Wireless MC5725 */
103
	{ USB_DEVICE(0x1199, 0x0220) },	/* Sierra Wireless MC5725 */
104
	{ USB_DEVICE(0x1199, 0x0019) },	/* Sierra Wireless AirCard 595 */
K
Kevin Lloyd 已提交
105
	{ USB_DEVICE(0x1199, 0x0021) },	/* Sierra Wireless AirCard 597E */
K
Kevin Lloyd 已提交
106
	{ USB_DEVICE(0x1199, 0x0120) },	/* Sierra Wireless USB Dongle 595U */
K
Kevin Lloyd 已提交
107
	{ USB_DEVICE(0x1199, 0x0023) },	/* Sierra Wireless AirCard */
K
Kevin Lloyd 已提交
108

109
	{ USB_DEVICE(0x1199, 0x6802) },	/* Sierra Wireless MC8755 */
K
Kevin Lloyd 已提交
110
	{ USB_DEVICE(0x1199, 0x6804) },	/* Sierra Wireless MC8755 */
111
	{ USB_DEVICE(0x1199, 0x6803) },	/* Sierra Wireless MC8765 */
K
Kevin Lloyd 已提交
112
	{ USB_DEVICE(0x1199, 0x6812) },	/* Sierra Wireless MC8775 & AC 875U */
K
Kevin R Page 已提交
113
	{ USB_DEVICE(0x1199, 0x6813) },	/* Sierra Wireless MC8775 (Thinkpad internal) */
114
	{ USB_DEVICE(0x1199, 0x6820) },	/* Sierra Wireless AirCard 875 */
K
Kevin Lloyd 已提交
115 116 117 118 119 120
	{ USB_DEVICE(0x1199, 0x6832) },	/* Sierra Wireless MC8780*/
	{ USB_DEVICE(0x1199, 0x6833) },	/* Sierra Wireless MC8781*/
	{ 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 已提交
121
	{ USB_DEVICE(0x1199, 0x6855) },	/* Sierra Wireless AirCard 880 U */
122
	{ USB_DEVICE(0x1199, 0x6856) },	/* Sierra Wireless AirCard 881 U */
K
Kevin Lloyd 已提交
123

K
Kevin Lloyd 已提交
124 125 126
	{ USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */
	{ USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */

127 128
	{ 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 */
129
	{ USB_DEVICE(0x05C6, 0x6613), .driver_info = DEVICE_1_PORT }, /* Onda H600/ZTE MF330 */
130 131

	{ USB_DEVICE(0x1199, 0x0FFF), .driver_info = DEVICE_INSTALLER},
K
Kevin Lloyd 已提交
132 133
	{ }
};
134
MODULE_DEVICE_TABLE(usb, id_table);
K
Kevin Lloyd 已提交
135 136 137 138

static struct usb_device_id id_table_1port [] = {
	{ USB_DEVICE(0x1199, 0x0112) }, /* Sierra Wireless AirCard 580 */
	{ USB_DEVICE(0x0F3D, 0x0112) }, /* AirPrime/Sierra PC 5220 */
139
	{ USB_DEVICE(0x05C6, 0x6613) }, /* Onda H600/ZTE MF330 */
140 141
	{ }
};
K
Kevin Lloyd 已提交
142 143

static struct usb_device_id id_table_3port [] = {
K
Kevin Lloyd 已提交
144
	{ USB_DEVICE(0x1199, 0x0017) },	/* Sierra Wireless EM5625 */
K
Kevin Lloyd 已提交
145
	{ USB_DEVICE(0x1199, 0x0018) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
146
	{ USB_DEVICE(0x0f30, 0x1b1d) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
147
	{ USB_DEVICE(0x1199, 0x0218) },	/* Sierra Wireless MC5720 */
K
Kevin Lloyd 已提交
148
	{ USB_DEVICE(0x1199, 0x0020) },	/* Sierra Wireless MC5725 */
149
	{ USB_DEVICE(0x1199, 0x0220) },	/* Sierra Wireless MC5725 */
K
Kevin Lloyd 已提交
150
	{ USB_DEVICE(0x1199, 0x0019) },	/* Sierra Wireless AirCard 595 */
K
Kevin Lloyd 已提交
151
	{ USB_DEVICE(0x1199, 0x0021) },	/* Sierra Wireless AirCard 597E */
K
Kevin Lloyd 已提交
152
	{ USB_DEVICE(0x1199, 0x0120) },	/* Sierra Wireless USB Dongle 595U*/
K
Kevin Lloyd 已提交
153
	{ USB_DEVICE(0x1199, 0x0023) },	/* Sierra Wireless AirCard */
154

K
Kevin Lloyd 已提交
155
	{ USB_DEVICE(0x1199, 0x6802) },	/* Sierra Wireless MC8755 */
K
Kevin Lloyd 已提交
156
	{ USB_DEVICE(0x1199, 0x6804) },	/* Sierra Wireless MC8755 */
K
Kevin Lloyd 已提交
157
	{ USB_DEVICE(0x1199, 0x6803) },	/* Sierra Wireless MC8765 */
K
Kevin Lloyd 已提交
158
	{ USB_DEVICE(0x1199, 0x6812) },	/* Sierra Wireless MC8775 & AC 875U */
K
Kevin R Page 已提交
159
	{ USB_DEVICE(0x1199, 0x6813) },	/* Sierra Wireless MC8775 (Thinkpad internal) */
K
Kevin Lloyd 已提交
160
	{ USB_DEVICE(0x1199, 0x6820) },	/* Sierra Wireless AirCard 875 */
K
Kevin Lloyd 已提交
161 162 163 164 165 166
	{ USB_DEVICE(0x1199, 0x6832) },	/* Sierra Wireless MC8780*/
	{ USB_DEVICE(0x1199, 0x6833) },	/* Sierra Wireless MC8781*/
	{ USB_DEVICE(0x1199, 0x6850) },	/* Sierra Wireless AirCard 880 */
	{ USB_DEVICE(0x1199, 0x6851) },	/* Sierra Wireless AirCard 881 */
	{ USB_DEVICE(0x1199, 0x6852) },	/* Sierra Wireless AirCard 880E */
	{ USB_DEVICE(0x1199, 0x6853) },	/* Sierra Wireless AirCard 881E */
K
Kevin Lloyd 已提交
167
	{ USB_DEVICE(0x1199, 0x6855) },	/* Sierra Wireless AirCard 880 U */
168
	{ USB_DEVICE(0x1199, 0x6856) },	/* Sierra Wireless AirCard 881U */
K
Kevin Lloyd 已提交
169 170
	{ USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */
	{ USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */
K
Kevin Lloyd 已提交
171 172 173
	{ }
};

174
static struct usb_driver sierra_driver = {
K
Kevin Lloyd 已提交
175
	.name       = "sierra",
176
	.probe      = sierra_probe,
K
Kevin Lloyd 已提交
177 178
	.disconnect = usb_serial_disconnect,
	.id_table   = id_table,
179
	.no_dynamic_id = 	1,
K
Kevin Lloyd 已提交
180 181 182 183
};


struct sierra_port_private {
184 185 186
	spinlock_t lock;	/* lock the structure */
	int outstanding_urbs;	/* number of out urbs in flight */

K
Kevin Lloyd 已提交
187 188 189 190 191 192 193 194 195 196 197 198 199
	/* Input endpoints and buffer for this port */
	struct urb *in_urbs[N_IN_URB];
	char in_buffer[N_IN_URB][IN_BUFLEN];

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

200
static int sierra_send_setup(struct usb_serial_port *port)
201
{
202 203
	struct usb_serial *serial = port->serial;
	struct sierra_port_private *portdata;
K
Kevin Lloyd 已提交
204

205
	dbg("%s", __FUNCTION__);
K
Kevin Lloyd 已提交
206

207
	portdata = usb_get_serial_port_data(port);
K
Kevin Lloyd 已提交
208

209 210 211 212 213 214
	if (port->tty) {
		int val = 0;
		if (portdata->dtr_state)
			val |= 0x01;
		if (portdata->rts_state)
			val |= 0x02;
K
Kevin Lloyd 已提交
215

216 217 218 219
		return usb_control_msg(serial->dev,
				usb_rcvctrlpipe(serial->dev, 0),
				0x22,0x21,val,0,NULL,0,USB_CTRL_SET_TIMEOUT);
	}
220

221
	return 0;
222 223
}

K
Kevin Lloyd 已提交
224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240
static void sierra_rx_throttle(struct usb_serial_port *port)
{
	dbg("%s", __FUNCTION__);
}

static void sierra_rx_unthrottle(struct usb_serial_port *port)
{
	dbg("%s", __FUNCTION__);
}

static void sierra_break_ctl(struct usb_serial_port *port, int break_state)
{
	/* Unfortunately, I don't know how to send a break */
	dbg("%s", __FUNCTION__);
}

static void sierra_set_termios(struct usb_serial_port *port,
A
Alan Cox 已提交
241
			struct ktermios *old_termios)
K
Kevin Lloyd 已提交
242 243
{
	dbg("%s", __FUNCTION__);
A
Alan Cox 已提交
244
	tty_termios_copy_hw(port->tty->termios, old_termios);
K
Kevin Lloyd 已提交
245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289
	sierra_send_setup(port);
}

static int sierra_tiocmget(struct usb_serial_port *port, struct file *file)
{
	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;
}

static int sierra_tiocmset(struct usb_serial_port *port, struct file *file,
			unsigned int set, unsigned int clear)
{
	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;
	return sierra_send_setup(port);
}

static int sierra_ioctl(struct usb_serial_port *port, struct file *file,
			unsigned int cmd, unsigned long arg)
{
	return -ENOIOCTLCMD;
}

290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
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;

	dbg("%s - port %d", __FUNCTION__, port->number);

	/* 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",
		    __FUNCTION__, status);

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

	usb_serial_port_softint(port);
}

K
Kevin Lloyd 已提交
313 314 315 316
/* Write */
static int sierra_write(struct usb_serial_port *port,
			const unsigned char *buf, int count)
{
317 318 319 320 321 322
	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 已提交
323 324 325 326 327

	portdata = usb_get_serial_port_data(port);

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

328 329 330 331 332 333 334 335 336 337 338 339 340 341 342
	spin_lock_irqsave(&portdata->lock, flags);
	if (portdata->outstanding_urbs > N_OUT_URB) {
		spin_unlock_irqrestore(&portdata->lock, flags);
		dbg("%s - write limit hit\n", __FUNCTION__);
		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 已提交
343

344 345 346 347 348 349
	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 已提交
350

351
	memcpy(buffer, buf, count);
K
Kevin Lloyd 已提交
352

353 354 355 356 357 358 359 360 361 362 363 364 365 366
	usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, buffer);

	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 "
			"with status = %d\n", __FUNCTION__, status);
		count = status;
		goto error;
K
Kevin Lloyd 已提交
367 368
	}

369 370 371 372 373 374 375 376 377 378 379 380 381
	/* 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 已提交
382 383 384 385 386 387 388 389 390 391
	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;
392
	int status = urb->status;
K
Kevin Lloyd 已提交
393 394 395 396 397 398

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

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

399
	if (status) {
K
Kevin Lloyd 已提交
400
		dbg("%s: nonzero status: %d on endpoint %02x.",
401
		    __FUNCTION__, status, endpoint);
K
Kevin Lloyd 已提交
402 403 404 405 406 407 408 409 410 411 412
	} else {
		tty = port->tty;
		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 {
			dbg("%s: empty read urb received", __FUNCTION__);
		}

		/* Resubmit urb so we continue receiving */
413
		if (port->open_count && status != -ESHUTDOWN) {
K
Kevin Lloyd 已提交
414 415
			err = usb_submit_urb(urb, GFP_ATOMIC);
			if (err)
416
				dev_err(&port->dev, "resubmit read urb failed."
417
					"(%d)\n", err);
K
Kevin Lloyd 已提交
418 419 420 421 422 423 424 425
		}
	}
	return;
}

static void sierra_instat_callback(struct urb *urb)
{
	int err;
426
	int status = urb->status;
K
Kevin Lloyd 已提交
427 428 429 430 431 432 433
	struct usb_serial_port *port = (struct usb_serial_port *) urb->context;
	struct sierra_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);

434
	if (status == 0) {
K
Kevin Lloyd 已提交
435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464
		struct usb_ctrlrequest *req_pkt =
				(struct usb_ctrlrequest *)urb->transfer_buffer;

		if (!req_pkt) {
			dbg("%s: NULL req_pkt\n", __FUNCTION__);
			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));

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

			if (port->tty && !C_CLOCAL(port->tty) &&
					old_dcd_state && !portdata->dcd_state)
				tty_hangup(port->tty);
		} else {
			dbg("%s: type %x req %x", __FUNCTION__,
				req_pkt->bRequestType,req_pkt->bRequest);
		}
	} else
465
		dbg("%s: error %d", __FUNCTION__, status);
K
Kevin Lloyd 已提交
466 467

	/* Resubmit urb so we continue receiving IRQ data */
468
	if (status != -ESHUTDOWN) {
K
Kevin Lloyd 已提交
469 470 471 472 473 474 475 476 477 478
		urb->dev = serial->dev;
		err = usb_submit_urb(urb, GFP_ATOMIC);
		if (err)
			dbg("%s: resubmit intr urb failed. (%d)",
				__FUNCTION__, err);
	}
}

static int sierra_write_room(struct usb_serial_port *port)
{
479 480
	struct sierra_port_private *portdata = usb_get_serial_port_data(port);
	unsigned long flags;
K
Kevin Lloyd 已提交
481

482
	dbg("%s - port %d", __FUNCTION__, port->number);
K
Kevin Lloyd 已提交
483

484 485 486 487 488 489 490
	/* 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);
		dbg("%s - write limit hit\n", __FUNCTION__);
		return 0;
K
Kevin Lloyd 已提交
491
	}
492
	spin_unlock_irqrestore(&portdata->lock, flags);
K
Kevin Lloyd 已提交
493

494
	return 2048;
K
Kevin Lloyd 已提交
495 496 497 498
}

static int sierra_chars_in_buffer(struct usb_serial_port *port)
{
499 500 501 502 503 504 505 506 507
	dbg("%s - port %d", __FUNCTION__, port->number);

	/*
	 * We can't really account for how much data we
	 * have sent out, but hasn't made it through to the
	 * device as we can't see the backend here, so just
	 * tell the tty layer that everything is flushed.
	 */
	return 0;
K
Kevin Lloyd 已提交
508 509 510 511 512 513
}

static int sierra_open(struct usb_serial_port *port, struct file *filp)
{
	struct sierra_port_private *portdata;
	struct usb_serial *serial = port->serial;
514
	int i;
K
Kevin Lloyd 已提交
515
	struct urb *urb;
K
Kevin Lloyd 已提交
516
	int result;
K
Kevin Lloyd 已提交
517 518 519 520 521 522 523 524 525 526 527 528

	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];
529
		if (!urb)
K
Kevin Lloyd 已提交
530 531 532 533 534 535 536 537 538 539 540 541 542
			continue;
		if (urb->dev != serial->dev) {
			dbg("%s: dev %p != %p", __FUNCTION__,
				urb->dev, serial->dev);
			continue;
		}

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

543 544
		result = usb_submit_urb(urb, GFP_KERNEL);
		if (result) {
545
			dev_err(&port->dev, "submit urb %d failed (%d) %d\n",
546
				i, result, urb->transfer_buffer_length);
K
Kevin Lloyd 已提交
547 548 549 550 551 552 553
		}
	}

	port->tty->low_latency = 1;

	sierra_send_setup(port);

554 555 556 557
	/* 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)
558
			dev_err(&port->dev, "submit irq_in urb failed %d\n",
559 560 561
				result);
	}
	return 0;
K
Kevin Lloyd 已提交
562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580
}

static void sierra_close(struct usb_serial_port *port, struct file *filp)
{
	int i;
	struct usb_serial *serial = port->serial;
	struct sierra_port_private *portdata;

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

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

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

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

584
	usb_kill_urb(port->interrupt_in_urb);
K
Kevin Lloyd 已提交
585

586
	port->tty = NULL;
K
Kevin Lloyd 已提交
587 588 589 590 591 592
}

static int sierra_startup(struct usb_serial *serial)
{
	struct usb_serial_port *port;
	struct sierra_port_private *portdata;
593 594 595
	struct urb *urb;
	int i;
	int j;
K
Kevin Lloyd 已提交
596 597 598

	dbg("%s", __FUNCTION__);

599 600 601
	/*Set Device mode to D0 */
	sierra_set_power_state(serial->dev, 0x0000);

K
Kevin Lloyd 已提交
602 603 604 605 606 607 608
	/* 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!.",
					__FUNCTION__, i);
609
			return -ENOMEM;
K
Kevin Lloyd 已提交
610
		}
611
		spin_lock_init(&portdata->lock);
K
Kevin Lloyd 已提交
612 613 614

		usb_set_serial_port_data(port, portdata);

615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630
		/* 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.",
				    __FUNCTION__);
				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 已提交
631 632
	}

633
	return 0;
K
Kevin Lloyd 已提交
634 635 636 637 638 639 640 641 642 643 644 645
}

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

	dbg("%s", __FUNCTION__);

	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
646 647
		if (!port)
			continue;
K
Kevin Lloyd 已提交
648
		portdata = usb_get_serial_port_data(port);
649 650
		if (!portdata)
			continue;
K
Kevin Lloyd 已提交
651 652

		for (j = 0; j < N_IN_URB; j++) {
653 654 655
			usb_kill_urb(portdata->in_urbs[j]);
			usb_free_urb(portdata->in_urbs[j]);
			portdata->in_urbs[j] = NULL;
K
Kevin Lloyd 已提交
656
		}
657 658
		kfree(portdata);
		usb_set_serial_port_data(port, NULL);
K
Kevin Lloyd 已提交
659 660 661
	}
}

662 663 664 665 666 667 668
static struct usb_serial_driver sierra_1port_device = {
	.driver = {
		.owner =	THIS_MODULE,
		.name =		"sierra1",
	},
	.description       = "Sierra USB modem (1 port)",
	.id_table          = id_table_1port,
669
	.usb_driver        = &sierra_driver,
670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697
	.num_interrupt_in  = NUM_DONT_CARE,
	.num_bulk_in       = 1,
	.num_bulk_out      = 1,
	.num_ports         = 1,
	.open              = sierra_open,
	.close             = sierra_close,
	.write             = sierra_write,
	.write_room        = sierra_write_room,
	.chars_in_buffer   = sierra_chars_in_buffer,
	.throttle          = sierra_rx_throttle,
	.unthrottle        = sierra_rx_unthrottle,
	.ioctl             = sierra_ioctl,
	.set_termios       = sierra_set_termios,
	.break_ctl         = sierra_break_ctl,
	.tiocmget          = sierra_tiocmget,
	.tiocmset          = sierra_tiocmset,
	.attach            = sierra_startup,
	.shutdown          = sierra_shutdown,
	.read_int_callback = sierra_instat_callback,
};

static struct usb_serial_driver sierra_3port_device = {
	.driver = {
		.owner =	THIS_MODULE,
		.name =		"sierra3",
	},
	.description       = "Sierra USB modem (3 port)",
	.id_table          = id_table_3port,
698
	.usb_driver        = &sierra_driver,
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757
	.num_interrupt_in  = NUM_DONT_CARE,
	.num_bulk_in       = 3,
	.num_bulk_out      = 3,
	.num_ports         = 3,
	.open              = sierra_open,
	.close             = sierra_close,
	.write             = sierra_write,
	.write_room        = sierra_write_room,
	.chars_in_buffer   = sierra_chars_in_buffer,
	.throttle          = sierra_rx_throttle,
	.unthrottle        = sierra_rx_unthrottle,
	.ioctl             = sierra_ioctl,
	.set_termios       = sierra_set_termios,
	.break_ctl         = sierra_break_ctl,
	.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;
	retval = usb_serial_register(&sierra_1port_device);
	if (retval)
		goto failed_1port_device_register;
	retval = usb_serial_register(&sierra_3port_device);
	if (retval)
		goto failed_3port_device_register;


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

	info(DRIVER_DESC ": " DRIVER_VERSION);

	return 0;

failed_driver_register:
	usb_serial_deregister(&sierra_3port_device);
failed_3port_device_register:
	usb_serial_deregister(&sierra_1port_device);
failed_1port_device_register:
	return retval;
}

static void __exit sierra_exit(void)
{
	usb_deregister (&sierra_driver);
	usb_serial_deregister(&sierra_1port_device);
	usb_serial_deregister(&sierra_3port_device);
}

module_init(sierra_init);
module_exit(sierra_exit);

K
Kevin Lloyd 已提交
758 759 760
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_VERSION(DRIVER_VERSION);
761
MODULE_LICENSE("GPL");
K
Kevin Lloyd 已提交
762 763 764 765 766 767

#ifdef CONFIG_USB_DEBUG
module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug messages");
#endif