2 * MCT (Magic Control Technology Corp.) USB RS232 Converter Driver
4 * Copyright (C) 2000 Wolfgang Grandegger (wolfgang@ces.ch)
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 * This program is largely derived from the Belkin USB Serial Adapter Driver
12 * (see belkin_sa.[ch]). All of the information about the device was acquired
13 * by using SniffUSB on Windows98. For technical details see mct_u232.h.
15 * William G. Greathouse and Greg Kroah-Hartman provided great help on how to
16 * do the reverse engineering and how to write a USB serial device driver.
18 * TO BE DONE, TO BE CHECKED:
19 * DTR/RTS signal handling may be incomplete or incorrect. I have mainly
20 * implemented what I have seen with SniffUSB or found in belkin_sa.c.
21 * For further TODOs check also belkin_sa.c.
24 * Basic tests have been performed with minicom/zmodem transfers and
25 * modem dialing under Linux 2.4.0-test10 (for me it works fine).
27 * 04-Nov-2003 Bill Marr <marr at flex dot com>
28 * - Mimic Windows driver by sending 2 USB 'device request' messages
29 * following normal 'baud rate change' message. This allows data to be
30 * transmitted to RS-232 devices which don't assert the 'CTS' signal.
32 * 10-Nov-2001 Wolfgang Grandegger
33 * - Fixed an endianess problem with the baudrate selection for PowerPC.
35 * 06-Dec-2001 Martin Hamilton <martinh@gnu.org>
36 * - Added support for the Belkin F5U109 DB9 adaptor
38 * 30-May-2001 Greg Kroah-Hartman
39 * - switched from using spinlock to a semaphore, which fixes lots of
42 * 04-May-2001 Stelian Pop
43 * - Set the maximum bulk output size for Sitecom U232-P25 model to 16 bytes
44 * instead of the device reported 32 (using 32 bytes causes many data
45 * loss, Windows driver uses 16 too).
47 * 02-May-2001 Stelian Pop
48 * - Fixed the baud calculation for Sitecom U232-P25 model
51 * - Identify version on module load.
53 * 06-Jan-2001 Cornel Ciocirlan
54 * - Added support for Sitecom U232-P25 model (Product Id 0x0230)
55 * - Added support for D-Link DU-H3SP USB BAY (Product Id 0x0200)
57 * 29-Nov-2000 Greg Kroah-Hartman
58 * - Added device id table to fit with 2.4.0-test11 structure.
59 * - took out DEAL_WITH_TWO_INT_IN_ENDPOINTS #define as it's not needed
60 * (lots of things will change if/when the usb-serial core changes to
61 * handle these issues.
63 * 27-Nov-2000 Wolfgang Grandegge
64 * A version for kernel 2.4.0-test10 released to the Linux community
65 * (via linux-usb-devel).
68 #include <linux/kernel.h>
69 #include <linux/errno.h>
70 #include <linux/init.h>
71 #include <linux/slab.h>
72 #include <linux/tty.h>
73 #include <linux/tty_driver.h>
74 #include <linux/tty_flip.h>
75 #include <linux/module.h>
76 #include <linux/spinlock.h>
77 #include <linux/uaccess.h>
78 #include <asm/unaligned.h>
79 #include <linux/usb.h>
80 #include <linux/usb/serial.h>
81 #include <linux/serial.h>
82 #include <linux/ioctl.h>
88 #define DRIVER_VERSION "z2.1" /* Linux in-kernel version */
89 #define DRIVER_AUTHOR "Wolfgang Grandegger <wolfgang@ces.ch>"
90 #define DRIVER_DESC "Magic Control Technology USB-RS232 converter driver"
97 static int mct_u232_startup(struct usb_serial *serial);
98 static void mct_u232_release(struct usb_serial *serial);
99 static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port);
100 static void mct_u232_close(struct usb_serial_port *port);
101 static void mct_u232_dtr_rts(struct usb_serial_port *port, int on);
102 static void mct_u232_read_int_callback(struct urb *urb);
103 static void mct_u232_set_termios(struct tty_struct *tty,
104 struct usb_serial_port *port, struct ktermios *old);
105 static void mct_u232_break_ctl(struct tty_struct *tty, int break_state);
106 static int mct_u232_tiocmget(struct tty_struct *tty);
107 static int mct_u232_tiocmset(struct tty_struct *tty,
108 unsigned int set, unsigned int clear);
109 static int mct_u232_ioctl(struct tty_struct *tty,
110 unsigned int cmd, unsigned long arg);
111 static int mct_u232_get_icount(struct tty_struct *tty,
112 struct serial_icounter_struct *icount);
113 static void mct_u232_throttle(struct tty_struct *tty);
114 static void mct_u232_unthrottle(struct tty_struct *tty);
118 * All of the device info needed for the MCT USB-RS232 converter.
120 static const struct usb_device_id id_table_combined[] = {
121 { USB_DEVICE(MCT_U232_VID, MCT_U232_PID) },
122 { USB_DEVICE(MCT_U232_VID, MCT_U232_SITECOM_PID) },
123 { USB_DEVICE(MCT_U232_VID, MCT_U232_DU_H3SP_PID) },
124 { USB_DEVICE(MCT_U232_BELKIN_F5U109_VID, MCT_U232_BELKIN_F5U109_PID) },
125 { } /* Terminating entry */
128 MODULE_DEVICE_TABLE(usb, id_table_combined);
130 static struct usb_driver mct_u232_driver = {
132 .probe = usb_serial_probe,
133 .disconnect = usb_serial_disconnect,
134 .id_table = id_table_combined,
138 static struct usb_serial_driver mct_u232_device = {
140 .owner = THIS_MODULE,
143 .description = "MCT U232",
144 .usb_driver = &mct_u232_driver,
145 .id_table = id_table_combined,
147 .open = mct_u232_open,
148 .close = mct_u232_close,
149 .dtr_rts = mct_u232_dtr_rts,
150 .throttle = mct_u232_throttle,
151 .unthrottle = mct_u232_unthrottle,
152 .read_int_callback = mct_u232_read_int_callback,
153 .set_termios = mct_u232_set_termios,
154 .break_ctl = mct_u232_break_ctl,
155 .tiocmget = mct_u232_tiocmget,
156 .tiocmset = mct_u232_tiocmset,
157 .attach = mct_u232_startup,
158 .release = mct_u232_release,
159 .ioctl = mct_u232_ioctl,
160 .get_icount = mct_u232_get_icount,
163 struct mct_u232_private {
165 unsigned int control_state; /* Modem Line Setting (TIOCM) */
166 unsigned char last_lcr; /* Line Control Register */
167 unsigned char last_lsr; /* Line Status Register */
168 unsigned char last_msr; /* Modem Status Register */
169 unsigned int rx_flags; /* Throttling flags */
170 struct async_icount icount;
171 wait_queue_head_t msr_wait; /* for handling sleeping while waiting
172 for msr change to happen */
175 #define THROTTLED 0x01
178 * Handle vendor specific USB requests
181 #define WDR_TIMEOUT 5000 /* default urb timeout */
184 * Later day 2.6.0-test kernels have new baud rates like B230400 which
185 * we do not know how to support. We ignore them for the moment.
187 static int mct_u232_calculate_baud_rate(struct usb_serial *serial,
188 speed_t value, speed_t *result)
192 if (le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_SITECOM_PID
193 || le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_BELKIN_F5U109_PID) {
198 return 0x02; /* this one not tested */
220 /* FIXME: Can we use any divider - should we do
221 divider = 115200/value;
222 real baud = 115200/divider */
242 static int mct_u232_set_baud_rate(struct tty_struct *tty,
243 struct usb_serial *serial, struct usb_serial_port *port, speed_t value)
245 unsigned int divisor;
248 unsigned char cts_enable_byte = 0;
251 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
255 divisor = mct_u232_calculate_baud_rate(serial, value, &speed);
256 put_unaligned_le32(cpu_to_le32(divisor), buf);
257 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
258 MCT_U232_SET_BAUD_RATE_REQUEST,
259 MCT_U232_SET_REQUEST_TYPE,
260 0, 0, buf, MCT_U232_SET_BAUD_RATE_SIZE,
262 if (rc < 0) /*FIXME: What value speed results */
263 dev_err(&port->dev, "Set BAUD RATE %d failed (error = %d)\n",
266 tty_encode_baud_rate(tty, speed, speed);
267 dbg("set_baud_rate: value: 0x%x, divisor: 0x%x", value, divisor);
269 /* Mimic the MCT-supplied Windows driver (version 1.21P.0104), which
270 always sends two extra USB 'device request' messages after the
271 'baud rate change' message. The actual functionality of the
272 request codes in these messages is not fully understood but these
273 particular codes are never seen in any operation besides a baud
274 rate change. Both of these messages send a single byte of data.
275 In the first message, the value of this byte is always zero.
277 The second message has been determined experimentally to control
278 whether data will be transmitted to a device which is not asserting
279 the 'CTS' signal. If the second message's data byte is zero, data
280 will be transmitted even if 'CTS' is not asserted (i.e. no hardware
281 flow control). if the second message's data byte is nonzero (a
282 value of 1 is used by this driver), data will not be transmitted to
283 a device which is not asserting 'CTS'.
287 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
288 MCT_U232_SET_UNKNOWN1_REQUEST,
289 MCT_U232_SET_REQUEST_TYPE,
290 0, 0, buf, MCT_U232_SET_UNKNOWN1_SIZE,
293 dev_err(&port->dev, "Sending USB device request code %d "
294 "failed (error = %d)\n", MCT_U232_SET_UNKNOWN1_REQUEST,
297 if (port && C_CRTSCTS(tty))
300 dbg("set_baud_rate: send second control message, data = %02X",
302 buf[0] = cts_enable_byte;
303 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
304 MCT_U232_SET_CTS_REQUEST,
305 MCT_U232_SET_REQUEST_TYPE,
306 0, 0, buf, MCT_U232_SET_CTS_SIZE,
309 dev_err(&port->dev, "Sending USB device request code %d "
310 "failed (error = %d)\n", MCT_U232_SET_CTS_REQUEST, rc);
314 } /* mct_u232_set_baud_rate */
316 static int mct_u232_set_line_ctrl(struct usb_serial *serial, unsigned char lcr)
321 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
326 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
327 MCT_U232_SET_LINE_CTRL_REQUEST,
328 MCT_U232_SET_REQUEST_TYPE,
329 0, 0, buf, MCT_U232_SET_LINE_CTRL_SIZE,
332 dev_err(&serial->dev->dev,
333 "Set LINE CTRL 0x%x failed (error = %d)\n", lcr, rc);
334 dbg("set_line_ctrl: 0x%x", lcr);
337 } /* mct_u232_set_line_ctrl */
339 static int mct_u232_set_modem_ctrl(struct usb_serial *serial,
340 unsigned int control_state)
346 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
350 mcr = MCT_U232_MCR_NONE;
351 if (control_state & TIOCM_DTR)
352 mcr |= MCT_U232_MCR_DTR;
353 if (control_state & TIOCM_RTS)
354 mcr |= MCT_U232_MCR_RTS;
357 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
358 MCT_U232_SET_MODEM_CTRL_REQUEST,
359 MCT_U232_SET_REQUEST_TYPE,
360 0, 0, buf, MCT_U232_SET_MODEM_CTRL_SIZE,
364 dbg("set_modem_ctrl: state=0x%x ==> mcr=0x%x", control_state, mcr);
367 dev_err(&serial->dev->dev,
368 "Set MODEM CTRL 0x%x failed (error = %d)\n", mcr, rc);
372 } /* mct_u232_set_modem_ctrl */
374 static int mct_u232_get_modem_stat(struct usb_serial *serial,
380 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
385 rc = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
386 MCT_U232_GET_MODEM_STAT_REQUEST,
387 MCT_U232_GET_REQUEST_TYPE,
388 0, 0, buf, MCT_U232_GET_MODEM_STAT_SIZE,
391 dev_err(&serial->dev->dev,
392 "Get MODEM STATus failed (error = %d)\n", rc);
397 dbg("get_modem_stat: 0x%x", *msr);
400 } /* mct_u232_get_modem_stat */
402 static void mct_u232_msr_to_icount(struct async_icount *icount,
405 /* Translate Control Line states */
406 if (msr & MCT_U232_MSR_DDSR)
408 if (msr & MCT_U232_MSR_DCTS)
410 if (msr & MCT_U232_MSR_DRI)
412 if (msr & MCT_U232_MSR_DCD)
414 } /* mct_u232_msr_to_icount */
416 static void mct_u232_msr_to_state(unsigned int *control_state,
419 /* Translate Control Line states */
420 if (msr & MCT_U232_MSR_DSR)
421 *control_state |= TIOCM_DSR;
423 *control_state &= ~TIOCM_DSR;
424 if (msr & MCT_U232_MSR_CTS)
425 *control_state |= TIOCM_CTS;
427 *control_state &= ~TIOCM_CTS;
428 if (msr & MCT_U232_MSR_RI)
429 *control_state |= TIOCM_RI;
431 *control_state &= ~TIOCM_RI;
432 if (msr & MCT_U232_MSR_CD)
433 *control_state |= TIOCM_CD;
435 *control_state &= ~TIOCM_CD;
436 dbg("msr_to_state: msr=0x%x ==> state=0x%x", msr, *control_state);
437 } /* mct_u232_msr_to_state */
440 * Driver's tty interface functions
443 static int mct_u232_startup(struct usb_serial *serial)
445 struct mct_u232_private *priv;
446 struct usb_serial_port *port, *rport;
448 priv = kzalloc(sizeof(struct mct_u232_private), GFP_KERNEL);
451 spin_lock_init(&priv->lock);
452 init_waitqueue_head(&priv->msr_wait);
453 usb_set_serial_port_data(serial->port[0], priv);
455 init_waitqueue_head(&serial->port[0]->write_wait);
457 /* Puh, that's dirty */
458 port = serial->port[0];
459 rport = serial->port[1];
460 /* No unlinking, it wasn't submitted yet. */
461 usb_free_urb(port->read_urb);
462 port->read_urb = rport->interrupt_in_urb;
463 rport->interrupt_in_urb = NULL;
464 port->read_urb->context = port;
467 } /* mct_u232_startup */
470 static void mct_u232_release(struct usb_serial *serial)
472 struct mct_u232_private *priv;
477 for (i = 0; i < serial->num_ports; ++i) {
478 /* My special items, the standard routines free my urbs */
479 priv = usb_get_serial_port_data(serial->port[i]);
482 } /* mct_u232_release */
484 static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port)
486 struct usb_serial *serial = port->serial;
487 struct mct_u232_private *priv = usb_get_serial_port_data(port);
489 unsigned int control_state;
491 unsigned char last_lcr;
492 unsigned char last_msr;
494 dbg("%s port %d", __func__, port->number);
496 /* Compensate for a hardware bug: although the Sitecom U232-P25
497 * device reports a maximum output packet size of 32 bytes,
498 * it seems to be able to accept only 16 bytes (and that's what
499 * SniffUSB says too...)
501 if (le16_to_cpu(serial->dev->descriptor.idProduct)
502 == MCT_U232_SITECOM_PID)
503 port->bulk_out_size = 16;
505 /* Do a defined restart: the normal serial device seems to
506 * always turn on DTR and RTS here, so do the same. I'm not
507 * sure if this is really necessary. But it should not harm
510 spin_lock_irqsave(&priv->lock, flags);
511 if (tty && (tty->termios->c_cflag & CBAUD))
512 priv->control_state = TIOCM_DTR | TIOCM_RTS;
514 priv->control_state = 0;
516 priv->last_lcr = (MCT_U232_DATA_BITS_8 |
517 MCT_U232_PARITY_NONE |
518 MCT_U232_STOP_BITS_1);
519 control_state = priv->control_state;
520 last_lcr = priv->last_lcr;
521 spin_unlock_irqrestore(&priv->lock, flags);
522 mct_u232_set_modem_ctrl(serial, control_state);
523 mct_u232_set_line_ctrl(serial, last_lcr);
525 /* Read modem status and update control state */
526 mct_u232_get_modem_stat(serial, &last_msr);
527 spin_lock_irqsave(&priv->lock, flags);
528 priv->last_msr = last_msr;
529 mct_u232_msr_to_state(&priv->control_state, priv->last_msr);
530 spin_unlock_irqrestore(&priv->lock, flags);
532 port->read_urb->dev = port->serial->dev;
533 retval = usb_submit_urb(port->read_urb, GFP_KERNEL);
536 "usb_submit_urb(read bulk) failed pipe 0x%x err %d\n",
537 port->read_urb->pipe, retval);
541 port->interrupt_in_urb->dev = port->serial->dev;
542 retval = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
544 usb_kill_urb(port->read_urb);
546 "usb_submit_urb(read int) failed pipe 0x%x err %d",
547 port->interrupt_in_urb->pipe, retval);
554 } /* mct_u232_open */
556 static void mct_u232_dtr_rts(struct usb_serial_port *port, int on)
558 unsigned int control_state;
559 struct mct_u232_private *priv = usb_get_serial_port_data(port);
561 mutex_lock(&port->serial->disc_mutex);
562 if (!port->serial->disconnected) {
563 /* drop DTR and RTS */
564 spin_lock_irq(&priv->lock);
566 priv->control_state |= TIOCM_DTR | TIOCM_RTS;
568 priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS);
569 control_state = priv->control_state;
570 spin_unlock_irq(&priv->lock);
571 mct_u232_set_modem_ctrl(port->serial, control_state);
573 mutex_unlock(&port->serial->disc_mutex);
576 static void mct_u232_close(struct usb_serial_port *port)
578 dbg("%s port %d", __func__, port->number);
581 * Must kill the read urb as it is actually an interrupt urb, which
582 * generic close thus fails to kill.
584 usb_kill_urb(port->read_urb);
585 usb_kill_urb(port->interrupt_in_urb);
587 usb_serial_generic_close(port);
588 } /* mct_u232_close */
591 static void mct_u232_read_int_callback(struct urb *urb)
593 struct usb_serial_port *port = urb->context;
594 struct mct_u232_private *priv = usb_get_serial_port_data(port);
595 struct usb_serial *serial = port->serial;
596 struct tty_struct *tty;
597 unsigned char *data = urb->transfer_buffer;
599 int status = urb->status;
609 /* this urb is terminated, clean up */
610 dbg("%s - urb shutting down with status: %d",
614 dbg("%s - nonzero urb status received: %d",
620 dbg("%s - bad serial pointer, exiting", __func__);
624 dbg("%s - port %d", __func__, port->number);
625 usb_serial_debug_data(debug, &port->dev, __func__,
626 urb->actual_length, data);
629 * Work-a-round: handle the 'usual' bulk-in pipe here
631 if (urb->transfer_buffer_length > 2) {
632 if (urb->actual_length) {
633 tty = tty_port_tty_get(&port->port);
635 tty_insert_flip_string(tty, data,
637 tty_flip_buffer_push(tty);
645 * The interrupt-in pipe signals exceptional conditions (modem line
646 * signal changes and errors). data[0] holds MSR, data[1] holds LSR.
648 spin_lock_irqsave(&priv->lock, flags);
649 priv->last_msr = data[MCT_U232_MSR_INDEX];
651 /* Record Control Line states */
652 mct_u232_msr_to_state(&priv->control_state, priv->last_msr);
654 mct_u232_msr_to_icount(&priv->icount, priv->last_msr);
657 /* Not yet handled. See belkin_sa.c for further information */
658 /* Now to report any errors */
659 priv->last_lsr = data[MCT_U232_LSR_INDEX];
661 * fill in the flip buffer here, but I do not know the relation
662 * to the current/next receive buffer or characters. I need
663 * to look in to this before committing any code.
665 if (priv->last_lsr & MCT_U232_LSR_ERR) {
666 tty = tty_port_tty_get(&port->port);
668 if (priv->last_lsr & MCT_U232_LSR_OE) {
671 if (priv->last_lsr & MCT_U232_LSR_PE) {
674 if (priv->last_lsr & MCT_U232_LSR_FE) {
676 /* Break Indicator */
677 if (priv->last_lsr & MCT_U232_LSR_BI) {
682 wake_up_interruptible(&priv->msr_wait);
683 spin_unlock_irqrestore(&priv->lock, flags);
685 retval = usb_submit_urb(urb, GFP_ATOMIC);
688 "%s - usb_submit_urb failed with result %d\n",
690 } /* mct_u232_read_int_callback */
692 static void mct_u232_set_termios(struct tty_struct *tty,
693 struct usb_serial_port *port,
694 struct ktermios *old_termios)
696 struct usb_serial *serial = port->serial;
697 struct mct_u232_private *priv = usb_get_serial_port_data(port);
698 struct ktermios *termios = tty->termios;
699 unsigned int cflag = termios->c_cflag;
700 unsigned int old_cflag = old_termios->c_cflag;
702 unsigned int control_state;
703 unsigned char last_lcr;
705 /* get a local copy of the current port settings */
706 spin_lock_irqsave(&priv->lock, flags);
707 control_state = priv->control_state;
708 spin_unlock_irqrestore(&priv->lock, flags);
713 * Do not attempt to cache old rates and skip settings,
714 * disconnects screw such tricks up completely.
715 * Premature optimization is the root of all evil.
718 /* reassert DTR and RTS on transition from B0 */
719 if ((old_cflag & CBAUD) == B0) {
720 dbg("%s: baud was B0", __func__);
721 control_state |= TIOCM_DTR | TIOCM_RTS;
722 mct_u232_set_modem_ctrl(serial, control_state);
725 mct_u232_set_baud_rate(tty, serial, port, tty_get_baud_rate(tty));
727 if ((cflag & CBAUD) == B0) {
728 dbg("%s: baud is B0", __func__);
729 /* Drop RTS and DTR */
730 control_state &= ~(TIOCM_DTR | TIOCM_RTS);
731 mct_u232_set_modem_ctrl(serial, control_state);
735 * Update line control register (LCR)
740 last_lcr |= (cflag & PARODD) ?
741 MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN;
743 last_lcr |= MCT_U232_PARITY_NONE;
745 /* set the number of data bits */
746 switch (cflag & CSIZE) {
748 last_lcr |= MCT_U232_DATA_BITS_5; break;
750 last_lcr |= MCT_U232_DATA_BITS_6; break;
752 last_lcr |= MCT_U232_DATA_BITS_7; break;
754 last_lcr |= MCT_U232_DATA_BITS_8; break;
757 "CSIZE was not CS5-CS8, using default of 8\n");
758 last_lcr |= MCT_U232_DATA_BITS_8;
762 termios->c_cflag &= ~CMSPAR;
764 /* set the number of stop bits */
765 last_lcr |= (cflag & CSTOPB) ?
766 MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1;
768 mct_u232_set_line_ctrl(serial, last_lcr);
770 /* save off the modified port settings */
771 spin_lock_irqsave(&priv->lock, flags);
772 priv->control_state = control_state;
773 priv->last_lcr = last_lcr;
774 spin_unlock_irqrestore(&priv->lock, flags);
775 } /* mct_u232_set_termios */
777 static void mct_u232_break_ctl(struct tty_struct *tty, int break_state)
779 struct usb_serial_port *port = tty->driver_data;
780 struct usb_serial *serial = port->serial;
781 struct mct_u232_private *priv = usb_get_serial_port_data(port);
785 dbg("%sstate=%d", __func__, break_state);
787 spin_lock_irqsave(&priv->lock, flags);
788 lcr = priv->last_lcr;
791 lcr |= MCT_U232_SET_BREAK;
792 spin_unlock_irqrestore(&priv->lock, flags);
794 mct_u232_set_line_ctrl(serial, lcr);
795 } /* mct_u232_break_ctl */
798 static int mct_u232_tiocmget(struct tty_struct *tty)
800 struct usb_serial_port *port = tty->driver_data;
801 struct mct_u232_private *priv = usb_get_serial_port_data(port);
802 unsigned int control_state;
807 spin_lock_irqsave(&priv->lock, flags);
808 control_state = priv->control_state;
809 spin_unlock_irqrestore(&priv->lock, flags);
811 return control_state;
814 static int mct_u232_tiocmset(struct tty_struct *tty,
815 unsigned int set, unsigned int clear)
817 struct usb_serial_port *port = tty->driver_data;
818 struct usb_serial *serial = port->serial;
819 struct mct_u232_private *priv = usb_get_serial_port_data(port);
820 unsigned int control_state;
825 spin_lock_irqsave(&priv->lock, flags);
826 control_state = priv->control_state;
829 control_state |= TIOCM_RTS;
831 control_state |= TIOCM_DTR;
832 if (clear & TIOCM_RTS)
833 control_state &= ~TIOCM_RTS;
834 if (clear & TIOCM_DTR)
835 control_state &= ~TIOCM_DTR;
837 priv->control_state = control_state;
838 spin_unlock_irqrestore(&priv->lock, flags);
839 return mct_u232_set_modem_ctrl(serial, control_state);
842 static void mct_u232_throttle(struct tty_struct *tty)
844 struct usb_serial_port *port = tty->driver_data;
845 struct mct_u232_private *priv = usb_get_serial_port_data(port);
846 unsigned int control_state;
848 dbg("%s - port %d", __func__, port->number);
850 spin_lock_irq(&priv->lock);
851 priv->rx_flags |= THROTTLED;
852 if (C_CRTSCTS(tty)) {
853 priv->control_state &= ~TIOCM_RTS;
854 control_state = priv->control_state;
855 spin_unlock_irq(&priv->lock);
856 (void) mct_u232_set_modem_ctrl(port->serial, control_state);
858 spin_unlock_irq(&priv->lock);
862 static void mct_u232_unthrottle(struct tty_struct *tty)
864 struct usb_serial_port *port = tty->driver_data;
865 struct mct_u232_private *priv = usb_get_serial_port_data(port);
866 unsigned int control_state;
868 dbg("%s - port %d", __func__, port->number);
870 spin_lock_irq(&priv->lock);
871 if ((priv->rx_flags & THROTTLED) && C_CRTSCTS(tty)) {
872 priv->rx_flags &= ~THROTTLED;
873 priv->control_state |= TIOCM_RTS;
874 control_state = priv->control_state;
875 spin_unlock_irq(&priv->lock);
876 (void) mct_u232_set_modem_ctrl(port->serial, control_state);
878 spin_unlock_irq(&priv->lock);
882 static int mct_u232_ioctl(struct tty_struct *tty,
883 unsigned int cmd, unsigned long arg)
886 struct usb_serial_port *port = tty->driver_data;
887 struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
888 struct async_icount cnow, cprev;
891 dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd);
897 dbg("%s (%d) TIOCMIWAIT", __func__, port->number);
899 spin_lock_irqsave(&mct_u232_port->lock, flags);
900 cprev = mct_u232_port->icount;
901 spin_unlock_irqrestore(&mct_u232_port->lock, flags);
903 prepare_to_wait(&mct_u232_port->msr_wait,
904 &wait, TASK_INTERRUPTIBLE);
906 finish_wait(&mct_u232_port->msr_wait, &wait);
907 /* see if a signal did it */
908 if (signal_pending(current))
910 spin_lock_irqsave(&mct_u232_port->lock, flags);
911 cnow = mct_u232_port->icount;
912 spin_unlock_irqrestore(&mct_u232_port->lock, flags);
913 if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
914 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
915 return -EIO; /* no change => error */
916 if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
917 ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
918 ((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
919 ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
929 static int mct_u232_get_icount(struct tty_struct *tty,
930 struct serial_icounter_struct *icount)
932 struct usb_serial_port *port = tty->driver_data;
933 struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
934 struct async_icount *ic = &mct_u232_port->icount;
937 spin_lock_irqsave(&mct_u232_port->lock, flags);
939 icount->cts = ic->cts;
940 icount->dsr = ic->dsr;
941 icount->rng = ic->rng;
942 icount->dcd = ic->dcd;
945 icount->frame = ic->frame;
946 icount->overrun = ic->overrun;
947 icount->parity = ic->parity;
948 icount->brk = ic->brk;
949 icount->buf_overrun = ic->buf_overrun;
951 spin_unlock_irqrestore(&mct_u232_port->lock, flags);
953 dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d",
954 __func__, port->number, icount->rx, icount->tx);
958 static int __init mct_u232_init(void)
961 retval = usb_serial_register(&mct_u232_device);
963 goto failed_usb_serial_register;
964 retval = usb_register(&mct_u232_driver);
966 goto failed_usb_register;
967 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
971 usb_serial_deregister(&mct_u232_device);
972 failed_usb_serial_register:
977 static void __exit mct_u232_exit(void)
979 usb_deregister(&mct_u232_driver);
980 usb_serial_deregister(&mct_u232_device);
983 module_init(mct_u232_init);
984 module_exit(mct_u232_exit);
986 MODULE_AUTHOR(DRIVER_AUTHOR);
987 MODULE_DESCRIPTION(DRIVER_DESC);
988 MODULE_LICENSE("GPL");
990 module_param(debug, bool, S_IRUGO | S_IWUSR);
991 MODULE_PARM_DESC(debug, "Debug enabled or not");