?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 4.2.1
[linux/fpc-iii.git] / drivers / usb / serial / mct_u232.c
blobfd707d6a10e26359f4f96502e0bcbb1f1c79bbe1
1 /*
2 * MCT (Magic Control Technology Corp.) USB RS232 Converter Driver
3 *
4 * Copyright (C) 2000 Wolfgang Grandegger (wolfgang@ces.ch)
5 *
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.
10 *
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.
14 *
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.
17 *
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.
22 */
23
24 #include <linux/kernel.h>
25 #include <linux/errno.h>
26 #include <linux/slab.h>
27 #include <linux/tty.h>
28 #include <linux/tty_driver.h>
29 #include <linux/tty_flip.h>
30 #include <linux/module.h>
31 #include <linux/spinlock.h>
32 #include <linux/uaccess.h>
33 #include <asm/unaligned.h>
34 #include <linux/usb.h>
35 #include <linux/usb/serial.h>
36 #include <linux/serial.h>
37 #include "mct_u232.h"
38
39 #define DRIVER_AUTHOR "Wolfgang Grandegger <wolfgang@ces.ch>"
40 #define DRIVER_DESC "Magic Control Technology USB-RS232 converter driver"
41
42 /*
43 * Function prototypes
44 */
45 static int mct_u232_port_probe(struct usb_serial_port *port);
46 static int mct_u232_port_remove(struct usb_serial_port *remove);
47 static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port);
48 static void mct_u232_close(struct usb_serial_port *port);
49 static void mct_u232_dtr_rts(struct usb_serial_port *port, int on);
50 static void mct_u232_read_int_callback(struct urb *urb);
51 static void mct_u232_set_termios(struct tty_struct *tty,
52 struct usb_serial_port *port, struct ktermios *old);
53 static void mct_u232_break_ctl(struct tty_struct *tty, int break_state);
54 static int mct_u232_tiocmget(struct tty_struct *tty);
55 static int mct_u232_tiocmset(struct tty_struct *tty,
56 unsigned int set, unsigned int clear);
57 static void mct_u232_throttle(struct tty_struct *tty);
58 static void mct_u232_unthrottle(struct tty_struct *tty);
59
60
61 /*
62 * All of the device info needed for the MCT USB-RS232 converter.
63 */
64 static const struct usb_device_id id_table[] = {
65 { USB_DEVICE(MCT_U232_VID, MCT_U232_PID) },
66 { USB_DEVICE(MCT_U232_VID, MCT_U232_SITECOM_PID) },
67 { USB_DEVICE(MCT_U232_VID, MCT_U232_DU_H3SP_PID) },
68 { USB_DEVICE(MCT_U232_BELKIN_F5U109_VID, MCT_U232_BELKIN_F5U109_PID) },
69 { } /* Terminating entry */
70 };
71 MODULE_DEVICE_TABLE(usb, id_table);
72
73 static struct usb_serial_driver mct_u232_device = {
74 .driver = {
75 .owner = THIS_MODULE,
76 .name = "mct_u232",
77 },
78 .description = "MCT U232",
79 .id_table = id_table,
80 .num_ports = 1,
81 .open = mct_u232_open,
82 .close = mct_u232_close,
83 .dtr_rts = mct_u232_dtr_rts,
84 .throttle = mct_u232_throttle,
85 .unthrottle = mct_u232_unthrottle,
86 .read_int_callback = mct_u232_read_int_callback,
87 .set_termios = mct_u232_set_termios,
88 .break_ctl = mct_u232_break_ctl,
89 .tiocmget = mct_u232_tiocmget,
90 .tiocmset = mct_u232_tiocmset,
91 .tiocmiwait = usb_serial_generic_tiocmiwait,
92 .port_probe = mct_u232_port_probe,
93 .port_remove = mct_u232_port_remove,
94 .get_icount = usb_serial_generic_get_icount,
95 };
96
97 static struct usb_serial_driver * const serial_drivers[] = {
98 &mct_u232_device, NULL
99 };
100
101 struct mct_u232_private {
102 struct urb *read_urb;
103 spinlock_t lock;
104 unsigned int control_state; /* Modem Line Setting (TIOCM) */
105 unsigned char last_lcr; /* Line Control Register */
106 unsigned char last_lsr; /* Line Status Register */
107 unsigned char last_msr; /* Modem Status Register */
108 unsigned int rx_flags; /* Throttling flags */
109 };
110
111 #define THROTTLED 0x01
112
113 /*
114 * Handle vendor specific USB requests
115 */
116
117 #define WDR_TIMEOUT 5000 /* default urb timeout */
118
119 /*
120 * Later day 2.6.0-test kernels have new baud rates like B230400 which
121 * we do not know how to support. We ignore them for the moment.
122 */
123 static int mct_u232_calculate_baud_rate(struct usb_serial *serial,
124 speed_t value, speed_t *result)
125 {
126 *result = value;
127
128 if (le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_SITECOM_PID
129 || le16_to_cpu(serial->dev->descriptor.idProduct) == MCT_U232_BELKIN_F5U109_PID) {
130 switch (value) {
131 case 300:
132 return 0x01;
133 case 600:
134 return 0x02; /* this one not tested */
135 case 1200:
136 return 0x03;
137 case 2400:
138 return 0x04;
139 case 4800:
140 return 0x06;
141 case 9600:
142 return 0x08;
143 case 19200:
144 return 0x09;
145 case 38400:
146 return 0x0a;
147 case 57600:
148 return 0x0b;
149 case 115200:
150 return 0x0c;
151 default:
152 *result = 9600;
153 return 0x08;
154 }
155 } else {
156 /* FIXME: Can we use any divider - should we do
157 divider = 115200/value;
158 real baud = 115200/divider */
159 switch (value) {
160 case 300: break;
161 case 600: break;
162 case 1200: break;
163 case 2400: break;
164 case 4800: break;
165 case 9600: break;
166 case 19200: break;
167 case 38400: break;
168 case 57600: break;
169 case 115200: break;
170 default:
171 value = 9600;
172 *result = 9600;
173 }
174 return 115200/value;
175 }
176 }
177
178 static int mct_u232_set_baud_rate(struct tty_struct *tty,
179 struct usb_serial *serial, struct usb_serial_port *port, speed_t value)
180 {
181 unsigned int divisor;
182 int rc;
183 unsigned char *buf;
184 unsigned char cts_enable_byte = 0;
185 speed_t speed;
186
187 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
188 if (buf == NULL)
189 return -ENOMEM;
190
191 divisor = mct_u232_calculate_baud_rate(serial, value, &speed);
192 put_unaligned_le32(cpu_to_le32(divisor), buf);
193 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
194 MCT_U232_SET_BAUD_RATE_REQUEST,
195 MCT_U232_SET_REQUEST_TYPE,
196 0, 0, buf, MCT_U232_SET_BAUD_RATE_SIZE,
197 WDR_TIMEOUT);
198 if (rc < 0) /*FIXME: What value speed results */
199 dev_err(&port->dev, "Set BAUD RATE %d failed (error = %d)\n",
200 value, rc);
201 else
202 tty_encode_baud_rate(tty, speed, speed);
203 dev_dbg(&port->dev, "set_baud_rate: value: 0x%x, divisor: 0x%x\n", value, divisor);
204
205 /* Mimic the MCT-supplied Windows driver (version 1.21P.0104), which
206 always sends two extra USB 'device request' messages after the
207 'baud rate change' message. The actual functionality of the
208 request codes in these messages is not fully understood but these
209 particular codes are never seen in any operation besides a baud
210 rate change. Both of these messages send a single byte of data.
211 In the first message, the value of this byte is always zero.
212
213 The second message has been determined experimentally to control
214 whether data will be transmitted to a device which is not asserting
215 the 'CTS' signal. If the second message's data byte is zero, data
216 will be transmitted even if 'CTS' is not asserted (i.e. no hardware
217 flow control). if the second message's data byte is nonzero (a
218 value of 1 is used by this driver), data will not be transmitted to
219 a device which is not asserting 'CTS'.
220 */
221
222 buf[0] = 0;
223 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
224 MCT_U232_SET_UNKNOWN1_REQUEST,
225 MCT_U232_SET_REQUEST_TYPE,
226 0, 0, buf, MCT_U232_SET_UNKNOWN1_SIZE,
227 WDR_TIMEOUT);
228 if (rc < 0)
229 dev_err(&port->dev, "Sending USB device request code %d "
230 "failed (error = %d)\n", MCT_U232_SET_UNKNOWN1_REQUEST,
231 rc);
232
233 if (port && C_CRTSCTS(tty))
234 cts_enable_byte = 1;
235
236 dev_dbg(&port->dev, "set_baud_rate: send second control message, data = %02X\n",
237 cts_enable_byte);
238 buf[0] = cts_enable_byte;
239 rc = usb_control_msg(serial->dev, usb_sndctrlpipe(serial->dev, 0),
240 MCT_U232_SET_CTS_REQUEST,
241 MCT_U232_SET_REQUEST_TYPE,
242 0, 0, buf, MCT_U232_SET_CTS_SIZE,
243 WDR_TIMEOUT);
244 if (rc < 0)
245 dev_err(&port->dev, "Sending USB device request code %d "
246 "failed (error = %d)\n", MCT_U232_SET_CTS_REQUEST, rc);
247
248 kfree(buf);
249 return rc;
250 } /* mct_u232_set_baud_rate */
251
252 static int mct_u232_set_line_ctrl(struct usb_serial_port *port,
253 unsigned char lcr)
254 {
255 int rc;
256 unsigned char *buf;
257
258 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
259 if (buf == NULL)
260 return -ENOMEM;
261
262 buf[0] = lcr;
263 rc = usb_control_msg(port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
264 MCT_U232_SET_LINE_CTRL_REQUEST,
265 MCT_U232_SET_REQUEST_TYPE,
266 0, 0, buf, MCT_U232_SET_LINE_CTRL_SIZE,
267 WDR_TIMEOUT);
268 if (rc < 0)
269 dev_err(&port->dev, "Set LINE CTRL 0x%x failed (error = %d)\n", lcr, rc);
270 dev_dbg(&port->dev, "set_line_ctrl: 0x%x\n", lcr);
271 kfree(buf);
272 return rc;
273 } /* mct_u232_set_line_ctrl */
274
275 static int mct_u232_set_modem_ctrl(struct usb_serial_port *port,
276 unsigned int control_state)
277 {
278 int rc;
279 unsigned char mcr;
280 unsigned char *buf;
281
282 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
283 if (buf == NULL)
284 return -ENOMEM;
285
286 mcr = MCT_U232_MCR_NONE;
287 if (control_state & TIOCM_DTR)
288 mcr |= MCT_U232_MCR_DTR;
289 if (control_state & TIOCM_RTS)
290 mcr |= MCT_U232_MCR_RTS;
291
292 buf[0] = mcr;
293 rc = usb_control_msg(port->serial->dev, usb_sndctrlpipe(port->serial->dev, 0),
294 MCT_U232_SET_MODEM_CTRL_REQUEST,
295 MCT_U232_SET_REQUEST_TYPE,
296 0, 0, buf, MCT_U232_SET_MODEM_CTRL_SIZE,
297 WDR_TIMEOUT);
298 kfree(buf);
299
300 dev_dbg(&port->dev, "set_modem_ctrl: state=0x%x ==> mcr=0x%x\n", control_state, mcr);
301
302 if (rc < 0) {
303 dev_err(&port->dev, "Set MODEM CTRL 0x%x failed (error = %d)\n", mcr, rc);
304 return rc;
305 }
306 return 0;
307 } /* mct_u232_set_modem_ctrl */
308
309 static int mct_u232_get_modem_stat(struct usb_serial_port *port,
310 unsigned char *msr)
311 {
312 int rc;
313 unsigned char *buf;
314
315 buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
316 if (buf == NULL) {
317 *msr = 0;
318 return -ENOMEM;
319 }
320 rc = usb_control_msg(port->serial->dev, usb_rcvctrlpipe(port->serial->dev, 0),
321 MCT_U232_GET_MODEM_STAT_REQUEST,
322 MCT_U232_GET_REQUEST_TYPE,
323 0, 0, buf, MCT_U232_GET_MODEM_STAT_SIZE,
324 WDR_TIMEOUT);
325 if (rc < 0) {
326 dev_err(&port->dev, "Get MODEM STATus failed (error = %d)\n", rc);
327 *msr = 0;
328 } else {
329 *msr = buf[0];
330 }
331 dev_dbg(&port->dev, "get_modem_stat: 0x%x\n", *msr);
332 kfree(buf);
333 return rc;
334 } /* mct_u232_get_modem_stat */
335
336 static void mct_u232_msr_to_icount(struct async_icount *icount,
337 unsigned char msr)
338 {
339 /* Translate Control Line states */
340 if (msr & MCT_U232_MSR_DDSR)
341 icount->dsr++;
342 if (msr & MCT_U232_MSR_DCTS)
343 icount->cts++;
344 if (msr & MCT_U232_MSR_DRI)
345 icount->rng++;
346 if (msr & MCT_U232_MSR_DCD)
347 icount->dcd++;
348 } /* mct_u232_msr_to_icount */
349
350 static void mct_u232_msr_to_state(struct usb_serial_port *port,
351 unsigned int *control_state, unsigned char msr)
352 {
353 /* Translate Control Line states */
354 if (msr & MCT_U232_MSR_DSR)
355 *control_state |= TIOCM_DSR;
356 else
357 *control_state &= ~TIOCM_DSR;
358 if (msr & MCT_U232_MSR_CTS)
359 *control_state |= TIOCM_CTS;
360 else
361 *control_state &= ~TIOCM_CTS;
362 if (msr & MCT_U232_MSR_RI)
363 *control_state |= TIOCM_RI;
364 else
365 *control_state &= ~TIOCM_RI;
366 if (msr & MCT_U232_MSR_CD)
367 *control_state |= TIOCM_CD;
368 else
369 *control_state &= ~TIOCM_CD;
370 dev_dbg(&port->dev, "msr_to_state: msr=0x%x ==> state=0x%x\n", msr, *control_state);
371 } /* mct_u232_msr_to_state */
372
373 /*
374 * Driver's tty interface functions
375 */
376
377 static int mct_u232_port_probe(struct usb_serial_port *port)
378 {
379 struct mct_u232_private *priv;
380
381 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
382 if (!priv)
383 return -ENOMEM;
384
385 /* Use second interrupt-in endpoint for reading. */
386 priv->read_urb = port->serial->port[1]->interrupt_in_urb;
387 priv->read_urb->context = port;
388
389 spin_lock_init(&priv->lock);
390
391 usb_set_serial_port_data(port, priv);
392
393 return 0;
394 }
395
396 static int mct_u232_port_remove(struct usb_serial_port *port)
397 {
398 struct mct_u232_private *priv;
399
400 priv = usb_get_serial_port_data(port);
401 kfree(priv);
402
403 return 0;
404 }
405
406 static int mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port)
407 {
408 struct usb_serial *serial = port->serial;
409 struct mct_u232_private *priv = usb_get_serial_port_data(port);
410 int retval = 0;
411 unsigned int control_state;
412 unsigned long flags;
413 unsigned char last_lcr;
414 unsigned char last_msr;
415
416 /* Compensate for a hardware bug: although the Sitecom U232-P25
417 * device reports a maximum output packet size of 32 bytes,
418 * it seems to be able to accept only 16 bytes (and that's what
419 * SniffUSB says too...)
420 */
421 if (le16_to_cpu(serial->dev->descriptor.idProduct)
422 == MCT_U232_SITECOM_PID)
423 port->bulk_out_size = 16;
424
425 /* Do a defined restart: the normal serial device seems to
426 * always turn on DTR and RTS here, so do the same. I'm not
427 * sure if this is really necessary. But it should not harm
428 * either.
429 */
430 spin_lock_irqsave(&priv->lock, flags);
431 if (tty && (tty->termios.c_cflag & CBAUD))
432 priv->control_state = TIOCM_DTR | TIOCM_RTS;
433 else
434 priv->control_state = 0;
435
436 priv->last_lcr = (MCT_U232_DATA_BITS_8 |
437 MCT_U232_PARITY_NONE |
438 MCT_U232_STOP_BITS_1);
439 control_state = priv->control_state;
440 last_lcr = priv->last_lcr;
441 spin_unlock_irqrestore(&priv->lock, flags);
442 mct_u232_set_modem_ctrl(port, control_state);
443 mct_u232_set_line_ctrl(port, last_lcr);
444
445 /* Read modem status and update control state */
446 mct_u232_get_modem_stat(port, &last_msr);
447 spin_lock_irqsave(&priv->lock, flags);
448 priv->last_msr = last_msr;
449 mct_u232_msr_to_state(port, &priv->control_state, priv->last_msr);
450 spin_unlock_irqrestore(&priv->lock, flags);
451
452 retval = usb_submit_urb(priv->read_urb, GFP_KERNEL);
453 if (retval) {
454 dev_err(&port->dev,
455 "usb_submit_urb(read) failed pipe 0x%x err %d\n",
456 port->read_urb->pipe, retval);
457 goto error;
458 }
459
460 retval = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
461 if (retval) {
462 usb_kill_urb(priv->read_urb);
463 dev_err(&port->dev,
464 "usb_submit_urb(read int) failed pipe 0x%x err %d",
465 port->interrupt_in_urb->pipe, retval);
466 goto error;
467 }
468 return 0;
469
470 error:
471 return retval;
472 } /* mct_u232_open */
473
474 static void mct_u232_dtr_rts(struct usb_serial_port *port, int on)
475 {
476 unsigned int control_state;
477 struct mct_u232_private *priv = usb_get_serial_port_data(port);
478
479 spin_lock_irq(&priv->lock);
480 if (on)
481 priv->control_state |= TIOCM_DTR | TIOCM_RTS;
482 else
483 priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS);
484 control_state = priv->control_state;
485 spin_unlock_irq(&priv->lock);
486
487 mct_u232_set_modem_ctrl(port, control_state);
488 }
489
490 static void mct_u232_close(struct usb_serial_port *port)
491 {
492 struct mct_u232_private *priv = usb_get_serial_port_data(port);
493
494 usb_kill_urb(priv->read_urb);
495 usb_kill_urb(port->interrupt_in_urb);
496
497 usb_serial_generic_close(port);
498 } /* mct_u232_close */
499
500
501 static void mct_u232_read_int_callback(struct urb *urb)
502 {
503 struct usb_serial_port *port = urb->context;
504 struct mct_u232_private *priv = usb_get_serial_port_data(port);
505 unsigned char *data = urb->transfer_buffer;
506 int retval;
507 int status = urb->status;
508 unsigned long flags;
509
510 switch (status) {
511 case 0:
512 /* success */
513 break;
514 case -ECONNRESET:
515 case -ENOENT:
516 case -ESHUTDOWN:
517 /* this urb is terminated, clean up */
518 dev_dbg(&port->dev, "%s - urb shutting down with status: %d\n",
519 __func__, status);
520 return;
521 default:
522 dev_dbg(&port->dev, "%s - nonzero urb status received: %d\n",
523 __func__, status);
524 goto exit;
525 }
526
527 usb_serial_debug_data(&port->dev, __func__, urb->actual_length, data);
528
529 /*
530 * Work-a-round: handle the 'usual' bulk-in pipe here
531 */
532 if (urb->transfer_buffer_length > 2) {
533 if (urb->actual_length) {
534 tty_insert_flip_string(&port->port, data,
535 urb->actual_length);
536 tty_flip_buffer_push(&port->port);
537 }
538 goto exit;
539 }
540
541 /*
542 * The interrupt-in pipe signals exceptional conditions (modem line
543 * signal changes and errors). data[0] holds MSR, data[1] holds LSR.
544 */
545 spin_lock_irqsave(&priv->lock, flags);
546 priv->last_msr = data[MCT_U232_MSR_INDEX];
547
548 /* Record Control Line states */
549 mct_u232_msr_to_state(port, &priv->control_state, priv->last_msr);
550
551 mct_u232_msr_to_icount(&port->icount, priv->last_msr);
552
553 #if 0
554 /* Not yet handled. See belkin_sa.c for further information */
555 /* Now to report any errors */
556 priv->last_lsr = data[MCT_U232_LSR_INDEX];
557 /*
558 * fill in the flip buffer here, but I do not know the relation
559 * to the current/next receive buffer or characters. I need
560 * to look in to this before committing any code.
561 */
562 if (priv->last_lsr & MCT_U232_LSR_ERR) {
563 tty = tty_port_tty_get(&port->port);
564 /* Overrun Error */
565 if (priv->last_lsr & MCT_U232_LSR_OE) {
566 }
567 /* Parity Error */
568 if (priv->last_lsr & MCT_U232_LSR_PE) {
569 }
570 /* Framing Error */
571 if (priv->last_lsr & MCT_U232_LSR_FE) {
572 }
573 /* Break Indicator */
574 if (priv->last_lsr & MCT_U232_LSR_BI) {
575 }
576 tty_kref_put(tty);
577 }
578 #endif
579 wake_up_interruptible(&port->port.delta_msr_wait);
580 spin_unlock_irqrestore(&priv->lock, flags);
581 exit:
582 retval = usb_submit_urb(urb, GFP_ATOMIC);
583 if (retval)
584 dev_err(&port->dev,
585 "%s - usb_submit_urb failed with result %d\n",
586 __func__, retval);
587 } /* mct_u232_read_int_callback */
588
589 static void mct_u232_set_termios(struct tty_struct *tty,
590 struct usb_serial_port *port,
591 struct ktermios *old_termios)
592 {
593 struct usb_serial *serial = port->serial;
594 struct mct_u232_private *priv = usb_get_serial_port_data(port);
595 struct ktermios *termios = &tty->termios;
596 unsigned int cflag = termios->c_cflag;
597 unsigned int old_cflag = old_termios->c_cflag;
598 unsigned long flags;
599 unsigned int control_state;
600 unsigned char last_lcr;
601
602 /* get a local copy of the current port settings */
603 spin_lock_irqsave(&priv->lock, flags);
604 control_state = priv->control_state;
605 spin_unlock_irqrestore(&priv->lock, flags);
606 last_lcr = 0;
607
608 /*
609 * Update baud rate.
610 * Do not attempt to cache old rates and skip settings,
611 * disconnects screw such tricks up completely.
612 * Premature optimization is the root of all evil.
613 */
614
615 /* reassert DTR and RTS on transition from B0 */
616 if ((old_cflag & CBAUD) == B0) {
617 dev_dbg(&port->dev, "%s: baud was B0\n", __func__);
618 control_state |= TIOCM_DTR | TIOCM_RTS;
619 mct_u232_set_modem_ctrl(port, control_state);
620 }
621
622 mct_u232_set_baud_rate(tty, serial, port, tty_get_baud_rate(tty));
623
624 if ((cflag & CBAUD) == B0) {
625 dev_dbg(&port->dev, "%s: baud is B0\n", __func__);
626 /* Drop RTS and DTR */
627 control_state &= ~(TIOCM_DTR | TIOCM_RTS);
628 mct_u232_set_modem_ctrl(port, control_state);
629 }
630
631 /*
632 * Update line control register (LCR)
633 */
634
635 /* set the parity */
636 if (cflag & PARENB)
637 last_lcr |= (cflag & PARODD) ?
638 MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN;
639 else
640 last_lcr |= MCT_U232_PARITY_NONE;
641
642 /* set the number of data bits */
643 switch (cflag & CSIZE) {
644 case CS5:
645 last_lcr |= MCT_U232_DATA_BITS_5; break;
646 case CS6:
647 last_lcr |= MCT_U232_DATA_BITS_6; break;
648 case CS7:
649 last_lcr |= MCT_U232_DATA_BITS_7; break;
650 case CS8:
651 last_lcr |= MCT_U232_DATA_BITS_8; break;
652 default:
653 dev_err(&port->dev,
654 "CSIZE was not CS5-CS8, using default of 8\n");
655 last_lcr |= MCT_U232_DATA_BITS_8;
656 break;
657 }
658
659 termios->c_cflag &= ~CMSPAR;
660
661 /* set the number of stop bits */
662 last_lcr |= (cflag & CSTOPB) ?
663 MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1;
664
665 mct_u232_set_line_ctrl(port, last_lcr);
666
667 /* save off the modified port settings */
668 spin_lock_irqsave(&priv->lock, flags);
669 priv->control_state = control_state;
670 priv->last_lcr = last_lcr;
671 spin_unlock_irqrestore(&priv->lock, flags);
672 } /* mct_u232_set_termios */
673
674 static void mct_u232_break_ctl(struct tty_struct *tty, int break_state)
675 {
676 struct usb_serial_port *port = tty->driver_data;
677 struct mct_u232_private *priv = usb_get_serial_port_data(port);
678 unsigned char lcr;
679 unsigned long flags;
680
681 spin_lock_irqsave(&priv->lock, flags);
682 lcr = priv->last_lcr;
683
684 if (break_state)
685 lcr |= MCT_U232_SET_BREAK;
686 spin_unlock_irqrestore(&priv->lock, flags);
687
688 mct_u232_set_line_ctrl(port, lcr);
689 } /* mct_u232_break_ctl */
690
691
692 static int mct_u232_tiocmget(struct tty_struct *tty)
693 {
694 struct usb_serial_port *port = tty->driver_data;
695 struct mct_u232_private *priv = usb_get_serial_port_data(port);
696 unsigned int control_state;
697 unsigned long flags;
698
699 spin_lock_irqsave(&priv->lock, flags);
700 control_state = priv->control_state;
701 spin_unlock_irqrestore(&priv->lock, flags);
702
703 return control_state;
704 }
705
706 static int mct_u232_tiocmset(struct tty_struct *tty,
707 unsigned int set, unsigned int clear)
708 {
709 struct usb_serial_port *port = tty->driver_data;
710 struct mct_u232_private *priv = usb_get_serial_port_data(port);
711 unsigned int control_state;
712 unsigned long flags;
713
714 spin_lock_irqsave(&priv->lock, flags);
715 control_state = priv->control_state;
716
717 if (set & TIOCM_RTS)
718 control_state |= TIOCM_RTS;
719 if (set & TIOCM_DTR)
720 control_state |= TIOCM_DTR;
721 if (clear & TIOCM_RTS)
722 control_state &= ~TIOCM_RTS;
723 if (clear & TIOCM_DTR)
724 control_state &= ~TIOCM_DTR;
725
726 priv->control_state = control_state;
727 spin_unlock_irqrestore(&priv->lock, flags);
728 return mct_u232_set_modem_ctrl(port, control_state);
729 }
730
731 static void mct_u232_throttle(struct tty_struct *tty)
732 {
733 struct usb_serial_port *port = tty->driver_data;
734 struct mct_u232_private *priv = usb_get_serial_port_data(port);
735 unsigned int control_state;
736
737 spin_lock_irq(&priv->lock);
738 priv->rx_flags |= THROTTLED;
739 if (C_CRTSCTS(tty)) {
740 priv->control_state &= ~TIOCM_RTS;
741 control_state = priv->control_state;
742 spin_unlock_irq(&priv->lock);
743 mct_u232_set_modem_ctrl(port, control_state);
744 } else {
745 spin_unlock_irq(&priv->lock);
746 }
747 }
748
749 static void mct_u232_unthrottle(struct tty_struct *tty)
750 {
751 struct usb_serial_port *port = tty->driver_data;
752 struct mct_u232_private *priv = usb_get_serial_port_data(port);
753 unsigned int control_state;
754
755 spin_lock_irq(&priv->lock);
756 if ((priv->rx_flags & THROTTLED) && C_CRTSCTS(tty)) {
757 priv->rx_flags &= ~THROTTLED;
758 priv->control_state |= TIOCM_RTS;
759 control_state = priv->control_state;
760 spin_unlock_irq(&priv->lock);
761 mct_u232_set_modem_ctrl(port, control_state);
762 } else {
763 spin_unlock_irq(&priv->lock);
764 }
765 }
766
767 module_usb_serial_driver(serial_drivers, id_table);
768
769 MODULE_AUTHOR(DRIVER_AUTHOR);
770 MODULE_DESCRIPTION(DRIVER_DESC);
771 MODULE_LICENSE("GPL");
Linux with added FPC-III support