ide: Fix host drivers that need IRQF_SHARED
[linux-2.6/linux-2.6-openrd.git] / drivers / usb / serial / digi_acceleport.c
blob38ba4ea8b6bfdf1b84b69d9338cd9c3154d60e51
1 /*
2 * Digi AccelePort USB-4 and USB-2 Serial Converters
4 * Copyright 2000 by Digi International
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * Shamelessly based on Brian Warner's keyspan_pda.c and Greg Kroah-Hartman's
12 * usb-serial driver.
14 * Peter Berger (pberger@brimson.com)
15 * Al Borchers (borchers@steinerpoint.com)
17 * (12/03/2001) gkh
18 * switched to using port->port.count instead of private version.
19 * Removed port->active
21 * (04/08/2001) gb
22 * Identify version on module load.
24 * (11/01/2000) Adam J. Richter
25 * usb_device_id table support
27 * (11/01/2000) pberger and borchers
28 * -- Turned off the USB_DISABLE_SPD flag for write bulk urbs--it caused
29 * USB 4 ports to hang on startup.
30 * -- Serialized access to write urbs by adding the dp_write_urb_in_use
31 * flag; otherwise, the driver caused SMP system hangs. Watching the
32 * urb status is not sufficient.
34 * (10/05/2000) gkh
35 * -- Fixed bug with urb->dev not being set properly, now that the usb
36 * core needs it.
38 * (8/8/2000) pberger and borchers
39 * -- Fixed close so that
40 * - it can timeout while waiting for transmit idle, if needed;
41 * - it ignores interrupts when flushing the port, turning
42 * of modem signalling, and so on;
43 * - it waits for the flush to really complete before returning.
44 * -- Read_bulk_callback and write_bulk_callback check for a closed
45 * port before using the tty struct or writing to the port.
46 * -- The two changes above fix the oops caused by interrupted closes.
47 * -- Added interruptible args to write_oob_command and set_modem_signals
48 * and added a timeout arg to transmit_idle; needed for fixes to
49 * close.
50 * -- Added code for rx_throttle and rx_unthrottle so that input flow
51 * control works.
52 * -- Added code to set overrun, parity, framing, and break errors
53 * (untested).
54 * -- Set USB_DISABLE_SPD flag for write bulk urbs, so no 0 length
55 * bulk writes are done. These hung the Digi USB device. The
56 * 0 length bulk writes were a new feature of usb-uhci added in
57 * the 2.4.0-test6 kernels.
58 * -- Fixed mod inc race in open; do mod inc before sleeping to wait
59 * for a close to finish.
61 * (7/31/2000) pberger
62 * -- Fixed bugs with hardware handshaking:
63 * - Added code to set/clear tty->hw_stopped in digi_read_oob_callback()
64 * and digi_set_termios()
65 * -- Added code in digi_set_termios() to
66 * - add conditional in code handling transition from B0 to only
67 * set RTS if RTS/CTS flow control is either not in use or if
68 * the port is not currently throttled.
69 * - handle turning off CRTSCTS.
71 * (7/30/2000) borchers
72 * -- Added support for more than one Digi USB device by moving
73 * globals to a private structure in the pointed to from the
74 * usb_serial structure.
75 * -- Moved the modem change and transmit idle wait queues into
76 * the port private structure, so each port has its own queue
77 * rather than sharing global queues.
78 * -- Added support for break signals.
80 * (7/25/2000) pberger
81 * -- Added USB-2 support. Note: the USB-2 supports 3 devices: two
82 * serial and a parallel port. The parallel port is implemented
83 * as a serial-to-parallel converter. That is, the driver actually
84 * presents all three USB-2 interfaces as serial ports, but the third
85 * one physically connects to a parallel device. Thus, for example,
86 * one could plug a parallel printer into the USB-2's third port,
87 * but from the kernel's (and userland's) point of view what's
88 * actually out there is a serial device.
90 * (7/15/2000) borchers
91 * -- Fixed race in open when a close is in progress.
92 * -- Keep count of opens and dec the module use count for each
93 * outstanding open when shutdown is called (on disconnect).
94 * -- Fixed sanity checks in read_bulk_callback and write_bulk_callback
95 * so pointers are checked before use.
96 * -- Split read bulk callback into in band and out of band
97 * callbacks, and no longer restart read chains if there is
98 * a status error or a sanity error. This fixed the seg
99 * faults and other errors we used to get on disconnect.
100 * -- Port->active is once again a flag as usb-serial intended it
101 * to be, not a count. Since it was only a char it would
102 * have been limited to 256 simultaneous opens. Now the open
103 * count is kept in the port private structure in dp_open_count.
104 * -- Added code for modularization of the digi_acceleport driver.
106 * (6/27/2000) pberger and borchers
107 * -- Zeroed out sync field in the wakeup_task before first use;
108 * otherwise the uninitialized value might prevent the task from
109 * being scheduled.
110 * -- Initialized ret value to 0 in write_bulk_callback, otherwise
111 * the uninitialized value could cause a spurious debugging message.
113 * (6/22/2000) pberger and borchers
114 * -- Made cond_wait_... inline--apparently on SPARC the flags arg
115 * to spin_lock_irqsave cannot be passed to another function
116 * to call spin_unlock_irqrestore. Thanks to Pauline Middelink.
117 * -- In digi_set_modem_signals the inner nested spin locks use just
118 * spin_lock() rather than spin_lock_irqsave(). The old code
119 * mistakenly left interrupts off. Thanks to Pauline Middelink.
120 * -- copy_from_user (which can sleep) is no longer called while a
121 * spinlock is held. We copy to a local buffer before getting
122 * the spinlock--don't like the extra copy but the code is simpler.
123 * -- Printk and dbg are no longer called while a spin lock is held.
125 * (6/4/2000) pberger and borchers
126 * -- Replaced separate calls to spin_unlock_irqrestore and
127 * interruptible_sleep_on_timeout with a new function
128 * cond_wait_interruptible_timeout_irqrestore. This eliminates
129 * the race condition where the wake up could happen after
130 * the unlock and before the sleep.
131 * -- Close now waits for output to drain.
132 * -- Open waits until any close in progress is finished.
133 * -- All out of band responses are now processed, not just the
134 * first in a USB packet.
135 * -- Fixed a bug that prevented the driver from working when the
136 * first Digi port was not the first USB serial port--the driver
137 * was mistakenly using the external USB serial port number to
138 * try to index into its internal ports.
139 * -- Fixed an SMP bug -- write_bulk_callback is called directly from
140 * an interrupt, so spin_lock_irqsave/spin_unlock_irqrestore are
141 * needed for locks outside write_bulk_callback that are also
142 * acquired by write_bulk_callback to prevent deadlocks.
143 * -- Fixed support for select() by making digi_chars_in_buffer()
144 * return 256 when -EINPROGRESS is set, as the line discipline
145 * code in n_tty.c expects.
146 * -- Fixed an include file ordering problem that prevented debugging
147 * messages from working.
148 * -- Fixed an intermittent timeout problem that caused writes to
149 * sometimes get stuck on some machines on some kernels. It turns
150 * out in these circumstances write_chan() (in n_tty.c) was
151 * asleep waiting for our wakeup call. Even though we call
152 * wake_up_interruptible() in digi_write_bulk_callback(), there is
153 * a race condition that could cause the wakeup to fail: if our
154 * wake_up_interruptible() call occurs between the time that our
155 * driver write routine finishes and write_chan() sets current->state
156 * to TASK_INTERRUPTIBLE, the effect of our wakeup setting the state
157 * to TASK_RUNNING will be lost and write_chan's subsequent call to
158 * schedule() will never return (unless it catches a signal).
159 * This race condition occurs because write_bulk_callback() (and thus
160 * the wakeup) are called asynchronously from an interrupt, rather than
161 * from the scheduler. We can avoid the race by calling the wakeup
162 * from the scheduler queue and that's our fix: Now, at the end of
163 * write_bulk_callback() we queue up a wakeup call on the scheduler
164 * task queue. We still also invoke the wakeup directly since that
165 * squeezes a bit more performance out of the driver, and any lost
166 * race conditions will get cleaned up at the next scheduler run.
168 * NOTE: The problem also goes away if you comment out
169 * the two code lines in write_chan() where current->state
170 * is set to TASK_RUNNING just before calling driver.write() and to
171 * TASK_INTERRUPTIBLE immediately afterwards. This is why the
172 * problem did not show up with the 2.2 kernels -- they do not
173 * include that code.
175 * (5/16/2000) pberger and borchers
176 * -- Added timeouts to sleeps, to defend against lost wake ups.
177 * -- Handle transition to/from B0 baud rate in digi_set_termios.
179 * (5/13/2000) pberger and borchers
180 * -- All commands now sent on out of band port, using
181 * digi_write_oob_command.
182 * -- Get modem control signals whenever they change, support TIOCMGET/
183 * SET/BIS/BIC ioctls.
184 * -- digi_set_termios now supports parity, word size, stop bits, and
185 * receive enable.
186 * -- Cleaned up open and close, use digi_set_termios and
187 * digi_write_oob_command to set port parameters.
188 * -- Added digi_startup_device to start read chains on all ports.
189 * -- Write buffer is only used when count==1, to be sure put_char can
190 * write a char (unless the buffer is full).
192 * (5/10/2000) pberger and borchers
193 * -- Added MOD_INC_USE_COUNT/MOD_DEC_USE_COUNT calls on open/close.
194 * -- Fixed problem where the first incoming character is lost on
195 * port opens after the first close on that port. Now we keep
196 * the read_urb chain open until shutdown.
197 * -- Added more port conditioning calls in digi_open and digi_close.
198 * -- Convert port->active to a use count so that we can deal with multiple
199 * opens and closes properly.
200 * -- Fixed some problems with the locking code.
202 * (5/3/2000) pberger and borchers
203 * -- First alpha version of the driver--many known limitations and bugs.
206 * Locking and SMP
208 * - Each port, including the out-of-band port, has a lock used to
209 * serialize all access to the port's private structure.
210 * - The port lock is also used to serialize all writes and access to
211 * the port's URB.
212 * - The port lock is also used for the port write_wait condition
213 * variable. Holding the port lock will prevent a wake up on the
214 * port's write_wait; this can be used with cond_wait_... to be sure
215 * the wake up is not lost in a race when dropping the lock and
216 * sleeping waiting for the wakeup.
217 * - digi_write() does not sleep, since it is sometimes called on
218 * interrupt time.
219 * - digi_write_bulk_callback() and digi_read_bulk_callback() are
220 * called directly from interrupts. Hence spin_lock_irqsave()
221 * and spin_unlock_irqrestore() are used in the rest of the code
222 * for any locks they acquire.
223 * - digi_write_bulk_callback() gets the port lock before waking up
224 * processes sleeping on the port write_wait. It also schedules
225 * wake ups so they happen from the scheduler, because the tty
226 * system can miss wake ups from interrupts.
227 * - All sleeps use a timeout of DIGI_RETRY_TIMEOUT before looping to
228 * recheck the condition they are sleeping on. This is defensive,
229 * in case a wake up is lost.
230 * - Following Documentation/DocBook/kernel-locking.pdf no spin locks
231 * are held when calling copy_to/from_user or printk.
234 #include <linux/kernel.h>
235 #include <linux/errno.h>
236 #include <linux/init.h>
237 #include <linux/slab.h>
238 #include <linux/tty.h>
239 #include <linux/tty_driver.h>
240 #include <linux/tty_flip.h>
241 #include <linux/module.h>
242 #include <linux/spinlock.h>
243 #include <linux/workqueue.h>
244 #include <linux/uaccess.h>
245 #include <linux/usb.h>
246 #include <linux/wait.h>
247 #include <linux/usb/serial.h>
249 /* Defines */
252 * Version Information
254 #define DRIVER_VERSION "v1.80.1.2"
255 #define DRIVER_AUTHOR "Peter Berger <pberger@brimson.com>, Al Borchers <borchers@steinerpoint.com>"
256 #define DRIVER_DESC "Digi AccelePort USB-2/USB-4 Serial Converter driver"
258 /* port output buffer length -- must be <= transfer buffer length - 2 */
259 /* so we can be sure to send the full buffer in one urb */
260 #define DIGI_OUT_BUF_SIZE 8
262 /* port input buffer length -- must be >= transfer buffer length - 3 */
263 /* so we can be sure to hold at least one full buffer from one urb */
264 #define DIGI_IN_BUF_SIZE 64
266 /* retry timeout while sleeping */
267 #define DIGI_RETRY_TIMEOUT (HZ/10)
269 /* timeout while waiting for tty output to drain in close */
270 /* this delay is used twice in close, so the total delay could */
271 /* be twice this value */
272 #define DIGI_CLOSE_TIMEOUT (5*HZ)
275 /* AccelePort USB Defines */
277 /* ids */
278 #define DIGI_VENDOR_ID 0x05c5
279 #define DIGI_2_ID 0x0002 /* USB-2 */
280 #define DIGI_4_ID 0x0004 /* USB-4 */
282 /* commands
283 * "INB": can be used on the in-band endpoint
284 * "OOB": can be used on the out-of-band endpoint
286 #define DIGI_CMD_SET_BAUD_RATE 0 /* INB, OOB */
287 #define DIGI_CMD_SET_WORD_SIZE 1 /* INB, OOB */
288 #define DIGI_CMD_SET_PARITY 2 /* INB, OOB */
289 #define DIGI_CMD_SET_STOP_BITS 3 /* INB, OOB */
290 #define DIGI_CMD_SET_INPUT_FLOW_CONTROL 4 /* INB, OOB */
291 #define DIGI_CMD_SET_OUTPUT_FLOW_CONTROL 5 /* INB, OOB */
292 #define DIGI_CMD_SET_DTR_SIGNAL 6 /* INB, OOB */
293 #define DIGI_CMD_SET_RTS_SIGNAL 7 /* INB, OOB */
294 #define DIGI_CMD_READ_INPUT_SIGNALS 8 /* OOB */
295 #define DIGI_CMD_IFLUSH_FIFO 9 /* OOB */
296 #define DIGI_CMD_RECEIVE_ENABLE 10 /* INB, OOB */
297 #define DIGI_CMD_BREAK_CONTROL 11 /* INB, OOB */
298 #define DIGI_CMD_LOCAL_LOOPBACK 12 /* INB, OOB */
299 #define DIGI_CMD_TRANSMIT_IDLE 13 /* INB, OOB */
300 #define DIGI_CMD_READ_UART_REGISTER 14 /* OOB */
301 #define DIGI_CMD_WRITE_UART_REGISTER 15 /* INB, OOB */
302 #define DIGI_CMD_AND_UART_REGISTER 16 /* INB, OOB */
303 #define DIGI_CMD_OR_UART_REGISTER 17 /* INB, OOB */
304 #define DIGI_CMD_SEND_DATA 18 /* INB */
305 #define DIGI_CMD_RECEIVE_DATA 19 /* INB */
306 #define DIGI_CMD_RECEIVE_DISABLE 20 /* INB */
307 #define DIGI_CMD_GET_PORT_TYPE 21 /* OOB */
309 /* baud rates */
310 #define DIGI_BAUD_50 0
311 #define DIGI_BAUD_75 1
312 #define DIGI_BAUD_110 2
313 #define DIGI_BAUD_150 3
314 #define DIGI_BAUD_200 4
315 #define DIGI_BAUD_300 5
316 #define DIGI_BAUD_600 6
317 #define DIGI_BAUD_1200 7
318 #define DIGI_BAUD_1800 8
319 #define DIGI_BAUD_2400 9
320 #define DIGI_BAUD_4800 10
321 #define DIGI_BAUD_7200 11
322 #define DIGI_BAUD_9600 12
323 #define DIGI_BAUD_14400 13
324 #define DIGI_BAUD_19200 14
325 #define DIGI_BAUD_28800 15
326 #define DIGI_BAUD_38400 16
327 #define DIGI_BAUD_57600 17
328 #define DIGI_BAUD_76800 18
329 #define DIGI_BAUD_115200 19
330 #define DIGI_BAUD_153600 20
331 #define DIGI_BAUD_230400 21
332 #define DIGI_BAUD_460800 22
334 /* arguments */
335 #define DIGI_WORD_SIZE_5 0
336 #define DIGI_WORD_SIZE_6 1
337 #define DIGI_WORD_SIZE_7 2
338 #define DIGI_WORD_SIZE_8 3
340 #define DIGI_PARITY_NONE 0
341 #define DIGI_PARITY_ODD 1
342 #define DIGI_PARITY_EVEN 2
343 #define DIGI_PARITY_MARK 3
344 #define DIGI_PARITY_SPACE 4
346 #define DIGI_STOP_BITS_1 0
347 #define DIGI_STOP_BITS_2 1
349 #define DIGI_INPUT_FLOW_CONTROL_XON_XOFF 1
350 #define DIGI_INPUT_FLOW_CONTROL_RTS 2
351 #define DIGI_INPUT_FLOW_CONTROL_DTR 4
353 #define DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF 1
354 #define DIGI_OUTPUT_FLOW_CONTROL_CTS 2
355 #define DIGI_OUTPUT_FLOW_CONTROL_DSR 4
357 #define DIGI_DTR_INACTIVE 0
358 #define DIGI_DTR_ACTIVE 1
359 #define DIGI_DTR_INPUT_FLOW_CONTROL 2
361 #define DIGI_RTS_INACTIVE 0
362 #define DIGI_RTS_ACTIVE 1
363 #define DIGI_RTS_INPUT_FLOW_CONTROL 2
364 #define DIGI_RTS_TOGGLE 3
366 #define DIGI_FLUSH_TX 1
367 #define DIGI_FLUSH_RX 2
368 #define DIGI_RESUME_TX 4 /* clears xoff condition */
370 #define DIGI_TRANSMIT_NOT_IDLE 0
371 #define DIGI_TRANSMIT_IDLE 1
373 #define DIGI_DISABLE 0
374 #define DIGI_ENABLE 1
376 #define DIGI_DEASSERT 0
377 #define DIGI_ASSERT 1
379 /* in band status codes */
380 #define DIGI_OVERRUN_ERROR 4
381 #define DIGI_PARITY_ERROR 8
382 #define DIGI_FRAMING_ERROR 16
383 #define DIGI_BREAK_ERROR 32
385 /* out of band status */
386 #define DIGI_NO_ERROR 0
387 #define DIGI_BAD_FIRST_PARAMETER 1
388 #define DIGI_BAD_SECOND_PARAMETER 2
389 #define DIGI_INVALID_LINE 3
390 #define DIGI_INVALID_OPCODE 4
392 /* input signals */
393 #define DIGI_READ_INPUT_SIGNALS_SLOT 1
394 #define DIGI_READ_INPUT_SIGNALS_ERR 2
395 #define DIGI_READ_INPUT_SIGNALS_BUSY 4
396 #define DIGI_READ_INPUT_SIGNALS_PE 8
397 #define DIGI_READ_INPUT_SIGNALS_CTS 16
398 #define DIGI_READ_INPUT_SIGNALS_DSR 32
399 #define DIGI_READ_INPUT_SIGNALS_RI 64
400 #define DIGI_READ_INPUT_SIGNALS_DCD 128
403 /* Structures */
405 struct digi_serial {
406 spinlock_t ds_serial_lock;
407 struct usb_serial_port *ds_oob_port; /* out-of-band port */
408 int ds_oob_port_num; /* index of out-of-band port */
409 int ds_device_started;
412 struct digi_port {
413 spinlock_t dp_port_lock;
414 int dp_port_num;
415 int dp_out_buf_len;
416 unsigned char dp_out_buf[DIGI_OUT_BUF_SIZE];
417 int dp_write_urb_in_use;
418 unsigned int dp_modem_signals;
419 wait_queue_head_t dp_modem_change_wait;
420 int dp_transmit_idle;
421 wait_queue_head_t dp_transmit_idle_wait;
422 int dp_throttled;
423 int dp_throttle_restart;
424 wait_queue_head_t dp_flush_wait;
425 int dp_in_close; /* close in progress */
426 wait_queue_head_t dp_close_wait; /* wait queue for close */
427 struct work_struct dp_wakeup_work;
428 struct usb_serial_port *dp_port;
432 /* Local Function Declarations */
434 static void digi_wakeup_write(struct usb_serial_port *port);
435 static void digi_wakeup_write_lock(struct work_struct *work);
436 static int digi_write_oob_command(struct usb_serial_port *port,
437 unsigned char *buf, int count, int interruptible);
438 static int digi_write_inb_command(struct usb_serial_port *port,
439 unsigned char *buf, int count, unsigned long timeout);
440 static int digi_set_modem_signals(struct usb_serial_port *port,
441 unsigned int modem_signals, int interruptible);
442 static int digi_transmit_idle(struct usb_serial_port *port,
443 unsigned long timeout);
444 static void digi_rx_throttle(struct tty_struct *tty);
445 static void digi_rx_unthrottle(struct tty_struct *tty);
446 static void digi_set_termios(struct tty_struct *tty,
447 struct usb_serial_port *port, struct ktermios *old_termios);
448 static void digi_break_ctl(struct tty_struct *tty, int break_state);
449 static int digi_tiocmget(struct tty_struct *tty, struct file *file);
450 static int digi_tiocmset(struct tty_struct *tty, struct file *file,
451 unsigned int set, unsigned int clear);
452 static int digi_write(struct tty_struct *tty, struct usb_serial_port *port,
453 const unsigned char *buf, int count);
454 static void digi_write_bulk_callback(struct urb *urb);
455 static int digi_write_room(struct tty_struct *tty);
456 static int digi_chars_in_buffer(struct tty_struct *tty);
457 static int digi_open(struct tty_struct *tty, struct usb_serial_port *port,
458 struct file *filp);
459 static void digi_close(struct tty_struct *tty, struct usb_serial_port *port,
460 struct file *filp);
461 static int digi_startup_device(struct usb_serial *serial);
462 static int digi_startup(struct usb_serial *serial);
463 static void digi_shutdown(struct usb_serial *serial);
464 static void digi_read_bulk_callback(struct urb *urb);
465 static int digi_read_inb_callback(struct urb *urb);
466 static int digi_read_oob_callback(struct urb *urb);
469 /* Statics */
471 static int debug;
473 static struct usb_device_id id_table_combined [] = {
474 { USB_DEVICE(DIGI_VENDOR_ID, DIGI_2_ID) },
475 { USB_DEVICE(DIGI_VENDOR_ID, DIGI_4_ID) },
476 { } /* Terminating entry */
479 static struct usb_device_id id_table_2 [] = {
480 { USB_DEVICE(DIGI_VENDOR_ID, DIGI_2_ID) },
481 { } /* Terminating entry */
484 static struct usb_device_id id_table_4 [] = {
485 { USB_DEVICE(DIGI_VENDOR_ID, DIGI_4_ID) },
486 { } /* Terminating entry */
489 MODULE_DEVICE_TABLE(usb, id_table_combined);
491 static struct usb_driver digi_driver = {
492 .name = "digi_acceleport",
493 .probe = usb_serial_probe,
494 .disconnect = usb_serial_disconnect,
495 .id_table = id_table_combined,
496 .no_dynamic_id = 1,
500 /* device info needed for the Digi serial converter */
502 static struct usb_serial_driver digi_acceleport_2_device = {
503 .driver = {
504 .owner = THIS_MODULE,
505 .name = "digi_2",
507 .description = "Digi 2 port USB adapter",
508 .usb_driver = &digi_driver,
509 .id_table = id_table_2,
510 .num_ports = 3,
511 .open = digi_open,
512 .close = digi_close,
513 .write = digi_write,
514 .write_room = digi_write_room,
515 .write_bulk_callback = digi_write_bulk_callback,
516 .read_bulk_callback = digi_read_bulk_callback,
517 .chars_in_buffer = digi_chars_in_buffer,
518 .throttle = digi_rx_throttle,
519 .unthrottle = digi_rx_unthrottle,
520 .set_termios = digi_set_termios,
521 .break_ctl = digi_break_ctl,
522 .tiocmget = digi_tiocmget,
523 .tiocmset = digi_tiocmset,
524 .attach = digi_startup,
525 .shutdown = digi_shutdown,
528 static struct usb_serial_driver digi_acceleport_4_device = {
529 .driver = {
530 .owner = THIS_MODULE,
531 .name = "digi_4",
533 .description = "Digi 4 port USB adapter",
534 .usb_driver = &digi_driver,
535 .id_table = id_table_4,
536 .num_ports = 4,
537 .open = digi_open,
538 .close = digi_close,
539 .write = digi_write,
540 .write_room = digi_write_room,
541 .write_bulk_callback = digi_write_bulk_callback,
542 .read_bulk_callback = digi_read_bulk_callback,
543 .chars_in_buffer = digi_chars_in_buffer,
544 .throttle = digi_rx_throttle,
545 .unthrottle = digi_rx_unthrottle,
546 .set_termios = digi_set_termios,
547 .break_ctl = digi_break_ctl,
548 .tiocmget = digi_tiocmget,
549 .tiocmset = digi_tiocmset,
550 .attach = digi_startup,
551 .shutdown = digi_shutdown,
555 /* Functions */
558 * Cond Wait Interruptible Timeout Irqrestore
560 * Do spin_unlock_irqrestore and interruptible_sleep_on_timeout
561 * so that wake ups are not lost if they occur between the unlock
562 * and the sleep. In other words, spin_unlock_irqrestore and
563 * interruptible_sleep_on_timeout are "atomic" with respect to
564 * wake ups. This is used to implement condition variables.
566 * interruptible_sleep_on_timeout is deprecated and has been replaced
567 * with the equivalent code.
570 static long cond_wait_interruptible_timeout_irqrestore(
571 wait_queue_head_t *q, long timeout,
572 spinlock_t *lock, unsigned long flags)
573 __releases(lock)
575 DEFINE_WAIT(wait);
577 prepare_to_wait(q, &wait, TASK_INTERRUPTIBLE);
578 spin_unlock_irqrestore(lock, flags);
579 timeout = schedule_timeout(timeout);
580 finish_wait(q, &wait);
582 return timeout;
587 * Digi Wakeup Write
589 * Wake up port, line discipline, and tty processes sleeping
590 * on writes.
593 static void digi_wakeup_write_lock(struct work_struct *work)
595 struct digi_port *priv =
596 container_of(work, struct digi_port, dp_wakeup_work);
597 struct usb_serial_port *port = priv->dp_port;
598 unsigned long flags;
600 spin_lock_irqsave(&priv->dp_port_lock, flags);
601 digi_wakeup_write(port);
602 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
605 static void digi_wakeup_write(struct usb_serial_port *port)
607 struct tty_struct *tty = tty_port_tty_get(&port->port);
608 tty_wakeup(tty);
609 tty_kref_put(tty);
614 * Digi Write OOB Command
616 * Write commands on the out of band port. Commands are 4
617 * bytes each, multiple commands can be sent at once, and
618 * no command will be split across USB packets. Returns 0
619 * if successful, -EINTR if interrupted while sleeping and
620 * the interruptible flag is true, or a negative error
621 * returned by usb_submit_urb.
624 static int digi_write_oob_command(struct usb_serial_port *port,
625 unsigned char *buf, int count, int interruptible)
628 int ret = 0;
629 int len;
630 struct usb_serial_port *oob_port = (struct usb_serial_port *)((struct digi_serial *)(usb_get_serial_data(port->serial)))->ds_oob_port;
631 struct digi_port *oob_priv = usb_get_serial_port_data(oob_port);
632 unsigned long flags = 0;
634 dbg("digi_write_oob_command: TOP: port=%d, count=%d", oob_priv->dp_port_num, count);
636 spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
637 while (count > 0) {
638 while (oob_priv->dp_write_urb_in_use) {
639 cond_wait_interruptible_timeout_irqrestore(
640 &oob_port->write_wait, DIGI_RETRY_TIMEOUT,
641 &oob_priv->dp_port_lock, flags);
642 if (interruptible && signal_pending(current))
643 return -EINTR;
644 spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
647 /* len must be a multiple of 4, so commands are not split */
648 len = min(count, oob_port->bulk_out_size);
649 if (len > 4)
650 len &= ~3;
651 memcpy(oob_port->write_urb->transfer_buffer, buf, len);
652 oob_port->write_urb->transfer_buffer_length = len;
653 oob_port->write_urb->dev = port->serial->dev;
654 ret = usb_submit_urb(oob_port->write_urb, GFP_ATOMIC);
655 if (ret == 0) {
656 oob_priv->dp_write_urb_in_use = 1;
657 count -= len;
658 buf += len;
661 spin_unlock_irqrestore(&oob_priv->dp_port_lock, flags);
662 if (ret)
663 dev_err(&port->dev, "%s: usb_submit_urb failed, ret=%d\n",
664 __func__, ret);
665 return ret;
671 * Digi Write In Band Command
673 * Write commands on the given port. Commands are 4
674 * bytes each, multiple commands can be sent at once, and
675 * no command will be split across USB packets. If timeout
676 * is non-zero, write in band command will return after
677 * waiting unsuccessfully for the URB status to clear for
678 * timeout ticks. Returns 0 if successful, or a negative
679 * error returned by digi_write.
682 static int digi_write_inb_command(struct usb_serial_port *port,
683 unsigned char *buf, int count, unsigned long timeout)
685 int ret = 0;
686 int len;
687 struct digi_port *priv = usb_get_serial_port_data(port);
688 unsigned char *data = port->write_urb->transfer_buffer;
689 unsigned long flags = 0;
691 dbg("digi_write_inb_command: TOP: port=%d, count=%d",
692 priv->dp_port_num, count);
694 if (timeout)
695 timeout += jiffies;
696 else
697 timeout = ULONG_MAX;
699 spin_lock_irqsave(&priv->dp_port_lock, flags);
700 while (count > 0 && ret == 0) {
701 while (priv->dp_write_urb_in_use &&
702 time_before(jiffies, timeout)) {
703 cond_wait_interruptible_timeout_irqrestore(
704 &port->write_wait, DIGI_RETRY_TIMEOUT,
705 &priv->dp_port_lock, flags);
706 if (signal_pending(current))
707 return -EINTR;
708 spin_lock_irqsave(&priv->dp_port_lock, flags);
711 /* len must be a multiple of 4 and small enough to */
712 /* guarantee the write will send buffered data first, */
713 /* so commands are in order with data and not split */
714 len = min(count, port->bulk_out_size-2-priv->dp_out_buf_len);
715 if (len > 4)
716 len &= ~3;
718 /* write any buffered data first */
719 if (priv->dp_out_buf_len > 0) {
720 data[0] = DIGI_CMD_SEND_DATA;
721 data[1] = priv->dp_out_buf_len;
722 memcpy(data + 2, priv->dp_out_buf,
723 priv->dp_out_buf_len);
724 memcpy(data + 2 + priv->dp_out_buf_len, buf, len);
725 port->write_urb->transfer_buffer_length
726 = priv->dp_out_buf_len + 2 + len;
727 } else {
728 memcpy(data, buf, len);
729 port->write_urb->transfer_buffer_length = len;
731 port->write_urb->dev = port->serial->dev;
733 ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
734 if (ret == 0) {
735 priv->dp_write_urb_in_use = 1;
736 priv->dp_out_buf_len = 0;
737 count -= len;
738 buf += len;
742 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
744 if (ret)
745 dev_err(&port->dev,
746 "%s: usb_submit_urb failed, ret=%d, port=%d\n",
747 __func__, ret, priv->dp_port_num);
748 return ret;
753 * Digi Set Modem Signals
755 * Sets or clears DTR and RTS on the port, according to the
756 * modem_signals argument. Use TIOCM_DTR and TIOCM_RTS flags
757 * for the modem_signals argument. Returns 0 if successful,
758 * -EINTR if interrupted while sleeping, or a non-zero error
759 * returned by usb_submit_urb.
762 static int digi_set_modem_signals(struct usb_serial_port *port,
763 unsigned int modem_signals, int interruptible)
766 int ret;
767 struct digi_port *port_priv = usb_get_serial_port_data(port);
768 struct usb_serial_port *oob_port = (struct usb_serial_port *) ((struct digi_serial *)(usb_get_serial_data(port->serial)))->ds_oob_port;
769 struct digi_port *oob_priv = usb_get_serial_port_data(oob_port);
770 unsigned char *data = oob_port->write_urb->transfer_buffer;
771 unsigned long flags = 0;
774 dbg("digi_set_modem_signals: TOP: port=%d, modem_signals=0x%x",
775 port_priv->dp_port_num, modem_signals);
777 spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
778 spin_lock(&port_priv->dp_port_lock);
780 while (oob_priv->dp_write_urb_in_use) {
781 spin_unlock(&port_priv->dp_port_lock);
782 cond_wait_interruptible_timeout_irqrestore(
783 &oob_port->write_wait, DIGI_RETRY_TIMEOUT,
784 &oob_priv->dp_port_lock, flags);
785 if (interruptible && signal_pending(current))
786 return -EINTR;
787 spin_lock_irqsave(&oob_priv->dp_port_lock, flags);
788 spin_lock(&port_priv->dp_port_lock);
790 data[0] = DIGI_CMD_SET_DTR_SIGNAL;
791 data[1] = port_priv->dp_port_num;
792 data[2] = (modem_signals & TIOCM_DTR) ?
793 DIGI_DTR_ACTIVE : DIGI_DTR_INACTIVE;
794 data[3] = 0;
795 data[4] = DIGI_CMD_SET_RTS_SIGNAL;
796 data[5] = port_priv->dp_port_num;
797 data[6] = (modem_signals & TIOCM_RTS) ?
798 DIGI_RTS_ACTIVE : DIGI_RTS_INACTIVE;
799 data[7] = 0;
801 oob_port->write_urb->transfer_buffer_length = 8;
802 oob_port->write_urb->dev = port->serial->dev;
804 ret = usb_submit_urb(oob_port->write_urb, GFP_ATOMIC);
805 if (ret == 0) {
806 oob_priv->dp_write_urb_in_use = 1;
807 port_priv->dp_modem_signals =
808 (port_priv->dp_modem_signals&~(TIOCM_DTR|TIOCM_RTS))
809 | (modem_signals&(TIOCM_DTR|TIOCM_RTS));
811 spin_unlock(&port_priv->dp_port_lock);
812 spin_unlock_irqrestore(&oob_priv->dp_port_lock, flags);
813 if (ret)
814 dev_err(&port->dev, "%s: usb_submit_urb failed, ret=%d\n",
815 __func__, ret);
816 return ret;
820 * Digi Transmit Idle
822 * Digi transmit idle waits, up to timeout ticks, for the transmitter
823 * to go idle. It returns 0 if successful or a negative error.
825 * There are race conditions here if more than one process is calling
826 * digi_transmit_idle on the same port at the same time. However, this
827 * is only called from close, and only one process can be in close on a
828 * port at a time, so its ok.
831 static int digi_transmit_idle(struct usb_serial_port *port,
832 unsigned long timeout)
834 int ret;
835 unsigned char buf[2];
836 struct digi_port *priv = usb_get_serial_port_data(port);
837 unsigned long flags = 0;
839 spin_lock_irqsave(&priv->dp_port_lock, flags);
840 priv->dp_transmit_idle = 0;
841 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
843 buf[0] = DIGI_CMD_TRANSMIT_IDLE;
844 buf[1] = 0;
846 timeout += jiffies;
848 ret = digi_write_inb_command(port, buf, 2, timeout - jiffies);
849 if (ret != 0)
850 return ret;
852 spin_lock_irqsave(&priv->dp_port_lock, flags);
854 while (time_before(jiffies, timeout) && !priv->dp_transmit_idle) {
855 cond_wait_interruptible_timeout_irqrestore(
856 &priv->dp_transmit_idle_wait, DIGI_RETRY_TIMEOUT,
857 &priv->dp_port_lock, flags);
858 if (signal_pending(current))
859 return -EINTR;
860 spin_lock_irqsave(&priv->dp_port_lock, flags);
862 priv->dp_transmit_idle = 0;
863 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
864 return 0;
869 static void digi_rx_throttle(struct tty_struct *tty)
871 unsigned long flags;
872 struct usb_serial_port *port = tty->driver_data;
873 struct digi_port *priv = usb_get_serial_port_data(port);
876 dbg("digi_rx_throttle: TOP: port=%d", priv->dp_port_num);
878 /* stop receiving characters by not resubmitting the read urb */
879 spin_lock_irqsave(&priv->dp_port_lock, flags);
880 priv->dp_throttled = 1;
881 priv->dp_throttle_restart = 0;
882 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
886 static void digi_rx_unthrottle(struct tty_struct *tty)
888 int ret = 0;
889 unsigned long flags;
890 struct usb_serial_port *port = tty->driver_data;
891 struct digi_port *priv = usb_get_serial_port_data(port);
893 dbg("digi_rx_unthrottle: TOP: port=%d", priv->dp_port_num);
895 spin_lock_irqsave(&priv->dp_port_lock, flags);
897 /* turn throttle off */
898 priv->dp_throttled = 0;
899 priv->dp_throttle_restart = 0;
901 /* restart read chain */
902 if (priv->dp_throttle_restart) {
903 port->read_urb->dev = port->serial->dev;
904 ret = usb_submit_urb(port->read_urb, GFP_ATOMIC);
907 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
909 if (ret)
910 dev_err(&port->dev,
911 "%s: usb_submit_urb failed, ret=%d, port=%d\n",
912 __func__, ret, priv->dp_port_num);
916 static void digi_set_termios(struct tty_struct *tty,
917 struct usb_serial_port *port, struct ktermios *old_termios)
919 struct digi_port *priv = usb_get_serial_port_data(port);
920 unsigned int iflag = tty->termios->c_iflag;
921 unsigned int cflag = tty->termios->c_cflag;
922 unsigned int old_iflag = old_termios->c_iflag;
923 unsigned int old_cflag = old_termios->c_cflag;
924 unsigned char buf[32];
925 unsigned int modem_signals;
926 int arg, ret;
927 int i = 0;
928 speed_t baud;
930 dbg("digi_set_termios: TOP: port=%d, iflag=0x%x, old_iflag=0x%x, cflag=0x%x, old_cflag=0x%x", priv->dp_port_num, iflag, old_iflag, cflag, old_cflag);
932 /* set baud rate */
933 baud = tty_get_baud_rate(tty);
934 if (baud != tty_termios_baud_rate(old_termios)) {
935 arg = -1;
937 /* reassert DTR and (maybe) RTS on transition from B0 */
938 if ((old_cflag&CBAUD) == B0) {
939 /* don't set RTS if using hardware flow control */
940 /* and throttling input */
941 modem_signals = TIOCM_DTR;
942 if (!(tty->termios->c_cflag & CRTSCTS) ||
943 !test_bit(TTY_THROTTLED, &tty->flags))
944 modem_signals |= TIOCM_RTS;
945 digi_set_modem_signals(port, modem_signals, 1);
947 switch (baud) {
948 /* drop DTR and RTS on transition to B0 */
949 case 0: digi_set_modem_signals(port, 0, 1); break;
950 case 50: arg = DIGI_BAUD_50; break;
951 case 75: arg = DIGI_BAUD_75; break;
952 case 110: arg = DIGI_BAUD_110; break;
953 case 150: arg = DIGI_BAUD_150; break;
954 case 200: arg = DIGI_BAUD_200; break;
955 case 300: arg = DIGI_BAUD_300; break;
956 case 600: arg = DIGI_BAUD_600; break;
957 case 1200: arg = DIGI_BAUD_1200; break;
958 case 1800: arg = DIGI_BAUD_1800; break;
959 case 2400: arg = DIGI_BAUD_2400; break;
960 case 4800: arg = DIGI_BAUD_4800; break;
961 case 9600: arg = DIGI_BAUD_9600; break;
962 case 19200: arg = DIGI_BAUD_19200; break;
963 case 38400: arg = DIGI_BAUD_38400; break;
964 case 57600: arg = DIGI_BAUD_57600; break;
965 case 115200: arg = DIGI_BAUD_115200; break;
966 case 230400: arg = DIGI_BAUD_230400; break;
967 case 460800: arg = DIGI_BAUD_460800; break;
968 default:
969 arg = DIGI_BAUD_9600;
970 baud = 9600;
971 break;
973 if (arg != -1) {
974 buf[i++] = DIGI_CMD_SET_BAUD_RATE;
975 buf[i++] = priv->dp_port_num;
976 buf[i++] = arg;
977 buf[i++] = 0;
980 /* set parity */
981 tty->termios->c_cflag &= ~CMSPAR;
983 if ((cflag&(PARENB|PARODD)) != (old_cflag&(PARENB|PARODD))) {
984 if (cflag&PARENB) {
985 if (cflag&PARODD)
986 arg = DIGI_PARITY_ODD;
987 else
988 arg = DIGI_PARITY_EVEN;
989 } else {
990 arg = DIGI_PARITY_NONE;
992 buf[i++] = DIGI_CMD_SET_PARITY;
993 buf[i++] = priv->dp_port_num;
994 buf[i++] = arg;
995 buf[i++] = 0;
997 /* set word size */
998 if ((cflag&CSIZE) != (old_cflag&CSIZE)) {
999 arg = -1;
1000 switch (cflag&CSIZE) {
1001 case CS5: arg = DIGI_WORD_SIZE_5; break;
1002 case CS6: arg = DIGI_WORD_SIZE_6; break;
1003 case CS7: arg = DIGI_WORD_SIZE_7; break;
1004 case CS8: arg = DIGI_WORD_SIZE_8; break;
1005 default:
1006 dbg("digi_set_termios: can't handle word size %d",
1007 (cflag&CSIZE));
1008 break;
1011 if (arg != -1) {
1012 buf[i++] = DIGI_CMD_SET_WORD_SIZE;
1013 buf[i++] = priv->dp_port_num;
1014 buf[i++] = arg;
1015 buf[i++] = 0;
1020 /* set stop bits */
1021 if ((cflag&CSTOPB) != (old_cflag&CSTOPB)) {
1023 if ((cflag&CSTOPB))
1024 arg = DIGI_STOP_BITS_2;
1025 else
1026 arg = DIGI_STOP_BITS_1;
1028 buf[i++] = DIGI_CMD_SET_STOP_BITS;
1029 buf[i++] = priv->dp_port_num;
1030 buf[i++] = arg;
1031 buf[i++] = 0;
1035 /* set input flow control */
1036 if ((iflag&IXOFF) != (old_iflag&IXOFF)
1037 || (cflag&CRTSCTS) != (old_cflag&CRTSCTS)) {
1038 arg = 0;
1039 if (iflag&IXOFF)
1040 arg |= DIGI_INPUT_FLOW_CONTROL_XON_XOFF;
1041 else
1042 arg &= ~DIGI_INPUT_FLOW_CONTROL_XON_XOFF;
1044 if (cflag&CRTSCTS) {
1045 arg |= DIGI_INPUT_FLOW_CONTROL_RTS;
1047 /* On USB-4 it is necessary to assert RTS prior */
1048 /* to selecting RTS input flow control. */
1049 buf[i++] = DIGI_CMD_SET_RTS_SIGNAL;
1050 buf[i++] = priv->dp_port_num;
1051 buf[i++] = DIGI_RTS_ACTIVE;
1052 buf[i++] = 0;
1054 } else {
1055 arg &= ~DIGI_INPUT_FLOW_CONTROL_RTS;
1057 buf[i++] = DIGI_CMD_SET_INPUT_FLOW_CONTROL;
1058 buf[i++] = priv->dp_port_num;
1059 buf[i++] = arg;
1060 buf[i++] = 0;
1063 /* set output flow control */
1064 if ((iflag & IXON) != (old_iflag & IXON)
1065 || (cflag & CRTSCTS) != (old_cflag & CRTSCTS)) {
1066 arg = 0;
1067 if (iflag & IXON)
1068 arg |= DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF;
1069 else
1070 arg &= ~DIGI_OUTPUT_FLOW_CONTROL_XON_XOFF;
1072 if (cflag & CRTSCTS) {
1073 arg |= DIGI_OUTPUT_FLOW_CONTROL_CTS;
1074 } else {
1075 arg &= ~DIGI_OUTPUT_FLOW_CONTROL_CTS;
1076 tty->hw_stopped = 0;
1079 buf[i++] = DIGI_CMD_SET_OUTPUT_FLOW_CONTROL;
1080 buf[i++] = priv->dp_port_num;
1081 buf[i++] = arg;
1082 buf[i++] = 0;
1085 /* set receive enable/disable */
1086 if ((cflag & CREAD) != (old_cflag & CREAD)) {
1087 if (cflag & CREAD)
1088 arg = DIGI_ENABLE;
1089 else
1090 arg = DIGI_DISABLE;
1092 buf[i++] = DIGI_CMD_RECEIVE_ENABLE;
1093 buf[i++] = priv->dp_port_num;
1094 buf[i++] = arg;
1095 buf[i++] = 0;
1097 ret = digi_write_oob_command(port, buf, i, 1);
1098 if (ret != 0)
1099 dbg("digi_set_termios: write oob failed, ret=%d", ret);
1100 tty_encode_baud_rate(tty, baud, baud);
1104 static void digi_break_ctl(struct tty_struct *tty, int break_state)
1106 struct usb_serial_port *port = tty->driver_data;
1107 unsigned char buf[4];
1109 buf[0] = DIGI_CMD_BREAK_CONTROL;
1110 buf[1] = 2; /* length */
1111 buf[2] = break_state ? 1 : 0;
1112 buf[3] = 0; /* pad */
1113 digi_write_inb_command(port, buf, 4, 0);
1117 static int digi_tiocmget(struct tty_struct *tty, struct file *file)
1119 struct usb_serial_port *port = tty->driver_data;
1120 struct digi_port *priv = usb_get_serial_port_data(port);
1121 unsigned int val;
1122 unsigned long flags;
1124 dbg("%s: TOP: port=%d", __func__, priv->dp_port_num);
1126 spin_lock_irqsave(&priv->dp_port_lock, flags);
1127 val = priv->dp_modem_signals;
1128 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1129 return val;
1133 static int digi_tiocmset(struct tty_struct *tty, struct file *file,
1134 unsigned int set, unsigned int clear)
1136 struct usb_serial_port *port = tty->driver_data;
1137 struct digi_port *priv = usb_get_serial_port_data(port);
1138 unsigned int val;
1139 unsigned long flags;
1141 dbg("%s: TOP: port=%d", __func__, priv->dp_port_num);
1143 spin_lock_irqsave(&priv->dp_port_lock, flags);
1144 val = (priv->dp_modem_signals & ~clear) | set;
1145 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1146 return digi_set_modem_signals(port, val, 1);
1150 static int digi_write(struct tty_struct *tty, struct usb_serial_port *port,
1151 const unsigned char *buf, int count)
1154 int ret, data_len, new_len;
1155 struct digi_port *priv = usb_get_serial_port_data(port);
1156 unsigned char *data = port->write_urb->transfer_buffer;
1157 unsigned long flags = 0;
1159 dbg("digi_write: TOP: port=%d, count=%d, in_interrupt=%ld",
1160 priv->dp_port_num, count, in_interrupt());
1162 /* copy user data (which can sleep) before getting spin lock */
1163 count = min(count, port->bulk_out_size-2);
1164 count = min(64, count);
1166 /* be sure only one write proceeds at a time */
1167 /* there are races on the port private buffer */
1168 spin_lock_irqsave(&priv->dp_port_lock, flags);
1170 /* wait for urb status clear to submit another urb */
1171 if (priv->dp_write_urb_in_use) {
1172 /* buffer data if count is 1 (probably put_char) if possible */
1173 if (count == 1 && priv->dp_out_buf_len < DIGI_OUT_BUF_SIZE) {
1174 priv->dp_out_buf[priv->dp_out_buf_len++] = *buf;
1175 new_len = 1;
1176 } else {
1177 new_len = 0;
1179 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1180 return new_len;
1183 /* allow space for any buffered data and for new data, up to */
1184 /* transfer buffer size - 2 (for command and length bytes) */
1185 new_len = min(count, port->bulk_out_size-2-priv->dp_out_buf_len);
1186 data_len = new_len + priv->dp_out_buf_len;
1188 if (data_len == 0) {
1189 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1190 return 0;
1193 port->write_urb->transfer_buffer_length = data_len+2;
1194 port->write_urb->dev = port->serial->dev;
1196 *data++ = DIGI_CMD_SEND_DATA;
1197 *data++ = data_len;
1199 /* copy in buffered data first */
1200 memcpy(data, priv->dp_out_buf, priv->dp_out_buf_len);
1201 data += priv->dp_out_buf_len;
1203 /* copy in new data */
1204 memcpy(data, buf, new_len);
1206 ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
1207 if (ret == 0) {
1208 priv->dp_write_urb_in_use = 1;
1209 ret = new_len;
1210 priv->dp_out_buf_len = 0;
1213 /* return length of new data written, or error */
1214 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1215 if (ret < 0)
1216 dev_err(&port->dev,
1217 "%s: usb_submit_urb failed, ret=%d, port=%d\n",
1218 __func__, ret, priv->dp_port_num);
1219 dbg("digi_write: returning %d", ret);
1220 return ret;
1224 static void digi_write_bulk_callback(struct urb *urb)
1227 struct usb_serial_port *port = urb->context;
1228 struct usb_serial *serial;
1229 struct digi_port *priv;
1230 struct digi_serial *serial_priv;
1231 int ret = 0;
1232 int status = urb->status;
1234 dbg("digi_write_bulk_callback: TOP, status=%d", status);
1236 /* port and serial sanity check */
1237 if (port == NULL || (priv = usb_get_serial_port_data(port)) == NULL) {
1238 dev_err(&port->dev,
1239 "%s: port or port->private is NULL, status=%d\n",
1240 __func__, status);
1241 return;
1243 serial = port->serial;
1244 if (serial == NULL || (serial_priv = usb_get_serial_data(serial)) == NULL) {
1245 dev_err(&port->dev,
1246 "%s: serial or serial->private is NULL, status=%d\n",
1247 __func__, status);
1248 return;
1251 /* handle oob callback */
1252 if (priv->dp_port_num == serial_priv->ds_oob_port_num) {
1253 dbg("digi_write_bulk_callback: oob callback");
1254 spin_lock(&priv->dp_port_lock);
1255 priv->dp_write_urb_in_use = 0;
1256 wake_up_interruptible(&port->write_wait);
1257 spin_unlock(&priv->dp_port_lock);
1258 return;
1261 /* try to send any buffered data on this port, if it is open */
1262 spin_lock(&priv->dp_port_lock);
1263 priv->dp_write_urb_in_use = 0;
1264 if (port->port.count && priv->dp_out_buf_len > 0) {
1265 *((unsigned char *)(port->write_urb->transfer_buffer))
1266 = (unsigned char)DIGI_CMD_SEND_DATA;
1267 *((unsigned char *)(port->write_urb->transfer_buffer) + 1)
1268 = (unsigned char)priv->dp_out_buf_len;
1269 port->write_urb->transfer_buffer_length =
1270 priv->dp_out_buf_len + 2;
1271 port->write_urb->dev = serial->dev;
1272 memcpy(port->write_urb->transfer_buffer + 2, priv->dp_out_buf,
1273 priv->dp_out_buf_len);
1274 ret = usb_submit_urb(port->write_urb, GFP_ATOMIC);
1275 if (ret == 0) {
1276 priv->dp_write_urb_in_use = 1;
1277 priv->dp_out_buf_len = 0;
1280 /* wake up processes sleeping on writes immediately */
1281 digi_wakeup_write(port);
1282 /* also queue up a wakeup at scheduler time, in case we */
1283 /* lost the race in write_chan(). */
1284 schedule_work(&priv->dp_wakeup_work);
1286 spin_unlock(&priv->dp_port_lock);
1287 if (ret)
1288 dev_err(&port->dev,
1289 "%s: usb_submit_urb failed, ret=%d, port=%d\n",
1290 __func__, ret, priv->dp_port_num);
1293 static int digi_write_room(struct tty_struct *tty)
1295 struct usb_serial_port *port = tty->driver_data;
1296 struct digi_port *priv = usb_get_serial_port_data(port);
1297 int room;
1298 unsigned long flags = 0;
1300 spin_lock_irqsave(&priv->dp_port_lock, flags);
1302 if (priv->dp_write_urb_in_use)
1303 room = 0;
1304 else
1305 room = port->bulk_out_size - 2 - priv->dp_out_buf_len;
1307 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1308 dbg("digi_write_room: port=%d, room=%d", priv->dp_port_num, room);
1309 return room;
1313 static int digi_chars_in_buffer(struct tty_struct *tty)
1315 struct usb_serial_port *port = tty->driver_data;
1316 struct digi_port *priv = usb_get_serial_port_data(port);
1318 if (priv->dp_write_urb_in_use) {
1319 dbg("digi_chars_in_buffer: port=%d, chars=%d",
1320 priv->dp_port_num, port->bulk_out_size - 2);
1321 /* return(port->bulk_out_size - 2); */
1322 return 256;
1323 } else {
1324 dbg("digi_chars_in_buffer: port=%d, chars=%d",
1325 priv->dp_port_num, priv->dp_out_buf_len);
1326 return priv->dp_out_buf_len;
1332 static int digi_open(struct tty_struct *tty, struct usb_serial_port *port,
1333 struct file *filp)
1335 int ret;
1336 unsigned char buf[32];
1337 struct digi_port *priv = usb_get_serial_port_data(port);
1338 struct ktermios not_termios;
1339 unsigned long flags = 0;
1341 dbg("digi_open: TOP: port=%d, open_count=%d",
1342 priv->dp_port_num, port->port.count);
1344 /* be sure the device is started up */
1345 if (digi_startup_device(port->serial) != 0)
1346 return -ENXIO;
1348 spin_lock_irqsave(&priv->dp_port_lock, flags);
1350 /* don't wait on a close in progress for non-blocking opens */
1351 if (priv->dp_in_close && (filp->f_flags&(O_NDELAY|O_NONBLOCK)) == 0) {
1352 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1353 return -EAGAIN;
1356 /* wait for a close in progress to finish */
1357 while (priv->dp_in_close) {
1358 cond_wait_interruptible_timeout_irqrestore(
1359 &priv->dp_close_wait, DIGI_RETRY_TIMEOUT,
1360 &priv->dp_port_lock, flags);
1361 if (signal_pending(current))
1362 return -EINTR;
1363 spin_lock_irqsave(&priv->dp_port_lock, flags);
1366 spin_unlock_irqrestore(&priv->dp_port_lock, flags);
1368 /* read modem signals automatically whenever they change */
1369 buf[0] = DIGI_CMD_READ_INPUT_SIGNALS;
1370 buf[1] = priv->dp_port_num;
1371 buf[2] = DIGI_ENABLE;
1372 buf[3] = 0;
1374 /* flush fifos */
1375 buf[4] = DIGI_CMD_IFLUSH_FIFO;
1376 buf[5] = priv->dp_port_num;
1377 buf[6] = DIGI_FLUSH_TX | DIGI_FLUSH_RX;
1378 buf[7] = 0;
1380 ret = digi_write_oob_command(port, buf, 8, 1);
1381 if (ret != 0)
1382 dbg("digi_open: write oob failed, ret=%d", ret);
1384 /* set termios settings */
1385 if (tty) {
1386 not_termios.c_cflag = ~tty->termios->c_cflag;
1387 not_termios.c_iflag = ~tty->termios->c_iflag;
1388 digi_set_termios(tty, port, &not_termios);
1391 /* set DTR and RTS */
1392 digi_set_modem_signals(port, TIOCM_DTR|TIOCM_RTS, 1);
1394 return 0;
1398 static void digi_close(struct tty_struct *tty, struct usb_serial_port *port,
1399 struct file *filp)
1401 DEFINE_WAIT(wait);
1402 int ret;
1403 unsigned char buf[32];
1404 struct digi_port *priv = usb_get_serial_port_data(port);
1406 dbg("digi_close: TOP: port=%d, open_count=%d",
1407 priv->dp_port_num, port->port.count);
1409 mutex_lock(&port->serial->disc_mutex);
1410 /* if disconnected, just clear flags */
1411 if (port->serial->disconnected)
1412 goto exit;
1414 /* do cleanup only after final close on this port */
1415 spin_lock_irq(&priv->dp_port_lock);
1416 priv->dp_in_close = 1;
1417 spin_unlock_irq(&priv->dp_port_lock);
1419 /* tell line discipline to process only XON/XOFF */
1420 tty->closing = 1;
1422 /* wait for output to drain */
1423 if ((filp->f_flags&(O_NDELAY|O_NONBLOCK)) == 0)
1424 tty_wait_until_sent(tty, DIGI_CLOSE_TIMEOUT);
1426 /* flush driver and line discipline buffers */
1427 tty_driver_flush_buffer(tty);
1428 tty_ldisc_flush(tty);
1430 if (port->serial->dev) {
1431 /* wait for transmit idle */
1432 if ((filp->f_flags&(O_NDELAY|O_NONBLOCK)) == 0)
1433 digi_transmit_idle(port, DIGI_CLOSE_TIMEOUT);
1434 /* drop DTR and RTS */
1435 digi_set_modem_signals(port, 0, 0);
1437 /* disable input flow control */
1438 buf[0] = DIGI_CMD_SET_INPUT_FLOW_CONTROL;
1439 buf[1] = priv->dp_port_num;
1440 buf[2] = DIGI_DISABLE;
1441 buf[3] = 0;
1443 /* disable output flow control */
1444 buf[4] = DIGI_CMD_SET_OUTPUT_FLOW_CONTROL;
1445 buf[5] = priv->dp_port_num;
1446 buf[6] = DIGI_DISABLE;
1447 buf[7] = 0;
1449 /* disable reading modem signals automatically */
1450 buf[8] = DIGI_CMD_READ_INPUT_SIGNALS;
1451 buf[9] = priv->dp_port_num;
1452 buf[10] = DIGI_DISABLE;
1453 buf[11] = 0;
1455 /* disable receive */
1456 buf[12] = DIGI_CMD_RECEIVE_ENABLE;
1457 buf[13] = priv->dp_port_num;
1458 buf[14] = DIGI_DISABLE;
1459 buf[15] = 0;
1461 /* flush fifos */
1462 buf[16] = DIGI_CMD_IFLUSH_FIFO;
1463 buf[17] = priv->dp_port_num;
1464 buf[18] = DIGI_FLUSH_TX | DIGI_FLUSH_RX;
1465 buf[19] = 0;
1467 ret = digi_write_oob_command(port, buf, 20, 0);
1468 if (ret != 0)
1469 dbg("digi_close: write oob failed, ret=%d", ret);
1471 /* wait for final commands on oob port to complete */
1472 prepare_to_wait(&priv->dp_flush_wait, &wait,
1473 TASK_INTERRUPTIBLE);
1474 schedule_timeout(DIGI_CLOSE_TIMEOUT);
1475 finish_wait(&priv->dp_flush_wait, &wait);
1477 /* shutdown any outstanding bulk writes */
1478 usb_kill_urb(port->write_urb);
1480 tty->closing = 0;
1481 exit:
1482 spin_lock_irq(&priv->dp_port_lock);
1483 priv->dp_write_urb_in_use = 0;
1484 priv->dp_in_close = 0;
1485 wake_up_interruptible(&priv->dp_close_wait);
1486 spin_unlock_irq(&priv->dp_port_lock);
1487 mutex_unlock(&port->serial->disc_mutex);
1488 dbg("digi_close: done");
1493 * Digi Startup Device
1495 * Starts reads on all ports. Must be called AFTER startup, with
1496 * urbs initialized. Returns 0 if successful, non-zero error otherwise.
1499 static int digi_startup_device(struct usb_serial *serial)
1501 int i, ret = 0;
1502 struct digi_serial *serial_priv = usb_get_serial_data(serial);
1503 struct usb_serial_port *port;
1505 /* be sure this happens exactly once */
1506 spin_lock(&serial_priv->ds_serial_lock);
1507 if (serial_priv->ds_device_started) {
1508 spin_unlock(&serial_priv->ds_serial_lock);
1509 return 0;
1511 serial_priv->ds_device_started = 1;
1512 spin_unlock(&serial_priv->ds_serial_lock);
1514 /* start reading from each bulk in endpoint for the device */
1515 /* set USB_DISABLE_SPD flag for write bulk urbs */
1516 for (i = 0; i < serial->type->num_ports + 1; i++) {
1517 port = serial->port[i];
1518 port->write_urb->dev = port->serial->dev;
1519 ret = usb_submit_urb(port->read_urb, GFP_KERNEL);
1520 if (ret != 0) {
1521 dev_err(&port->dev,
1522 "%s: usb_submit_urb failed, ret=%d, port=%d\n",
1523 __func__, ret, i);
1524 break;
1527 return ret;
1531 static int digi_startup(struct usb_serial *serial)
1534 int i;
1535 struct digi_port *priv;
1536 struct digi_serial *serial_priv;
1538 dbg("digi_startup: TOP");
1540 /* allocate the private data structures for all ports */
1541 /* number of regular ports + 1 for the out-of-band port */
1542 for (i = 0; i < serial->type->num_ports + 1; i++) {
1543 /* allocate port private structure */
1544 priv = kmalloc(sizeof(struct digi_port), GFP_KERNEL);
1545 if (priv == NULL) {
1546 while (--i >= 0)
1547 kfree(usb_get_serial_port_data(serial->port[i]));
1548 return 1; /* error */
1551 /* initialize port private structure */
1552 spin_lock_init(&priv->dp_port_lock);
1553 priv->dp_port_num = i;
1554 priv->dp_out_buf_len = 0;
1555 priv->dp_write_urb_in_use = 0;
1556 priv->dp_modem_signals = 0;
1557 init_waitqueue_head(&priv->dp_modem_change_wait);
1558 priv->dp_transmit_idle = 0;
1559 init_waitqueue_head(&priv->dp_transmit_idle_wait);
1560 priv->dp_throttled = 0;
1561 priv->dp_throttle_restart = 0;
1562 init_waitqueue_head(&priv->dp_flush_wait);
1563 priv->dp_in_close = 0;
1564 init_waitqueue_head(&priv->dp_close_wait);
1565 INIT_WORK(&priv->dp_wakeup_work, digi_wakeup_write_lock);
1566 priv->dp_port = serial->port[i];
1567 /* initialize write wait queue for this port */
1568 init_waitqueue_head(&serial->port[i]->write_wait);
1570 usb_set_serial_port_data(serial->port[i], priv);
1573 /* allocate serial private structure */
1574 serial_priv = kmalloc(sizeof(struct digi_serial), GFP_KERNEL);
1575 if (serial_priv == NULL) {
1576 for (i = 0; i < serial->type->num_ports + 1; i++)
1577 kfree(usb_get_serial_port_data(serial->port[i]));
1578 return 1; /* error */
1581 /* initialize serial private structure */
1582 spin_lock_init(&serial_priv->ds_serial_lock);
1583 serial_priv->ds_oob_port_num = serial->type->num_ports;
1584 serial_priv->ds_oob_port = serial->port[serial_priv->ds_oob_port_num];
1585 serial_priv->ds_device_started = 0;
1586 usb_set_serial_data(serial, serial_priv);
1588 return 0;
1592 static void digi_shutdown(struct usb_serial *serial)
1594 int i;
1595 dbg("digi_shutdown: TOP, in_interrupt()=%ld", in_interrupt());
1597 /* stop reads and writes on all ports */
1598 for (i = 0; i < serial->type->num_ports + 1; i++) {
1599 usb_kill_urb(serial->port[i]->read_urb);
1600 usb_kill_urb(serial->port[i]->write_urb);
1603 /* free the private data structures for all ports */
1604 /* number of regular ports + 1 for the out-of-band port */
1605 for (i = 0; i < serial->type->num_ports + 1; i++)
1606 kfree(usb_get_serial_port_data(serial->port[i]));
1607 kfree(usb_get_serial_data(serial));
1611 static void digi_read_bulk_callback(struct urb *urb)
1613 struct usb_serial_port *port = urb->context;
1614 struct digi_port *priv;
1615 struct digi_serial *serial_priv;
1616 int ret;
1617 int status = urb->status;
1619 dbg("digi_read_bulk_callback: TOP");
1621 /* port sanity check, do not resubmit if port is not valid */
1622 if (port == NULL)
1623 return;
1624 priv = usb_get_serial_port_data(port);
1625 if (priv == NULL) {
1626 dev_err(&port->dev, "%s: port->private is NULL, status=%d\n",
1627 __func__, status);
1628 return;
1630 if (port->serial == NULL ||
1631 (serial_priv = usb_get_serial_data(port->serial)) == NULL) {
1632 dev_err(&port->dev, "%s: serial is bad or serial->private "
1633 "is NULL, status=%d\n", __func__, status);
1634 return;
1637 /* do not resubmit urb if it has any status error */
1638 if (status) {
1639 dev_err(&port->dev,
1640 "%s: nonzero read bulk status: status=%d, port=%d\n",
1641 __func__, status, priv->dp_port_num);
1642 return;
1645 /* handle oob or inb callback, do not resubmit if error */
1646 if (priv->dp_port_num == serial_priv->ds_oob_port_num) {
1647 if (digi_read_oob_callback(urb) != 0)
1648 return;
1649 } else {
1650 if (digi_read_inb_callback(urb) != 0)
1651 return;
1654 /* continue read */
1655 urb->dev = port->serial->dev;
1656 ret = usb_submit_urb(urb, GFP_ATOMIC);
1657 if (ret != 0) {
1658 dev_err(&port->dev,
1659 "%s: failed resubmitting urb, ret=%d, port=%d\n",
1660 __func__, ret, priv->dp_port_num);
1666 * Digi Read INB Callback
1668 * Digi Read INB Callback handles reads on the in band ports, sending
1669 * the data on to the tty subsystem. When called we know port and
1670 * port->private are not NULL and port->serial has been validated.
1671 * It returns 0 if successful, 1 if successful but the port is
1672 * throttled, and -1 if the sanity checks failed.
1675 static int digi_read_inb_callback(struct urb *urb)
1678 struct usb_serial_port *port = urb->context;
1679 struct tty_struct *tty;
1680 struct digi_port *priv = usb_get_serial_port_data(port);
1681 int opcode = ((unsigned char *)urb->transfer_buffer)[0];
1682 int len = ((unsigned char *)urb->transfer_buffer)[1];
1683 int port_status = ((unsigned char *)urb->transfer_buffer)[2];
1684 unsigned char *data = ((unsigned char *)urb->transfer_buffer) + 3;
1685 int flag, throttled;
1686 int i;
1687 int status = urb->status;
1689 /* do not process callbacks on closed ports */
1690 /* but do continue the read chain */
1691 if (port->port.count == 0)
1692 return 0;
1694 /* short/multiple packet check */
1695 if (urb->actual_length != len + 2) {
1696 dev_err(&port->dev, "%s: INCOMPLETE OR MULTIPLE PACKET, "
1697 "status=%d, port=%d, opcode=%d, len=%d, "
1698 "actual_length=%d, status=%d\n", __func__, status,
1699 priv->dp_port_num, opcode, len, urb->actual_length,
1700 port_status);
1701 return -1;
1704 tty = tty_port_tty_get(&port->port);
1705 spin_lock(&priv->dp_port_lock);
1707 /* check for throttle; if set, do not resubmit read urb */
1708 /* indicate the read chain needs to be restarted on unthrottle */
1709 throttled = priv->dp_throttled;
1710 if (throttled)
1711 priv->dp_throttle_restart = 1;
1713 /* receive data */
1714 if (opcode == DIGI_CMD_RECEIVE_DATA) {
1715 /* get flag from port_status */
1716 flag = 0;
1718 /* overrun is special, not associated with a char */
1719 if (port_status & DIGI_OVERRUN_ERROR)
1720 tty_insert_flip_char(tty, 0, TTY_OVERRUN);
1722 /* break takes precedence over parity, */
1723 /* which takes precedence over framing errors */
1724 if (port_status & DIGI_BREAK_ERROR)
1725 flag = TTY_BREAK;
1726 else if (port_status & DIGI_PARITY_ERROR)
1727 flag = TTY_PARITY;
1728 else if (port_status & DIGI_FRAMING_ERROR)
1729 flag = TTY_FRAME;
1731 /* data length is len-1 (one byte of len is port_status) */
1732 --len;
1734 len = tty_buffer_request_room(tty, len);
1735 if (len > 0) {
1736 /* Hot path */
1737 if (flag == TTY_NORMAL)
1738 tty_insert_flip_string(tty, data, len);
1739 else {
1740 for (i = 0; i < len; i++)
1741 tty_insert_flip_char(tty,
1742 data[i], flag);
1744 tty_flip_buffer_push(tty);
1747 spin_unlock(&priv->dp_port_lock);
1748 tty_kref_put(tty);
1750 if (opcode == DIGI_CMD_RECEIVE_DISABLE)
1751 dbg("%s: got RECEIVE_DISABLE", __func__);
1752 else if (opcode != DIGI_CMD_RECEIVE_DATA)
1753 dbg("%s: unknown opcode: %d", __func__, opcode);
1755 return throttled ? 1 : 0;
1761 * Digi Read OOB Callback
1763 * Digi Read OOB Callback handles reads on the out of band port.
1764 * When called we know port and port->private are not NULL and
1765 * the port->serial is valid. It returns 0 if successful, and
1766 * -1 if the sanity checks failed.
1769 static int digi_read_oob_callback(struct urb *urb)
1772 struct usb_serial_port *port = urb->context;
1773 struct usb_serial *serial = port->serial;
1774 struct tty_struct *tty;
1775 struct digi_port *priv = usb_get_serial_port_data(port);
1776 int opcode, line, status, val;
1777 int i;
1778 unsigned int rts;
1780 dbg("digi_read_oob_callback: port=%d, len=%d",
1781 priv->dp_port_num, urb->actual_length);
1783 /* handle each oob command */
1784 for (i = 0; i < urb->actual_length - 3;) {
1785 opcode = ((unsigned char *)urb->transfer_buffer)[i++];
1786 line = ((unsigned char *)urb->transfer_buffer)[i++];
1787 status = ((unsigned char *)urb->transfer_buffer)[i++];
1788 val = ((unsigned char *)urb->transfer_buffer)[i++];
1790 dbg("digi_read_oob_callback: opcode=%d, line=%d, status=%d, val=%d",
1791 opcode, line, status, val);
1793 if (status != 0 || line >= serial->type->num_ports)
1794 continue;
1796 port = serial->port[line];
1798 priv = usb_get_serial_port_data(port);
1799 if (priv == NULL)
1800 return -1;
1802 tty = tty_port_tty_get(&port->port);
1803 rts = 0;
1804 if (port->port.count)
1805 rts = tty->termios->c_cflag & CRTSCTS;
1807 if (opcode == DIGI_CMD_READ_INPUT_SIGNALS) {
1808 spin_lock(&priv->dp_port_lock);
1809 /* convert from digi flags to termiox flags */
1810 if (val & DIGI_READ_INPUT_SIGNALS_CTS) {
1811 priv->dp_modem_signals |= TIOCM_CTS;
1812 /* port must be open to use tty struct */
1813 if (rts) {
1814 tty->hw_stopped = 0;
1815 digi_wakeup_write(port);
1817 } else {
1818 priv->dp_modem_signals &= ~TIOCM_CTS;
1819 /* port must be open to use tty struct */
1820 if (rts)
1821 tty->hw_stopped = 1;
1823 if (val & DIGI_READ_INPUT_SIGNALS_DSR)
1824 priv->dp_modem_signals |= TIOCM_DSR;
1825 else
1826 priv->dp_modem_signals &= ~TIOCM_DSR;
1827 if (val & DIGI_READ_INPUT_SIGNALS_RI)
1828 priv->dp_modem_signals |= TIOCM_RI;
1829 else
1830 priv->dp_modem_signals &= ~TIOCM_RI;
1831 if (val & DIGI_READ_INPUT_SIGNALS_DCD)
1832 priv->dp_modem_signals |= TIOCM_CD;
1833 else
1834 priv->dp_modem_signals &= ~TIOCM_CD;
1836 wake_up_interruptible(&priv->dp_modem_change_wait);
1837 spin_unlock(&priv->dp_port_lock);
1838 } else if (opcode == DIGI_CMD_TRANSMIT_IDLE) {
1839 spin_lock(&priv->dp_port_lock);
1840 priv->dp_transmit_idle = 1;
1841 wake_up_interruptible(&priv->dp_transmit_idle_wait);
1842 spin_unlock(&priv->dp_port_lock);
1843 } else if (opcode == DIGI_CMD_IFLUSH_FIFO) {
1844 wake_up_interruptible(&priv->dp_flush_wait);
1846 tty_kref_put(tty);
1848 return 0;
1852 static int __init digi_init(void)
1854 int retval;
1855 retval = usb_serial_register(&digi_acceleport_2_device);
1856 if (retval)
1857 goto failed_acceleport_2_device;
1858 retval = usb_serial_register(&digi_acceleport_4_device);
1859 if (retval)
1860 goto failed_acceleport_4_device;
1861 retval = usb_register(&digi_driver);
1862 if (retval)
1863 goto failed_usb_register;
1864 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
1865 DRIVER_DESC "\n");
1866 return 0;
1867 failed_usb_register:
1868 usb_serial_deregister(&digi_acceleport_4_device);
1869 failed_acceleport_4_device:
1870 usb_serial_deregister(&digi_acceleport_2_device);
1871 failed_acceleport_2_device:
1872 return retval;
1875 static void __exit digi_exit (void)
1877 usb_deregister(&digi_driver);
1878 usb_serial_deregister(&digi_acceleport_2_device);
1879 usb_serial_deregister(&digi_acceleport_4_device);
1883 module_init(digi_init);
1884 module_exit(digi_exit);
1887 MODULE_AUTHOR(DRIVER_AUTHOR);
1888 MODULE_DESCRIPTION(DRIVER_DESC);
1889 MODULE_LICENSE("GPL");
1891 module_param(debug, bool, S_IRUGO | S_IWUSR);
1892 MODULE_PARM_DESC(debug, "Debug enabled or not");