usb-serial.c 40.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * USB Serial Converter driver
 *
4
 * Copyright (C) 1999 - 2012 Greg Kroah-Hartman (greg@kroah.com)
L
Linus Torvalds 已提交
5 6 7 8 9 10 11
 * Copyright (C) 2000 Peter Berger (pberger@brimson.com)
 * Copyright (C) 2000 Al Borchers (borchers@steinerpoint.com)
 *
 *	This program is free software; you can redistribute it and/or
 *	modify it under the terms of the GNU General Public License version
 *	2 as published by the Free Software Foundation.
 *
12
 * This driver was originally based on the ACM driver by Armin Fuerst (which was
L
Linus Torvalds 已提交
13 14
 * based on a driver by Brad Keryan)
 *
A
Alan Cox 已提交
15 16
 * See Documentation/usb/usb-serial.txt for more information on using this
 * driver
L
Linus Torvalds 已提交
17 18 19
 *
 */

20 21
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

L
Linus Torvalds 已提交
22 23 24 25 26 27 28 29 30
#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
31
#include <linux/seq_file.h>
L
Linus Torvalds 已提交
32
#include <linux/spinlock.h>
33
#include <linux/mutex.h>
L
Linus Torvalds 已提交
34
#include <linux/list.h>
A
Alan Cox 已提交
35
#include <linux/uaccess.h>
36
#include <linux/serial.h>
L
Linus Torvalds 已提交
37
#include <linux/usb.h>
38
#include <linux/usb/serial.h>
39
#include <linux/kfifo.h>
L
Linus Torvalds 已提交
40 41
#include "pl2303.h"

42
#define DRIVER_AUTHOR "Greg Kroah-Hartman <gregkh@linuxfoundation.org>"
L
Linus Torvalds 已提交
43 44 45 46 47 48 49 50 51
#define DRIVER_DESC "USB Serial Driver core"

/* There is no MODULE_DEVICE_TABLE for usbserial.c.  Instead
   the MODULE_DEVICE_TABLE declarations in each serial driver
   cause the "hotplug" program to pull in whatever module is necessary
   via modprobe, and modprobe will load usbserial because the serial
   drivers depend on it.
*/

A
Alan Cox 已提交
52 53
/* initially all NULL */
static struct usb_serial *serial_table[SERIAL_TTY_MINORS];
54
static DEFINE_MUTEX(table_lock);
L
Linus Torvalds 已提交
55 56
static LIST_HEAD(usb_serial_driver_list);

57 58 59 60 61
/*
 * Look up the serial structure.  If it is found and it hasn't been
 * disconnected, return with its disc_mutex held and its refcount
 * incremented.  Otherwise return NULL.
 */
L
Linus Torvalds 已提交
62 63
struct usb_serial *usb_serial_get_by_index(unsigned index)
{
64 65
	struct usb_serial *serial;

66
	mutex_lock(&table_lock);
67
	serial = serial_table[index];
L
Linus Torvalds 已提交
68

69 70 71 72 73 74 75 76 77
	if (serial) {
		mutex_lock(&serial->disc_mutex);
		if (serial->disconnected) {
			mutex_unlock(&serial->disc_mutex);
			serial = NULL;
		} else {
			kref_get(&serial->kref);
		}
	}
78
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
79 80 81
	return serial;
}

A
Alan Cox 已提交
82 83
static struct usb_serial *get_free_serial(struct usb_serial *serial,
					int num_ports, unsigned int *minor)
L
Linus Torvalds 已提交
84 85 86 87
{
	unsigned int i, j;
	int good_spot;

88
	dev_dbg(&serial->interface->dev, "%s %d\n", __func__, num_ports);
L
Linus Torvalds 已提交
89 90

	*minor = 0;
91
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
92 93 94 95 96 97 98 99 100 101 102 103 104 105 106
	for (i = 0; i < SERIAL_TTY_MINORS; ++i) {
		if (serial_table[i])
			continue;

		good_spot = 1;
		for (j = 1; j <= num_ports-1; ++j)
			if ((i+j >= SERIAL_TTY_MINORS) || (serial_table[i+j])) {
				good_spot = 0;
				i += j;
				break;
			}
		if (good_spot == 0)
			continue;

		*minor = i;
O
Oliver Neukum 已提交
107
		j = 0;
108
		dev_dbg(&serial->interface->dev, "%s - minor base = %d\n", __func__, *minor);
O
Oliver Neukum 已提交
109
		for (i = *minor; (i < (*minor + num_ports)) && (i < SERIAL_TTY_MINORS); ++i) {
L
Linus Torvalds 已提交
110
			serial_table[i] = serial;
O
Oliver Neukum 已提交
111 112
			serial->port[j++]->number = i;
		}
113
		mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
114 115
		return serial;
	}
116
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
117 118 119 120 121 122 123
	return NULL;
}

static void return_serial(struct usb_serial *serial)
{
	int i;

124
	mutex_lock(&table_lock);
A
Alan Cox 已提交
125
	for (i = 0; i < serial->num_ports; ++i)
L
Linus Torvalds 已提交
126
		serial_table[serial->minor + i] = NULL;
127
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
128 129 130 131 132 133 134 135 136 137
}

static void destroy_serial(struct kref *kref)
{
	struct usb_serial *serial;
	struct usb_serial_port *port;
	int i;

	serial = to_usb_serial(kref);

J
Jim Radford 已提交
138
	/* return the minor range that this device had */
139 140
	if (serial->minor != SERIAL_TTY_NO_MINOR)
		return_serial(serial);
J
Jim Radford 已提交
141

142 143
	if (serial->attached)
		serial->type->release(serial);
144

145 146
	/* Now that nothing is using the ports, they can be freed */
	for (i = 0; i < serial->num_port_pointers; ++i) {
147
		port = serial->port[i];
148 149
		if (port) {
			port->serial = NULL;
150
			put_device(&port->dev);
L
Linus Torvalds 已提交
151 152 153 154
		}
	}

	usb_put_dev(serial->dev);
A
Alan Cox 已提交
155
	kfree(serial);
L
Linus Torvalds 已提交
156 157
}

158 159 160 161 162
void usb_serial_put(struct usb_serial *serial)
{
	kref_put(&serial->kref, destroy_serial);
}

L
Linus Torvalds 已提交
163 164 165
/*****************************************************************************
 * Driver tty interface functions
 *****************************************************************************/
166 167 168 169 170 171 172 173 174

/**
 * serial_install - install tty
 * @driver: the driver (USB in our case)
 * @tty: the tty being created
 *
 * Create the termios objects for this tty.  We use the default
 * USB serial settings but permit them to be overridden by
 * serial->type->init_termios.
175 176 177 178
 *
 * This is the first place a new tty gets used.  Hence this is where we
 * acquire references to the usb_serial structure and the driver module,
 * where we store a pointer to the port, and where we do an autoresume.
179
 * All these actions are reversed in serial_cleanup().
180 181 182 183 184
 */
static int serial_install(struct tty_driver *driver, struct tty_struct *tty)
{
	int idx = tty->index;
	struct usb_serial *serial;
185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200
	struct usb_serial_port *port;
	int retval = -ENODEV;

	serial = usb_serial_get_by_index(idx);
	if (!serial)
		return retval;

	port = serial->port[idx - serial->minor];
	if (!port)
		goto error_no_port;
	if (!try_module_get(serial->type->driver.owner))
		goto error_module_get;

	retval = usb_autopm_get_interface(serial->interface);
	if (retval)
		goto error_get_interface;
201

202
	retval = tty_port_install(&port->port, driver, tty);
203 204 205
	if (retval)
		goto error_init_termios;

206 207
	mutex_unlock(&serial->disc_mutex);

208 209 210 211
	/* allow the driver to update the settings */
	if (serial->type->init_termios)
		serial->type->init_termios(tty);

212 213 214 215
	tty->driver_data = port;

	return retval;

216
 error_init_termios:
217 218
	usb_autopm_put_interface(serial->interface);
 error_get_interface:
219 220 221 222 223 224
	module_put(serial->type->driver.owner);
 error_module_get:
 error_no_port:
	usb_serial_put(serial);
	mutex_unlock(&serial->disc_mutex);
	return retval;
225 226
}

A
Alan Cox 已提交
227
static int serial_activate(struct tty_port *tport, struct tty_struct *tty)
L
Linus Torvalds 已提交
228
{
A
Alan Cox 已提交
229 230
	struct usb_serial_port *port =
		container_of(tport, struct usb_serial_port, port);
231 232
	struct usb_serial *serial = port->serial;
	int retval;
233

A
Alan Cox 已提交
234 235 236 237 238 239
	mutex_lock(&serial->disc_mutex);
	if (serial->disconnected)
		retval = -ENODEV;
	else
		retval = port->serial->type->open(tty, port);
	mutex_unlock(&serial->disc_mutex);
240 241 242 243

	if (retval < 0)
		retval = usb_translate_errors(retval);

A
Alan Cox 已提交
244 245
	return retval;
}
L
Linus Torvalds 已提交
246

A
Alan Cox 已提交
247 248 249
static int serial_open(struct tty_struct *tty, struct file *filp)
{
	struct usb_serial_port *port = tty->driver_data;
250

251
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
A
Alan Cox 已提交
252
	return tty_port_open(&port->port, tty, filp);
L
Linus Torvalds 已提交
253 254
}

255
/**
A
Alan Stern 已提交
256
 * serial_down - shut down hardware
257
 * @tport: tty port to shut down
258
 *
259
 * Shut down a USB serial port unless it is the console.  We never
260 261 262
 * shut down the console hardware as it will always be in use. Serialized
 * against activate by the tport mutex and kept to matching open/close pairs
 * of calls by the ASYNCB_INITIALIZED flag.
263
 */
264
static void serial_down(struct tty_port *tport)
L
Linus Torvalds 已提交
265
{
266 267
	struct usb_serial_port *port =
		container_of(tport, struct usb_serial_port, port);
268
	struct usb_serial_driver *drv = port->serial->type;
269 270 271 272
	/*
	 * The console is magical.  Do not hang up the console hardware
	 * or there will be tears.
	 */
273
	if (port->port.console)
L
Linus Torvalds 已提交
274
		return;
275 276 277 278
	if (drv->close)
		drv->close(port);
}

279 280 281
static void serial_hangup(struct tty_struct *tty)
{
	struct usb_serial_port *port = tty->driver_data;
282 283

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
284 285 286 287 288 289
	tty_port_hangup(&port->port);
}

static void serial_close(struct tty_struct *tty, struct file *filp)
{
	struct usb_serial_port *port = tty->driver_data;
290 291

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
292
	tty_port_close(&port->port, tty, filp);
293 294
}

295
/**
296
 * serial_cleanup - free resources post close/hangup
297
 * @port: port to free up
298
 *
299 300
 * Do the resource freeing and refcount dropping for the port.
 * Avoid freeing the console.
301
 *
302
 * Called asynchronously after the last tty kref is dropped.
303
 */
304
static void serial_cleanup(struct tty_struct *tty)
305
{
306
	struct usb_serial_port *port = tty->driver_data;
307 308 309
	struct usb_serial *serial;
	struct module *owner;

310 311 312
	/* The console is magical.  Do not hang up the console hardware
	 * or there will be tears.
	 */
313
	if (port->port.console)
314 315
		return;

316
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
317

318 319
	tty->driver_data = NULL;

320 321
	serial = port->serial;
	owner = serial->type->driver.owner;
322

323 324 325 326
	mutex_lock(&serial->disc_mutex);
	if (!serial->disconnected)
		usb_autopm_put_interface(serial->interface);
	mutex_unlock(&serial->disc_mutex);
327

328
	usb_serial_put(serial);
329 330 331
	module_put(owner);
}

A
Alan Cox 已提交
332 333
static int serial_write(struct tty_struct *tty, const unsigned char *buf,
								int count)
L
Linus Torvalds 已提交
334
{
335
	struct usb_serial_port *port = tty->driver_data;
336
	int retval = -ENODEV;
L
Linus Torvalds 已提交
337

A
Alan Cox 已提交
338
	if (port->serial->dev->state == USB_STATE_NOTATTACHED)
339 340
		goto exit;

341 342
	dev_dbg(tty->dev, "%s - port %d, %d byte(s)\n", __func__,
		port->number, count);
L
Linus Torvalds 已提交
343 344

	/* pass on to the driver specific version of this function */
A
Alan Cox 已提交
345
	retval = port->serial->type->write(tty, port, buf, count);
346 347
	if (retval < 0)
		retval = usb_translate_errors(retval);
L
Linus Torvalds 已提交
348 349 350 351
exit:
	return retval;
}

A
Alan Cox 已提交
352
static int serial_write_room(struct tty_struct *tty)
L
Linus Torvalds 已提交
353
{
354
	struct usb_serial_port *port = tty->driver_data;
355 356

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
357
	/* pass on to the driver specific version of this function */
A
Alan Cox 已提交
358
	return port->serial->type->write_room(tty);
L
Linus Torvalds 已提交
359 360
}

A
Alan Cox 已提交
361
static int serial_chars_in_buffer(struct tty_struct *tty)
L
Linus Torvalds 已提交
362
{
363
	struct usb_serial_port *port = tty->driver_data;
364 365
	struct usb_serial *serial = port->serial;
	int count = 0;
366 367

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
368

369
	mutex_lock(&serial->disc_mutex);
370 371
	/* if the device was unplugged then any remaining characters
	   fell out of the connector ;) */
372 373 374 375 376 377 378
	if (serial->disconnected)
		count = 0;
	else
		count = serial->type->chars_in_buffer(tty);
	mutex_unlock(&serial->disc_mutex);

	return count;
L
Linus Torvalds 已提交
379 380
}

A
Alan Cox 已提交
381
static void serial_throttle(struct tty_struct *tty)
L
Linus Torvalds 已提交
382
{
383
	struct usb_serial_port *port = tty->driver_data;
384 385

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
386 387 388

	/* pass on to the driver specific version of this function */
	if (port->serial->type->throttle)
A
Alan Cox 已提交
389
		port->serial->type->throttle(tty);
L
Linus Torvalds 已提交
390 391
}

A
Alan Cox 已提交
392
static void serial_unthrottle(struct tty_struct *tty)
L
Linus Torvalds 已提交
393
{
394
	struct usb_serial_port *port = tty->driver_data;
395 396

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
397 398 399

	/* pass on to the driver specific version of this function */
	if (port->serial->type->unthrottle)
A
Alan Cox 已提交
400
		port->serial->type->unthrottle(tty);
L
Linus Torvalds 已提交
401 402
}

403
static int serial_ioctl(struct tty_struct *tty,
A
Alan Cox 已提交
404
					unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
405
{
406
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
407 408
	int retval = -ENODEV;

409 410
	dev_dbg(tty->dev, "%s - port %d, cmd 0x%.4x\n", __func__,
		port->number, cmd);
L
Linus Torvalds 已提交
411

A
Alan Cox 已提交
412 413
	/* pass on to the driver specific version of this function
	   if it is available */
A
Alan Cox 已提交
414
	if (port->serial->type->ioctl) {
415
		retval = port->serial->type->ioctl(tty, cmd, arg);
A
Alan Cox 已提交
416
	} else
L
Linus Torvalds 已提交
417 418 419 420
		retval = -ENOIOCTLCMD;
	return retval;
}

A
Alan Cox 已提交
421
static void serial_set_termios(struct tty_struct *tty, struct ktermios *old)
L
Linus Torvalds 已提交
422
{
423
	struct usb_serial_port *port = tty->driver_data;
424 425

	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
426

A
Alan Cox 已提交
427 428
	/* pass on to the driver specific version of this function
	   if it is available */
L
Linus Torvalds 已提交
429
	if (port->serial->type->set_termios)
A
Alan Cox 已提交
430
		port->serial->type->set_termios(tty, port, old);
431
	else
432
		tty_termios_copy_hw(&tty->termios, old);
L
Linus Torvalds 已提交
433 434
}

A
Alan Cox 已提交
435
static int serial_break(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
436
{
437
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
438

439
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
440

A
Alan Cox 已提交
441 442
	/* pass on to the driver specific version of this function
	   if it is available */
443
	if (port->serial->type->break_ctl)
A
Alan Cox 已提交
444
		port->serial->type->break_ctl(tty, break_state);
A
Alan Cox 已提交
445
	return 0;
L
Linus Torvalds 已提交
446 447
}

448
static int serial_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
449 450 451 452 453
{
	struct usb_serial *serial;
	int i;
	char tmp[40];

454 455
	seq_puts(m, "usbserinfo:1.0 driver:2.0\n");
	for (i = 0; i < SERIAL_TTY_MINORS; ++i) {
L
Linus Torvalds 已提交
456 457 458 459
		serial = usb_serial_get_by_index(i);
		if (serial == NULL)
			continue;

460
		seq_printf(m, "%d:", i);
461
		if (serial->type->driver.owner)
462
			seq_printf(m, " module:%s",
A
Alan Cox 已提交
463
				module_name(serial->type->driver.owner));
464
		seq_printf(m, " name:\"%s\"",
A
Alan Cox 已提交
465
				serial->type->description);
466
		seq_printf(m, " vendor:%04x product:%04x",
A
Alan Cox 已提交
467 468
			le16_to_cpu(serial->dev->descriptor.idVendor),
			le16_to_cpu(serial->dev->descriptor.idProduct));
469 470
		seq_printf(m, " num_ports:%d", serial->num_ports);
		seq_printf(m, " port:%d", i - serial->minor + 1);
L
Linus Torvalds 已提交
471
		usb_make_path(serial->dev, tmp, sizeof(tmp));
472
		seq_printf(m, " path:%s", tmp);
A
Alan Cox 已提交
473

474
		seq_putc(m, '\n');
475
		usb_serial_put(serial);
476
		mutex_unlock(&serial->disc_mutex);
L
Linus Torvalds 已提交
477
	}
478
	return 0;
L
Linus Torvalds 已提交
479 480
}

481 482 483 484 485 486 487 488 489 490 491 492 493
static int serial_proc_open(struct inode *inode, struct file *file)
{
	return single_open(file, serial_proc_show, NULL);
}

static const struct file_operations serial_proc_fops = {
	.owner		= THIS_MODULE,
	.open		= serial_proc_open,
	.read		= seq_read,
	.llseek		= seq_lseek,
	.release	= single_release,
};

494
static int serial_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
495
{
496
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
497

498
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
499 500

	if (port->serial->type->tiocmget)
501
		return port->serial->type->tiocmget(tty);
L
Linus Torvalds 已提交
502 503 504
	return -EINVAL;
}

505
static int serial_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
506 507
			    unsigned int set, unsigned int clear)
{
508
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
509

510
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
L
Linus Torvalds 已提交
511 512

	if (port->serial->type->tiocmset)
513
		return port->serial->type->tiocmset(tty, set, clear);
L
Linus Torvalds 已提交
514 515 516
	return -EINVAL;
}

A
Alan Cox 已提交
517 518 519 520 521
static int serial_get_icount(struct tty_struct *tty,
				struct serial_icounter_struct *icount)
{
	struct usb_serial_port *port = tty->driver_data;

522
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
A
Alan Cox 已提交
523 524 525 526 527 528

	if (port->serial->type->get_icount)
		return port->serial->type->get_icount(tty, icount);
	return -EINVAL;
}

529 530 531 532 533 534 535 536 537
/*
 * We would be calling tty_wakeup here, but unfortunately some line
 * disciplines have an annoying habit of calling tty->write from
 * the write wakeup callback (e.g. n_hdlc.c).
 */
void usb_serial_port_softint(struct usb_serial_port *port)
{
	schedule_work(&port->work);
}
A
Alan Cox 已提交
538
EXPORT_SYMBOL_GPL(usb_serial_port_softint);
539

D
David Howells 已提交
540
static void usb_serial_port_work(struct work_struct *work)
L
Linus Torvalds 已提交
541
{
D
David Howells 已提交
542 543
	struct usb_serial_port *port =
		container_of(work, struct usb_serial_port, work);
L
Linus Torvalds 已提交
544 545
	struct tty_struct *tty;

A
Alan Cox 已提交
546
	tty = tty_port_tty_get(&port->port);
L
Linus Torvalds 已提交
547 548 549
	if (!tty)
		return;

550 551
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);

L
Linus Torvalds 已提交
552
	tty_wakeup(tty);
A
Alan Cox 已提交
553
	tty_kref_put(tty);
L
Linus Torvalds 已提交
554 555
}

556
static void kill_traffic(struct usb_serial_port *port)
557
{
558 559
	int i;

560 561
	for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i)
		usb_kill_urb(port->read_urbs[i]);
562 563
	for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i)
		usb_kill_urb(port->write_urbs[i]);
564 565 566 567 568 569 570 571 572 573 574
	/*
	 * This is tricky.
	 * Some drivers submit the read_urb in the
	 * handler for the write_urb or vice versa
	 * this order determines the order in which
	 * usb_kill_urb() must be used to reliably
	 * kill the URBs. As it is unknown here,
	 * both orders must be used in turn.
	 * The call below is not redundant.
	 */
	usb_kill_urb(port->read_urb);
L
Linus Torvalds 已提交
575 576
	usb_kill_urb(port->interrupt_in_urb);
	usb_kill_urb(port->interrupt_out_urb);
577 578
}

579
static void port_release(struct device *dev)
580
{
581
	struct usb_serial_port *port = to_usb_serial_port(dev);
582
	int i;
583

584
	dev_dbg(dev, "%s\n", __func__);
585

586 587 588 589
	/*
	 * Stop all the traffic before cancelling the work, so that
	 * nobody will restart it by calling usb_serial_port_softint.
	 */
590
	kill_traffic(port);
591 592
	cancel_work_sync(&port->work);

593
	usb_free_urb(port->interrupt_in_urb);
L
Linus Torvalds 已提交
594
	usb_free_urb(port->interrupt_out_urb);
595 596 597 598
	for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i) {
		usb_free_urb(port->read_urbs[i]);
		kfree(port->bulk_in_buffers[i]);
	}
599 600 601 602
	for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i) {
		usb_free_urb(port->write_urbs[i]);
		kfree(port->bulk_out_buffers[i]);
	}
603
	kfifo_free(&port->write_fifo);
L
Linus Torvalds 已提交
604 605
	kfree(port->interrupt_in_buffer);
	kfree(port->interrupt_out_buffer);
606
	tty_port_destroy(&port->port);
L
Linus Torvalds 已提交
607 608 609
	kfree(port);
}

A
Alan Cox 已提交
610 611 612
static struct usb_serial *create_serial(struct usb_device *dev,
					struct usb_interface *interface,
					struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
613 614 615
{
	struct usb_serial *serial;

616
	serial = kzalloc(sizeof(*serial), GFP_KERNEL);
L
Linus Torvalds 已提交
617
	if (!serial) {
618
		dev_err(&dev->dev, "%s - out of memory\n", __func__);
L
Linus Torvalds 已提交
619 620 621
		return NULL;
	}
	serial->dev = usb_get_dev(dev);
622
	serial->type = driver;
L
Linus Torvalds 已提交
623 624
	serial->interface = interface;
	kref_init(&serial->kref);
625
	mutex_init(&serial->disc_mutex);
626
	serial->minor = SERIAL_TTY_NO_MINOR;
L
Linus Torvalds 已提交
627 628 629 630

	return serial;
}

631
static const struct usb_device_id *match_dynamic_id(struct usb_interface *intf,
A
Alan Cox 已提交
632
					    struct usb_serial_driver *drv)
633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653
{
	struct usb_dynid *dynid;

	spin_lock(&drv->dynids.lock);
	list_for_each_entry(dynid, &drv->dynids.list, node) {
		if (usb_match_one_id(intf, &dynid->id)) {
			spin_unlock(&drv->dynids.lock);
			return &dynid->id;
		}
	}
	spin_unlock(&drv->dynids.lock);
	return NULL;
}

static const struct usb_device_id *get_iface_id(struct usb_serial_driver *drv,
						struct usb_interface *intf)
{
	const struct usb_device_id *id;

	id = usb_match_id(intf, drv->id_table);
	if (id) {
654
		dev_dbg(&intf->dev, "static descriptor matches\n");
655 656 657 658
		goto exit;
	}
	id = match_dynamic_id(intf, drv);
	if (id)
659
		dev_dbg(&intf->dev, "dynamic descriptor matches\n");
660 661 662 663
exit:
	return id;
}

664
/* Caller must hold table_lock */
A
Alan Cox 已提交
665 666
static struct usb_serial_driver *search_serial_device(
					struct usb_interface *iface)
L
Linus Torvalds 已提交
667
{
668
	const struct usb_device_id *id = NULL;
669
	struct usb_serial_driver *drv;
670
	struct usb_driver *driver = to_usb_driver(iface->dev.driver);
L
Linus Torvalds 已提交
671

A
Adrian Bunk 已提交
672
	/* Check if the usb id matches a known device */
673
	list_for_each_entry(drv, &usb_serial_driver_list, driver_list) {
674 675
		if (drv->usb_driver == driver)
			id = get_iface_id(drv, iface);
676
		if (id)
677
			return drv;
L
Linus Torvalds 已提交
678 679 680 681 682
	}

	return NULL;
}

683 684 685 686
static int serial_carrier_raised(struct tty_port *port)
{
	struct usb_serial_port *p = container_of(port, struct usb_serial_port, port);
	struct usb_serial_driver *drv = p->serial->type;
J
Johan Hovold 已提交
687

688 689 690
	if (drv->carrier_raised)
		return drv->carrier_raised(p);
	/* No carrier control - don't block */
J
Johan Hovold 已提交
691
	return 1;
692 693 694 695 696 697
}

static void serial_dtr_rts(struct tty_port *port, int on)
{
	struct usb_serial_port *p = container_of(port, struct usb_serial_port, port);
	struct usb_serial_driver *drv = p->serial->type;
J
Johan Hovold 已提交
698

699 700 701 702 703 704 705
	if (drv->dtr_rts)
		drv->dtr_rts(p, on);
}

static const struct tty_port_operations serial_port_ops = {
	.carrier_raised = serial_carrier_raised,
	.dtr_rts = serial_dtr_rts,
A
Alan Cox 已提交
706
	.activate = serial_activate,
707
	.shutdown = serial_down,
708 709
};

710
static int usb_serial_probe(struct usb_interface *interface,
L
Linus Torvalds 已提交
711 712
			       const struct usb_device_id *id)
{
713
	struct device *ddev = &interface->dev;
A
Alan Cox 已提交
714
	struct usb_device *dev = interface_to_usbdev(interface);
L
Linus Torvalds 已提交
715 716 717 718 719 720 721 722
	struct usb_serial *serial = NULL;
	struct usb_serial_port *port;
	struct usb_host_interface *iface_desc;
	struct usb_endpoint_descriptor *endpoint;
	struct usb_endpoint_descriptor *interrupt_in_endpoint[MAX_NUM_PORTS];
	struct usb_endpoint_descriptor *interrupt_out_endpoint[MAX_NUM_PORTS];
	struct usb_endpoint_descriptor *bulk_in_endpoint[MAX_NUM_PORTS];
	struct usb_endpoint_descriptor *bulk_out_endpoint[MAX_NUM_PORTS];
723
	struct usb_serial_driver *type = NULL;
L
Linus Torvalds 已提交
724
	int retval;
725
	unsigned int minor;
L
Linus Torvalds 已提交
726 727
	int buffer_size;
	int i;
728
	int j;
L
Linus Torvalds 已提交
729 730 731 732 733 734 735
	int num_interrupt_in = 0;
	int num_interrupt_out = 0;
	int num_bulk_in = 0;
	int num_bulk_out = 0;
	int num_ports = 0;
	int max_endpoints;

736
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
737 738
	type = search_serial_device(interface);
	if (!type) {
739
		mutex_unlock(&table_lock);
740
		dev_dbg(ddev, "none matched\n");
L
Linus Torvalds 已提交
741 742 743
		return -ENODEV;
	}

744 745
	if (!try_module_get(type->driver.owner)) {
		mutex_unlock(&table_lock);
746
		dev_err(ddev, "module get failed, exiting\n");
747 748 749 750
		return -EIO;
	}
	mutex_unlock(&table_lock);

A
Alan Cox 已提交
751
	serial = create_serial(dev, interface, type);
L
Linus Torvalds 已提交
752
	if (!serial) {
753
		module_put(type->driver.owner);
754
		dev_err(ddev, "%s - out of memory\n", __func__);
L
Linus Torvalds 已提交
755 756 757 758 759 760 761
		return -ENOMEM;
	}

	/* if this device type has a probe function, call it */
	if (type->probe) {
		const struct usb_device_id *id;

762
		id = get_iface_id(type, interface);
L
Linus Torvalds 已提交
763 764 765
		retval = type->probe(serial, id);

		if (retval) {
766
			dev_dbg(ddev, "sub driver rejected device\n");
767
			usb_serial_put(serial);
768
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
769 770 771 772 773 774 775 776 777
			return retval;
		}
	}

	/* descriptor matches, let's find the endpoints needed */
	/* check out the endpoints */
	iface_desc = interface->cur_altsetting;
	for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
		endpoint = &iface_desc->endpoint[i].desc;
778 779

		if (usb_endpoint_is_bulk_in(endpoint)) {
L
Linus Torvalds 已提交
780
			/* we found a bulk in endpoint */
781
			dev_dbg(ddev, "found bulk in on endpoint %d\n", i);
L
Linus Torvalds 已提交
782 783 784 785
			bulk_in_endpoint[num_bulk_in] = endpoint;
			++num_bulk_in;
		}

786
		if (usb_endpoint_is_bulk_out(endpoint)) {
L
Linus Torvalds 已提交
787
			/* we found a bulk out endpoint */
788
			dev_dbg(ddev, "found bulk out on endpoint %d\n", i);
L
Linus Torvalds 已提交
789 790 791
			bulk_out_endpoint[num_bulk_out] = endpoint;
			++num_bulk_out;
		}
792 793

		if (usb_endpoint_is_int_in(endpoint)) {
L
Linus Torvalds 已提交
794
			/* we found a interrupt in endpoint */
795
			dev_dbg(ddev, "found interrupt in on endpoint %d\n", i);
L
Linus Torvalds 已提交
796 797 798 799
			interrupt_in_endpoint[num_interrupt_in] = endpoint;
			++num_interrupt_in;
		}

800
		if (usb_endpoint_is_int_out(endpoint)) {
L
Linus Torvalds 已提交
801
			/* we found an interrupt out endpoint */
802
			dev_dbg(ddev, "found interrupt out on endpoint %d\n", i);
L
Linus Torvalds 已提交
803 804 805 806 807 808
			interrupt_out_endpoint[num_interrupt_out] = endpoint;
			++num_interrupt_out;
		}
	}

#if defined(CONFIG_USB_SERIAL_PL2303) || defined(CONFIG_USB_SERIAL_PL2303_MODULE)
A
Alan Cox 已提交
809
	/* BEGIN HORRIBLE HACK FOR PL2303 */
L
Linus Torvalds 已提交
810 811 812 813
	/* this is needed due to the looney way its endpoints are set up */
	if (((le16_to_cpu(dev->descriptor.idVendor) == PL2303_VENDOR_ID) &&
	     (le16_to_cpu(dev->descriptor.idProduct) == PL2303_PRODUCT_ID)) ||
	    ((le16_to_cpu(dev->descriptor.idVendor) == ATEN_VENDOR_ID) &&
814 815
	     (le16_to_cpu(dev->descriptor.idProduct) == ATEN_PRODUCT_ID)) ||
	    ((le16_to_cpu(dev->descriptor.idVendor) == ALCOR_VENDOR_ID) &&
816 817 818
	     (le16_to_cpu(dev->descriptor.idProduct) == ALCOR_PRODUCT_ID)) ||
	    ((le16_to_cpu(dev->descriptor.idVendor) == SIEMENS_VENDOR_ID) &&
	     (le16_to_cpu(dev->descriptor.idProduct) == SIEMENS_PRODUCT_ID_EF81))) {
L
Linus Torvalds 已提交
819 820 821 822 823
		if (interface != dev->actconfig->interface[0]) {
			/* check out the endpoints of the other interface*/
			iface_desc = dev->actconfig->interface[0]->cur_altsetting;
			for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
				endpoint = &iface_desc->endpoint[i].desc;
824
				if (usb_endpoint_is_int_in(endpoint)) {
L
Linus Torvalds 已提交
825
					/* we found a interrupt in endpoint */
826
					dev_dbg(ddev, "found interrupt in for Prolific device on separate interface\n");
L
Linus Torvalds 已提交
827 828 829 830 831 832 833 834 835 836 837
					interrupt_in_endpoint[num_interrupt_in] = endpoint;
					++num_interrupt_in;
				}
			}
		}

		/* Now make sure the PL-2303 is configured correctly.
		 * If not, give up now and hope this hack will work
		 * properly during a later invocation of usb_serial_probe
		 */
		if (num_bulk_in == 0 || num_bulk_out == 0) {
838
			dev_info(ddev, "PL-2303 hack: descriptors matched but endpoints did not\n");
839
			usb_serial_put(serial);
840
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
841 842 843 844 845 846 847 848 849 850
			return -ENODEV;
		}
	}
	/* END HORRIBLE HACK FOR PL2303 */
#endif

#ifdef CONFIG_USB_SERIAL_GENERIC
	if (type == &usb_serial_generic_device) {
		num_ports = num_bulk_out;
		if (num_ports == 0) {
851
			dev_err(ddev, "Generic device with no bulk out, not allowed.\n");
852
			usb_serial_put(serial);
853
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
854 855
			return -EIO;
		}
856 857
		dev_info(ddev, "The \"generic\" usb-serial driver is only for testing and one-off prototypes.\n");
		dev_info(ddev, "Tell linux-usb@vger.kernel.org to add your device to a proper driver.\n");
L
Linus Torvalds 已提交
858 859 860 861
	}
#endif
	if (!num_ports) {
		/* if this device type has a calc_num_ports function, call it */
862
		if (type->calc_num_ports)
A
Alan Cox 已提交
863
			num_ports = type->calc_num_ports(serial);
L
Linus Torvalds 已提交
864 865 866 867 868 869 870 871 872 873
		if (!num_ports)
			num_ports = type->num_ports;
	}

	serial->num_ports = num_ports;
	serial->num_bulk_in = num_bulk_in;
	serial->num_bulk_out = num_bulk_out;
	serial->num_interrupt_in = num_interrupt_in;
	serial->num_interrupt_out = num_interrupt_out;

874
	/* found all that we need */
875
	dev_info(ddev, "%s converter detected\n", type->description);
876

L
Linus Torvalds 已提交
877
	/* create our ports, we need as many as the max endpoints */
A
Alan Cox 已提交
878 879
	/* we don't use num_ports here because some devices have more
	   endpoint pairs than ports */
L
Linus Torvalds 已提交
880 881 882 883 884
	max_endpoints = max(num_bulk_in, num_bulk_out);
	max_endpoints = max(max_endpoints, num_interrupt_in);
	max_endpoints = max(max_endpoints, num_interrupt_out);
	max_endpoints = max(max_endpoints, (int)serial->num_ports);
	serial->num_port_pointers = max_endpoints;
885

886
	dev_dbg(ddev, "setting up %d port structures for this device", max_endpoints);
L
Linus Torvalds 已提交
887
	for (i = 0; i < max_endpoints; ++i) {
888
		port = kzalloc(sizeof(struct usb_serial_port), GFP_KERNEL);
L
Linus Torvalds 已提交
889 890
		if (!port)
			goto probe_error;
A
Alan Cox 已提交
891
		tty_port_init(&port->port);
892
		port->port.ops = &serial_port_ops;
L
Linus Torvalds 已提交
893
		port->serial = serial;
894
		spin_lock_init(&port->lock);
895 896
		/* Keep this for private driver use for the moment but
		   should probably go away */
D
David Howells 已提交
897
		INIT_WORK(&port->work, usb_serial_port_work);
L
Linus Torvalds 已提交
898
		serial->port[i] = port;
899 900 901 902 903
		port->dev.parent = &interface->dev;
		port->dev.driver = NULL;
		port->dev.bus = &usb_serial_bus_type;
		port->dev.release = &port_release;
		device_initialize(&port->dev);
L
Linus Torvalds 已提交
904 905 906 907 908 909
	}

	/* set up the endpoint information */
	for (i = 0; i < num_bulk_in; ++i) {
		endpoint = bulk_in_endpoint[i];
		port = serial->port[i];
910
		buffer_size = max_t(int, serial->type->bulk_in_size,
911
				usb_endpoint_maxp(endpoint));
L
Linus Torvalds 已提交
912 913
		port->bulk_in_size = buffer_size;
		port->bulk_in_endpointAddress = endpoint->bEndpointAddress;
914 915 916 917 918

		for (j = 0; j < ARRAY_SIZE(port->read_urbs); ++j) {
			set_bit(j, &port->read_urbs_free);
			port->read_urbs[j] = usb_alloc_urb(0, GFP_KERNEL);
			if (!port->read_urbs[j]) {
919
				dev_err(ddev, "No free urbs available\n");
920 921 922 923 924
				goto probe_error;
			}
			port->bulk_in_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
			if (!port->bulk_in_buffers[j]) {
925
				dev_err(ddev, "Couldn't allocate bulk_in_buffer\n");
926 927 928 929
				goto probe_error;
			}
			usb_fill_bulk_urb(port->read_urbs[j], dev,
					usb_rcvbulkpipe(dev,
A
Alan Cox 已提交
930
						endpoint->bEndpointAddress),
931 932 933 934 935 936 937
					port->bulk_in_buffers[j], buffer_size,
					serial->type->read_bulk_callback,
					port);
		}

		port->read_urb = port->read_urbs[0];
		port->bulk_in_buffer = port->bulk_in_buffers[0];
L
Linus Torvalds 已提交
938 939 940 941 942
	}

	for (i = 0; i < num_bulk_out; ++i) {
		endpoint = bulk_out_endpoint[i];
		port = serial->port[i];
943
		if (kfifo_alloc(&port->write_fifo, PAGE_SIZE, GFP_KERNEL))
944
			goto probe_error;
945 946
		buffer_size = serial->type->bulk_out_size;
		if (!buffer_size)
947
			buffer_size = usb_endpoint_maxp(endpoint);
L
Linus Torvalds 已提交
948 949
		port->bulk_out_size = buffer_size;
		port->bulk_out_endpointAddress = endpoint->bEndpointAddress;
950

951 952 953 954
		for (j = 0; j < ARRAY_SIZE(port->write_urbs); ++j) {
			set_bit(j, &port->write_urbs_free);
			port->write_urbs[j] = usb_alloc_urb(0, GFP_KERNEL);
			if (!port->write_urbs[j]) {
955
				dev_err(ddev, "No free urbs available\n");
956 957 958 959 960
				goto probe_error;
			}
			port->bulk_out_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
			if (!port->bulk_out_buffers[j]) {
961
				dev_err(ddev, "Couldn't allocate bulk_out_buffer\n");
962 963 964 965 966 967 968 969 970
				goto probe_error;
			}
			usb_fill_bulk_urb(port->write_urbs[j], dev,
					usb_sndbulkpipe(dev,
						endpoint->bEndpointAddress),
					port->bulk_out_buffers[j], buffer_size,
					serial->type->write_bulk_callback,
					port);
		}
971 972 973

		port->write_urb = port->write_urbs[0];
		port->bulk_out_buffer = port->bulk_out_buffers[0];
L
Linus Torvalds 已提交
974 975 976 977 978 979 980 981
	}

	if (serial->type->read_int_callback) {
		for (i = 0; i < num_interrupt_in; ++i) {
			endpoint = interrupt_in_endpoint[i];
			port = serial->port[i];
			port->interrupt_in_urb = usb_alloc_urb(0, GFP_KERNEL);
			if (!port->interrupt_in_urb) {
982
				dev_err(ddev, "No free urbs available\n");
L
Linus Torvalds 已提交
983 984
				goto probe_error;
			}
985
			buffer_size = usb_endpoint_maxp(endpoint);
A
Alan Cox 已提交
986 987 988 989
			port->interrupt_in_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_in_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
L
Linus Torvalds 已提交
990
			if (!port->interrupt_in_buffer) {
991
				dev_err(ddev, "Couldn't allocate interrupt_in_buffer\n");
L
Linus Torvalds 已提交
992 993
				goto probe_error;
			}
A
Alan Cox 已提交
994 995 996 997 998 999
			usb_fill_int_urb(port->interrupt_in_urb, dev,
				usb_rcvintpipe(dev,
						endpoint->bEndpointAddress),
				port->interrupt_in_buffer, buffer_size,
				serial->type->read_int_callback, port,
				endpoint->bInterval);
L
Linus Torvalds 已提交
1000 1001
		}
	} else if (num_interrupt_in) {
1002
		dev_dbg(ddev, "The device claims to support interrupt in transfers, but read_int_callback is not defined\n");
L
Linus Torvalds 已提交
1003
	}
A
Alan Cox 已提交
1004

L
Linus Torvalds 已提交
1005 1006 1007 1008 1009 1010
	if (serial->type->write_int_callback) {
		for (i = 0; i < num_interrupt_out; ++i) {
			endpoint = interrupt_out_endpoint[i];
			port = serial->port[i];
			port->interrupt_out_urb = usb_alloc_urb(0, GFP_KERNEL);
			if (!port->interrupt_out_urb) {
1011
				dev_err(ddev, "No free urbs available\n");
L
Linus Torvalds 已提交
1012 1013
				goto probe_error;
			}
1014
			buffer_size = usb_endpoint_maxp(endpoint);
L
Linus Torvalds 已提交
1015
			port->interrupt_out_size = buffer_size;
A
Alan Cox 已提交
1016 1017 1018 1019
			port->interrupt_out_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_out_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
L
Linus Torvalds 已提交
1020
			if (!port->interrupt_out_buffer) {
1021
				dev_err(ddev, "Couldn't allocate interrupt_out_buffer\n");
L
Linus Torvalds 已提交
1022 1023
				goto probe_error;
			}
A
Alan Cox 已提交
1024 1025 1026 1027 1028 1029
			usb_fill_int_urb(port->interrupt_out_urb, dev,
				usb_sndintpipe(dev,
						  endpoint->bEndpointAddress),
				port->interrupt_out_buffer, buffer_size,
				serial->type->write_int_callback, port,
				endpoint->bInterval);
L
Linus Torvalds 已提交
1030 1031
		}
	} else if (num_interrupt_out) {
1032
		dev_dbg(ddev, "The device claims to support interrupt out transfers, but write_int_callback is not defined\n");
L
Linus Torvalds 已提交
1033
	}
A
Alan Cox 已提交
1034

1035 1036
	usb_set_intfdata(interface, serial);

L
Linus Torvalds 已提交
1037 1038
	/* if this device type has an attach function, call it */
	if (type->attach) {
A
Alan Cox 已提交
1039
		retval = type->attach(serial);
L
Linus Torvalds 已提交
1040 1041
		if (retval < 0)
			goto probe_error;
1042
		serial->attached = 1;
L
Linus Torvalds 已提交
1043
		if (retval > 0) {
A
Alan Cox 已提交
1044 1045
			/* quietly accept this device, but don't bind to a
			   serial port as it's about to disappear */
1046
			serial->num_ports = 0;
L
Linus Torvalds 已提交
1047 1048
			goto exit;
		}
1049 1050
	} else {
		serial->attached = 1;
L
Linus Torvalds 已提交
1051 1052
	}

1053 1054 1055 1056 1057 1058
	/* Avoid race with tty_open and serial_install by setting the
	 * disconnected flag and not clearing it until all ports have been
	 * registered.
	 */
	serial->disconnected = 1;

A
Alan Cox 已提交
1059
	if (get_free_serial(serial, num_ports, &minor) == NULL) {
1060
		dev_err(ddev, "No more free serial devices\n");
1061 1062
		goto probe_error;
	}
1063
	serial->minor = minor;
1064

L
Linus Torvalds 已提交
1065 1066 1067
	/* register all of the individual ports with the driver core */
	for (i = 0; i < num_ports; ++i) {
		port = serial->port[i];
1068
		dev_set_name(&port->dev, "ttyUSB%d", port->number);
1069
		dev_dbg(ddev, "registering %s", dev_name(&port->dev));
1070 1071
		device_enable_async_suspend(&port->dev);

1072
		retval = device_add(&port->dev);
1073
		if (retval)
1074
			dev_err(ddev, "Error registering port device, continuing\n");
L
Linus Torvalds 已提交
1075 1076
	}

1077 1078
	serial->disconnected = 0;

1079
	usb_serial_console_init(minor);
L
Linus Torvalds 已提交
1080
exit:
1081
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1082 1083 1084
	return 0;

probe_error:
1085
	usb_serial_put(serial);
1086
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1087 1088 1089
	return -EIO;
}

1090
static void usb_serial_disconnect(struct usb_interface *interface)
L
Linus Torvalds 已提交
1091 1092
{
	int i;
A
Alan Cox 已提交
1093
	struct usb_serial *serial = usb_get_intfdata(interface);
L
Linus Torvalds 已提交
1094 1095 1096
	struct device *dev = &interface->dev;
	struct usb_serial_port *port;

1097
	usb_serial_console_disconnect(serial);
L
Linus Torvalds 已提交
1098

1099 1100 1101
	mutex_lock(&serial->disc_mutex);
	/* must set a flag, to signal subdrivers */
	serial->disconnected = 1;
1102 1103
	mutex_unlock(&serial->disc_mutex);

1104 1105 1106
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		if (port) {
A
Alan Cox 已提交
1107 1108
			struct tty_struct *tty = tty_port_tty_get(&port->port);
			if (tty) {
A
Alan Cox 已提交
1109
				tty_vhangup(tty);
A
Alan Cox 已提交
1110 1111
				tty_kref_put(tty);
			}
1112
			kill_traffic(port);
1113
			cancel_work_sync(&port->work);
1114
			if (device_is_registered(&port->dev))
1115
				device_del(&port->dev);
1116 1117
		}
	}
1118
	serial->type->disconnect(serial);
1119

1120
	/* let the last holder of this object cause it to be cleaned up */
1121
	usb_serial_put(serial);
L
Linus Torvalds 已提交
1122 1123 1124
	dev_info(dev, "device disconnected\n");
}

1125 1126 1127 1128 1129 1130
int usb_serial_suspend(struct usb_interface *intf, pm_message_t message)
{
	struct usb_serial *serial = usb_get_intfdata(intf);
	struct usb_serial_port *port;
	int i, r = 0;

1131 1132
	serial->suspending = 1;

1133 1134
	if (serial->type->suspend) {
		r = serial->type->suspend(serial, message);
1135 1136
		if (r < 0) {
			serial->suspending = 0;
1137
			goto err_out;
1138
		}
1139 1140
	}

1141 1142 1143 1144
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		if (port)
			kill_traffic(port);
1145 1146
	}

1147
err_out:
1148 1149 1150 1151 1152 1153 1154
	return r;
}
EXPORT_SYMBOL(usb_serial_suspend);

int usb_serial_resume(struct usb_interface *intf)
{
	struct usb_serial *serial = usb_get_intfdata(intf);
1155
	int rv;
1156

1157
	serial->suspending = 0;
S
Sarah Sharp 已提交
1158
	if (serial->type->resume)
1159 1160 1161
		rv = serial->type->resume(serial);
	else
		rv = usb_serial_generic_resume(serial);
1162

1163
	return rv;
1164 1165 1166
}
EXPORT_SYMBOL(usb_serial_resume);

1167 1168 1169 1170 1171 1172 1173 1174
static int usb_serial_reset_resume(struct usb_interface *intf)
{
	struct usb_serial *serial = usb_get_intfdata(intf);
	int rv;

	serial->suspending = 0;
	if (serial->type->reset_resume)
		rv = serial->type->reset_resume(serial);
1175 1176 1177 1178
	else {
		rv = -EOPNOTSUPP;
		intf->needs_binding = 1;
	}
1179 1180 1181 1182

	return rv;
}

J
Jeff Dike 已提交
1183
static const struct tty_operations serial_ops = {
L
Linus Torvalds 已提交
1184 1185 1186
	.open =			serial_open,
	.close =		serial_close,
	.write =		serial_write,
J
Johan Hovold 已提交
1187
	.hangup =		serial_hangup,
L
Linus Torvalds 已提交
1188 1189 1190 1191 1192 1193 1194 1195 1196
	.write_room =		serial_write_room,
	.ioctl =		serial_ioctl,
	.set_termios =		serial_set_termios,
	.throttle =		serial_throttle,
	.unthrottle =		serial_unthrottle,
	.break_ctl =		serial_break,
	.chars_in_buffer =	serial_chars_in_buffer,
	.tiocmget =		serial_tiocmget,
	.tiocmset =		serial_tiocmset,
J
Johan Hovold 已提交
1197 1198 1199
	.get_icount =		serial_get_icount,
	.cleanup =		serial_cleanup,
	.install =		serial_install,
1200
	.proc_fops =		&serial_proc_fops,
L
Linus Torvalds 已提交
1201 1202
};

1203

L
Linus Torvalds 已提交
1204 1205
struct tty_driver *usb_serial_tty_driver;

1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216
/* Driver structure we register with the USB core */
static struct usb_driver usb_serial_driver = {
	.name =		"usbserial",
	.probe =	usb_serial_probe,
	.disconnect =	usb_serial_disconnect,
	.suspend =	usb_serial_suspend,
	.resume =	usb_serial_resume,
	.no_dynamic_id =	1,
	.supports_autosuspend =	1,
};

L
Linus Torvalds 已提交
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
static int __init usb_serial_init(void)
{
	int i;
	int result;

	usb_serial_tty_driver = alloc_tty_driver(SERIAL_TTY_MINORS);
	if (!usb_serial_tty_driver)
		return -ENOMEM;

	/* Initialize our global data */
A
Alan Cox 已提交
1227
	for (i = 0; i < SERIAL_TTY_MINORS; ++i)
L
Linus Torvalds 已提交
1228 1229 1230 1231
		serial_table[i] = NULL;

	result = bus_register(&usb_serial_bus_type);
	if (result) {
1232
		pr_err("%s - registering bus driver failed\n", __func__);
L
Linus Torvalds 已提交
1233 1234 1235 1236
		goto exit_bus;
	}

	usb_serial_tty_driver->driver_name = "usbserial";
J
Johan Hovold 已提交
1237
	usb_serial_tty_driver->name = "ttyUSB";
L
Linus Torvalds 已提交
1238 1239 1240 1241
	usb_serial_tty_driver->major = SERIAL_TTY_MAJOR;
	usb_serial_tty_driver->minor_start = 0;
	usb_serial_tty_driver->type = TTY_DRIVER_TYPE_SERIAL;
	usb_serial_tty_driver->subtype = SERIAL_TYPE_NORMAL;
A
Alan Cox 已提交
1242 1243
	usb_serial_tty_driver->flags = TTY_DRIVER_REAL_RAW |
						TTY_DRIVER_DYNAMIC_DEV;
L
Linus Torvalds 已提交
1244
	usb_serial_tty_driver->init_termios = tty_std_termios;
A
Alan Cox 已提交
1245 1246
	usb_serial_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD
							| HUPCL | CLOCAL;
1247 1248
	usb_serial_tty_driver->init_termios.c_ispeed = 9600;
	usb_serial_tty_driver->init_termios.c_ospeed = 9600;
L
Linus Torvalds 已提交
1249 1250 1251
	tty_set_operations(usb_serial_tty_driver, &serial_ops);
	result = tty_register_driver(usb_serial_tty_driver);
	if (result) {
1252
		pr_err("%s - tty_register_driver failed\n", __func__);
L
Linus Torvalds 已提交
1253 1254 1255 1256 1257 1258
		goto exit_reg_driver;
	}

	/* register the USB driver */
	result = usb_register(&usb_serial_driver);
	if (result < 0) {
1259
		pr_err("%s - usb_register failed\n", __func__);
L
Linus Torvalds 已提交
1260 1261 1262
		goto exit_tty;
	}

1263
	/* register the generic driver, if we should */
1264
	result = usb_serial_generic_register();
1265
	if (result < 0) {
1266
		pr_err("%s - registering generic driver failed\n", __func__);
1267 1268 1269
		goto exit_generic;
	}

L
Linus Torvalds 已提交
1270 1271
	return result;

1272 1273 1274
exit_generic:
	usb_deregister(&usb_serial_driver);

L
Linus Torvalds 已提交
1275 1276 1277 1278 1279 1280 1281
exit_tty:
	tty_unregister_driver(usb_serial_tty_driver);

exit_reg_driver:
	bus_unregister(&usb_serial_bus_type);

exit_bus:
1282
	pr_err("%s - returning with error %d\n", __func__, result);
L
Linus Torvalds 已提交
1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307
	put_tty_driver(usb_serial_tty_driver);
	return result;
}


static void __exit usb_serial_exit(void)
{
	usb_serial_console_exit();

	usb_serial_generic_deregister();

	usb_deregister(&usb_serial_driver);
	tty_unregister_driver(usb_serial_tty_driver);
	put_tty_driver(usb_serial_tty_driver);
	bus_unregister(&usb_serial_bus_type);
}


module_init(usb_serial_init);
module_exit(usb_serial_exit);

#define set_to_generic_if_null(type, function)				\
	do {								\
		if (!type->function) {					\
			type->function = usb_serial_generic_##function;	\
1308
			pr_debug("Had to override the " #function	\
A
Alan Cox 已提交
1309
				" usb serial operation with the generic one.");\
L
Linus Torvalds 已提交
1310 1311 1312
			}						\
	} while (0)

1313
static void fixup_generic(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1314 1315 1316 1317 1318 1319 1320 1321
{
	set_to_generic_if_null(device, open);
	set_to_generic_if_null(device, write);
	set_to_generic_if_null(device, close);
	set_to_generic_if_null(device, write_room);
	set_to_generic_if_null(device, chars_in_buffer);
	set_to_generic_if_null(device, read_bulk_callback);
	set_to_generic_if_null(device, write_bulk_callback);
1322 1323
	set_to_generic_if_null(device, disconnect);
	set_to_generic_if_null(device, release);
1324
	set_to_generic_if_null(device, process_read_urb);
1325
	set_to_generic_if_null(device, prepare_write_buffer);
L
Linus Torvalds 已提交
1326 1327
}

1328
static int usb_serial_register(struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
1329 1330 1331
{
	int retval;

1332 1333 1334
	if (usb_disabled())
		return -ENODEV;

1335
	fixup_generic(driver);
L
Linus Torvalds 已提交
1336

1337 1338
	if (!driver->description)
		driver->description = driver->driver.name;
1339 1340 1341 1342 1343
	if (!driver->usb_driver) {
		WARN(1, "Serial driver %s has no usb_driver\n",
				driver->description);
		return -EINVAL;
	}
1344

L
Linus Torvalds 已提交
1345
	/* Add this device to our list of devices */
1346
	mutex_lock(&table_lock);
1347
	list_add(&driver->driver_list, &usb_serial_driver_list);
L
Linus Torvalds 已提交
1348

1349
	retval = usb_serial_bus_register(driver);
L
Linus Torvalds 已提交
1350
	if (retval) {
1351
		pr_err("problem %d when registering driver %s\n", retval, driver->description);
1352
		list_del(&driver->driver_list);
A
Alan Cox 已提交
1353
	} else
1354
		pr_info("USB Serial support registered for %s\n", driver->description);
L
Linus Torvalds 已提交
1355

1356
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1357 1358 1359
	return retval;
}

1360
static void usb_serial_deregister(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1361
{
1362
	pr_info("USB Serial deregistering driver %s\n", device->description);
1363
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
1364 1365
	list_del(&device->driver_list);
	usb_serial_bus_deregister(device);
1366
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1367 1368
}

1369 1370 1371
/**
 * usb_serial_register_drivers - register drivers for a usb-serial module
 * @serial_drivers: NULL-terminated array of pointers to drivers to be registered
1372 1373
 * @name: name of the usb_driver for this set of @serial_drivers
 * @id_table: list of all devices this @serial_drivers set binds to
1374
 *
1375 1376
 * Registers all the drivers in the @serial_drivers array, and dynamically
 * creates a struct usb_driver with the name @name and id_table of @id_table.
1377
 */
1378 1379 1380
int usb_serial_register_drivers(struct usb_serial_driver *const serial_drivers[],
				const char *name,
				const struct usb_device_id *id_table)
1381 1382
{
	int rc;
1383
	struct usb_driver *udriver;
1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
	struct usb_serial_driver * const *sd;

	/*
	 * udriver must be registered before any of the serial drivers,
	 * because the store_new_id() routine for the serial drivers (in
	 * bus.c) probes udriver.
	 *
	 * Performance hack: We don't want udriver to be probed until
	 * the serial drivers are registered, because the probe would
	 * simply fail for lack of a matching serial driver.
1394
	 * So we leave udriver's id_table set to NULL until we are all set.
1395 1396 1397
	 *
	 * Suspend/resume support is implemented in the usb-serial core,
	 * so fill in the PM-related fields in udriver.
1398
	 */
1399 1400 1401
	udriver = kzalloc(sizeof(*udriver), GFP_KERNEL);
	if (!udriver)
		return -ENOMEM;
1402

1403
	udriver->name = name;
1404
	udriver->no_dynamic_id = 1;
1405 1406 1407
	udriver->supports_autosuspend = 1;
	udriver->suspend = usb_serial_suspend;
	udriver->resume = usb_serial_resume;
1408
	udriver->probe = usb_serial_probe;
1409
	udriver->disconnect = usb_serial_disconnect;
1410 1411 1412

	/* we only set the reset_resume field if the serial_driver has one */
	for (sd = serial_drivers; *sd; ++sd) {
1413
		if ((*sd)->reset_resume) {
1414 1415
			udriver->reset_resume = usb_serial_reset_resume;
			break;
1416
		}
1417 1418
	}

1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429
	rc = usb_register(udriver);
	if (rc)
		return rc;

	for (sd = serial_drivers; *sd; ++sd) {
		(*sd)->usb_driver = udriver;
		rc = usb_serial_register(*sd);
		if (rc)
			goto failed;
	}

1430 1431
	/* Now set udriver's id_table and look for matches */
	udriver->id_table = id_table;
1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446
	rc = driver_attach(&udriver->drvwrap.driver);
	return 0;

 failed:
	while (sd-- > serial_drivers)
		usb_serial_deregister(*sd);
	usb_deregister(udriver);
	return rc;
}
EXPORT_SYMBOL_GPL(usb_serial_register_drivers);

/**
 * usb_serial_deregister_drivers - deregister drivers for a usb-serial module
 * @serial_drivers: NULL-terminated array of pointers to drivers to be deregistered
 *
1447 1448 1449
 * Deregisters all the drivers in the @serial_drivers array and deregisters and
 * frees the struct usb_driver that was created by the call to
 * usb_serial_register_drivers().
1450
 */
1451
void usb_serial_deregister_drivers(struct usb_serial_driver *const serial_drivers[])
1452
{
1453 1454
	struct usb_driver *udriver = (*serial_drivers)->usb_driver;

1455 1456 1457
	for (; *serial_drivers; ++serial_drivers)
		usb_serial_deregister(*serial_drivers);
	usb_deregister(udriver);
1458
	kfree(udriver);
1459 1460
}
EXPORT_SYMBOL_GPL(usb_serial_deregister_drivers);
L
Linus Torvalds 已提交
1461 1462

/* Module information */
A
Alan Cox 已提交
1463 1464
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
1465
MODULE_LICENSE("GPL");