usb-serial.c 40.0 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

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

367 368 369 370
	/* if the device was unplugged then any remaining characters
	   fell out of the connector ;) */
	if (port->serial->disconnected)
		return 0;
L
Linus Torvalds 已提交
371
	/* pass on to the driver specific version of this function */
A
Alan Cox 已提交
372
	return port->serial->type->chars_in_buffer(tty);
L
Linus Torvalds 已提交
373 374
}

A
Alan Cox 已提交
375
static void serial_throttle(struct tty_struct *tty)
L
Linus Torvalds 已提交
376
{
377
	struct usb_serial_port *port = tty->driver_data;
378 379

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

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

A
Alan Cox 已提交
386
static void serial_unthrottle(struct tty_struct *tty)
L
Linus Torvalds 已提交
387
{
388
	struct usb_serial_port *port = tty->driver_data;
389 390

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

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

397
static int serial_ioctl(struct tty_struct *tty,
A
Alan Cox 已提交
398
					unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
399
{
400
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
401 402
	int retval = -ENODEV;

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

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

A
Alan Cox 已提交
415
static void serial_set_termios(struct tty_struct *tty, struct ktermios *old)
L
Linus Torvalds 已提交
416
{
417
	struct usb_serial_port *port = tty->driver_data;
418 419

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

A
Alan Cox 已提交
421 422
	/* pass on to the driver specific version of this function
	   if it is available */
L
Linus Torvalds 已提交
423
	if (port->serial->type->set_termios)
A
Alan Cox 已提交
424
		port->serial->type->set_termios(tty, port, old);
425
	else
426
		tty_termios_copy_hw(&tty->termios, old);
L
Linus Torvalds 已提交
427 428
}

A
Alan Cox 已提交
429
static int serial_break(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
430
{
431
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
432

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

A
Alan Cox 已提交
435 436
	/* pass on to the driver specific version of this function
	   if it is available */
437
	if (port->serial->type->break_ctl)
A
Alan Cox 已提交
438
		port->serial->type->break_ctl(tty, break_state);
A
Alan Cox 已提交
439
	return 0;
L
Linus Torvalds 已提交
440 441
}

442
static int serial_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
443 444 445 446 447
{
	struct usb_serial *serial;
	int i;
	char tmp[40];

448 449
	seq_puts(m, "usbserinfo:1.0 driver:2.0\n");
	for (i = 0; i < SERIAL_TTY_MINORS; ++i) {
L
Linus Torvalds 已提交
450 451 452 453
		serial = usb_serial_get_by_index(i);
		if (serial == NULL)
			continue;

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

468
		seq_putc(m, '\n');
469
		usb_serial_put(serial);
470
		mutex_unlock(&serial->disc_mutex);
L
Linus Torvalds 已提交
471
	}
472
	return 0;
L
Linus Torvalds 已提交
473 474
}

475 476 477 478 479 480 481 482 483 484 485 486 487
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,
};

488
static int serial_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
489
{
490
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
491

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

	if (port->serial->type->tiocmget)
495
		return port->serial->type->tiocmget(tty);
L
Linus Torvalds 已提交
496 497 498
	return -EINVAL;
}

499
static int serial_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
500 501
			    unsigned int set, unsigned int clear)
{
502
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
503

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

	if (port->serial->type->tiocmset)
507
		return port->serial->type->tiocmset(tty, set, clear);
L
Linus Torvalds 已提交
508 509 510
	return -EINVAL;
}

A
Alan Cox 已提交
511 512 513 514 515
static int serial_get_icount(struct tty_struct *tty,
				struct serial_icounter_struct *icount)
{
	struct usb_serial_port *port = tty->driver_data;

516
	dev_dbg(tty->dev, "%s - port %d\n", __func__, port->number);
A
Alan Cox 已提交
517 518 519 520 521 522

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

523 524 525 526 527 528 529 530 531
/*
 * 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 已提交
532
EXPORT_SYMBOL_GPL(usb_serial_port_softint);
533

D
David Howells 已提交
534
static void usb_serial_port_work(struct work_struct *work)
L
Linus Torvalds 已提交
535
{
D
David Howells 已提交
536 537
	struct usb_serial_port *port =
		container_of(work, struct usb_serial_port, work);
L
Linus Torvalds 已提交
538 539
	struct tty_struct *tty;

A
Alan Cox 已提交
540
	tty = tty_port_tty_get(&port->port);
L
Linus Torvalds 已提交
541 542 543
	if (!tty)
		return;

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

L
Linus Torvalds 已提交
546
	tty_wakeup(tty);
A
Alan Cox 已提交
547
	tty_kref_put(tty);
L
Linus Torvalds 已提交
548 549
}

550
static void kill_traffic(struct usb_serial_port *port)
551
{
552 553
	int i;

554 555
	for (i = 0; i < ARRAY_SIZE(port->read_urbs); ++i)
		usb_kill_urb(port->read_urbs[i]);
556 557
	for (i = 0; i < ARRAY_SIZE(port->write_urbs); ++i)
		usb_kill_urb(port->write_urbs[i]);
558 559 560 561 562 563 564 565 566 567 568
	/*
	 * 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 已提交
569 570
	usb_kill_urb(port->interrupt_in_urb);
	usb_kill_urb(port->interrupt_out_urb);
571 572
}

573
static void port_release(struct device *dev)
574
{
575
	struct usb_serial_port *port = to_usb_serial_port(dev);
576
	int i;
577

578
	dev_dbg(dev, "%s\n", __func__);
579

580 581 582 583
	/*
	 * Stop all the traffic before cancelling the work, so that
	 * nobody will restart it by calling usb_serial_port_softint.
	 */
584
	kill_traffic(port);
585 586
	cancel_work_sync(&port->work);

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

A
Alan Cox 已提交
604 605 606
static struct usb_serial *create_serial(struct usb_device *dev,
					struct usb_interface *interface,
					struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
607 608 609
{
	struct usb_serial *serial;

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

	return serial;
}

625
static const struct usb_device_id *match_dynamic_id(struct usb_interface *intf,
A
Alan Cox 已提交
626
					    struct usb_serial_driver *drv)
627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647
{
	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) {
648
		dev_dbg(&intf->dev, "static descriptor matches\n");
649 650 651 652
		goto exit;
	}
	id = match_dynamic_id(intf, drv);
	if (id)
653
		dev_dbg(&intf->dev, "dynamic descriptor matches\n");
654 655 656 657
exit:
	return id;
}

658
/* Caller must hold table_lock */
A
Alan Cox 已提交
659 660
static struct usb_serial_driver *search_serial_device(
					struct usb_interface *iface)
L
Linus Torvalds 已提交
661
{
662
	const struct usb_device_id *id = NULL;
663
	struct usb_serial_driver *drv;
664
	struct usb_driver *driver = to_usb_driver(iface->dev.driver);
L
Linus Torvalds 已提交
665

A
Adrian Bunk 已提交
666
	/* Check if the usb id matches a known device */
667
	list_for_each_entry(drv, &usb_serial_driver_list, driver_list) {
668 669
		if (drv->usb_driver == driver)
			id = get_iface_id(drv, iface);
670
		if (id)
671
			return drv;
L
Linus Torvalds 已提交
672 673 674 675 676
	}

	return NULL;
}

677 678 679 680
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 已提交
681

682 683 684
	if (drv->carrier_raised)
		return drv->carrier_raised(p);
	/* No carrier control - don't block */
J
Johan Hovold 已提交
685
	return 1;
686 687 688 689 690 691
}

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 已提交
692

693 694 695 696 697 698 699
	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 已提交
700
	.activate = serial_activate,
701
	.shutdown = serial_down,
702 703
};

704
static int usb_serial_probe(struct usb_interface *interface,
L
Linus Torvalds 已提交
705 706
			       const struct usb_device_id *id)
{
707
	struct device *ddev = &interface->dev;
A
Alan Cox 已提交
708
	struct usb_device *dev = interface_to_usbdev(interface);
L
Linus Torvalds 已提交
709 710 711 712 713 714 715 716
	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];
717
	struct usb_serial_driver *type = NULL;
L
Linus Torvalds 已提交
718
	int retval;
719
	unsigned int minor;
L
Linus Torvalds 已提交
720 721
	int buffer_size;
	int i;
722
	int j;
L
Linus Torvalds 已提交
723 724 725 726 727 728 729
	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;

730
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
731 732
	type = search_serial_device(interface);
	if (!type) {
733
		mutex_unlock(&table_lock);
734
		dev_dbg(ddev, "none matched\n");
L
Linus Torvalds 已提交
735 736 737
		return -ENODEV;
	}

738 739
	if (!try_module_get(type->driver.owner)) {
		mutex_unlock(&table_lock);
740
		dev_err(ddev, "module get failed, exiting\n");
741 742 743 744
		return -EIO;
	}
	mutex_unlock(&table_lock);

A
Alan Cox 已提交
745
	serial = create_serial(dev, interface, type);
L
Linus Torvalds 已提交
746
	if (!serial) {
747
		module_put(type->driver.owner);
748
		dev_err(ddev, "%s - out of memory\n", __func__);
L
Linus Torvalds 已提交
749 750 751 752 753 754 755
		return -ENOMEM;
	}

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

756
		id = get_iface_id(type, interface);
L
Linus Torvalds 已提交
757 758 759
		retval = type->probe(serial, id);

		if (retval) {
760
			dev_dbg(ddev, "sub driver rejected device\n");
761
			usb_serial_put(serial);
762
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
763 764 765 766 767 768 769 770 771
			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;
772 773

		if (usb_endpoint_is_bulk_in(endpoint)) {
L
Linus Torvalds 已提交
774
			/* we found a bulk in endpoint */
775
			dev_dbg(ddev, "found bulk in on endpoint %d\n", i);
L
Linus Torvalds 已提交
776 777 778 779
			bulk_in_endpoint[num_bulk_in] = endpoint;
			++num_bulk_in;
		}

780
		if (usb_endpoint_is_bulk_out(endpoint)) {
L
Linus Torvalds 已提交
781
			/* we found a bulk out endpoint */
782
			dev_dbg(ddev, "found bulk out on endpoint %d\n", i);
L
Linus Torvalds 已提交
783 784 785
			bulk_out_endpoint[num_bulk_out] = endpoint;
			++num_bulk_out;
		}
786 787

		if (usb_endpoint_is_int_in(endpoint)) {
L
Linus Torvalds 已提交
788
			/* we found a interrupt in endpoint */
789
			dev_dbg(ddev, "found interrupt in on endpoint %d\n", i);
L
Linus Torvalds 已提交
790 791 792 793
			interrupt_in_endpoint[num_interrupt_in] = endpoint;
			++num_interrupt_in;
		}

794
		if (usb_endpoint_is_int_out(endpoint)) {
L
Linus Torvalds 已提交
795
			/* we found an interrupt out endpoint */
796
			dev_dbg(ddev, "found interrupt out on endpoint %d\n", i);
L
Linus Torvalds 已提交
797 798 799 800 801 802
			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 已提交
803
	/* BEGIN HORRIBLE HACK FOR PL2303 */
L
Linus Torvalds 已提交
804 805 806 807
	/* 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) &&
808 809
	     (le16_to_cpu(dev->descriptor.idProduct) == ATEN_PRODUCT_ID)) ||
	    ((le16_to_cpu(dev->descriptor.idVendor) == ALCOR_VENDOR_ID) &&
810 811 812
	     (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 已提交
813 814 815 816 817
		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;
818
				if (usb_endpoint_is_int_in(endpoint)) {
L
Linus Torvalds 已提交
819
					/* we found a interrupt in endpoint */
820
					dev_dbg(ddev, "found interrupt in for Prolific device on separate interface\n");
L
Linus Torvalds 已提交
821 822 823 824 825 826 827 828 829 830 831
					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) {
832
			dev_info(ddev, "PL-2303 hack: descriptors matched but endpoints did not\n");
833
			usb_serial_put(serial);
834
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
835 836 837 838 839 840 841 842 843 844
			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) {
845
			dev_err(ddev, "Generic device with no bulk out, not allowed.\n");
846
			usb_serial_put(serial);
847
			module_put(type->driver.owner);
L
Linus Torvalds 已提交
848 849
			return -EIO;
		}
850 851
		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 已提交
852 853 854 855
	}
#endif
	if (!num_ports) {
		/* if this device type has a calc_num_ports function, call it */
856
		if (type->calc_num_ports)
A
Alan Cox 已提交
857
			num_ports = type->calc_num_ports(serial);
L
Linus Torvalds 已提交
858 859 860 861 862 863 864 865 866 867
		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;

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

L
Linus Torvalds 已提交
871
	/* create our ports, we need as many as the max endpoints */
A
Alan Cox 已提交
872 873
	/* we don't use num_ports here because some devices have more
	   endpoint pairs than ports */
L
Linus Torvalds 已提交
874 875 876 877 878
	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;
879

880
	dev_dbg(ddev, "setting up %d port structures for this device", max_endpoints);
L
Linus Torvalds 已提交
881
	for (i = 0; i < max_endpoints; ++i) {
882
		port = kzalloc(sizeof(struct usb_serial_port), GFP_KERNEL);
L
Linus Torvalds 已提交
883 884
		if (!port)
			goto probe_error;
A
Alan Cox 已提交
885
		tty_port_init(&port->port);
886
		port->port.ops = &serial_port_ops;
L
Linus Torvalds 已提交
887
		port->serial = serial;
888
		spin_lock_init(&port->lock);
889 890
		/* Keep this for private driver use for the moment but
		   should probably go away */
D
David Howells 已提交
891
		INIT_WORK(&port->work, usb_serial_port_work);
L
Linus Torvalds 已提交
892
		serial->port[i] = port;
893 894 895 896 897
		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 已提交
898 899 900 901 902 903
	}

	/* set up the endpoint information */
	for (i = 0; i < num_bulk_in; ++i) {
		endpoint = bulk_in_endpoint[i];
		port = serial->port[i];
904
		buffer_size = max_t(int, serial->type->bulk_in_size,
905
				usb_endpoint_maxp(endpoint));
L
Linus Torvalds 已提交
906 907
		port->bulk_in_size = buffer_size;
		port->bulk_in_endpointAddress = endpoint->bEndpointAddress;
908 909 910 911 912

		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]) {
913
				dev_err(ddev, "No free urbs available\n");
914 915 916 917 918
				goto probe_error;
			}
			port->bulk_in_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
			if (!port->bulk_in_buffers[j]) {
919
				dev_err(ddev, "Couldn't allocate bulk_in_buffer\n");
920 921 922 923
				goto probe_error;
			}
			usb_fill_bulk_urb(port->read_urbs[j], dev,
					usb_rcvbulkpipe(dev,
A
Alan Cox 已提交
924
						endpoint->bEndpointAddress),
925 926 927 928 929 930 931
					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 已提交
932 933 934 935 936
	}

	for (i = 0; i < num_bulk_out; ++i) {
		endpoint = bulk_out_endpoint[i];
		port = serial->port[i];
937
		if (kfifo_alloc(&port->write_fifo, PAGE_SIZE, GFP_KERNEL))
938
			goto probe_error;
939 940
		buffer_size = serial->type->bulk_out_size;
		if (!buffer_size)
941
			buffer_size = usb_endpoint_maxp(endpoint);
L
Linus Torvalds 已提交
942 943
		port->bulk_out_size = buffer_size;
		port->bulk_out_endpointAddress = endpoint->bEndpointAddress;
944

945 946 947 948
		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]) {
949
				dev_err(ddev, "No free urbs available\n");
950 951 952 953 954
				goto probe_error;
			}
			port->bulk_out_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
			if (!port->bulk_out_buffers[j]) {
955
				dev_err(ddev, "Couldn't allocate bulk_out_buffer\n");
956 957 958 959 960 961 962 963 964
				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);
		}
965 966 967

		port->write_urb = port->write_urbs[0];
		port->bulk_out_buffer = port->bulk_out_buffers[0];
L
Linus Torvalds 已提交
968 969 970 971 972 973 974 975
	}

	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) {
976
				dev_err(ddev, "No free urbs available\n");
L
Linus Torvalds 已提交
977 978
				goto probe_error;
			}
979
			buffer_size = usb_endpoint_maxp(endpoint);
A
Alan Cox 已提交
980 981 982 983
			port->interrupt_in_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_in_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
L
Linus Torvalds 已提交
984
			if (!port->interrupt_in_buffer) {
985
				dev_err(ddev, "Couldn't allocate interrupt_in_buffer\n");
L
Linus Torvalds 已提交
986 987
				goto probe_error;
			}
A
Alan Cox 已提交
988 989 990 991 992 993
			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 已提交
994 995
		}
	} else if (num_interrupt_in) {
996
		dev_dbg(ddev, "The device claims to support interrupt in transfers, but read_int_callback is not defined\n");
L
Linus Torvalds 已提交
997
	}
A
Alan Cox 已提交
998

L
Linus Torvalds 已提交
999 1000 1001 1002 1003 1004
	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) {
1005
				dev_err(ddev, "No free urbs available\n");
L
Linus Torvalds 已提交
1006 1007
				goto probe_error;
			}
1008
			buffer_size = usb_endpoint_maxp(endpoint);
L
Linus Torvalds 已提交
1009
			port->interrupt_out_size = buffer_size;
A
Alan Cox 已提交
1010 1011 1012 1013
			port->interrupt_out_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_out_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
L
Linus Torvalds 已提交
1014
			if (!port->interrupt_out_buffer) {
1015
				dev_err(ddev, "Couldn't allocate interrupt_out_buffer\n");
L
Linus Torvalds 已提交
1016 1017
				goto probe_error;
			}
A
Alan Cox 已提交
1018 1019 1020 1021 1022 1023
			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 已提交
1024 1025
		}
	} else if (num_interrupt_out) {
1026
		dev_dbg(ddev, "The device claims to support interrupt out transfers, but write_int_callback is not defined\n");
L
Linus Torvalds 已提交
1027
	}
A
Alan Cox 已提交
1028

1029 1030
	usb_set_intfdata(interface, serial);

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

1047 1048 1049 1050 1051 1052
	/* 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 已提交
1053
	if (get_free_serial(serial, num_ports, &minor) == NULL) {
1054
		dev_err(ddev, "No more free serial devices\n");
1055 1056
		goto probe_error;
	}
1057
	serial->minor = minor;
1058

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

1066
		retval = device_add(&port->dev);
1067
		if (retval)
1068
			dev_err(ddev, "Error registering port device, continuing\n");
L
Linus Torvalds 已提交
1069 1070
	}

1071 1072
	serial->disconnected = 0;

1073
	usb_serial_console_init(minor);
L
Linus Torvalds 已提交
1074
exit:
1075
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1076 1077 1078
	return 0;

probe_error:
1079
	usb_serial_put(serial);
1080
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1081 1082 1083
	return -EIO;
}

1084
static void usb_serial_disconnect(struct usb_interface *interface)
L
Linus Torvalds 已提交
1085 1086
{
	int i;
A
Alan Cox 已提交
1087
	struct usb_serial *serial = usb_get_intfdata(interface);
L
Linus Torvalds 已提交
1088 1089 1090
	struct device *dev = &interface->dev;
	struct usb_serial_port *port;

1091
	usb_serial_console_disconnect(serial);
L
Linus Torvalds 已提交
1092

1093 1094 1095
	mutex_lock(&serial->disc_mutex);
	/* must set a flag, to signal subdrivers */
	serial->disconnected = 1;
1096 1097
	mutex_unlock(&serial->disc_mutex);

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

1114
	/* let the last holder of this object cause it to be cleaned up */
1115
	usb_serial_put(serial);
L
Linus Torvalds 已提交
1116 1117 1118
	dev_info(dev, "device disconnected\n");
}

1119 1120 1121 1122 1123 1124
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;

1125 1126
	serial->suspending = 1;

1127 1128
	if (serial->type->suspend) {
		r = serial->type->suspend(serial, message);
1129 1130
		if (r < 0) {
			serial->suspending = 0;
1131
			goto err_out;
1132
		}
1133 1134
	}

1135 1136 1137 1138
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		if (port)
			kill_traffic(port);
1139 1140
	}

1141
err_out:
1142 1143 1144 1145 1146 1147 1148
	return r;
}
EXPORT_SYMBOL(usb_serial_suspend);

int usb_serial_resume(struct usb_interface *intf)
{
	struct usb_serial *serial = usb_get_intfdata(intf);
1149
	int rv;
1150

1151
	serial->suspending = 0;
S
Sarah Sharp 已提交
1152
	if (serial->type->resume)
1153 1154 1155
		rv = serial->type->resume(serial);
	else
		rv = usb_serial_generic_resume(serial);
1156

1157
	return rv;
1158 1159 1160
}
EXPORT_SYMBOL(usb_serial_resume);

1161 1162 1163 1164 1165 1166 1167 1168
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);
1169 1170 1171 1172
	else {
		rv = -EOPNOTSUPP;
		intf->needs_binding = 1;
	}
1173 1174 1175 1176

	return rv;
}

J
Jeff Dike 已提交
1177
static const struct tty_operations serial_ops = {
L
Linus Torvalds 已提交
1178 1179 1180
	.open =			serial_open,
	.close =		serial_close,
	.write =		serial_write,
J
Johan Hovold 已提交
1181
	.hangup =		serial_hangup,
L
Linus Torvalds 已提交
1182 1183 1184 1185 1186 1187 1188 1189 1190
	.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 已提交
1191 1192 1193
	.get_icount =		serial_get_icount,
	.cleanup =		serial_cleanup,
	.install =		serial_install,
1194
	.proc_fops =		&serial_proc_fops,
L
Linus Torvalds 已提交
1195 1196
};

1197

L
Linus Torvalds 已提交
1198 1199
struct tty_driver *usb_serial_tty_driver;

1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
/* 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 已提交
1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
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 已提交
1221
	for (i = 0; i < SERIAL_TTY_MINORS; ++i)
L
Linus Torvalds 已提交
1222 1223 1224 1225
		serial_table[i] = NULL;

	result = bus_register(&usb_serial_bus_type);
	if (result) {
1226
		pr_err("%s - registering bus driver failed\n", __func__);
L
Linus Torvalds 已提交
1227 1228 1229 1230
		goto exit_bus;
	}

	usb_serial_tty_driver->driver_name = "usbserial";
J
Johan Hovold 已提交
1231
	usb_serial_tty_driver->name = "ttyUSB";
L
Linus Torvalds 已提交
1232 1233 1234 1235
	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 已提交
1236 1237
	usb_serial_tty_driver->flags = TTY_DRIVER_REAL_RAW |
						TTY_DRIVER_DYNAMIC_DEV;
L
Linus Torvalds 已提交
1238
	usb_serial_tty_driver->init_termios = tty_std_termios;
A
Alan Cox 已提交
1239 1240
	usb_serial_tty_driver->init_termios.c_cflag = B9600 | CS8 | CREAD
							| HUPCL | CLOCAL;
1241 1242
	usb_serial_tty_driver->init_termios.c_ispeed = 9600;
	usb_serial_tty_driver->init_termios.c_ospeed = 9600;
L
Linus Torvalds 已提交
1243 1244 1245
	tty_set_operations(usb_serial_tty_driver, &serial_ops);
	result = tty_register_driver(usb_serial_tty_driver);
	if (result) {
1246
		pr_err("%s - tty_register_driver failed\n", __func__);
L
Linus Torvalds 已提交
1247 1248 1249 1250 1251 1252
		goto exit_reg_driver;
	}

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

1257
	/* register the generic driver, if we should */
1258
	result = usb_serial_generic_register();
1259
	if (result < 0) {
1260
		pr_err("%s - registering generic driver failed\n", __func__);
1261 1262 1263
		goto exit_generic;
	}

L
Linus Torvalds 已提交
1264 1265
	return result;

1266 1267 1268
exit_generic:
	usb_deregister(&usb_serial_driver);

L
Linus Torvalds 已提交
1269 1270 1271 1272 1273 1274 1275
exit_tty:
	tty_unregister_driver(usb_serial_tty_driver);

exit_reg_driver:
	bus_unregister(&usb_serial_bus_type);

exit_bus:
1276
	pr_err("%s - returning with error %d\n", __func__, result);
L
Linus Torvalds 已提交
1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301
	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;	\
1302
			pr_debug("Had to override the " #function	\
A
Alan Cox 已提交
1303
				" usb serial operation with the generic one.");\
L
Linus Torvalds 已提交
1304 1305 1306
			}						\
	} while (0)

1307
static void fixup_generic(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1308 1309 1310 1311 1312 1313 1314 1315
{
	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);
1316 1317
	set_to_generic_if_null(device, disconnect);
	set_to_generic_if_null(device, release);
1318
	set_to_generic_if_null(device, process_read_urb);
1319
	set_to_generic_if_null(device, prepare_write_buffer);
L
Linus Torvalds 已提交
1320 1321
}

1322
static int usb_serial_register(struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
1323 1324 1325
{
	int retval;

1326 1327 1328
	if (usb_disabled())
		return -ENODEV;

1329
	fixup_generic(driver);
L
Linus Torvalds 已提交
1330

1331 1332
	if (!driver->description)
		driver->description = driver->driver.name;
1333 1334 1335 1336 1337
	if (!driver->usb_driver) {
		WARN(1, "Serial driver %s has no usb_driver\n",
				driver->description);
		return -EINVAL;
	}
1338

L
Linus Torvalds 已提交
1339
	/* Add this device to our list of devices */
1340
	mutex_lock(&table_lock);
1341
	list_add(&driver->driver_list, &usb_serial_driver_list);
L
Linus Torvalds 已提交
1342

1343
	retval = usb_serial_bus_register(driver);
L
Linus Torvalds 已提交
1344
	if (retval) {
1345
		pr_err("problem %d when registering driver %s\n", retval, driver->description);
1346
		list_del(&driver->driver_list);
A
Alan Cox 已提交
1347
	} else
1348
		pr_info("USB Serial support registered for %s\n", driver->description);
L
Linus Torvalds 已提交
1349

1350
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1351 1352 1353
	return retval;
}

1354
static void usb_serial_deregister(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1355
{
1356
	pr_info("USB Serial deregistering driver %s\n", device->description);
1357
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
1358 1359
	list_del(&device->driver_list);
	usb_serial_bus_deregister(device);
1360
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1361 1362
}

1363 1364 1365
/**
 * usb_serial_register_drivers - register drivers for a usb-serial module
 * @serial_drivers: NULL-terminated array of pointers to drivers to be registered
1366 1367
 * @name: name of the usb_driver for this set of @serial_drivers
 * @id_table: list of all devices this @serial_drivers set binds to
1368
 *
1369 1370
 * 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.
1371
 */
1372 1373 1374
int usb_serial_register_drivers(struct usb_serial_driver *const serial_drivers[],
				const char *name,
				const struct usb_device_id *id_table)
1375 1376
{
	int rc;
1377
	struct usb_driver *udriver;
1378 1379 1380 1381 1382 1383 1384 1385 1386 1387
	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.
1388
	 * So we leave udriver's id_table set to NULL until we are all set.
1389 1390 1391
	 *
	 * Suspend/resume support is implemented in the usb-serial core,
	 * so fill in the PM-related fields in udriver.
1392
	 */
1393 1394 1395
	udriver = kzalloc(sizeof(*udriver), GFP_KERNEL);
	if (!udriver)
		return -ENOMEM;
1396

1397
	udriver->name = name;
1398
	udriver->no_dynamic_id = 1;
1399 1400 1401
	udriver->supports_autosuspend = 1;
	udriver->suspend = usb_serial_suspend;
	udriver->resume = usb_serial_resume;
1402
	udriver->probe = usb_serial_probe;
1403
	udriver->disconnect = usb_serial_disconnect;
1404 1405 1406

	/* we only set the reset_resume field if the serial_driver has one */
	for (sd = serial_drivers; *sd; ++sd) {
1407
		if ((*sd)->reset_resume) {
1408 1409
			udriver->reset_resume = usb_serial_reset_resume;
			break;
1410
		}
1411 1412
	}

1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
	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;
	}

1424 1425
	/* Now set udriver's id_table and look for matches */
	udriver->id_table = id_table;
1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440
	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
 *
1441 1442 1443
 * 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().
1444
 */
1445
void usb_serial_deregister_drivers(struct usb_serial_driver *const serial_drivers[])
1446
{
1447 1448
	struct usb_driver *udriver = (*serial_drivers)->usb_driver;

1449 1450 1451
	for (; *serial_drivers; ++serial_drivers)
		usb_serial_deregister(*serial_drivers);
	usb_deregister(udriver);
1452
	kfree(udriver);
1453 1454
}
EXPORT_SYMBOL_GPL(usb_serial_deregister_drivers);
L
Linus Torvalds 已提交
1455 1456

/* Module information */
A
Alan Cox 已提交
1457 1458
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
1459
MODULE_LICENSE("GPL");