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 #include <linux/kernel.h>
25 #include <linux/errno.h>
26 #include <linux/init.h>
27 #include <linux/slab.h>
28 #include <linux/tty.h>
29 #include <linux/tty_driver.h>
30 #include <linux/tty_flip.h>
31 #include <linux/module.h>
32 #include <linux/spinlock.h>
33 #include <linux/uaccess.h>
34 #include <asm/unaligned.h>
35 #include <linux/usb.h>
36 #include <linux/usb/serial.h>
37 #include <linux/serial.h>
38 #include <linux/ioctl.h>
44 #define DRIVER_VERSION "z2.1" /* Linux in-kernel version */
45 #define DRIVER_AUTHOR "Wolfgang Grandegger <wolfgang@ces.ch>"
46 #define DRIVER_DESC "Magic Control Technology USB-RS232 converter driver"
53 static int mct_u232_startup(struct usb_serial
*serial
);
54 static void mct_u232_release(struct usb_serial
*serial
);
55 static int mct_u232_open(struct tty_struct
*tty
, struct usb_serial_port
*port
);
56 static void mct_u232_close(struct usb_serial_port
*port
);
57 static void mct_u232_dtr_rts(struct usb_serial_port
*port
, int on
);
58 static void mct_u232_read_int_callback(struct urb
*urb
);
59 static void mct_u232_set_termios(struct tty_struct
*tty
,
60 struct usb_serial_port
*port
, struct ktermios
*old
);
61 static void mct_u232_break_ctl(struct tty_struct
*tty
, int break_state
);
62 static int mct_u232_tiocmget(struct tty_struct
*tty
);
63 static int mct_u232_tiocmset(struct tty_struct
*tty
,
64 unsigned int set
, unsigned int clear
);
65 static int mct_u232_ioctl(struct tty_struct
*tty
,
66 unsigned int cmd
, unsigned long arg
);
67 static int mct_u232_get_icount(struct tty_struct
*tty
,
68 struct serial_icounter_struct
*icount
);
69 static void mct_u232_throttle(struct tty_struct
*tty
);
70 static void mct_u232_unthrottle(struct tty_struct
*tty
);
74 * All of the device info needed for the MCT USB-RS232 converter.
76 static const struct usb_device_id id_table
[] = {
77 { USB_DEVICE(MCT_U232_VID
, MCT_U232_PID
) },
78 { USB_DEVICE(MCT_U232_VID
, MCT_U232_SITECOM_PID
) },
79 { USB_DEVICE(MCT_U232_VID
, MCT_U232_DU_H3SP_PID
) },
80 { USB_DEVICE(MCT_U232_BELKIN_F5U109_VID
, MCT_U232_BELKIN_F5U109_PID
) },
81 { } /* Terminating entry */
83 MODULE_DEVICE_TABLE(usb
, id_table
);
85 static struct usb_serial_driver mct_u232_device
= {
90 .description
= "MCT U232",
93 .open
= mct_u232_open
,
94 .close
= mct_u232_close
,
95 .dtr_rts
= mct_u232_dtr_rts
,
96 .throttle
= mct_u232_throttle
,
97 .unthrottle
= mct_u232_unthrottle
,
98 .read_int_callback
= mct_u232_read_int_callback
,
99 .set_termios
= mct_u232_set_termios
,
100 .break_ctl
= mct_u232_break_ctl
,
101 .tiocmget
= mct_u232_tiocmget
,
102 .tiocmset
= mct_u232_tiocmset
,
103 .attach
= mct_u232_startup
,
104 .release
= mct_u232_release
,
105 .ioctl
= mct_u232_ioctl
,
106 .get_icount
= mct_u232_get_icount
,
109 static struct usb_serial_driver
* const serial_drivers
[] = {
110 &mct_u232_device
, NULL
113 struct mct_u232_private
{
115 unsigned int control_state
; /* Modem Line Setting (TIOCM) */
116 unsigned char last_lcr
; /* Line Control Register */
117 unsigned char last_lsr
; /* Line Status Register */
118 unsigned char last_msr
; /* Modem Status Register */
119 unsigned int rx_flags
; /* Throttling flags */
120 struct async_icount icount
;
121 wait_queue_head_t msr_wait
; /* for handling sleeping while waiting
122 for msr change to happen */
125 #define THROTTLED 0x01
128 * Handle vendor specific USB requests
131 #define WDR_TIMEOUT 5000 /* default urb timeout */
134 * Later day 2.6.0-test kernels have new baud rates like B230400 which
135 * we do not know how to support. We ignore them for the moment.
137 static int mct_u232_calculate_baud_rate(struct usb_serial
*serial
,
138 speed_t value
, speed_t
*result
)
142 if (le16_to_cpu(serial
->dev
->descriptor
.idProduct
) == MCT_U232_SITECOM_PID
143 || le16_to_cpu(serial
->dev
->descriptor
.idProduct
) == MCT_U232_BELKIN_F5U109_PID
) {
148 return 0x02; /* this one not tested */
170 /* FIXME: Can we use any divider - should we do
171 divider = 115200/value;
172 real baud = 115200/divider */
192 static int mct_u232_set_baud_rate(struct tty_struct
*tty
,
193 struct usb_serial
*serial
, struct usb_serial_port
*port
, speed_t value
)
195 unsigned int divisor
;
198 unsigned char cts_enable_byte
= 0;
201 buf
= kmalloc(MCT_U232_MAX_SIZE
, GFP_KERNEL
);
205 divisor
= mct_u232_calculate_baud_rate(serial
, value
, &speed
);
206 put_unaligned_le32(cpu_to_le32(divisor
), buf
);
207 rc
= usb_control_msg(serial
->dev
, usb_sndctrlpipe(serial
->dev
, 0),
208 MCT_U232_SET_BAUD_RATE_REQUEST
,
209 MCT_U232_SET_REQUEST_TYPE
,
210 0, 0, buf
, MCT_U232_SET_BAUD_RATE_SIZE
,
212 if (rc
< 0) /*FIXME: What value speed results */
213 dev_err(&port
->dev
, "Set BAUD RATE %d failed (error = %d)\n",
216 tty_encode_baud_rate(tty
, speed
, speed
);
217 dbg("set_baud_rate: value: 0x%x, divisor: 0x%x", value
, divisor
);
219 /* Mimic the MCT-supplied Windows driver (version 1.21P.0104), which
220 always sends two extra USB 'device request' messages after the
221 'baud rate change' message. The actual functionality of the
222 request codes in these messages is not fully understood but these
223 particular codes are never seen in any operation besides a baud
224 rate change. Both of these messages send a single byte of data.
225 In the first message, the value of this byte is always zero.
227 The second message has been determined experimentally to control
228 whether data will be transmitted to a device which is not asserting
229 the 'CTS' signal. If the second message's data byte is zero, data
230 will be transmitted even if 'CTS' is not asserted (i.e. no hardware
231 flow control). if the second message's data byte is nonzero (a
232 value of 1 is used by this driver), data will not be transmitted to
233 a device which is not asserting 'CTS'.
237 rc
= usb_control_msg(serial
->dev
, usb_sndctrlpipe(serial
->dev
, 0),
238 MCT_U232_SET_UNKNOWN1_REQUEST
,
239 MCT_U232_SET_REQUEST_TYPE
,
240 0, 0, buf
, MCT_U232_SET_UNKNOWN1_SIZE
,
243 dev_err(&port
->dev
, "Sending USB device request code %d "
244 "failed (error = %d)\n", MCT_U232_SET_UNKNOWN1_REQUEST
,
247 if (port
&& C_CRTSCTS(tty
))
250 dbg("set_baud_rate: send second control message, data = %02X",
252 buf
[0] = cts_enable_byte
;
253 rc
= usb_control_msg(serial
->dev
, usb_sndctrlpipe(serial
->dev
, 0),
254 MCT_U232_SET_CTS_REQUEST
,
255 MCT_U232_SET_REQUEST_TYPE
,
256 0, 0, buf
, MCT_U232_SET_CTS_SIZE
,
259 dev_err(&port
->dev
, "Sending USB device request code %d "
260 "failed (error = %d)\n", MCT_U232_SET_CTS_REQUEST
, rc
);
264 } /* mct_u232_set_baud_rate */
266 static int mct_u232_set_line_ctrl(struct usb_serial
*serial
, unsigned char lcr
)
271 buf
= kmalloc(MCT_U232_MAX_SIZE
, GFP_KERNEL
);
276 rc
= usb_control_msg(serial
->dev
, usb_sndctrlpipe(serial
->dev
, 0),
277 MCT_U232_SET_LINE_CTRL_REQUEST
,
278 MCT_U232_SET_REQUEST_TYPE
,
279 0, 0, buf
, MCT_U232_SET_LINE_CTRL_SIZE
,
282 dev_err(&serial
->dev
->dev
,
283 "Set LINE CTRL 0x%x failed (error = %d)\n", lcr
, rc
);
284 dbg("set_line_ctrl: 0x%x", lcr
);
287 } /* mct_u232_set_line_ctrl */
289 static int mct_u232_set_modem_ctrl(struct usb_serial
*serial
,
290 unsigned int control_state
)
296 buf
= kmalloc(MCT_U232_MAX_SIZE
, GFP_KERNEL
);
300 mcr
= MCT_U232_MCR_NONE
;
301 if (control_state
& TIOCM_DTR
)
302 mcr
|= MCT_U232_MCR_DTR
;
303 if (control_state
& TIOCM_RTS
)
304 mcr
|= MCT_U232_MCR_RTS
;
307 rc
= usb_control_msg(serial
->dev
, usb_sndctrlpipe(serial
->dev
, 0),
308 MCT_U232_SET_MODEM_CTRL_REQUEST
,
309 MCT_U232_SET_REQUEST_TYPE
,
310 0, 0, buf
, MCT_U232_SET_MODEM_CTRL_SIZE
,
313 dev_err(&serial
->dev
->dev
,
314 "Set MODEM CTRL 0x%x failed (error = %d)\n", mcr
, rc
);
315 dbg("set_modem_ctrl: state=0x%x ==> mcr=0x%x", control_state
, mcr
);
319 } /* mct_u232_set_modem_ctrl */
321 static int mct_u232_get_modem_stat(struct usb_serial
*serial
,
327 buf
= kmalloc(MCT_U232_MAX_SIZE
, GFP_KERNEL
);
332 rc
= usb_control_msg(serial
->dev
, usb_rcvctrlpipe(serial
->dev
, 0),
333 MCT_U232_GET_MODEM_STAT_REQUEST
,
334 MCT_U232_GET_REQUEST_TYPE
,
335 0, 0, buf
, MCT_U232_GET_MODEM_STAT_SIZE
,
338 dev_err(&serial
->dev
->dev
,
339 "Get MODEM STATus failed (error = %d)\n", rc
);
344 dbg("get_modem_stat: 0x%x", *msr
);
347 } /* mct_u232_get_modem_stat */
349 static void mct_u232_msr_to_icount(struct async_icount
*icount
,
352 /* Translate Control Line states */
353 if (msr
& MCT_U232_MSR_DDSR
)
355 if (msr
& MCT_U232_MSR_DCTS
)
357 if (msr
& MCT_U232_MSR_DRI
)
359 if (msr
& MCT_U232_MSR_DCD
)
361 } /* mct_u232_msr_to_icount */
363 static void mct_u232_msr_to_state(unsigned int *control_state
,
366 /* Translate Control Line states */
367 if (msr
& MCT_U232_MSR_DSR
)
368 *control_state
|= TIOCM_DSR
;
370 *control_state
&= ~TIOCM_DSR
;
371 if (msr
& MCT_U232_MSR_CTS
)
372 *control_state
|= TIOCM_CTS
;
374 *control_state
&= ~TIOCM_CTS
;
375 if (msr
& MCT_U232_MSR_RI
)
376 *control_state
|= TIOCM_RI
;
378 *control_state
&= ~TIOCM_RI
;
379 if (msr
& MCT_U232_MSR_CD
)
380 *control_state
|= TIOCM_CD
;
382 *control_state
&= ~TIOCM_CD
;
383 dbg("msr_to_state: msr=0x%x ==> state=0x%x", msr
, *control_state
);
384 } /* mct_u232_msr_to_state */
387 * Driver's tty interface functions
390 static int mct_u232_startup(struct usb_serial
*serial
)
392 struct mct_u232_private
*priv
;
393 struct usb_serial_port
*port
, *rport
;
395 priv
= kzalloc(sizeof(struct mct_u232_private
), GFP_KERNEL
);
398 spin_lock_init(&priv
->lock
);
399 init_waitqueue_head(&priv
->msr_wait
);
400 usb_set_serial_port_data(serial
->port
[0], priv
);
402 init_waitqueue_head(&serial
->port
[0]->write_wait
);
404 /* Puh, that's dirty */
405 port
= serial
->port
[0];
406 rport
= serial
->port
[1];
407 /* No unlinking, it wasn't submitted yet. */
408 usb_free_urb(port
->read_urb
);
409 port
->read_urb
= rport
->interrupt_in_urb
;
410 rport
->interrupt_in_urb
= NULL
;
411 port
->read_urb
->context
= port
;
414 } /* mct_u232_startup */
417 static void mct_u232_release(struct usb_serial
*serial
)
419 struct mct_u232_private
*priv
;
422 for (i
= 0; i
< serial
->num_ports
; ++i
) {
423 /* My special items, the standard routines free my urbs */
424 priv
= usb_get_serial_port_data(serial
->port
[i
]);
427 } /* mct_u232_release */
429 static int mct_u232_open(struct tty_struct
*tty
, struct usb_serial_port
*port
)
431 struct usb_serial
*serial
= port
->serial
;
432 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
434 unsigned int control_state
;
436 unsigned char last_lcr
;
437 unsigned char last_msr
;
439 /* Compensate for a hardware bug: although the Sitecom U232-P25
440 * device reports a maximum output packet size of 32 bytes,
441 * it seems to be able to accept only 16 bytes (and that's what
442 * SniffUSB says too...)
444 if (le16_to_cpu(serial
->dev
->descriptor
.idProduct
)
445 == MCT_U232_SITECOM_PID
)
446 port
->bulk_out_size
= 16;
448 /* Do a defined restart: the normal serial device seems to
449 * always turn on DTR and RTS here, so do the same. I'm not
450 * sure if this is really necessary. But it should not harm
453 spin_lock_irqsave(&priv
->lock
, flags
);
454 if (tty
&& (tty
->termios
->c_cflag
& CBAUD
))
455 priv
->control_state
= TIOCM_DTR
| TIOCM_RTS
;
457 priv
->control_state
= 0;
459 priv
->last_lcr
= (MCT_U232_DATA_BITS_8
|
460 MCT_U232_PARITY_NONE
|
461 MCT_U232_STOP_BITS_1
);
462 control_state
= priv
->control_state
;
463 last_lcr
= priv
->last_lcr
;
464 spin_unlock_irqrestore(&priv
->lock
, flags
);
465 mct_u232_set_modem_ctrl(serial
, control_state
);
466 mct_u232_set_line_ctrl(serial
, last_lcr
);
468 /* Read modem status and update control state */
469 mct_u232_get_modem_stat(serial
, &last_msr
);
470 spin_lock_irqsave(&priv
->lock
, flags
);
471 priv
->last_msr
= last_msr
;
472 mct_u232_msr_to_state(&priv
->control_state
, priv
->last_msr
);
473 spin_unlock_irqrestore(&priv
->lock
, flags
);
475 retval
= usb_submit_urb(port
->read_urb
, GFP_KERNEL
);
478 "usb_submit_urb(read bulk) failed pipe 0x%x err %d\n",
479 port
->read_urb
->pipe
, retval
);
483 retval
= usb_submit_urb(port
->interrupt_in_urb
, GFP_KERNEL
);
485 usb_kill_urb(port
->read_urb
);
487 "usb_submit_urb(read int) failed pipe 0x%x err %d",
488 port
->interrupt_in_urb
->pipe
, retval
);
495 } /* mct_u232_open */
497 static void mct_u232_dtr_rts(struct usb_serial_port
*port
, int on
)
499 unsigned int control_state
;
500 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
502 mutex_lock(&port
->serial
->disc_mutex
);
503 if (!port
->serial
->disconnected
) {
504 /* drop DTR and RTS */
505 spin_lock_irq(&priv
->lock
);
507 priv
->control_state
|= TIOCM_DTR
| TIOCM_RTS
;
509 priv
->control_state
&= ~(TIOCM_DTR
| TIOCM_RTS
);
510 control_state
= priv
->control_state
;
511 spin_unlock_irq(&priv
->lock
);
512 mct_u232_set_modem_ctrl(port
->serial
, control_state
);
514 mutex_unlock(&port
->serial
->disc_mutex
);
517 static void mct_u232_close(struct usb_serial_port
*port
)
519 if (port
->serial
->dev
) {
520 /* shutdown our urbs */
521 usb_kill_urb(port
->write_urb
);
522 usb_kill_urb(port
->read_urb
);
523 usb_kill_urb(port
->interrupt_in_urb
);
525 } /* mct_u232_close */
528 static void mct_u232_read_int_callback(struct urb
*urb
)
530 struct usb_serial_port
*port
= urb
->context
;
531 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
532 struct usb_serial
*serial
= port
->serial
;
533 struct tty_struct
*tty
;
534 unsigned char *data
= urb
->transfer_buffer
;
536 int status
= urb
->status
;
546 /* this urb is terminated, clean up */
547 dbg("%s - urb shutting down with status: %d",
551 dbg("%s - nonzero urb status received: %d",
557 dbg("%s - bad serial pointer, exiting", __func__
);
561 usb_serial_debug_data(debug
, &port
->dev
, __func__
,
562 urb
->actual_length
, data
);
565 * Work-a-round: handle the 'usual' bulk-in pipe here
567 if (urb
->transfer_buffer_length
> 2) {
568 if (urb
->actual_length
) {
569 tty
= tty_port_tty_get(&port
->port
);
571 tty_insert_flip_string(tty
, data
,
573 tty_flip_buffer_push(tty
);
581 * The interrupt-in pipe signals exceptional conditions (modem line
582 * signal changes and errors). data[0] holds MSR, data[1] holds LSR.
584 spin_lock_irqsave(&priv
->lock
, flags
);
585 priv
->last_msr
= data
[MCT_U232_MSR_INDEX
];
587 /* Record Control Line states */
588 mct_u232_msr_to_state(&priv
->control_state
, priv
->last_msr
);
590 mct_u232_msr_to_icount(&priv
->icount
, priv
->last_msr
);
593 /* Not yet handled. See belkin_sa.c for further information */
594 /* Now to report any errors */
595 priv
->last_lsr
= data
[MCT_U232_LSR_INDEX
];
597 * fill in the flip buffer here, but I do not know the relation
598 * to the current/next receive buffer or characters. I need
599 * to look in to this before committing any code.
601 if (priv
->last_lsr
& MCT_U232_LSR_ERR
) {
602 tty
= tty_port_tty_get(&port
->port
);
604 if (priv
->last_lsr
& MCT_U232_LSR_OE
) {
607 if (priv
->last_lsr
& MCT_U232_LSR_PE
) {
610 if (priv
->last_lsr
& MCT_U232_LSR_FE
) {
612 /* Break Indicator */
613 if (priv
->last_lsr
& MCT_U232_LSR_BI
) {
618 wake_up_interruptible(&priv
->msr_wait
);
619 spin_unlock_irqrestore(&priv
->lock
, flags
);
621 retval
= usb_submit_urb(urb
, GFP_ATOMIC
);
624 "%s - usb_submit_urb failed with result %d\n",
626 } /* mct_u232_read_int_callback */
628 static void mct_u232_set_termios(struct tty_struct
*tty
,
629 struct usb_serial_port
*port
,
630 struct ktermios
*old_termios
)
632 struct usb_serial
*serial
= port
->serial
;
633 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
634 struct ktermios
*termios
= tty
->termios
;
635 unsigned int cflag
= termios
->c_cflag
;
636 unsigned int old_cflag
= old_termios
->c_cflag
;
638 unsigned int control_state
;
639 unsigned char last_lcr
;
641 /* get a local copy of the current port settings */
642 spin_lock_irqsave(&priv
->lock
, flags
);
643 control_state
= priv
->control_state
;
644 spin_unlock_irqrestore(&priv
->lock
, flags
);
649 * Do not attempt to cache old rates and skip settings,
650 * disconnects screw such tricks up completely.
651 * Premature optimization is the root of all evil.
654 /* reassert DTR and RTS on transition from B0 */
655 if ((old_cflag
& CBAUD
) == B0
) {
656 dbg("%s: baud was B0", __func__
);
657 control_state
|= TIOCM_DTR
| TIOCM_RTS
;
658 mct_u232_set_modem_ctrl(serial
, control_state
);
661 mct_u232_set_baud_rate(tty
, serial
, port
, tty_get_baud_rate(tty
));
663 if ((cflag
& CBAUD
) == B0
) {
664 dbg("%s: baud is B0", __func__
);
665 /* Drop RTS and DTR */
666 control_state
&= ~(TIOCM_DTR
| TIOCM_RTS
);
667 mct_u232_set_modem_ctrl(serial
, control_state
);
671 * Update line control register (LCR)
676 last_lcr
|= (cflag
& PARODD
) ?
677 MCT_U232_PARITY_ODD
: MCT_U232_PARITY_EVEN
;
679 last_lcr
|= MCT_U232_PARITY_NONE
;
681 /* set the number of data bits */
682 switch (cflag
& CSIZE
) {
684 last_lcr
|= MCT_U232_DATA_BITS_5
; break;
686 last_lcr
|= MCT_U232_DATA_BITS_6
; break;
688 last_lcr
|= MCT_U232_DATA_BITS_7
; break;
690 last_lcr
|= MCT_U232_DATA_BITS_8
; break;
693 "CSIZE was not CS5-CS8, using default of 8\n");
694 last_lcr
|= MCT_U232_DATA_BITS_8
;
698 termios
->c_cflag
&= ~CMSPAR
;
700 /* set the number of stop bits */
701 last_lcr
|= (cflag
& CSTOPB
) ?
702 MCT_U232_STOP_BITS_2
: MCT_U232_STOP_BITS_1
;
704 mct_u232_set_line_ctrl(serial
, last_lcr
);
706 /* save off the modified port settings */
707 spin_lock_irqsave(&priv
->lock
, flags
);
708 priv
->control_state
= control_state
;
709 priv
->last_lcr
= last_lcr
;
710 spin_unlock_irqrestore(&priv
->lock
, flags
);
711 } /* mct_u232_set_termios */
713 static void mct_u232_break_ctl(struct tty_struct
*tty
, int break_state
)
715 struct usb_serial_port
*port
= tty
->driver_data
;
716 struct usb_serial
*serial
= port
->serial
;
717 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
721 spin_lock_irqsave(&priv
->lock
, flags
);
722 lcr
= priv
->last_lcr
;
725 lcr
|= MCT_U232_SET_BREAK
;
726 spin_unlock_irqrestore(&priv
->lock
, flags
);
728 mct_u232_set_line_ctrl(serial
, lcr
);
729 } /* mct_u232_break_ctl */
732 static int mct_u232_tiocmget(struct tty_struct
*tty
)
734 struct usb_serial_port
*port
= tty
->driver_data
;
735 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
736 unsigned int control_state
;
739 spin_lock_irqsave(&priv
->lock
, flags
);
740 control_state
= priv
->control_state
;
741 spin_unlock_irqrestore(&priv
->lock
, flags
);
743 return control_state
;
746 static int mct_u232_tiocmset(struct tty_struct
*tty
,
747 unsigned int set
, unsigned int clear
)
749 struct usb_serial_port
*port
= tty
->driver_data
;
750 struct usb_serial
*serial
= port
->serial
;
751 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
752 unsigned int control_state
;
755 spin_lock_irqsave(&priv
->lock
, flags
);
756 control_state
= priv
->control_state
;
759 control_state
|= TIOCM_RTS
;
761 control_state
|= TIOCM_DTR
;
762 if (clear
& TIOCM_RTS
)
763 control_state
&= ~TIOCM_RTS
;
764 if (clear
& TIOCM_DTR
)
765 control_state
&= ~TIOCM_DTR
;
767 priv
->control_state
= control_state
;
768 spin_unlock_irqrestore(&priv
->lock
, flags
);
769 return mct_u232_set_modem_ctrl(serial
, control_state
);
772 static void mct_u232_throttle(struct tty_struct
*tty
)
774 struct usb_serial_port
*port
= tty
->driver_data
;
775 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
776 unsigned int control_state
;
778 spin_lock_irq(&priv
->lock
);
779 priv
->rx_flags
|= THROTTLED
;
780 if (C_CRTSCTS(tty
)) {
781 priv
->control_state
&= ~TIOCM_RTS
;
782 control_state
= priv
->control_state
;
783 spin_unlock_irq(&priv
->lock
);
784 (void) mct_u232_set_modem_ctrl(port
->serial
, control_state
);
786 spin_unlock_irq(&priv
->lock
);
790 static void mct_u232_unthrottle(struct tty_struct
*tty
)
792 struct usb_serial_port
*port
= tty
->driver_data
;
793 struct mct_u232_private
*priv
= usb_get_serial_port_data(port
);
794 unsigned int control_state
;
796 spin_lock_irq(&priv
->lock
);
797 if ((priv
->rx_flags
& THROTTLED
) && C_CRTSCTS(tty
)) {
798 priv
->rx_flags
&= ~THROTTLED
;
799 priv
->control_state
|= TIOCM_RTS
;
800 control_state
= priv
->control_state
;
801 spin_unlock_irq(&priv
->lock
);
802 (void) mct_u232_set_modem_ctrl(port
->serial
, control_state
);
804 spin_unlock_irq(&priv
->lock
);
808 static int mct_u232_ioctl(struct tty_struct
*tty
,
809 unsigned int cmd
, unsigned long arg
)
812 struct usb_serial_port
*port
= tty
->driver_data
;
813 struct mct_u232_private
*mct_u232_port
= usb_get_serial_port_data(port
);
814 struct async_icount cnow
, cprev
;
817 dbg("%s - port %d, cmd = 0x%x", __func__
, port
->number
, cmd
);
823 dbg("%s (%d) TIOCMIWAIT", __func__
, port
->number
);
825 spin_lock_irqsave(&mct_u232_port
->lock
, flags
);
826 cprev
= mct_u232_port
->icount
;
827 spin_unlock_irqrestore(&mct_u232_port
->lock
, flags
);
829 prepare_to_wait(&mct_u232_port
->msr_wait
,
830 &wait
, TASK_INTERRUPTIBLE
);
832 finish_wait(&mct_u232_port
->msr_wait
, &wait
);
833 /* see if a signal did it */
834 if (signal_pending(current
))
836 spin_lock_irqsave(&mct_u232_port
->lock
, flags
);
837 cnow
= mct_u232_port
->icount
;
838 spin_unlock_irqrestore(&mct_u232_port
->lock
, flags
);
839 if (cnow
.rng
== cprev
.rng
&& cnow
.dsr
== cprev
.dsr
&&
840 cnow
.dcd
== cprev
.dcd
&& cnow
.cts
== cprev
.cts
)
841 return -EIO
; /* no change => error */
842 if (((arg
& TIOCM_RNG
) && (cnow
.rng
!= cprev
.rng
)) ||
843 ((arg
& TIOCM_DSR
) && (cnow
.dsr
!= cprev
.dsr
)) ||
844 ((arg
& TIOCM_CD
) && (cnow
.dcd
!= cprev
.dcd
)) ||
845 ((arg
& TIOCM_CTS
) && (cnow
.cts
!= cprev
.cts
))) {
855 static int mct_u232_get_icount(struct tty_struct
*tty
,
856 struct serial_icounter_struct
*icount
)
858 struct usb_serial_port
*port
= tty
->driver_data
;
859 struct mct_u232_private
*mct_u232_port
= usb_get_serial_port_data(port
);
860 struct async_icount
*ic
= &mct_u232_port
->icount
;
863 spin_lock_irqsave(&mct_u232_port
->lock
, flags
);
865 icount
->cts
= ic
->cts
;
866 icount
->dsr
= ic
->dsr
;
867 icount
->rng
= ic
->rng
;
868 icount
->dcd
= ic
->dcd
;
871 icount
->frame
= ic
->frame
;
872 icount
->overrun
= ic
->overrun
;
873 icount
->parity
= ic
->parity
;
874 icount
->brk
= ic
->brk
;
875 icount
->buf_overrun
= ic
->buf_overrun
;
877 spin_unlock_irqrestore(&mct_u232_port
->lock
, flags
);
879 dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d",
880 __func__
, port
->number
, icount
->rx
, icount
->tx
);
884 module_usb_serial_driver(serial_drivers
, id_table
);
886 MODULE_AUTHOR(DRIVER_AUTHOR
);
887 MODULE_DESCRIPTION(DRIVER_DESC
);
888 MODULE_LICENSE("GPL");
890 module_param(debug
, bool, S_IRUGO
| S_IWUSR
);
891 MODULE_PARM_DESC(debug
, "Debug enabled or not");