usb-serial.c 39.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
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

L
Linus Torvalds 已提交
21 22 23 24 25 26 27 28 29
#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>
30
#include <linux/seq_file.h>
L
Linus Torvalds 已提交
31
#include <linux/spinlock.h>
32
#include <linux/mutex.h>
L
Linus Torvalds 已提交
33
#include <linux/list.h>
A
Alan Cox 已提交
34
#include <linux/uaccess.h>
35
#include <linux/serial.h>
L
Linus Torvalds 已提交
36
#include <linux/usb.h>
37
#include <linux/usb/serial.h>
38
#include <linux/kfifo.h>
L
Linus Torvalds 已提交
39 40
#include "pl2303.h"

41
#define DRIVER_AUTHOR "Greg Kroah-Hartman <gregkh@linuxfoundation.org>"
L
Linus Torvalds 已提交
42 43 44 45 46 47 48 49 50
#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 已提交
51
static struct usb_serial *serial_table[SERIAL_TTY_MINORS];
52
static DEFINE_MUTEX(table_lock);
L
Linus Torvalds 已提交
53 54
static LIST_HEAD(usb_serial_driver_list);

55 56 57 58 59
/*
 * 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 已提交
60 61
struct usb_serial *usb_serial_get_by_index(unsigned index)
{
62 63
	struct usb_serial *serial;

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

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

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

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

	*minor = 0;
89
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
90 91 92 93 94 95 96 97 98 99 100 101 102 103 104
	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 已提交
105
		j = 0;
106
		dev_dbg(&serial->interface->dev, "%s - minor base = %d\n", __func__, *minor);
O
Oliver Neukum 已提交
107
		for (i = *minor; (i < (*minor + num_ports)) && (i < SERIAL_TTY_MINORS); ++i) {
L
Linus Torvalds 已提交
108
			serial_table[i] = serial;
O
Oliver Neukum 已提交
109 110
			serial->port[j++]->number = i;
		}
111
		mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
112 113
		return serial;
	}
114
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
115 116 117 118 119 120 121
	return NULL;
}

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

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

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 已提交
136
	/* return the minor range that this device had */
137 138
	if (serial->minor != SERIAL_TTY_NO_MINOR)
		return_serial(serial);
J
Jim Radford 已提交
139

140 141
	if (serial->attached)
		serial->type->release(serial);
142

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

152
	usb_put_intf(serial->interface);
L
Linus Torvalds 已提交
153
	usb_put_dev(serial->dev);
A
Alan Cox 已提交
154
	kfree(serial);
L
Linus Torvalds 已提交
155 156
}

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

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

/**
 * 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.
174 175 176 177
 *
 * 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.
178
 * All these actions are reversed in serial_cleanup().
179 180 181 182 183
 */
static int serial_install(struct tty_driver *driver, struct tty_struct *tty)
{
	int idx = tty->index;
	struct usb_serial *serial;
184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199
	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;
200

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

205 206
	mutex_unlock(&serial->disc_mutex);

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

211 212 213 214
	tty->driver_data = port;

	return retval;

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

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

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

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

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

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

J
Johan Hovold 已提交
250 251
	dev_dbg(tty->dev, "%s\n", __func__);

A
Alan Cox 已提交
252
	return tty_port_open(&port->port, tty, filp);
L
Linus Torvalds 已提交
253 254
}

255
/**
256
 * serial_port_shutdown - shut down hardware
257
 * @tport: tty port to shut down
258
 *
259 260
 * Shut down a USB serial port. Serialized against activate by the
 * tport mutex and kept to matching open/close pairs
261
 * of calls by the ASYNCB_INITIALIZED flag.
262 263
 *
 * Not called if tty is console.
264
 */
265
static void serial_port_shutdown(struct tty_port *tport)
L
Linus Torvalds 已提交
266
{
267 268
	struct usb_serial_port *port =
		container_of(tport, struct usb_serial_port, port);
269
	struct usb_serial_driver *drv = port->serial->type;
270

271 272 273 274
	if (drv->close)
		drv->close(port);
}

275 276 277
static void serial_hangup(struct tty_struct *tty)
{
	struct usb_serial_port *port = tty->driver_data;
278

J
Johan Hovold 已提交
279 280
	dev_dbg(tty->dev, "%s\n", __func__);

281 282 283 284 285 286
	tty_port_hangup(&port->port);
}

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

J
Johan Hovold 已提交
288 289
	dev_dbg(tty->dev, "%s\n", __func__);

290
	tty_port_close(&port->port, tty, filp);
291 292
}

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

J
Johan Hovold 已提交
308 309
	dev_dbg(tty->dev, "%s\n", __func__);

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 317
	tty->driver_data = NULL;

318 319
	serial = port->serial;
	owner = serial->type->driver.owner;
320

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

326
	usb_serial_put(serial);
327 328 329
	module_put(owner);
}

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

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

J
Johan Hovold 已提交
339
	dev_dbg(tty->dev, "%s - %d byte(s)\n", __func__, count);
L
Linus Torvalds 已提交
340

A
Alan Cox 已提交
341
	retval = port->serial->type->write(tty, port, buf, count);
342 343
	if (retval < 0)
		retval = usb_translate_errors(retval);
L
Linus Torvalds 已提交
344 345 346 347
exit:
	return retval;
}

A
Alan Cox 已提交
348
static int serial_write_room(struct tty_struct *tty)
L
Linus Torvalds 已提交
349
{
350
	struct usb_serial_port *port = tty->driver_data;
351

J
Johan Hovold 已提交
352
	dev_dbg(tty->dev, "%s\n", __func__);
353

A
Alan Cox 已提交
354
	return port->serial->type->write_room(tty);
L
Linus Torvalds 已提交
355 356
}

A
Alan Cox 已提交
357
static int serial_chars_in_buffer(struct tty_struct *tty)
L
Linus Torvalds 已提交
358
{
359
	struct usb_serial_port *port = tty->driver_data;
360 361
	struct usb_serial *serial = port->serial;
	int count = 0;
362

J
Johan Hovold 已提交
363
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
364

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

	return count;
L
Linus Torvalds 已提交
375 376
}

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

J
Johan Hovold 已提交
381
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
382 383

	if (port->serial->type->throttle)
A
Alan Cox 已提交
384
		port->serial->type->throttle(tty);
L
Linus Torvalds 已提交
385 386
}

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

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

	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;

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

405
	if (port->serial->type->ioctl)
406
		retval = port->serial->type->ioctl(tty, cmd, arg);
407
	else
L
Linus Torvalds 已提交
408
		retval = -ENOIOCTLCMD;
409

L
Linus Torvalds 已提交
410 411 412
	return retval;
}

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

J
Johan Hovold 已提交
417
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
418 419

	if (port->serial->type->set_termios)
A
Alan Cox 已提交
420
		port->serial->type->set_termios(tty, port, old);
421
	else
422
		tty_termios_copy_hw(&tty->termios, old);
L
Linus Torvalds 已提交
423 424
}

A
Alan Cox 已提交
425
static int serial_break(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
426
{
427
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
428

J
Johan Hovold 已提交
429
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
430

431
	if (port->serial->type->break_ctl)
A
Alan Cox 已提交
432
		port->serial->type->break_ctl(tty, break_state);
433

A
Alan Cox 已提交
434
	return 0;
L
Linus Torvalds 已提交
435 436
}

437
static int serial_proc_show(struct seq_file *m, void *v)
L
Linus Torvalds 已提交
438 439 440 441 442
{
	struct usb_serial *serial;
	int i;
	char tmp[40];

443 444
	seq_puts(m, "usbserinfo:1.0 driver:2.0\n");
	for (i = 0; i < SERIAL_TTY_MINORS; ++i) {
L
Linus Torvalds 已提交
445 446 447 448
		serial = usb_serial_get_by_index(i);
		if (serial == NULL)
			continue;

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

463
		seq_putc(m, '\n');
464
		usb_serial_put(serial);
465
		mutex_unlock(&serial->disc_mutex);
L
Linus Torvalds 已提交
466
	}
467
	return 0;
L
Linus Torvalds 已提交
468 469
}

470 471 472 473 474 475 476 477 478 479 480 481 482
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,
};

483
static int serial_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
484
{
485
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
486

J
Johan Hovold 已提交
487
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
488 489

	if (port->serial->type->tiocmget)
490
		return port->serial->type->tiocmget(tty);
L
Linus Torvalds 已提交
491 492 493
	return -EINVAL;
}

494
static int serial_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
495 496
			    unsigned int set, unsigned int clear)
{
497
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
498

J
Johan Hovold 已提交
499
	dev_dbg(tty->dev, "%s\n", __func__);
L
Linus Torvalds 已提交
500 501

	if (port->serial->type->tiocmset)
502
		return port->serial->type->tiocmset(tty, set, clear);
L
Linus Torvalds 已提交
503 504 505
	return -EINVAL;
}

A
Alan Cox 已提交
506 507 508 509 510
static int serial_get_icount(struct tty_struct *tty,
				struct serial_icounter_struct *icount)
{
	struct usb_serial_port *port = tty->driver_data;

J
Johan Hovold 已提交
511
	dev_dbg(tty->dev, "%s\n", __func__);
A
Alan Cox 已提交
512 513 514 515 516 517

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

518 519 520 521 522 523 524 525 526
/*
 * 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 已提交
527
EXPORT_SYMBOL_GPL(usb_serial_port_softint);
528

D
David Howells 已提交
529
static void usb_serial_port_work(struct work_struct *work)
L
Linus Torvalds 已提交
530
{
D
David Howells 已提交
531 532
	struct usb_serial_port *port =
		container_of(work, struct usb_serial_port, work);
L
Linus Torvalds 已提交
533 534
	struct tty_struct *tty;

A
Alan Cox 已提交
535
	tty = tty_port_tty_get(&port->port);
L
Linus Torvalds 已提交
536 537 538
	if (!tty)
		return;

J
Johan Hovold 已提交
539
	dev_dbg(tty->dev, "%s\n", __func__);
540

L
Linus Torvalds 已提交
541
	tty_wakeup(tty);
A
Alan Cox 已提交
542
	tty_kref_put(tty);
L
Linus Torvalds 已提交
543 544
}

545
static void kill_traffic(struct usb_serial_port *port)
546
{
547 548
	int i;

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

568
static void port_release(struct device *dev)
569
{
570
	struct usb_serial_port *port = to_usb_serial_port(dev);
571
	int i;
572

573
	dev_dbg(dev, "%s\n", __func__);
574

575 576 577 578
	/*
	 * Stop all the traffic before cancelling the work, so that
	 * nobody will restart it by calling usb_serial_port_softint.
	 */
579
	kill_traffic(port);
580 581
	cancel_work_sync(&port->work);

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

A
Alan Cox 已提交
599 600 601
static struct usb_serial *create_serial(struct usb_device *dev,
					struct usb_interface *interface,
					struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
602 603 604
{
	struct usb_serial *serial;

605
	serial = kzalloc(sizeof(*serial), GFP_KERNEL);
606
	if (!serial)
L
Linus Torvalds 已提交
607 608
		return NULL;
	serial->dev = usb_get_dev(dev);
609
	serial->type = driver;
610
	serial->interface = usb_get_intf(interface);
L
Linus Torvalds 已提交
611
	kref_init(&serial->kref);
612
	mutex_init(&serial->disc_mutex);
613
	serial->minor = SERIAL_TTY_NO_MINOR;
L
Linus Torvalds 已提交
614 615 616 617

	return serial;
}

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

651
/* Caller must hold table_lock */
A
Alan Cox 已提交
652 653
static struct usb_serial_driver *search_serial_device(
					struct usb_interface *iface)
L
Linus Torvalds 已提交
654
{
655
	const struct usb_device_id *id = NULL;
656
	struct usb_serial_driver *drv;
657
	struct usb_driver *driver = to_usb_driver(iface->dev.driver);
L
Linus Torvalds 已提交
658

A
Adrian Bunk 已提交
659
	/* Check if the usb id matches a known device */
660
	list_for_each_entry(drv, &usb_serial_driver_list, driver_list) {
661 662
		if (drv->usb_driver == driver)
			id = get_iface_id(drv, iface);
663
		if (id)
664
			return drv;
L
Linus Torvalds 已提交
665 666 667 668 669
	}

	return NULL;
}

670
static int serial_port_carrier_raised(struct tty_port *port)
671 672 673
{
	struct usb_serial_port *p = container_of(port, struct usb_serial_port, port);
	struct usb_serial_driver *drv = p->serial->type;
J
Johan Hovold 已提交
674

675 676 677
	if (drv->carrier_raised)
		return drv->carrier_raised(p);
	/* No carrier control - don't block */
J
Johan Hovold 已提交
678
	return 1;
679 680
}

681
static void serial_port_dtr_rts(struct tty_port *port, int on)
682 683
{
	struct usb_serial_port *p = container_of(port, struct usb_serial_port, port);
684 685
	struct usb_serial *serial = p->serial;
	struct usb_serial_driver *drv = serial->type;
J
Johan Hovold 已提交
686

687 688 689 690 691 692 693 694 695
	if (!drv->dtr_rts)
		return;
	/*
	 * Work-around bug in the tty-layer which can result in dtr_rts
	 * being called after a disconnect (and tty_unregister_device
	 * has returned). Remove once bug has been squashed.
	 */
	mutex_lock(&serial->disc_mutex);
	if (!serial->disconnected)
696
		drv->dtr_rts(p, on);
697
	mutex_unlock(&serial->disc_mutex);
698 699 700
}

static const struct tty_port_operations serial_port_ops = {
701 702 703 704
	.carrier_raised		= serial_port_carrier_raised,
	.dtr_rts		= serial_port_dtr_rts,
	.activate		= serial_port_activate,
	.shutdown		= serial_port_shutdown,
705 706
};

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

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

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

A
Alan Cox 已提交
748
	serial = create_serial(dev, interface, type);
L
Linus Torvalds 已提交
749
	if (!serial) {
750
		module_put(type->driver.owner);
L
Linus Torvalds 已提交
751 752 753 754 755 756 757
		return -ENOMEM;
	}

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

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

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

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

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

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

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

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

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

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

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

		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);
914
			if (!port->read_urbs[j])
915 916 917
				goto probe_error;
			port->bulk_in_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
918
			if (!port->bulk_in_buffers[j])
919 920 921
				goto probe_error;
			usb_fill_bulk_urb(port->read_urbs[j], dev,
					usb_rcvbulkpipe(dev,
A
Alan Cox 已提交
922
						endpoint->bEndpointAddress),
923 924 925 926 927 928 929
					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 已提交
930 931 932 933 934
	}

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

943 944 945
		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);
946
			if (!port->write_urbs[j])
947 948 949
				goto probe_error;
			port->bulk_out_buffers[j] = kmalloc(buffer_size,
								GFP_KERNEL);
950
			if (!port->bulk_out_buffers[j])
951 952 953 954 955 956 957 958
				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);
		}
959 960 961

		port->write_urb = port->write_urbs[0];
		port->bulk_out_buffer = port->bulk_out_buffers[0];
L
Linus Torvalds 已提交
962 963 964 965 966 967 968
	}

	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);
969
			if (!port->interrupt_in_urb)
L
Linus Torvalds 已提交
970
				goto probe_error;
971
			buffer_size = usb_endpoint_maxp(endpoint);
A
Alan Cox 已提交
972 973 974 975
			port->interrupt_in_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_in_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
976
			if (!port->interrupt_in_buffer)
L
Linus Torvalds 已提交
977
				goto probe_error;
A
Alan Cox 已提交
978 979 980 981 982 983
			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 已提交
984 985
		}
	} else if (num_interrupt_in) {
986
		dev_dbg(ddev, "The device claims to support interrupt in transfers, but read_int_callback is not defined\n");
L
Linus Torvalds 已提交
987
	}
A
Alan Cox 已提交
988

L
Linus Torvalds 已提交
989 990 991 992 993
	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);
994
			if (!port->interrupt_out_urb)
L
Linus Torvalds 已提交
995
				goto probe_error;
996
			buffer_size = usb_endpoint_maxp(endpoint);
L
Linus Torvalds 已提交
997
			port->interrupt_out_size = buffer_size;
A
Alan Cox 已提交
998 999 1000 1001
			port->interrupt_out_endpointAddress =
						endpoint->bEndpointAddress;
			port->interrupt_out_buffer = kmalloc(buffer_size,
								GFP_KERNEL);
1002
			if (!port->interrupt_out_buffer)
L
Linus Torvalds 已提交
1003
				goto probe_error;
A
Alan Cox 已提交
1004 1005 1006 1007 1008 1009
			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 已提交
1010 1011
		}
	} else if (num_interrupt_out) {
1012
		dev_dbg(ddev, "The device claims to support interrupt out transfers, but write_int_callback is not defined\n");
L
Linus Torvalds 已提交
1013
	}
A
Alan Cox 已提交
1014

1015 1016
	usb_set_intfdata(interface, serial);

L
Linus Torvalds 已提交
1017 1018
	/* if this device type has an attach function, call it */
	if (type->attach) {
A
Alan Cox 已提交
1019
		retval = type->attach(serial);
L
Linus Torvalds 已提交
1020 1021
		if (retval < 0)
			goto probe_error;
1022
		serial->attached = 1;
L
Linus Torvalds 已提交
1023
		if (retval > 0) {
A
Alan Cox 已提交
1024 1025
			/* quietly accept this device, but don't bind to a
			   serial port as it's about to disappear */
1026
			serial->num_ports = 0;
L
Linus Torvalds 已提交
1027 1028
			goto exit;
		}
1029 1030
	} else {
		serial->attached = 1;
L
Linus Torvalds 已提交
1031 1032
	}

1033 1034 1035 1036 1037 1038
	/* 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 已提交
1039
	if (get_free_serial(serial, num_ports, &minor) == NULL) {
1040
		dev_err(ddev, "No more free serial devices\n");
1041 1042
		goto probe_error;
	}
1043
	serial->minor = minor;
1044

L
Linus Torvalds 已提交
1045 1046 1047
	/* register all of the individual ports with the driver core */
	for (i = 0; i < num_ports; ++i) {
		port = serial->port[i];
1048
		dev_set_name(&port->dev, "ttyUSB%d", port->number);
1049
		dev_dbg(ddev, "registering %s", dev_name(&port->dev));
1050 1051
		device_enable_async_suspend(&port->dev);

1052
		retval = device_add(&port->dev);
1053
		if (retval)
1054
			dev_err(ddev, "Error registering port device, continuing\n");
L
Linus Torvalds 已提交
1055 1056
	}

1057 1058
	serial->disconnected = 0;

1059
	usb_serial_console_init(minor);
L
Linus Torvalds 已提交
1060
exit:
1061
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1062 1063 1064
	return 0;

probe_error:
1065
	usb_serial_put(serial);
1066
	module_put(type->driver.owner);
L
Linus Torvalds 已提交
1067 1068 1069
	return -EIO;
}

1070
static void usb_serial_disconnect(struct usb_interface *interface)
L
Linus Torvalds 已提交
1071 1072
{
	int i;
A
Alan Cox 已提交
1073
	struct usb_serial *serial = usb_get_intfdata(interface);
L
Linus Torvalds 已提交
1074 1075 1076
	struct device *dev = &interface->dev;
	struct usb_serial_port *port;

1077
	usb_serial_console_disconnect(serial);
L
Linus Torvalds 已提交
1078

1079 1080 1081
	mutex_lock(&serial->disc_mutex);
	/* must set a flag, to signal subdrivers */
	serial->disconnected = 1;
1082 1083
	mutex_unlock(&serial->disc_mutex);

1084 1085 1086
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		if (port) {
A
Alan Cox 已提交
1087 1088
			struct tty_struct *tty = tty_port_tty_get(&port->port);
			if (tty) {
A
Alan Cox 已提交
1089
				tty_vhangup(tty);
A
Alan Cox 已提交
1090 1091
				tty_kref_put(tty);
			}
1092
			kill_traffic(port);
1093
			cancel_work_sync(&port->work);
1094
			if (device_is_registered(&port->dev))
1095
				device_del(&port->dev);
1096 1097
		}
	}
1098 1099
	if (serial->type->disconnect)
		serial->type->disconnect(serial);
1100

1101
	/* let the last holder of this object cause it to be cleaned up */
1102
	usb_serial_put(serial);
L
Linus Torvalds 已提交
1103 1104 1105
	dev_info(dev, "device disconnected\n");
}

1106 1107 1108 1109 1110 1111
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;

1112 1113
	serial->suspending = 1;

1114 1115 1116 1117 1118
	/*
	 * serial->type->suspend() MUST return 0 in system sleep context,
	 * otherwise, the resume callback has to recover device from
	 * previous suspend failure.
	 */
1119 1120
	if (serial->type->suspend) {
		r = serial->type->suspend(serial, message);
1121 1122
		if (r < 0) {
			serial->suspending = 0;
1123
			goto err_out;
1124
		}
1125 1126
	}

1127 1128 1129 1130
	for (i = 0; i < serial->num_ports; ++i) {
		port = serial->port[i];
		if (port)
			kill_traffic(port);
1131 1132
	}

1133
err_out:
1134 1135 1136 1137 1138 1139 1140
	return r;
}
EXPORT_SYMBOL(usb_serial_suspend);

int usb_serial_resume(struct usb_interface *intf)
{
	struct usb_serial *serial = usb_get_intfdata(intf);
1141
	int rv;
1142

1143
	serial->suspending = 0;
S
Sarah Sharp 已提交
1144
	if (serial->type->resume)
1145 1146 1147
		rv = serial->type->resume(serial);
	else
		rv = usb_serial_generic_resume(serial);
1148

1149
	return rv;
1150 1151 1152
}
EXPORT_SYMBOL(usb_serial_resume);

1153 1154 1155 1156 1157 1158 1159 1160
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);
1161 1162 1163 1164
	else {
		rv = -EOPNOTSUPP;
		intf->needs_binding = 1;
	}
1165 1166 1167 1168

	return rv;
}

J
Jeff Dike 已提交
1169
static const struct tty_operations serial_ops = {
L
Linus Torvalds 已提交
1170 1171 1172
	.open =			serial_open,
	.close =		serial_close,
	.write =		serial_write,
J
Johan Hovold 已提交
1173
	.hangup =		serial_hangup,
L
Linus Torvalds 已提交
1174 1175 1176 1177 1178 1179 1180 1181 1182
	.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 已提交
1183 1184 1185
	.get_icount =		serial_get_icount,
	.cleanup =		serial_cleanup,
	.install =		serial_install,
1186
	.proc_fops =		&serial_proc_fops,
L
Linus Torvalds 已提交
1187 1188
};

1189

L
Linus Torvalds 已提交
1190 1191
struct tty_driver *usb_serial_tty_driver;

1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
/* 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 已提交
1203 1204 1205 1206 1207 1208 1209 1210 1211 1212
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 已提交
1213
	for (i = 0; i < SERIAL_TTY_MINORS; ++i)
L
Linus Torvalds 已提交
1214 1215 1216 1217
		serial_table[i] = NULL;

	result = bus_register(&usb_serial_bus_type);
	if (result) {
1218
		pr_err("%s - registering bus driver failed\n", __func__);
L
Linus Torvalds 已提交
1219 1220 1221 1222
		goto exit_bus;
	}

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

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

1249
	/* register the generic driver, if we should */
1250
	result = usb_serial_generic_register();
1251
	if (result < 0) {
1252
		pr_err("%s - registering generic driver failed\n", __func__);
1253 1254 1255
		goto exit_generic;
	}

L
Linus Torvalds 已提交
1256 1257
	return result;

1258 1259 1260
exit_generic:
	usb_deregister(&usb_serial_driver);

L
Linus Torvalds 已提交
1261 1262 1263 1264 1265 1266 1267
exit_tty:
	tty_unregister_driver(usb_serial_tty_driver);

exit_reg_driver:
	bus_unregister(&usb_serial_bus_type);

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

1299
static void fixup_generic(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1300 1301 1302 1303 1304 1305 1306 1307
{
	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);
1308
	set_to_generic_if_null(device, release);
1309
	set_to_generic_if_null(device, process_read_urb);
1310
	set_to_generic_if_null(device, prepare_write_buffer);
L
Linus Torvalds 已提交
1311 1312
}

1313
static int usb_serial_register(struct usb_serial_driver *driver)
L
Linus Torvalds 已提交
1314 1315 1316
{
	int retval;

1317 1318 1319
	if (usb_disabled())
		return -ENODEV;

1320
	fixup_generic(driver);
L
Linus Torvalds 已提交
1321

1322 1323
	if (!driver->description)
		driver->description = driver->driver.name;
1324 1325 1326 1327 1328
	if (!driver->usb_driver) {
		WARN(1, "Serial driver %s has no usb_driver\n",
				driver->description);
		return -EINVAL;
	}
1329

L
Linus Torvalds 已提交
1330
	/* Add this device to our list of devices */
1331
	mutex_lock(&table_lock);
1332
	list_add(&driver->driver_list, &usb_serial_driver_list);
L
Linus Torvalds 已提交
1333

1334
	retval = usb_serial_bus_register(driver);
L
Linus Torvalds 已提交
1335
	if (retval) {
1336
		pr_err("problem %d when registering driver %s\n", retval, driver->description);
1337
		list_del(&driver->driver_list);
A
Alan Cox 已提交
1338
	} else
1339
		pr_info("USB Serial support registered for %s\n", driver->description);
L
Linus Torvalds 已提交
1340

1341
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1342 1343 1344
	return retval;
}

1345
static void usb_serial_deregister(struct usb_serial_driver *device)
L
Linus Torvalds 已提交
1346
{
1347
	pr_info("USB Serial deregistering driver %s\n", device->description);
1348
	mutex_lock(&table_lock);
L
Linus Torvalds 已提交
1349 1350
	list_del(&device->driver_list);
	usb_serial_bus_deregister(device);
1351
	mutex_unlock(&table_lock);
L
Linus Torvalds 已提交
1352 1353
}

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

1388
	udriver->name = name;
1389
	udriver->no_dynamic_id = 1;
1390 1391 1392
	udriver->supports_autosuspend = 1;
	udriver->suspend = usb_serial_suspend;
	udriver->resume = usb_serial_resume;
1393
	udriver->probe = usb_serial_probe;
1394
	udriver->disconnect = usb_serial_disconnect;
1395 1396 1397

	/* we only set the reset_resume field if the serial_driver has one */
	for (sd = serial_drivers; *sd; ++sd) {
1398
		if ((*sd)->reset_resume) {
1399 1400
			udriver->reset_resume = usb_serial_reset_resume;
			break;
1401
		}
1402 1403
	}

1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414
	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;
	}

1415 1416
	/* Now set udriver's id_table and look for matches */
	udriver->id_table = id_table;
1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431
	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
 *
1432 1433 1434
 * 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().
1435
 */
1436
void usb_serial_deregister_drivers(struct usb_serial_driver *const serial_drivers[])
1437
{
1438 1439
	struct usb_driver *udriver = (*serial_drivers)->usb_driver;

1440 1441 1442
	for (; *serial_drivers; ++serial_drivers)
		usb_serial_deregister(*serial_drivers);
	usb_deregister(udriver);
1443
	kfree(udriver);
1444 1445
}
EXPORT_SYMBOL_GPL(usb_serial_deregister_drivers);
L
Linus Torvalds 已提交
1446

A
Alan Cox 已提交
1447 1448
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
1449
MODULE_LICENSE("GPL");