digi_acceleport.c 43.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26
/*
*  Digi AccelePort USB-4 and USB-2 Serial Converters
*
*  Copyright 2000 by Digi International
*
*  This program is free software; you can redistribute it and/or modify
*  it under the terms of the GNU General Public License as published by
*  the Free Software Foundation; either version 2 of the License, or
*  (at your option) any later version.
*
*  Shamelessly based on Brian Warner's keyspan_pda.c and Greg Kroah-Hartman's
*  usb-serial driver.
*
*  Peter Berger (pberger@brimson.com)
*  Al Borchers (borchers@steinerpoint.com)
*/

#include <linux/kernel.h>
#include <linux/errno.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/spinlock.h>
#include <linux/workqueue.h>
A
Alan Cox 已提交
27
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
28 29
#include <linux/usb.h>
#include <linux/wait.h>
30
#include <linux/usb/serial.h>
L
Linus Torvalds 已提交
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204

/* Defines */

#define DRIVER_AUTHOR "Peter Berger <pberger@brimson.com>, Al Borchers <borchers@steinerpoint.com>"
#define DRIVER_DESC "Digi AccelePort USB-2/USB-4 Serial Converter driver"

/* port output buffer length -- must be <= transfer buffer length - 2 */
/* so we can be sure to send the full buffer in one urb */
#define DIGI_OUT_BUF_SIZE		8

/* port input buffer length -- must be >= transfer buffer length - 3 */
/* so we can be sure to hold at least one full buffer from one urb */
#define DIGI_IN_BUF_SIZE		64

/* retry timeout while sleeping */
#define DIGI_RETRY_TIMEOUT		(HZ/10)

/* timeout while waiting for tty output to drain in close */
/* this delay is used twice in close, so the total delay could */
/* be twice this value */
#define DIGI_CLOSE_TIMEOUT		(5*HZ)


/* AccelePort USB Defines */

/* ids */
#define DIGI_VENDOR_ID			0x05c5
#define DIGI_2_ID			0x0002	/* USB-2 */
#define DIGI_4_ID			0x0004	/* USB-4 */

/* commands
 * "INB": can be used on the in-band endpoint
 * "OOB": can be used on the out-of-band endpoint
 */
#define DIGI_CMD_SET_BAUD_RATE			0	/* INB, OOB */
#define DIGI_CMD_SET_WORD_SIZE			1	/* INB, OOB */
#define DIGI_CMD_SET_PARITY			2	/* INB, OOB */
#define DIGI_CMD_SET_STOP_BITS			3	/* INB, OOB */
#define DIGI_CMD_SET_INPUT_FLOW_CONTROL		4	/* INB, OOB */
#define DIGI_CMD_SET_OUTPUT_FLOW_CONTROL	5	/* INB, OOB */
#define DIGI_CMD_SET_DTR_SIGNAL			6	/* INB, OOB */
#define DIGI_CMD_SET_RTS_SIGNAL			7	/* INB, OOB */
#define DIGI_CMD_READ_INPUT_SIGNALS		8	/*      OOB */
#define DIGI_CMD_IFLUSH_FIFO			9	/*      OOB */
#define DIGI_CMD_RECEIVE_ENABLE			10	/* INB, OOB */
#define DIGI_CMD_BREAK_CONTROL			11	/* INB, OOB */
#define DIGI_CMD_LOCAL_LOOPBACK			12	/* INB, OOB */
#define DIGI_CMD_TRANSMIT_IDLE			13	/* INB, OOB */
#define DIGI_CMD_READ_UART_REGISTER		14	/*      OOB */
#define DIGI_CMD_WRITE_UART_REGISTER		15	/* INB, OOB */
#define DIGI_CMD_AND_UART_REGISTER		16	/* INB, OOB */
#define DIGI_CMD_OR_UART_REGISTER		17	/* INB, OOB */
#define DIGI_CMD_SEND_DATA			18	/* INB      */
#define DIGI_CMD_RECEIVE_DATA			19	/* INB      */
#define DIGI_CMD_RECEIVE_DISABLE		20	/* INB      */
#define DIGI_CMD_GET_PORT_TYPE			21	/*      OOB */

/* baud rates */
#define DIGI_BAUD_50				0
#define DIGI_BAUD_75				1
#define DIGI_BAUD_110				2
#define DIGI_BAUD_150				3
#define DIGI_BAUD_200				4
#define DIGI_BAUD_300				5
#define DIGI_BAUD_600				6
#define DIGI_BAUD_1200				7
#define DIGI_BAUD_1800				8
#define DIGI_BAUD_2400				9
#define DIGI_BAUD_4800				10
#define DIGI_BAUD_7200				11
#define DIGI_BAUD_9600				12
#define DIGI_BAUD_14400				13
#define DIGI_BAUD_19200				14
#define DIGI_BAUD_28800				15
#define DIGI_BAUD_38400				16
#define DIGI_BAUD_57600				17
#define DIGI_BAUD_76800				18
#define DIGI_BAUD_115200			19
#define DIGI_BAUD_153600			20
#define DIGI_BAUD_230400			21
#define DIGI_BAUD_460800			22

/* arguments */
#define DIGI_WORD_SIZE_5			0
#define DIGI_WORD_SIZE_6			1
#define DIGI_WORD_SIZE_7			2
#define DIGI_WORD_SIZE_8			3

#define DIGI_PARITY_NONE			0
#define DIGI_PARITY_ODD				1
#define DIGI_PARITY_EVEN			2
#define DIGI_PARITY_MARK			3
#define DIGI_PARITY_SPACE			4

#define DIGI_STOP_BITS_1			0
#define DIGI_STOP_BITS_2			1

#define DIGI_INPUT_FLOW_CONTROL_XON_XOFF	1
#define DIGI_INPUT_FLOW_CONTROL_RTS		2
#define DIGI_INPUT_FLOW_CONTROL_DTR		4

#define DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF	1
#define DIGI_OUTPUT_FLOW_CONTROL_CTS		2
#define DIGI_OUTPUT_FLOW_CONTROL_DSR		4

#define DIGI_DTR_INACTIVE			0
#define DIGI_DTR_ACTIVE				1
#define DIGI_DTR_INPUT_FLOW_CONTROL		2

#define DIGI_RTS_INACTIVE			0
#define DIGI_RTS_ACTIVE				1
#define DIGI_RTS_INPUT_FLOW_CONTROL		2
#define DIGI_RTS_TOGGLE				3

#define DIGI_FLUSH_TX				1
#define DIGI_FLUSH_RX				2
#define DIGI_RESUME_TX				4 /* clears xoff condition */

#define DIGI_TRANSMIT_NOT_IDLE			0
#define DIGI_TRANSMIT_IDLE			1

#define DIGI_DISABLE				0
#define DIGI_ENABLE				1

#define DIGI_DEASSERT				0
#define DIGI_ASSERT				1

/* in band status codes */
#define DIGI_OVERRUN_ERROR			4
#define DIGI_PARITY_ERROR			8
#define DIGI_FRAMING_ERROR			16
#define DIGI_BREAK_ERROR			32

/* out of band status */
#define DIGI_NO_ERROR				0
#define DIGI_BAD_FIRST_PARAMETER		1
#define DIGI_BAD_SECOND_PARAMETER		2
#define DIGI_INVALID_LINE			3
#define DIGI_INVALID_OPCODE			4

/* input signals */
#define DIGI_READ_INPUT_SIGNALS_SLOT		1
#define DIGI_READ_INPUT_SIGNALS_ERR		2
#define DIGI_READ_INPUT_SIGNALS_BUSY		4
#define DIGI_READ_INPUT_SIGNALS_PE		8
#define DIGI_READ_INPUT_SIGNALS_CTS		16
#define DIGI_READ_INPUT_SIGNALS_DSR		32
#define DIGI_READ_INPUT_SIGNALS_RI		64
#define DIGI_READ_INPUT_SIGNALS_DCD		128


/* Structures */

struct digi_serial {
	spinlock_t ds_serial_lock;
	struct usb_serial_port *ds_oob_port;	/* out-of-band port */
	int ds_oob_port_num;			/* index of out-of-band port */
	int ds_device_started;
};

struct digi_port {
	spinlock_t dp_port_lock;
	int dp_port_num;
	int dp_out_buf_len;
	unsigned char dp_out_buf[DIGI_OUT_BUF_SIZE];
	int dp_write_urb_in_use;
	unsigned int dp_modem_signals;
	int dp_transmit_idle;
	wait_queue_head_t dp_transmit_idle_wait;
	int dp_throttled;
	int dp_throttle_restart;
	wait_queue_head_t dp_flush_wait;
	wait_queue_head_t dp_close_wait;	/* wait queue for close */
	struct work_struct dp_wakeup_work;
D
David Howells 已提交
205
	struct usb_serial_port *dp_port;
L
Linus Torvalds 已提交
206 207 208 209 210
};


/* Local Function Declarations */

D
David Howells 已提交
211
static void digi_wakeup_write_lock(struct work_struct *work);
212 213 214 215 216 217 218 219
static int digi_write_oob_command(struct usb_serial_port *port,
	unsigned char *buf, int count, int interruptible);
static int digi_write_inb_command(struct usb_serial_port *port,
	unsigned char *buf, int count, unsigned long timeout);
static int digi_set_modem_signals(struct usb_serial_port *port,
	unsigned int modem_signals, int interruptible);
static int digi_transmit_idle(struct usb_serial_port *port,
	unsigned long timeout);
A
Alan Cox 已提交
220 221
static void digi_rx_throttle(struct tty_struct *tty);
static void digi_rx_unthrottle(struct tty_struct *tty);
A
Alan Cox 已提交
222 223 224
static void digi_set_termios(struct tty_struct *tty,
		struct usb_serial_port *port, struct ktermios *old_termios);
static void digi_break_ctl(struct tty_struct *tty, int break_state);
225
static int digi_tiocmget(struct tty_struct *tty);
226 227
static int digi_tiocmset(struct tty_struct *tty, unsigned int set,
		unsigned int clear);
A
Alan Cox 已提交
228
static int digi_write(struct tty_struct *tty, struct usb_serial_port *port,
229
		const unsigned char *buf, int count);
230
static void digi_write_bulk_callback(struct urb *urb);
A
Alan Cox 已提交
231 232
static int digi_write_room(struct tty_struct *tty);
static int digi_chars_in_buffer(struct tty_struct *tty);
233
static int digi_open(struct tty_struct *tty, struct usb_serial_port *port);
234 235
static void digi_close(struct usb_serial_port *port);
static void digi_dtr_rts(struct usb_serial_port *port, int on);
236 237
static int digi_startup_device(struct usb_serial *serial);
static int digi_startup(struct usb_serial *serial);
238 239
static void digi_disconnect(struct usb_serial *serial);
static void digi_release(struct usb_serial *serial);
240 241
static int digi_port_probe(struct usb_serial_port *port);
static int digi_port_remove(struct usb_serial_port *port);
242 243 244
static void digi_read_bulk_callback(struct urb *urb);
static int digi_read_inb_callback(struct urb *urb);
static int digi_read_oob_callback(struct urb *urb);
L
Linus Torvalds 已提交
245 246


247
static const struct usb_device_id id_table_combined[] = {
L
Linus Torvalds 已提交
248 249 250 251 252
	{ USB_DEVICE(DIGI_VENDOR_ID, DIGI_2_ID) },
	{ USB_DEVICE(DIGI_VENDOR_ID, DIGI_4_ID) },
	{ }						/* Terminating entry */
};

253
static const struct usb_device_id id_table_2[] = {
L
Linus Torvalds 已提交
254 255 256 257
	{ USB_DEVICE(DIGI_VENDOR_ID, DIGI_2_ID) },
	{ }						/* Terminating entry */
};

258
static const struct usb_device_id id_table_4[] = {
L
Linus Torvalds 已提交
259 260 261 262
	{ USB_DEVICE(DIGI_VENDOR_ID, DIGI_4_ID) },
	{ }						/* Terminating entry */
};

A
Alan Cox 已提交
263
MODULE_DEVICE_TABLE(usb, id_table_combined);
L
Linus Torvalds 已提交
264 265 266

/* device info needed for the Digi serial converter */

267
static struct usb_serial_driver digi_acceleport_2_device = {
268
	.driver = {
269 270
		.owner =		THIS_MODULE,
		.name =			"digi_2",
271
	},
272
	.description =			"Digi 2 port USB adapter",
L
Linus Torvalds 已提交
273 274 275 276
	.id_table =			id_table_2,
	.num_ports =			3,
	.open =				digi_open,
	.close =			digi_close,
277
	.dtr_rts =			digi_dtr_rts,
L
Linus Torvalds 已提交
278 279 280 281 282 283 284 285 286 287 288 289
	.write =			digi_write,
	.write_room =			digi_write_room,
	.write_bulk_callback = 		digi_write_bulk_callback,
	.read_bulk_callback =		digi_read_bulk_callback,
	.chars_in_buffer =		digi_chars_in_buffer,
	.throttle =			digi_rx_throttle,
	.unthrottle =			digi_rx_unthrottle,
	.set_termios =			digi_set_termios,
	.break_ctl =			digi_break_ctl,
	.tiocmget =			digi_tiocmget,
	.tiocmset =			digi_tiocmset,
	.attach =			digi_startup,
290 291
	.disconnect =			digi_disconnect,
	.release =			digi_release,
292 293
	.port_probe =			digi_port_probe,
	.port_remove =			digi_port_remove,
L
Linus Torvalds 已提交
294 295
};

296
static struct usb_serial_driver digi_acceleport_4_device = {
297
	.driver = {
298 299
		.owner =		THIS_MODULE,
		.name =			"digi_4",
300
	},
301
	.description =			"Digi 4 port USB adapter",
L
Linus Torvalds 已提交
302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317
	.id_table =			id_table_4,
	.num_ports =			4,
	.open =				digi_open,
	.close =			digi_close,
	.write =			digi_write,
	.write_room =			digi_write_room,
	.write_bulk_callback = 		digi_write_bulk_callback,
	.read_bulk_callback =		digi_read_bulk_callback,
	.chars_in_buffer =		digi_chars_in_buffer,
	.throttle =			digi_rx_throttle,
	.unthrottle =			digi_rx_unthrottle,
	.set_termios =			digi_set_termios,
	.break_ctl =			digi_break_ctl,
	.tiocmget =			digi_tiocmget,
	.tiocmset =			digi_tiocmset,
	.attach =			digi_startup,
318 319
	.disconnect =			digi_disconnect,
	.release =			digi_release,
320 321
	.port_probe =			digi_port_probe,
	.port_remove =			digi_port_remove,
L
Linus Torvalds 已提交
322 323
};

324 325 326
static struct usb_serial_driver * const serial_drivers[] = {
	&digi_acceleport_2_device, &digi_acceleport_4_device, NULL
};
L
Linus Torvalds 已提交
327 328 329 330

/* Functions */

/*
A
Alan Cox 已提交
331 332 333 334 335 336 337 338 339 340 341
 *  Cond Wait Interruptible Timeout Irqrestore
 *
 *  Do spin_unlock_irqrestore and interruptible_sleep_on_timeout
 *  so that wake ups are not lost if they occur between the unlock
 *  and the sleep.  In other words, spin_unlock_irqrestore and
 *  interruptible_sleep_on_timeout are "atomic" with respect to
 *  wake ups.  This is used to implement condition variables.
 *
 *  interruptible_sleep_on_timeout is deprecated and has been replaced
 *  with the equivalent code.
 */
L
Linus Torvalds 已提交
342

343
static long cond_wait_interruptible_timeout_irqrestore(
L
Linus Torvalds 已提交
344
	wait_queue_head_t *q, long timeout,
345
	spinlock_t *lock, unsigned long flags)
346
__releases(lock)
L
Linus Torvalds 已提交
347 348 349
{
	DEFINE_WAIT(wait);

350
	prepare_to_wait(q, &wait, TASK_INTERRUPTIBLE);
L
Linus Torvalds 已提交
351 352 353 354 355 356 357 358 359
	spin_unlock_irqrestore(lock, flags);
	timeout = schedule_timeout(timeout);
	finish_wait(q, &wait);

	return timeout;
}


/*
A
Alan Cox 已提交
360 361 362 363 364
 *  Digi Wakeup Write
 *
 *  Wake up port, line discipline, and tty processes sleeping
 *  on writes.
 */
L
Linus Torvalds 已提交
365

D
David Howells 已提交
366
static void digi_wakeup_write_lock(struct work_struct *work)
L
Linus Torvalds 已提交
367
{
A
Alan Cox 已提交
368 369
	struct digi_port *priv =
			container_of(work, struct digi_port, dp_wakeup_work);
D
David Howells 已提交
370
	struct usb_serial_port *port = priv->dp_port;
L
Linus Torvalds 已提交
371 372
	unsigned long flags;

373
	spin_lock_irqsave(&priv->dp_port_lock, flags);
J
Jiri Slaby 已提交
374
	tty_port_tty_wakeup(&port->port);
375
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
376 377 378
}

/*
A
Alan Cox 已提交
379 380 381 382 383 384 385 386 387
 *  Digi Write OOB Command
 *
 *  Write commands on the out of band port.  Commands are 4
 *  bytes each, multiple commands can be sent at once, and
 *  no command will be split across USB packets.  Returns 0
 *  if successful, -EINTR if interrupted while sleeping and
 *  the interruptible flag is true, or a negative error
 *  returned by usb_submit_urb.
 */
L
Linus Torvalds 已提交
388

389 390
static int digi_write_oob_command(struct usb_serial_port *port,
	unsigned char *buf, int count, int interruptible)
L
Linus Torvalds 已提交
391 392 393 394 395 396 397
{
	int ret = 0;
	int len;
	struct usb_serial_port *oob_port = (struct usb_serial_port *)((struct digi_serial *)(usb_get_serial_data(port->serial)))->ds_oob_port;
	struct digi_port *oob_priv = usb_get_serial_port_data(oob_port);
	unsigned long flags = 0;

398 399 400
	dev_dbg(&port->dev,
		"digi_write_oob_command: TOP: port=%d, count=%d\n",
		oob_priv->dp_port_num, count);
L
Linus Torvalds 已提交
401

402
	spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
A
Alan Cox 已提交
403
	while (count > 0) {
404
		while (oob_priv->dp_write_urb_in_use) {
L
Linus Torvalds 已提交
405 406
			cond_wait_interruptible_timeout_irqrestore(
				&oob_port->write_wait, DIGI_RETRY_TIMEOUT,
407 408 409 410
				&oob_priv->dp_port_lock, flags);
			if (interruptible && signal_pending(current))
				return -EINTR;
			spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
411 412 413
		}

		/* len must be a multiple of 4, so commands are not split */
414 415
		len = min(count, oob_port->bulk_out_size);
		if (len > 4)
L
Linus Torvalds 已提交
416
			len &= ~3;
417
		memcpy(oob_port->write_urb->transfer_buffer, buf, len);
L
Linus Torvalds 已提交
418
		oob_port->write_urb->transfer_buffer_length = len;
A
Alan Cox 已提交
419 420
		ret = usb_submit_urb(oob_port->write_urb, GFP_ATOMIC);
		if (ret == 0) {
L
Linus Torvalds 已提交
421 422 423 424 425
			oob_priv->dp_write_urb_in_use = 1;
			count -= len;
			buf += len;
		}
	}
426 427
	spin_unlock_irqrestore(&oob_priv->dp_port_lock, flags);
	if (ret)
428 429
		dev_err(&port->dev, "%s: usb_submit_urb failed, ret=%d\n",
			__func__, ret);
430
	return ret;
L
Linus Torvalds 已提交
431 432 433 434 435

}


/*
A
Alan Cox 已提交
436 437 438 439 440 441 442 443 444 445
 *  Digi Write In Band Command
 *
 *  Write commands on the given port.  Commands are 4
 *  bytes each, multiple commands can be sent at once, and
 *  no command will be split across USB packets.  If timeout
 *  is non-zero, write in band command will return after
 *  waiting unsuccessfully for the URB status to clear for
 *  timeout ticks.  Returns 0 if successful, or a negative
 *  error returned by digi_write.
 */
L
Linus Torvalds 已提交
446

447 448
static int digi_write_inb_command(struct usb_serial_port *port,
	unsigned char *buf, int count, unsigned long timeout)
L
Linus Torvalds 已提交
449 450 451 452 453 454 455
{
	int ret = 0;
	int len;
	struct digi_port *priv = usb_get_serial_port_data(port);
	unsigned char *data = port->write_urb->transfer_buffer;
	unsigned long flags = 0;

456
	dev_dbg(&port->dev, "digi_write_inb_command: TOP: port=%d, count=%d\n",
457
		priv->dp_port_num, count);
L
Linus Torvalds 已提交
458

459
	if (timeout)
L
Linus Torvalds 已提交
460 461 462 463
		timeout += jiffies;
	else
		timeout = ULONG_MAX;

464
	spin_lock_irqsave(&priv->dp_port_lock, flags);
A
Alan Cox 已提交
465
	while (count > 0 && ret == 0) {
466 467
		while (priv->dp_write_urb_in_use &&
		       time_before(jiffies, timeout)) {
L
Linus Torvalds 已提交
468 469
			cond_wait_interruptible_timeout_irqrestore(
				&port->write_wait, DIGI_RETRY_TIMEOUT,
470 471 472 473
				&priv->dp_port_lock, flags);
			if (signal_pending(current))
				return -EINTR;
			spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
474 475 476 477 478
		}

		/* len must be a multiple of 4 and small enough to */
		/* guarantee the write will send buffered data first, */
		/* so commands are in order with data and not split */
479 480
		len = min(count, port->bulk_out_size-2-priv->dp_out_buf_len);
		if (len > 4)
L
Linus Torvalds 已提交
481 482 483
			len &= ~3;

		/* write any buffered data first */
484
		if (priv->dp_out_buf_len > 0) {
L
Linus Torvalds 已提交
485 486
			data[0] = DIGI_CMD_SEND_DATA;
			data[1] = priv->dp_out_buf_len;
487 488 489
			memcpy(data + 2, priv->dp_out_buf,
				priv->dp_out_buf_len);
			memcpy(data + 2 + priv->dp_out_buf_len, buf, len);
L
Linus Torvalds 已提交
490
			port->write_urb->transfer_buffer_length
491
				= priv->dp_out_buf_len + 2 + len;
L
Linus Torvalds 已提交
492
		} else {
493
			memcpy(data, buf, len);
L
Linus Torvalds 已提交
494 495 496
			port->write_urb->transfer_buffer_length = len;
		}

A
Alan Cox 已提交
497 498
		ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
		if (ret == 0) {
L
Linus Torvalds 已提交
499 500 501 502 503 504 505
			priv->dp_write_urb_in_use = 1;
			priv->dp_out_buf_len = 0;
			count -= len;
			buf += len;
		}

	}
506
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
507

508
	if (ret)
509 510
		dev_err(&port->dev,
			"%s: usb_submit_urb failed, ret=%d, port=%d\n",
511
			__func__, ret, priv->dp_port_num);
512
	return ret;
L
Linus Torvalds 已提交
513 514 515 516
}


/*
A
Alan Cox 已提交
517 518 519 520 521 522 523 524
 *  Digi Set Modem Signals
 *
 *  Sets or clears DTR and RTS on the port, according to the
 *  modem_signals argument.  Use TIOCM_DTR and TIOCM_RTS flags
 *  for the modem_signals argument.  Returns 0 if successful,
 *  -EINTR if interrupted while sleeping, or a non-zero error
 *  returned by usb_submit_urb.
 */
L
Linus Torvalds 已提交
525

526 527
static int digi_set_modem_signals(struct usb_serial_port *port,
	unsigned int modem_signals, int interruptible)
L
Linus Torvalds 已提交
528 529 530 531
{

	int ret;
	struct digi_port *port_priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
532
	struct usb_serial_port *oob_port = (struct usb_serial_port *) ((struct digi_serial *)(usb_get_serial_data(port->serial)))->ds_oob_port;
L
Linus Torvalds 已提交
533 534 535 536 537
	struct digi_port *oob_priv = usb_get_serial_port_data(oob_port);
	unsigned char *data = oob_port->write_urb->transfer_buffer;
	unsigned long flags = 0;


538 539
	dev_dbg(&port->dev,
		"digi_set_modem_signals: TOP: port=%d, modem_signals=0x%x\n",
540
		port_priv->dp_port_num, modem_signals);
L
Linus Torvalds 已提交
541

542 543
	spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
	spin_lock(&port_priv->dp_port_lock);
L
Linus Torvalds 已提交
544

545
	while (oob_priv->dp_write_urb_in_use) {
546
		spin_unlock(&port_priv->dp_port_lock);
L
Linus Torvalds 已提交
547 548
		cond_wait_interruptible_timeout_irqrestore(
			&oob_port->write_wait, DIGI_RETRY_TIMEOUT,
549 550 551 552 553
			&oob_priv->dp_port_lock, flags);
		if (interruptible && signal_pending(current))
			return -EINTR;
		spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
		spin_lock(&port_priv->dp_port_lock);
L
Linus Torvalds 已提交
554 555 556
	}
	data[0] = DIGI_CMD_SET_DTR_SIGNAL;
	data[1] = port_priv->dp_port_num;
A
Alan Cox 已提交
557 558
	data[2] = (modem_signals & TIOCM_DTR) ?
					DIGI_DTR_ACTIVE : DIGI_DTR_INACTIVE;
L
Linus Torvalds 已提交
559 560 561
	data[3] = 0;
	data[4] = DIGI_CMD_SET_RTS_SIGNAL;
	data[5] = port_priv->dp_port_num;
A
Alan Cox 已提交
562 563
	data[6] = (modem_signals & TIOCM_RTS) ?
					DIGI_RTS_ACTIVE : DIGI_RTS_INACTIVE;
L
Linus Torvalds 已提交
564 565 566 567
	data[7] = 0;

	oob_port->write_urb->transfer_buffer_length = 8;

A
Alan Cox 已提交
568 569
	ret = usb_submit_urb(oob_port->write_urb, GFP_ATOMIC);
	if (ret == 0) {
L
Linus Torvalds 已提交
570 571 572 573 574
		oob_priv->dp_write_urb_in_use = 1;
		port_priv->dp_modem_signals =
			(port_priv->dp_modem_signals&~(TIOCM_DTR|TIOCM_RTS))
			| (modem_signals&(TIOCM_DTR|TIOCM_RTS));
	}
575 576 577
	spin_unlock(&port_priv->dp_port_lock);
	spin_unlock_irqrestore(&oob_priv->dp_port_lock, flags);
	if (ret)
578 579
		dev_err(&port->dev, "%s: usb_submit_urb failed, ret=%d\n",
			__func__, ret);
580
	return ret;
L
Linus Torvalds 已提交
581 582 583
}

/*
A
Alan Cox 已提交
584 585 586 587 588 589 590 591 592 593
 *  Digi Transmit Idle
 *
 *  Digi transmit idle waits, up to timeout ticks, for the transmitter
 *  to go idle.  It returns 0 if successful or a negative error.
 *
 *  There are race conditions here if more than one process is calling
 *  digi_transmit_idle on the same port at the same time.  However, this
 *  is only called from close, and only one process can be in close on a
 *  port at a time, so its ok.
 */
L
Linus Torvalds 已提交
594

595 596
static int digi_transmit_idle(struct usb_serial_port *port,
	unsigned long timeout)
L
Linus Torvalds 已提交
597 598 599 600 601 602
{
	int ret;
	unsigned char buf[2];
	struct digi_port *priv = usb_get_serial_port_data(port);
	unsigned long flags = 0;

603
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
604
	priv->dp_transmit_idle = 0;
605
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
606 607 608 609 610 611

	buf[0] = DIGI_CMD_TRANSMIT_IDLE;
	buf[1] = 0;

	timeout += jiffies;

A
Alan Cox 已提交
612 613
	ret = digi_write_inb_command(port, buf, 2, timeout - jiffies);
	if (ret != 0)
614
		return ret;
L
Linus Torvalds 已提交
615

616
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
617

A
Alan Cox 已提交
618
	while (time_before(jiffies, timeout) && !priv->dp_transmit_idle) {
L
Linus Torvalds 已提交
619 620
		cond_wait_interruptible_timeout_irqrestore(
			&priv->dp_transmit_idle_wait, DIGI_RETRY_TIMEOUT,
621 622 623 624
			&priv->dp_port_lock, flags);
		if (signal_pending(current))
			return -EINTR;
		spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
625 626
	}
	priv->dp_transmit_idle = 0;
627 628
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
	return 0;
L
Linus Torvalds 已提交
629 630 631 632

}


A
Alan Cox 已提交
633
static void digi_rx_throttle(struct tty_struct *tty)
L
Linus Torvalds 已提交
634 635
{
	unsigned long flags;
A
Alan Cox 已提交
636
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
637 638 639
	struct digi_port *priv = usb_get_serial_port_data(port);

	/* stop receiving characters by not resubmitting the read urb */
640
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
641 642
	priv->dp_throttled = 1;
	priv->dp_throttle_restart = 0;
643
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
644 645 646
}


A
Alan Cox 已提交
647
static void digi_rx_unthrottle(struct tty_struct *tty)
L
Linus Torvalds 已提交
648 649 650
{
	int ret = 0;
	unsigned long flags;
A
Alan Cox 已提交
651
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
652 653
	struct digi_port *priv = usb_get_serial_port_data(port);

654
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
655 656

	/* restart read chain */
657
	if (priv->dp_throttle_restart)
658
		ret = usb_submit_urb(port->read_urb, GFP_ATOMIC);
L
Linus Torvalds 已提交
659

660 661 662 663
	/* turn throttle off */
	priv->dp_throttled = 0;
	priv->dp_throttle_restart = 0;

664
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
665

666
	if (ret)
667 668
		dev_err(&port->dev,
			"%s: usb_submit_urb failed, ret=%d, port=%d\n",
669
			__func__, ret, priv->dp_port_num);
L
Linus Torvalds 已提交
670 671 672
}


A
Alan Cox 已提交
673
static void digi_set_termios(struct tty_struct *tty,
A
Alan Cox 已提交
674
		struct usb_serial_port *port, struct ktermios *old_termios)
L
Linus Torvalds 已提交
675 676
{
	struct digi_port *priv = usb_get_serial_port_data(port);
677
	struct device *dev = &port->dev;
678 679
	unsigned int iflag = tty->termios.c_iflag;
	unsigned int cflag = tty->termios.c_cflag;
L
Linus Torvalds 已提交
680 681 682 683
	unsigned int old_iflag = old_termios->c_iflag;
	unsigned int old_cflag = old_termios->c_cflag;
	unsigned char buf[32];
	unsigned int modem_signals;
A
Alan Cox 已提交
684
	int arg, ret;
L
Linus Torvalds 已提交
685
	int i = 0;
686
	speed_t baud;
L
Linus Torvalds 已提交
687

688 689 690
	dev_dbg(dev,
		"digi_set_termios: TOP: port=%d, iflag=0x%x, old_iflag=0x%x, cflag=0x%x, old_cflag=0x%x\n",
		priv->dp_port_num, iflag, old_iflag, cflag, old_cflag);
L
Linus Torvalds 已提交
691 692

	/* set baud rate */
A
Alan Cox 已提交
693 694
	baud = tty_get_baud_rate(tty);
	if (baud != tty_termios_baud_rate(old_termios)) {
L
Linus Torvalds 已提交
695 696 697
		arg = -1;

		/* reassert DTR and (maybe) RTS on transition from B0 */
P
Peter Hurley 已提交
698
		if ((old_cflag & CBAUD) == B0) {
L
Linus Torvalds 已提交
699 700 701
			/* don't set RTS if using hardware flow control */
			/* and throttling input */
			modem_signals = TIOCM_DTR;
702
			if (!C_CRTSCTS(tty) || !tty_throttled(tty))
L
Linus Torvalds 已提交
703
				modem_signals |= TIOCM_RTS;
704
			digi_set_modem_signals(port, modem_signals, 1);
L
Linus Torvalds 已提交
705
		}
706
		switch (baud) {
A
Alan Cox 已提交
707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730
		/* drop DTR and RTS on transition to B0 */
		case 0: digi_set_modem_signals(port, 0, 1); break;
		case 50: arg = DIGI_BAUD_50; break;
		case 75: arg = DIGI_BAUD_75; break;
		case 110: arg = DIGI_BAUD_110; break;
		case 150: arg = DIGI_BAUD_150; break;
		case 200: arg = DIGI_BAUD_200; break;
		case 300: arg = DIGI_BAUD_300; break;
		case 600: arg = DIGI_BAUD_600; break;
		case 1200: arg = DIGI_BAUD_1200; break;
		case 1800: arg = DIGI_BAUD_1800; break;
		case 2400: arg = DIGI_BAUD_2400; break;
		case 4800: arg = DIGI_BAUD_4800; break;
		case 9600: arg = DIGI_BAUD_9600; break;
		case 19200: arg = DIGI_BAUD_19200; break;
		case 38400: arg = DIGI_BAUD_38400; break;
		case 57600: arg = DIGI_BAUD_57600; break;
		case 115200: arg = DIGI_BAUD_115200; break;
		case 230400: arg = DIGI_BAUD_230400; break;
		case 460800: arg = DIGI_BAUD_460800; break;
		default:
			arg = DIGI_BAUD_9600;
			baud = 9600;
			break;
L
Linus Torvalds 已提交
731
		}
732
		if (arg != -1) {
L
Linus Torvalds 已提交
733 734 735 736 737 738 739
			buf[i++] = DIGI_CMD_SET_BAUD_RATE;
			buf[i++] = priv->dp_port_num;
			buf[i++] = arg;
			buf[i++] = 0;
		}
	}
	/* set parity */
740
	tty->termios.c_cflag &= ~CMSPAR;
741

742 743 744
	if ((cflag&(PARENB|PARODD)) != (old_cflag&(PARENB|PARODD))) {
		if (cflag&PARENB) {
			if (cflag&PARODD)
L
Linus Torvalds 已提交
745 746 747 748 749 750 751 752 753 754 755 756
				arg = DIGI_PARITY_ODD;
			else
				arg = DIGI_PARITY_EVEN;
		} else {
			arg = DIGI_PARITY_NONE;
		}
		buf[i++] = DIGI_CMD_SET_PARITY;
		buf[i++] = priv->dp_port_num;
		buf[i++] = arg;
		buf[i++] = 0;
	}
	/* set word size */
757
	if ((cflag&CSIZE) != (old_cflag&CSIZE)) {
L
Linus Torvalds 已提交
758
		arg = -1;
759
		switch (cflag&CSIZE) {
L
Linus Torvalds 已提交
760 761 762 763 764
		case CS5: arg = DIGI_WORD_SIZE_5; break;
		case CS6: arg = DIGI_WORD_SIZE_6; break;
		case CS7: arg = DIGI_WORD_SIZE_7; break;
		case CS8: arg = DIGI_WORD_SIZE_8; break;
		default:
765 766
			dev_dbg(dev,
				"digi_set_termios: can't handle word size %d\n",
767
				(cflag&CSIZE));
L
Linus Torvalds 已提交
768 769 770
			break;
		}

771
		if (arg != -1) {
L
Linus Torvalds 已提交
772 773 774 775 776 777 778 779 780
			buf[i++] = DIGI_CMD_SET_WORD_SIZE;
			buf[i++] = priv->dp_port_num;
			buf[i++] = arg;
			buf[i++] = 0;
		}

	}

	/* set stop bits */
781
	if ((cflag&CSTOPB) != (old_cflag&CSTOPB)) {
L
Linus Torvalds 已提交
782

783
		if ((cflag&CSTOPB))
L
Linus Torvalds 已提交
784 785 786 787 788 789 790 791 792 793 794 795
			arg = DIGI_STOP_BITS_2;
		else
			arg = DIGI_STOP_BITS_1;

		buf[i++] = DIGI_CMD_SET_STOP_BITS;
		buf[i++] = priv->dp_port_num;
		buf[i++] = arg;
		buf[i++] = 0;

	}

	/* set input flow control */
796 797
	if ((iflag&IXOFF) != (old_iflag&IXOFF)
	    || (cflag&CRTSCTS) != (old_cflag&CRTSCTS)) {
L
Linus Torvalds 已提交
798
		arg = 0;
799
		if (iflag&IXOFF)
L
Linus Torvalds 已提交
800 801 802 803
			arg |= DIGI_INPUT_FLOW_CONTROL_XON_XOFF;
		else
			arg &= ~DIGI_INPUT_FLOW_CONTROL_XON_XOFF;

804
		if (cflag&CRTSCTS) {
L
Linus Torvalds 已提交
805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823
			arg |= DIGI_INPUT_FLOW_CONTROL_RTS;

			/* On USB-4 it is necessary to assert RTS prior */
			/* to selecting RTS input flow control.  */
			buf[i++] = DIGI_CMD_SET_RTS_SIGNAL;
			buf[i++] = priv->dp_port_num;
			buf[i++] = DIGI_RTS_ACTIVE;
			buf[i++] = 0;

		} else {
			arg &= ~DIGI_INPUT_FLOW_CONTROL_RTS;
		}
		buf[i++] = DIGI_CMD_SET_INPUT_FLOW_CONTROL;
		buf[i++] = priv->dp_port_num;
		buf[i++] = arg;
		buf[i++] = 0;
	}

	/* set output flow control */
824 825
	if ((iflag & IXON) != (old_iflag & IXON)
	    || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) {
L
Linus Torvalds 已提交
826
		arg = 0;
827
		if (iflag & IXON)
L
Linus Torvalds 已提交
828 829 830 831
			arg |= DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF;
		else
			arg &= ~DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF;

832
		if (cflag & CRTSCTS) {
L
Linus Torvalds 已提交
833 834 835 836 837 838 839 840 841 842 843 844
			arg |= DIGI_OUTPUT_FLOW_CONTROL_CTS;
		} else {
			arg &= ~DIGI_OUTPUT_FLOW_CONTROL_CTS;
		}

		buf[i++] = DIGI_CMD_SET_OUTPUT_FLOW_CONTROL;
		buf[i++] = priv->dp_port_num;
		buf[i++] = arg;
		buf[i++] = 0;
	}

	/* set receive enable/disable */
845 846
	if ((cflag & CREAD) != (old_cflag & CREAD)) {
		if (cflag & CREAD)
L
Linus Torvalds 已提交
847 848 849 850 851 852 853 854 855
			arg = DIGI_ENABLE;
		else
			arg = DIGI_DISABLE;

		buf[i++] = DIGI_CMD_RECEIVE_ENABLE;
		buf[i++] = priv->dp_port_num;
		buf[i++] = arg;
		buf[i++] = 0;
	}
A
Alan Cox 已提交
856 857
	ret = digi_write_oob_command(port, buf, i, 1);
	if (ret != 0)
858
		dev_dbg(dev, "digi_set_termios: write oob failed, ret=%d\n", ret);
859
	tty_encode_baud_rate(tty, baud, baud);
L
Linus Torvalds 已提交
860 861 862
}


A
Alan Cox 已提交
863
static void digi_break_ctl(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
864
{
A
Alan Cox 已提交
865
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
866 867 868 869 870 871
	unsigned char buf[4];

	buf[0] = DIGI_CMD_BREAK_CONTROL;
	buf[1] = 2;				/* length */
	buf[2] = break_state ? 1 : 0;
	buf[3] = 0;				/* pad */
872
	digi_write_inb_command(port, buf, 4, 0);
L
Linus Torvalds 已提交
873 874 875
}


876
static int digi_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
877
{
A
Alan Cox 已提交
878
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
879 880 881 882
	struct digi_port *priv = usb_get_serial_port_data(port);
	unsigned int val;
	unsigned long flags;

883
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
884
	val = priv->dp_modem_signals;
885
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
886 887 888 889
	return val;
}


890 891
static int digi_tiocmset(struct tty_struct *tty,
					unsigned int set, unsigned int clear)
L
Linus Torvalds 已提交
892
{
A
Alan Cox 已提交
893
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
894 895 896 897
	struct digi_port *priv = usb_get_serial_port_data(port);
	unsigned int val;
	unsigned long flags;

898
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
899
	val = (priv->dp_modem_signals & ~clear) | set;
900 901
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
	return digi_set_modem_signals(port, val, 1);
L
Linus Torvalds 已提交
902 903 904
}


A
Alan Cox 已提交
905 906
static int digi_write(struct tty_struct *tty, struct usb_serial_port *port,
					const unsigned char *buf, int count)
L
Linus Torvalds 已提交
907 908
{

A
Alan Cox 已提交
909
	int ret, data_len, new_len;
L
Linus Torvalds 已提交
910 911 912 913
	struct digi_port *priv = usb_get_serial_port_data(port);
	unsigned char *data = port->write_urb->transfer_buffer;
	unsigned long flags = 0;

914 915
	dev_dbg(&port->dev,
		"digi_write: TOP: port=%d, count=%d, in_interrupt=%ld\n",
916
		priv->dp_port_num, count, in_interrupt());
L
Linus Torvalds 已提交
917 918

	/* copy user data (which can sleep) before getting spin lock */
919 920
	count = min(count, port->bulk_out_size-2);
	count = min(64, count);
L
Linus Torvalds 已提交
921 922 923

	/* be sure only one write proceeds at a time */
	/* there are races on the port private buffer */
924
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
925 926

	/* wait for urb status clear to submit another urb */
927
	if (priv->dp_write_urb_in_use) {
L
Linus Torvalds 已提交
928
		/* buffer data if count is 1 (probably put_char) if possible */
929
		if (count == 1 && priv->dp_out_buf_len < DIGI_OUT_BUF_SIZE) {
L
Linus Torvalds 已提交
930 931 932 933 934
			priv->dp_out_buf[priv->dp_out_buf_len++] = *buf;
			new_len = 1;
		} else {
			new_len = 0;
		}
935 936
		spin_unlock_irqrestore(&priv->dp_port_lock, flags);
		return new_len;
L
Linus Torvalds 已提交
937 938 939 940 941 942 943
	}

	/* allow space for any buffered data and for new data, up to */
	/* transfer buffer size - 2 (for command and length bytes) */
	new_len = min(count, port->bulk_out_size-2-priv->dp_out_buf_len);
	data_len = new_len + priv->dp_out_buf_len;

944 945 946
	if (data_len == 0) {
		spin_unlock_irqrestore(&priv->dp_port_lock, flags);
		return 0;
L
Linus Torvalds 已提交
947 948 949 950 951 952 953 954
	}

	port->write_urb->transfer_buffer_length = data_len+2;

	*data++ = DIGI_CMD_SEND_DATA;
	*data++ = data_len;

	/* copy in buffered data first */
955
	memcpy(data, priv->dp_out_buf, priv->dp_out_buf_len);
L
Linus Torvalds 已提交
956 957 958
	data += priv->dp_out_buf_len;

	/* copy in new data */
959
	memcpy(data, buf, new_len);
L
Linus Torvalds 已提交
960

A
Alan Cox 已提交
961 962
	ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
	if (ret == 0) {
L
Linus Torvalds 已提交
963 964 965 966 967 968
		priv->dp_write_urb_in_use = 1;
		ret = new_len;
		priv->dp_out_buf_len = 0;
	}

	/* return length of new data written, or error */
969 970
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
	if (ret < 0)
971
		dev_err_console(port,
972
			"%s: usb_submit_urb failed, ret=%d, port=%d\n",
973
			__func__, ret, priv->dp_port_num);
974
	dev_dbg(&port->dev, "digi_write: returning %d\n", ret);
975
	return ret;
L
Linus Torvalds 已提交
976

A
Alan Cox 已提交
977
}
L
Linus Torvalds 已提交
978

979
static void digi_write_bulk_callback(struct urb *urb)
L
Linus Torvalds 已提交
980 981
{

982
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
983 984 985 986
	struct usb_serial *serial;
	struct digi_port *priv;
	struct digi_serial *serial_priv;
	int ret = 0;
987
	int status = urb->status;
L
Linus Torvalds 已提交
988 989

	/* port and serial sanity check */
A
Alan Cox 已提交
990
	if (port == NULL || (priv = usb_get_serial_port_data(port)) == NULL) {
991
		pr_err("%s: port or port->private is NULL, status=%d\n",
992
			__func__, status);
L
Linus Torvalds 已提交
993 994 995
		return;
	}
	serial = port->serial;
A
Alan Cox 已提交
996
	if (serial == NULL || (serial_priv = usb_get_serial_data(serial)) == NULL) {
997 998 999
		dev_err(&port->dev,
			"%s: serial or serial->private is NULL, status=%d\n",
			__func__, status);
L
Linus Torvalds 已提交
1000 1001 1002 1003
		return;
	}

	/* handle oob callback */
1004
	if (priv->dp_port_num == serial_priv->ds_oob_port_num) {
1005
		dev_dbg(&port->dev, "digi_write_bulk_callback: oob callback\n");
1006
		spin_lock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1007
		priv->dp_write_urb_in_use = 0;
1008 1009
		wake_up_interruptible(&port->write_wait);
		spin_unlock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1010 1011 1012
		return;
	}

1013
	/* try to send any buffered data on this port */
1014
	spin_lock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1015
	priv->dp_write_urb_in_use = 0;
1016
	if (priv->dp_out_buf_len > 0) {
L
Linus Torvalds 已提交
1017 1018
		*((unsigned char *)(port->write_urb->transfer_buffer))
			= (unsigned char)DIGI_CMD_SEND_DATA;
A
Alan Cox 已提交
1019
		*((unsigned char *)(port->write_urb->transfer_buffer) + 1)
L
Linus Torvalds 已提交
1020
			= (unsigned char)priv->dp_out_buf_len;
A
Alan Cox 已提交
1021 1022 1023
		port->write_urb->transfer_buffer_length =
						priv->dp_out_buf_len + 2;
		memcpy(port->write_urb->transfer_buffer + 2, priv->dp_out_buf,
1024
			priv->dp_out_buf_len);
A
Alan Cox 已提交
1025 1026
		ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
		if (ret == 0) {
L
Linus Torvalds 已提交
1027 1028 1029 1030 1031
			priv->dp_write_urb_in_use = 1;
			priv->dp_out_buf_len = 0;
		}
	}
	/* wake up processes sleeping on writes immediately */
J
Jiri Slaby 已提交
1032
	tty_port_tty_wakeup(&port->port);
L
Linus Torvalds 已提交
1033 1034 1035 1036
	/* also queue up a wakeup at scheduler time, in case we */
	/* lost the race in write_chan(). */
	schedule_work(&priv->dp_wakeup_work);

1037
	spin_unlock(&priv->dp_port_lock);
1038
	if (ret && ret != -EPERM)
1039
		dev_err_console(port,
1040
			"%s: usb_submit_urb failed, ret=%d, port=%d\n",
1041
			__func__, ret, priv->dp_port_num);
L
Linus Torvalds 已提交
1042 1043
}

A
Alan Cox 已提交
1044
static int digi_write_room(struct tty_struct *tty)
L
Linus Torvalds 已提交
1045
{
A
Alan Cox 已提交
1046
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
1047
	struct digi_port *priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
1048
	int room;
L
Linus Torvalds 已提交
1049 1050
	unsigned long flags = 0;

1051
	spin_lock_irqsave(&priv->dp_port_lock, flags);
L
Linus Torvalds 已提交
1052

1053
	if (priv->dp_write_urb_in_use)
L
Linus Torvalds 已提交
1054 1055 1056 1057
		room = 0;
	else
		room = port->bulk_out_size - 2 - priv->dp_out_buf_len;

1058
	spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1059
	dev_dbg(&port->dev, "digi_write_room: port=%d, room=%d\n", priv->dp_port_num, room);
1060
	return room;
L
Linus Torvalds 已提交
1061 1062 1063

}

A
Alan Cox 已提交
1064
static int digi_chars_in_buffer(struct tty_struct *tty)
L
Linus Torvalds 已提交
1065
{
A
Alan Cox 已提交
1066
	struct usb_serial_port *port = tty->driver_data;
L
Linus Torvalds 已提交
1067 1068
	struct digi_port *priv = usb_get_serial_port_data(port);

1069
	if (priv->dp_write_urb_in_use) {
1070
		dev_dbg(&port->dev, "digi_chars_in_buffer: port=%d, chars=%d\n",
1071 1072 1073
			priv->dp_port_num, port->bulk_out_size - 2);
		/* return(port->bulk_out_size - 2); */
		return 256;
L
Linus Torvalds 已提交
1074
	} else {
1075
		dev_dbg(&port->dev, "digi_chars_in_buffer: port=%d, chars=%d\n",
1076 1077
			priv->dp_port_num, priv->dp_out_buf_len);
		return priv->dp_out_buf_len;
L
Linus Torvalds 已提交
1078 1079 1080 1081
	}

}

1082 1083 1084 1085 1086 1087
static void digi_dtr_rts(struct usb_serial_port *port, int on)
{
	/* Adjust DTR and RTS */
	digi_set_modem_signals(port, on * (TIOCM_DTR|TIOCM_RTS), 1);
}

1088
static int digi_open(struct tty_struct *tty, struct usb_serial_port *port)
L
Linus Torvalds 已提交
1089 1090 1091 1092
{
	int ret;
	unsigned char buf[32];
	struct digi_port *priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
1093
	struct ktermios not_termios;
L
Linus Torvalds 已提交
1094 1095

	/* be sure the device is started up */
1096 1097
	if (digi_startup_device(port->serial) != 0)
		return -ENXIO;
L
Linus Torvalds 已提交
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110

	/* read modem signals automatically whenever they change */
	buf[0] = DIGI_CMD_READ_INPUT_SIGNALS;
	buf[1] = priv->dp_port_num;
	buf[2] = DIGI_ENABLE;
	buf[3] = 0;

	/* flush fifos */
	buf[4] = DIGI_CMD_IFLUSH_FIFO;
	buf[5] = priv->dp_port_num;
	buf[6] = DIGI_FLUSH_TX | DIGI_FLUSH_RX;
	buf[7] = 0;

A
Alan Cox 已提交
1111 1112
	ret = digi_write_oob_command(port, buf, 8, 1);
	if (ret != 0)
1113
		dev_dbg(&port->dev, "digi_open: write oob failed, ret=%d\n", ret);
L
Linus Torvalds 已提交
1114 1115

	/* set termios settings */
A
Alan Cox 已提交
1116
	if (tty) {
1117 1118
		not_termios.c_cflag = ~tty->termios.c_cflag;
		not_termios.c_iflag = ~tty->termios.c_iflag;
A
Alan Cox 已提交
1119 1120
		digi_set_termios(tty, port, &not_termios);
	}
1121
	return 0;
L
Linus Torvalds 已提交
1122 1123 1124
}


1125
static void digi_close(struct usb_serial_port *port)
L
Linus Torvalds 已提交
1126 1127 1128 1129 1130 1131
{
	DEFINE_WAIT(wait);
	int ret;
	unsigned char buf[32];
	struct digi_port *priv = usb_get_serial_port_data(port);

1132
	mutex_lock(&port->serial->disc_mutex);
L
Linus Torvalds 已提交
1133
	/* if disconnected, just clear flags */
1134
	if (port->serial->disconnected)
L
Linus Torvalds 已提交
1135 1136
		goto exit;

1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181
	/* FIXME: Transmit idle belongs in the wait_unti_sent path */
	digi_transmit_idle(port, DIGI_CLOSE_TIMEOUT);

	/* disable input flow control */
	buf[0] = DIGI_CMD_SET_INPUT_FLOW_CONTROL;
	buf[1] = priv->dp_port_num;
	buf[2] = DIGI_DISABLE;
	buf[3] = 0;

	/* disable output flow control */
	buf[4] = DIGI_CMD_SET_OUTPUT_FLOW_CONTROL;
	buf[5] = priv->dp_port_num;
	buf[6] = DIGI_DISABLE;
	buf[7] = 0;

	/* disable reading modem signals automatically */
	buf[8] = DIGI_CMD_READ_INPUT_SIGNALS;
	buf[9] = priv->dp_port_num;
	buf[10] = DIGI_DISABLE;
	buf[11] = 0;

	/* disable receive */
	buf[12] = DIGI_CMD_RECEIVE_ENABLE;
	buf[13] = priv->dp_port_num;
	buf[14] = DIGI_DISABLE;
	buf[15] = 0;

	/* flush fifos */
	buf[16] = DIGI_CMD_IFLUSH_FIFO;
	buf[17] = priv->dp_port_num;
	buf[18] = DIGI_FLUSH_TX | DIGI_FLUSH_RX;
	buf[19] = 0;

	ret = digi_write_oob_command(port, buf, 20, 0);
	if (ret != 0)
		dev_dbg(&port->dev, "digi_close: write oob failed, ret=%d\n",
									ret);
	/* wait for final commands on oob port to complete */
	prepare_to_wait(&priv->dp_flush_wait, &wait,
			TASK_INTERRUPTIBLE);
	schedule_timeout(DIGI_CLOSE_TIMEOUT);
	finish_wait(&priv->dp_flush_wait, &wait);

	/* shutdown any outstanding bulk writes */
	usb_kill_urb(port->write_urb);
L
Linus Torvalds 已提交
1182
exit:
1183
	spin_lock_irq(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1184
	priv->dp_write_urb_in_use = 0;
1185
	wake_up_interruptible(&priv->dp_close_wait);
1186 1187
	spin_unlock_irq(&priv->dp_port_lock);
	mutex_unlock(&port->serial->disc_mutex);
L
Linus Torvalds 已提交
1188 1189 1190 1191
}


/*
A
Alan Cox 已提交
1192 1193 1194 1195 1196
 *  Digi Startup Device
 *
 *  Starts reads on all ports.  Must be called AFTER startup, with
 *  urbs initialized.  Returns 0 if successful, non-zero error otherwise.
 */
L
Linus Torvalds 已提交
1197

1198
static int digi_startup_device(struct usb_serial *serial)
L
Linus Torvalds 已提交
1199
{
A
Alan Cox 已提交
1200
	int i, ret = 0;
L
Linus Torvalds 已提交
1201 1202 1203 1204
	struct digi_serial *serial_priv = usb_get_serial_data(serial);
	struct usb_serial_port *port;

	/* be sure this happens exactly once */
1205 1206 1207 1208
	spin_lock(&serial_priv->ds_serial_lock);
	if (serial_priv->ds_device_started) {
		spin_unlock(&serial_priv->ds_serial_lock);
		return 0;
L
Linus Torvalds 已提交
1209 1210
	}
	serial_priv->ds_device_started = 1;
1211
	spin_unlock(&serial_priv->ds_serial_lock);
L
Linus Torvalds 已提交
1212 1213 1214

	/* start reading from each bulk in endpoint for the device */
	/* set USB_DISABLE_SPD flag for write bulk urbs */
1215
	for (i = 0; i < serial->type->num_ports + 1; i++) {
L
Linus Torvalds 已提交
1216
		port = serial->port[i];
A
Alan Cox 已提交
1217 1218
		ret = usb_submit_urb(port->read_urb, GFP_KERNEL);
		if (ret != 0) {
1219 1220 1221
			dev_err(&port->dev,
				"%s: usb_submit_urb failed, ret=%d, port=%d\n",
				__func__, ret, i);
L
Linus Torvalds 已提交
1222 1223 1224
			break;
		}
	}
1225
	return ret;
L
Linus Torvalds 已提交
1226 1227
}

1228
static int digi_port_init(struct usb_serial_port *port, unsigned port_num)
L
Linus Torvalds 已提交
1229 1230 1231
{
	struct digi_port *priv;

1232 1233 1234
	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;
L
Linus Torvalds 已提交
1235

1236 1237 1238 1239 1240 1241 1242
	spin_lock_init(&priv->dp_port_lock);
	priv->dp_port_num = port_num;
	init_waitqueue_head(&priv->dp_transmit_idle_wait);
	init_waitqueue_head(&priv->dp_flush_wait);
	init_waitqueue_head(&priv->dp_close_wait);
	INIT_WORK(&priv->dp_wakeup_work, digi_wakeup_write_lock);
	priv->dp_port = port;
L
Linus Torvalds 已提交
1243

1244 1245 1246 1247 1248 1249 1250 1251 1252
	init_waitqueue_head(&port->write_wait);

	usb_set_serial_port_data(port, priv);

	return 0;
}

static int digi_startup(struct usb_serial *serial)
{
1253
	struct device *dev = &serial->interface->dev;
1254 1255
	struct digi_serial *serial_priv;
	int ret;
1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273
	int i;

	/* check whether the device has the expected number of endpoints */
	if (serial->num_port_pointers < serial->type->num_ports + 1) {
		dev_err(dev, "OOB endpoints missing\n");
		return -ENODEV;
	}

	for (i = 0; i < serial->type->num_ports + 1 ; i++) {
		if (!serial->port[i]->read_urb) {
			dev_err(dev, "bulk-in endpoint missing\n");
			return -ENODEV;
		}
		if (!serial->port[i]->write_urb) {
			dev_err(dev, "bulk-out endpoint missing\n");
			return -ENODEV;
		}
	}
1274 1275 1276 1277

	serial_priv = kzalloc(sizeof(*serial_priv), GFP_KERNEL);
	if (!serial_priv)
		return -ENOMEM;
L
Linus Torvalds 已提交
1278

1279
	spin_lock_init(&serial_priv->ds_serial_lock);
L
Linus Torvalds 已提交
1280 1281
	serial_priv->ds_oob_port_num = serial->type->num_ports;
	serial_priv->ds_oob_port = serial->port[serial_priv->ds_oob_port_num];
1282 1283 1284 1285 1286 1287 1288 1289

	ret = digi_port_init(serial_priv->ds_oob_port,
						serial_priv->ds_oob_port_num);
	if (ret) {
		kfree(serial_priv);
		return ret;
	}

L
Linus Torvalds 已提交
1290 1291
	usb_set_serial_data(serial, serial_priv);

1292
	return 0;
L
Linus Torvalds 已提交
1293 1294 1295
}


1296
static void digi_disconnect(struct usb_serial *serial)
L
Linus Torvalds 已提交
1297 1298 1299 1300
{
	int i;

	/* stop reads and writes on all ports */
1301
	for (i = 0; i < serial->type->num_ports + 1; i++) {
L
Linus Torvalds 已提交
1302 1303 1304
		usb_kill_urb(serial->port[i]->read_urb);
		usb_kill_urb(serial->port[i]->write_urb);
	}
1305 1306 1307 1308 1309
}


static void digi_release(struct usb_serial *serial)
{
1310 1311 1312 1313 1314 1315 1316
	struct digi_serial *serial_priv;
	struct digi_port *priv;

	serial_priv = usb_get_serial_data(serial);

	priv = usb_get_serial_port_data(serial_priv->ds_oob_port);
	kfree(priv);
L
Linus Torvalds 已提交
1317

1318
	kfree(serial_priv);
L
Linus Torvalds 已提交
1319 1320
}

1321 1322
static int digi_port_probe(struct usb_serial_port *port)
{
1323
	return digi_port_init(port, port->port_number);
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334
}

static int digi_port_remove(struct usb_serial_port *port)
{
	struct digi_port *priv;

	priv = usb_get_serial_port_data(port);
	kfree(priv);

	return 0;
}
L
Linus Torvalds 已提交
1335

1336
static void digi_read_bulk_callback(struct urb *urb)
L
Linus Torvalds 已提交
1337
{
1338
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
1339 1340 1341
	struct digi_port *priv;
	struct digi_serial *serial_priv;
	int ret;
1342
	int status = urb->status;
L
Linus Torvalds 已提交
1343 1344

	/* port sanity check, do not resubmit if port is not valid */
1345 1346 1347 1348 1349 1350
	if (port == NULL)
		return;
	priv = usb_get_serial_port_data(port);
	if (priv == NULL) {
		dev_err(&port->dev, "%s: port->private is NULL, status=%d\n",
			__func__, status);
L
Linus Torvalds 已提交
1351 1352
		return;
	}
1353
	if (port->serial == NULL ||
A
Alan Cox 已提交
1354
		(serial_priv = usb_get_serial_data(port->serial)) == NULL) {
1355 1356
		dev_err(&port->dev, "%s: serial is bad or serial->private "
			"is NULL, status=%d\n", __func__, status);
L
Linus Torvalds 已提交
1357 1358 1359 1360
		return;
	}

	/* do not resubmit urb if it has any status error */
1361
	if (status) {
1362 1363 1364
		dev_err(&port->dev,
			"%s: nonzero read bulk status: status=%d, port=%d\n",
			__func__, status, priv->dp_port_num);
L
Linus Torvalds 已提交
1365 1366 1367 1368
		return;
	}

	/* handle oob or inb callback, do not resubmit if error */
1369 1370
	if (priv->dp_port_num == serial_priv->ds_oob_port_num) {
		if (digi_read_oob_callback(urb) != 0)
L
Linus Torvalds 已提交
1371 1372
			return;
	} else {
1373
		if (digi_read_inb_callback(urb) != 0)
L
Linus Torvalds 已提交
1374 1375 1376 1377
			return;
	}

	/* continue read */
A
Alan Cox 已提交
1378
	ret = usb_submit_urb(urb, GFP_ATOMIC);
1379
	if (ret != 0 && ret != -EPERM) {
1380 1381 1382
		dev_err(&port->dev,
			"%s: failed resubmitting urb, ret=%d, port=%d\n",
			__func__, ret, priv->dp_port_num);
L
Linus Torvalds 已提交
1383 1384 1385 1386
	}

}

A
Alan Cox 已提交
1387 1388 1389 1390 1391 1392 1393 1394 1395
/*
 *  Digi Read INB Callback
 *
 *  Digi Read INB Callback handles reads on the in band ports, sending
 *  the data on to the tty subsystem.  When called we know port and
 *  port->private are not NULL and port->serial has been validated.
 *  It returns 0 if successful, 1 if successful but the port is
 *  throttled, and -1 if the sanity checks failed.
 */
L
Linus Torvalds 已提交
1396

1397
static int digi_read_inb_callback(struct urb *urb)
L
Linus Torvalds 已提交
1398
{
1399
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
1400 1401 1402
	struct digi_port *priv = usb_get_serial_port_data(port);
	int opcode = ((unsigned char *)urb->transfer_buffer)[0];
	int len = ((unsigned char *)urb->transfer_buffer)[1];
1403
	int port_status = ((unsigned char *)urb->transfer_buffer)[2];
A
Alan Cox 已提交
1404 1405
	unsigned char *data = ((unsigned char *)urb->transfer_buffer) + 3;
	int flag, throttled;
1406
	int status = urb->status;
L
Linus Torvalds 已提交
1407 1408 1409

	/* do not process callbacks on closed ports */
	/* but do continue the read chain */
1410
	if (urb->status == -ENOENT)
1411
		return 0;
L
Linus Torvalds 已提交
1412 1413

	/* short/multiple packet check */
1414
	if (urb->actual_length != len + 2) {
1415
		dev_err(&port->dev, "%s: INCOMPLETE OR MULTIPLE PACKET, "
1416
			"status=%d, port=%d, opcode=%d, len=%d, "
1417 1418 1419
			"actual_length=%d, status=%d\n", __func__, status,
			priv->dp_port_num, opcode, len, urb->actual_length,
			port_status);
1420
		return -1;
L
Linus Torvalds 已提交
1421 1422
	}

1423
	spin_lock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1424 1425 1426 1427

	/* check for throttle; if set, do not resubmit read urb */
	/* indicate the read chain needs to be restarted on unthrottle */
	throttled = priv->dp_throttled;
1428
	if (throttled)
L
Linus Torvalds 已提交
1429 1430 1431
		priv->dp_throttle_restart = 1;

	/* receive data */
J
Jiri Slaby 已提交
1432
	if (opcode == DIGI_CMD_RECEIVE_DATA) {
1433
		/* get flag from port_status */
L
Linus Torvalds 已提交
1434 1435 1436
		flag = 0;

		/* overrun is special, not associated with a char */
1437
		if (port_status & DIGI_OVERRUN_ERROR)
J
Jiri Slaby 已提交
1438
			tty_insert_flip_char(&port->port, 0, TTY_OVERRUN);
L
Linus Torvalds 已提交
1439 1440 1441

		/* break takes precedence over parity, */
		/* which takes precedence over framing errors */
1442
		if (port_status & DIGI_BREAK_ERROR)
L
Linus Torvalds 已提交
1443
			flag = TTY_BREAK;
1444
		else if (port_status & DIGI_PARITY_ERROR)
L
Linus Torvalds 已提交
1445
			flag = TTY_PARITY;
1446
		else if (port_status & DIGI_FRAMING_ERROR)
L
Linus Torvalds 已提交
1447 1448
			flag = TTY_FRAME;

1449
		/* data length is len-1 (one byte of len is port_status) */
L
Linus Torvalds 已提交
1450
		--len;
1451
		if (len > 0) {
1452 1453
			tty_insert_flip_string_fixed_flag(&port->port, data,
					flag, len);
J
Jiri Slaby 已提交
1454
			tty_flip_buffer_push(&port->port);
L
Linus Torvalds 已提交
1455 1456
		}
	}
1457
	spin_unlock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1458

1459
	if (opcode == DIGI_CMD_RECEIVE_DISABLE)
1460
		dev_dbg(&port->dev, "%s: got RECEIVE_DISABLE\n", __func__);
1461
	else if (opcode != DIGI_CMD_RECEIVE_DATA)
1462
		dev_dbg(&port->dev, "%s: unknown opcode: %d\n", __func__, opcode);
L
Linus Torvalds 已提交
1463

A
Alan Cox 已提交
1464
	return throttled ? 1 : 0;
L
Linus Torvalds 已提交
1465 1466 1467 1468

}


A
Alan Cox 已提交
1469 1470 1471 1472 1473 1474 1475 1476
/*
 *  Digi Read OOB Callback
 *
 *  Digi Read OOB Callback handles reads on the out of band port.
 *  When called we know port and port->private are not NULL and
 *  the port->serial is valid.  It returns 0 if successful, and
 *  -1 if the sanity checks failed.
 */
L
Linus Torvalds 已提交
1477

1478
static int digi_read_oob_callback(struct urb *urb)
L
Linus Torvalds 已提交
1479 1480
{

1481
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
1482
	struct usb_serial *serial = port->serial;
A
Alan Cox 已提交
1483
	struct tty_struct *tty;
L
Linus Torvalds 已提交
1484 1485 1486
	struct digi_port *priv = usb_get_serial_port_data(port);
	int opcode, line, status, val;
	int i;
A
Alan Cox 已提交
1487
	unsigned int rts;
L
Linus Torvalds 已提交
1488 1489

	/* handle each oob command */
A
Alan Cox 已提交
1490
	for (i = 0; i < urb->actual_length - 3;) {
L
Linus Torvalds 已提交
1491 1492 1493 1494 1495
		opcode = ((unsigned char *)urb->transfer_buffer)[i++];
		line = ((unsigned char *)urb->transfer_buffer)[i++];
		status = ((unsigned char *)urb->transfer_buffer)[i++];
		val = ((unsigned char *)urb->transfer_buffer)[i++];

1496
		dev_dbg(&port->dev, "digi_read_oob_callback: opcode=%d, line=%d, status=%d, val=%d\n",
1497
			opcode, line, status, val);
L
Linus Torvalds 已提交
1498

1499
		if (status != 0 || line >= serial->type->num_ports)
L
Linus Torvalds 已提交
1500 1501 1502 1503
			continue;

		port = serial->port[line];

A
Alan Cox 已提交
1504 1505
		priv = usb_get_serial_port_data(port);
		if (priv == NULL)
L
Linus Torvalds 已提交
1506 1507
			return -1;

A
Alan Cox 已提交
1508
		tty = tty_port_tty_get(&port->port);
1509

A
Alan Cox 已提交
1510
		rts = 0;
1511
		if (tty)
P
Peter Hurley 已提交
1512 1513
			rts = C_CRTSCTS(tty);

1514
		if (tty && opcode == DIGI_CMD_READ_INPUT_SIGNALS) {
1515
			spin_lock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1516
			/* convert from digi flags to termiox flags */
1517
			if (val & DIGI_READ_INPUT_SIGNALS_CTS) {
L
Linus Torvalds 已提交
1518 1519
				priv->dp_modem_signals |= TIOCM_CTS;
				/* port must be open to use tty struct */
1520
				if (rts)
J
Jiri Slaby 已提交
1521
					tty_port_tty_wakeup(&port->port);
L
Linus Torvalds 已提交
1522 1523 1524 1525
			} else {
				priv->dp_modem_signals &= ~TIOCM_CTS;
				/* port must be open to use tty struct */
			}
1526
			if (val & DIGI_READ_INPUT_SIGNALS_DSR)
L
Linus Torvalds 已提交
1527 1528 1529
				priv->dp_modem_signals |= TIOCM_DSR;
			else
				priv->dp_modem_signals &= ~TIOCM_DSR;
1530
			if (val & DIGI_READ_INPUT_SIGNALS_RI)
L
Linus Torvalds 已提交
1531 1532 1533
				priv->dp_modem_signals |= TIOCM_RI;
			else
				priv->dp_modem_signals &= ~TIOCM_RI;
1534
			if (val & DIGI_READ_INPUT_SIGNALS_DCD)
L
Linus Torvalds 已提交
1535 1536 1537 1538
				priv->dp_modem_signals |= TIOCM_CD;
			else
				priv->dp_modem_signals &= ~TIOCM_CD;

1539 1540 1541
			spin_unlock(&priv->dp_port_lock);
		} else if (opcode == DIGI_CMD_TRANSMIT_IDLE) {
			spin_lock(&priv->dp_port_lock);
L
Linus Torvalds 已提交
1542
			priv->dp_transmit_idle = 1;
1543 1544 1545 1546
			wake_up_interruptible(&priv->dp_transmit_idle_wait);
			spin_unlock(&priv->dp_port_lock);
		} else if (opcode == DIGI_CMD_IFLUSH_FIFO) {
			wake_up_interruptible(&priv->dp_flush_wait);
L
Linus Torvalds 已提交
1547
		}
A
Alan Cox 已提交
1548
		tty_kref_put(tty);
L
Linus Torvalds 已提交
1549
	}
1550
	return 0;
L
Linus Torvalds 已提交
1551 1552 1553

}

1554
module_usb_serial_driver(serial_drivers, id_table_combined);
L
Linus Torvalds 已提交
1555

1556 1557
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
L
Linus Torvalds 已提交
1558
MODULE_LICENSE("GPL");