USB: serial: fix null-pointer dereferences on disconnect
[pandora-kernel.git] / drivers / usb / serial / mct_u232.c
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  * TEST STATUS:
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).
26  *
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.
31  *
32  * 10-Nov-2001 Wolfgang Grandegger
33  *   - Fixed an endianess problem with the baudrate selection for PowerPC.
34  *
35  * 06-Dec-2001 Martin Hamilton <martinh@gnu.org>
36  *   - Added support for the Belkin F5U109 DB9 adaptor
37  *
38  * 30-May-2001 Greg Kroah-Hartman
39  *   - switched from using spinlock to a semaphore, which fixes lots of
40  *     problems.
41  *
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).
46  *
47  * 02-May-2001 Stelian Pop
48  *   - Fixed the baud calculation for Sitecom U232-P25 model
49  *
50  * 08-Apr-2001 gb
51  *   - Identify version on module load.
52  *
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)
56  *
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.
62  *
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).
66  */
67
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>
83 #include "mct_u232.h"
84
85 /*
86  * Version Information
87  */
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"
91
92 static int debug;
93
94 /*
95  * Function prototypes
96  */
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);
115
116
117 /*
118  * All of the device info needed for the MCT USB-RS232 converter.
119  */
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 */
126 };
127
128 MODULE_DEVICE_TABLE(usb, id_table_combined);
129
130 static struct usb_driver mct_u232_driver = {
131         .name =         "mct_u232",
132         .probe =        usb_serial_probe,
133         .disconnect =   usb_serial_disconnect,
134         .id_table =     id_table_combined,
135         .no_dynamic_id =        1,
136 };
137
138 static struct usb_serial_driver mct_u232_device = {
139         .driver = {
140                 .owner =        THIS_MODULE,
141                 .name =         "mct_u232",
142         },
143         .description =       "MCT U232",
144         .usb_driver =        &mct_u232_driver,
145         .id_table =          id_table_combined,
146         .num_ports =         1,
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,
161 };
162
163 struct mct_u232_private {
164         spinlock_t lock;
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 */
173 };
174
175 #define THROTTLED               0x01
176
177 /*
178  * Handle vendor specific USB requests
179  */
180
181 #define WDR_TIMEOUT 5000 /* default urb timeout */
182
183 /*
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.
186  */
187 static int mct_u232_calculate_baud_rate(struct usb_serial *serial,
188                                         speed_t value, speed_t *result)
189 {
190         *result = value;
191
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) {
194                 switch (value) {
195                 case 300:
196                         return 0x01;
197                 case 600:
198                         return 0x02; /* this one not tested */
199                 case 1200:
200                         return 0x03;
201                 case 2400:
202                         return 0x04;
203                 case 4800:
204                         return 0x06;
205                 case 9600:
206                         return 0x08;
207                 case 19200:
208                         return 0x09;
209                 case 38400:
210                         return 0x0a;
211                 case 57600:
212                         return 0x0b;
213                 case 115200:
214                         return 0x0c;
215                 default:
216                         *result = 9600;
217                         return 0x08;
218                 }
219         } else {
220                 /* FIXME: Can we use any divider - should we do
221                    divider = 115200/value;
222                    real baud = 115200/divider */
223                 switch (value) {
224                 case 300: break;
225                 case 600: break;
226                 case 1200: break;
227                 case 2400: break;
228                 case 4800: break;
229                 case 9600: break;
230                 case 19200: break;
231                 case 38400: break;
232                 case 57600: break;
233                 case 115200: break;
234                 default:
235                         value = 9600;
236                         *result = 9600;
237                 }
238                 return 115200/value;
239         }
240 }
241
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)
244 {
245         unsigned int divisor;
246         int rc;
247         unsigned char *buf;
248         unsigned char cts_enable_byte = 0;
249         speed_t speed;
250
251         buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
252         if (buf == NULL)
253                 return -ENOMEM;
254
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,
261                                 WDR_TIMEOUT);
262         if (rc < 0)     /*FIXME: What value speed results */
263                 dev_err(&port->dev, "Set BAUD RATE %d failed (error = %d)\n",
264                         value, rc);
265         else
266                 tty_encode_baud_rate(tty, speed, speed);
267         dbg("set_baud_rate: value: 0x%x, divisor: 0x%x", value, divisor);
268
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.
276
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'.
284         */
285
286         buf[0] = 0;
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,
291                                 WDR_TIMEOUT);
292         if (rc < 0)
293                 dev_err(&port->dev, "Sending USB device request code %d "
294                         "failed (error = %d)\n", MCT_U232_SET_UNKNOWN1_REQUEST,
295                         rc);
296
297         if (port && C_CRTSCTS(tty))
298            cts_enable_byte = 1;
299
300         dbg("set_baud_rate: send second control message, data = %02X",
301                                                         cts_enable_byte);
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,
307                         WDR_TIMEOUT);
308         if (rc < 0)
309                 dev_err(&port->dev, "Sending USB device request code %d "
310                         "failed (error = %d)\n", MCT_U232_SET_CTS_REQUEST, rc);
311
312         kfree(buf);
313         return rc;
314 } /* mct_u232_set_baud_rate */
315
316 static int mct_u232_set_line_ctrl(struct usb_serial *serial, unsigned char lcr)
317 {
318         int rc;
319         unsigned char *buf;
320
321         buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
322         if (buf == NULL)
323                 return -ENOMEM;
324
325         buf[0] = lcr;
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,
330                         WDR_TIMEOUT);
331         if (rc < 0)
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);
335         kfree(buf);
336         return rc;
337 } /* mct_u232_set_line_ctrl */
338
339 static int mct_u232_set_modem_ctrl(struct usb_serial *serial,
340                                    unsigned int control_state)
341 {
342         int rc;
343         unsigned char mcr;
344         unsigned char *buf;
345
346         buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
347         if (buf == NULL)
348                 return -ENOMEM;
349
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;
355
356         buf[0] = mcr;
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,
361                         WDR_TIMEOUT);
362         kfree(buf);
363
364         dbg("set_modem_ctrl: state=0x%x ==> mcr=0x%x", control_state, mcr);
365
366         if (rc < 0) {
367                 dev_err(&serial->dev->dev,
368                         "Set MODEM CTRL 0x%x failed (error = %d)\n", mcr, rc);
369                 return rc;
370         }
371         return 0;
372 } /* mct_u232_set_modem_ctrl */
373
374 static int mct_u232_get_modem_stat(struct usb_serial *serial,
375                                                 unsigned char *msr)
376 {
377         int rc;
378         unsigned char *buf;
379
380         buf = kmalloc(MCT_U232_MAX_SIZE, GFP_KERNEL);
381         if (buf == NULL) {
382                 *msr = 0;
383                 return -ENOMEM;
384         }
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,
389                         WDR_TIMEOUT);
390         if (rc < 0) {
391                 dev_err(&serial->dev->dev,
392                         "Get MODEM STATus failed (error = %d)\n", rc);
393                 *msr = 0;
394         } else {
395                 *msr = buf[0];
396         }
397         dbg("get_modem_stat: 0x%x", *msr);
398         kfree(buf);
399         return rc;
400 } /* mct_u232_get_modem_stat */
401
402 static void mct_u232_msr_to_icount(struct async_icount *icount,
403                                                 unsigned char msr)
404 {
405         /* Translate Control Line states */
406         if (msr & MCT_U232_MSR_DDSR)
407                 icount->dsr++;
408         if (msr & MCT_U232_MSR_DCTS)
409                 icount->cts++;
410         if (msr & MCT_U232_MSR_DRI)
411                 icount->rng++;
412         if (msr & MCT_U232_MSR_DCD)
413                 icount->dcd++;
414 } /* mct_u232_msr_to_icount */
415
416 static void mct_u232_msr_to_state(unsigned int *control_state,
417                                                 unsigned char msr)
418 {
419         /* Translate Control Line states */
420         if (msr & MCT_U232_MSR_DSR)
421                 *control_state |=  TIOCM_DSR;
422         else
423                 *control_state &= ~TIOCM_DSR;
424         if (msr & MCT_U232_MSR_CTS)
425                 *control_state |=  TIOCM_CTS;
426         else
427                 *control_state &= ~TIOCM_CTS;
428         if (msr & MCT_U232_MSR_RI)
429                 *control_state |=  TIOCM_RI;
430         else
431                 *control_state &= ~TIOCM_RI;
432         if (msr & MCT_U232_MSR_CD)
433                 *control_state |=  TIOCM_CD;
434         else
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 */
438
439 /*
440  * Driver's tty interface functions
441  */
442
443 static int mct_u232_startup(struct usb_serial *serial)
444 {
445         struct mct_u232_private *priv;
446         struct usb_serial_port *port, *rport;
447
448         priv = kzalloc(sizeof(struct mct_u232_private), GFP_KERNEL);
449         if (!priv)
450                 return -ENOMEM;
451         spin_lock_init(&priv->lock);
452         init_waitqueue_head(&priv->msr_wait);
453         usb_set_serial_port_data(serial->port[0], priv);
454
455         init_waitqueue_head(&serial->port[0]->write_wait);
456
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;
465
466         return 0;
467 } /* mct_u232_startup */
468
469
470 static void mct_u232_release(struct usb_serial *serial)
471 {
472         struct mct_u232_private *priv;
473         int i;
474
475         dbg("%s", __func__);
476
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]);
480                 kfree(priv);
481         }
482 } /* mct_u232_release */
483
484 static int  mct_u232_open(struct tty_struct *tty, struct usb_serial_port *port)
485 {
486         struct usb_serial *serial = port->serial;
487         struct mct_u232_private *priv = usb_get_serial_port_data(port);
488         int retval = 0;
489         unsigned int control_state;
490         unsigned long flags;
491         unsigned char last_lcr;
492         unsigned char last_msr;
493
494         dbg("%s port %d", __func__, port->number);
495
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...)
500          */
501         if (le16_to_cpu(serial->dev->descriptor.idProduct)
502                                                 == MCT_U232_SITECOM_PID)
503                 port->bulk_out_size = 16;
504
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
508          * either.
509          */
510         spin_lock_irqsave(&priv->lock, flags);
511         if (tty && (tty->termios->c_cflag & CBAUD))
512                 priv->control_state = TIOCM_DTR | TIOCM_RTS;
513         else
514                 priv->control_state = 0;
515
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);
524
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);
531
532         port->read_urb->dev = port->serial->dev;
533         retval = usb_submit_urb(port->read_urb, GFP_KERNEL);
534         if (retval) {
535                 dev_err(&port->dev,
536                         "usb_submit_urb(read bulk) failed pipe 0x%x err %d\n",
537                         port->read_urb->pipe, retval);
538                 goto error;
539         }
540
541         port->interrupt_in_urb->dev = port->serial->dev;
542         retval = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
543         if (retval) {
544                 usb_kill_urb(port->read_urb);
545                 dev_err(&port->dev,
546                         "usb_submit_urb(read int) failed pipe 0x%x err %d",
547                         port->interrupt_in_urb->pipe, retval);
548                 goto error;
549         }
550         return 0;
551
552 error:
553         return retval;
554 } /* mct_u232_open */
555
556 static void mct_u232_dtr_rts(struct usb_serial_port *port, int on)
557 {
558         unsigned int control_state;
559         struct mct_u232_private *priv = usb_get_serial_port_data(port);
560
561         spin_lock_irq(&priv->lock);
562         if (on)
563                 priv->control_state |= TIOCM_DTR | TIOCM_RTS;
564         else
565                 priv->control_state &= ~(TIOCM_DTR | TIOCM_RTS);
566         control_state = priv->control_state;
567         spin_unlock_irq(&priv->lock);
568
569         mct_u232_set_modem_ctrl(port->serial, control_state);
570 }
571
572 static void mct_u232_close(struct usb_serial_port *port)
573 {
574         dbg("%s port %d", __func__, port->number);
575
576         /*
577          * Must kill the read urb as it is actually an interrupt urb, which
578          * generic close thus fails to kill.
579          */
580         usb_kill_urb(port->read_urb);
581         usb_kill_urb(port->interrupt_in_urb);
582
583         usb_serial_generic_close(port);
584 } /* mct_u232_close */
585
586
587 static void mct_u232_read_int_callback(struct urb *urb)
588 {
589         struct usb_serial_port *port = urb->context;
590         struct mct_u232_private *priv = usb_get_serial_port_data(port);
591         struct usb_serial *serial = port->serial;
592         struct tty_struct *tty;
593         unsigned char *data = urb->transfer_buffer;
594         int retval;
595         int status = urb->status;
596         unsigned long flags;
597
598         switch (status) {
599         case 0:
600                 /* success */
601                 break;
602         case -ECONNRESET:
603         case -ENOENT:
604         case -ESHUTDOWN:
605                 /* this urb is terminated, clean up */
606                 dbg("%s - urb shutting down with status: %d",
607                     __func__, status);
608                 return;
609         default:
610                 dbg("%s - nonzero urb status received: %d",
611                     __func__, status);
612                 goto exit;
613         }
614
615         if (!serial) {
616                 dbg("%s - bad serial pointer, exiting", __func__);
617                 return;
618         }
619
620         dbg("%s - port %d", __func__, port->number);
621         usb_serial_debug_data(debug, &port->dev, __func__,
622                                         urb->actual_length, data);
623
624         /*
625          * Work-a-round: handle the 'usual' bulk-in pipe here
626          */
627         if (urb->transfer_buffer_length > 2) {
628                 if (urb->actual_length) {
629                         tty = tty_port_tty_get(&port->port);
630                         if (tty) {
631                                 tty_insert_flip_string(tty, data,
632                                                 urb->actual_length);
633                                 tty_flip_buffer_push(tty);
634                         }
635                         tty_kref_put(tty);
636                 }
637                 goto exit;
638         }
639
640         /*
641          * The interrupt-in pipe signals exceptional conditions (modem line
642          * signal changes and errors). data[0] holds MSR, data[1] holds LSR.
643          */
644         spin_lock_irqsave(&priv->lock, flags);
645         priv->last_msr = data[MCT_U232_MSR_INDEX];
646
647         /* Record Control Line states */
648         mct_u232_msr_to_state(&priv->control_state, priv->last_msr);
649
650         mct_u232_msr_to_icount(&priv->icount, priv->last_msr);
651
652 #if 0
653         /* Not yet handled. See belkin_sa.c for further information */
654         /* Now to report any errors */
655         priv->last_lsr = data[MCT_U232_LSR_INDEX];
656         /*
657          * fill in the flip buffer here, but I do not know the relation
658          * to the current/next receive buffer or characters.  I need
659          * to look in to this before committing any code.
660          */
661         if (priv->last_lsr & MCT_U232_LSR_ERR) {
662                 tty = tty_port_tty_get(&port->port);
663                 /* Overrun Error */
664                 if (priv->last_lsr & MCT_U232_LSR_OE) {
665                 }
666                 /* Parity Error */
667                 if (priv->last_lsr & MCT_U232_LSR_PE) {
668                 }
669                 /* Framing Error */
670                 if (priv->last_lsr & MCT_U232_LSR_FE) {
671                 }
672                 /* Break Indicator */
673                 if (priv->last_lsr & MCT_U232_LSR_BI) {
674                 }
675                 tty_kref_put(tty);
676         }
677 #endif
678         wake_up_interruptible(&priv->msr_wait);
679         spin_unlock_irqrestore(&priv->lock, flags);
680 exit:
681         retval = usb_submit_urb(urb, GFP_ATOMIC);
682         if (retval)
683                 dev_err(&port->dev,
684                         "%s - usb_submit_urb failed with result %d\n",
685                         __func__, retval);
686 } /* mct_u232_read_int_callback */
687
688 static void mct_u232_set_termios(struct tty_struct *tty,
689                                  struct usb_serial_port *port,
690                                  struct ktermios *old_termios)
691 {
692         struct usb_serial *serial = port->serial;
693         struct mct_u232_private *priv = usb_get_serial_port_data(port);
694         struct ktermios *termios = tty->termios;
695         unsigned int cflag = termios->c_cflag;
696         unsigned int old_cflag = old_termios->c_cflag;
697         unsigned long flags;
698         unsigned int control_state;
699         unsigned char last_lcr;
700
701         /* get a local copy of the current port settings */
702         spin_lock_irqsave(&priv->lock, flags);
703         control_state = priv->control_state;
704         spin_unlock_irqrestore(&priv->lock, flags);
705         last_lcr = 0;
706
707         /*
708          * Update baud rate.
709          * Do not attempt to cache old rates and skip settings,
710          * disconnects screw such tricks up completely.
711          * Premature optimization is the root of all evil.
712          */
713
714         /* reassert DTR and RTS on transition from B0 */
715         if ((old_cflag & CBAUD) == B0) {
716                 dbg("%s: baud was B0", __func__);
717                 control_state |= TIOCM_DTR | TIOCM_RTS;
718                 mct_u232_set_modem_ctrl(serial, control_state);
719         }
720
721         mct_u232_set_baud_rate(tty, serial, port, tty_get_baud_rate(tty));
722
723         if ((cflag & CBAUD) == B0) {
724                 dbg("%s: baud is B0", __func__);
725                 /* Drop RTS and DTR */
726                 control_state &= ~(TIOCM_DTR | TIOCM_RTS);
727                 mct_u232_set_modem_ctrl(serial, control_state);
728         }
729
730         /*
731          * Update line control register (LCR)
732          */
733
734         /* set the parity */
735         if (cflag & PARENB)
736                 last_lcr |= (cflag & PARODD) ?
737                         MCT_U232_PARITY_ODD : MCT_U232_PARITY_EVEN;
738         else
739                 last_lcr |= MCT_U232_PARITY_NONE;
740
741         /* set the number of data bits */
742         switch (cflag & CSIZE) {
743         case CS5:
744                 last_lcr |= MCT_U232_DATA_BITS_5; break;
745         case CS6:
746                 last_lcr |= MCT_U232_DATA_BITS_6; break;
747         case CS7:
748                 last_lcr |= MCT_U232_DATA_BITS_7; break;
749         case CS8:
750                 last_lcr |= MCT_U232_DATA_BITS_8; break;
751         default:
752                 dev_err(&port->dev,
753                         "CSIZE was not CS5-CS8, using default of 8\n");
754                 last_lcr |= MCT_U232_DATA_BITS_8;
755                 break;
756         }
757
758         termios->c_cflag &= ~CMSPAR;
759
760         /* set the number of stop bits */
761         last_lcr |= (cflag & CSTOPB) ?
762                 MCT_U232_STOP_BITS_2 : MCT_U232_STOP_BITS_1;
763
764         mct_u232_set_line_ctrl(serial, last_lcr);
765
766         /* save off the modified port settings */
767         spin_lock_irqsave(&priv->lock, flags);
768         priv->control_state = control_state;
769         priv->last_lcr = last_lcr;
770         spin_unlock_irqrestore(&priv->lock, flags);
771 } /* mct_u232_set_termios */
772
773 static void mct_u232_break_ctl(struct tty_struct *tty, int break_state)
774 {
775         struct usb_serial_port *port = tty->driver_data;
776         struct usb_serial *serial = port->serial;
777         struct mct_u232_private *priv = usb_get_serial_port_data(port);
778         unsigned char lcr;
779         unsigned long flags;
780
781         dbg("%sstate=%d", __func__, break_state);
782
783         spin_lock_irqsave(&priv->lock, flags);
784         lcr = priv->last_lcr;
785
786         if (break_state)
787                 lcr |= MCT_U232_SET_BREAK;
788         spin_unlock_irqrestore(&priv->lock, flags);
789
790         mct_u232_set_line_ctrl(serial, lcr);
791 } /* mct_u232_break_ctl */
792
793
794 static int mct_u232_tiocmget(struct tty_struct *tty)
795 {
796         struct usb_serial_port *port = tty->driver_data;
797         struct mct_u232_private *priv = usb_get_serial_port_data(port);
798         unsigned int control_state;
799         unsigned long flags;
800
801         dbg("%s", __func__);
802
803         spin_lock_irqsave(&priv->lock, flags);
804         control_state = priv->control_state;
805         spin_unlock_irqrestore(&priv->lock, flags);
806
807         return control_state;
808 }
809
810 static int mct_u232_tiocmset(struct tty_struct *tty,
811                               unsigned int set, unsigned int clear)
812 {
813         struct usb_serial_port *port = tty->driver_data;
814         struct usb_serial *serial = port->serial;
815         struct mct_u232_private *priv = usb_get_serial_port_data(port);
816         unsigned int control_state;
817         unsigned long flags;
818
819         dbg("%s", __func__);
820
821         spin_lock_irqsave(&priv->lock, flags);
822         control_state = priv->control_state;
823
824         if (set & TIOCM_RTS)
825                 control_state |= TIOCM_RTS;
826         if (set & TIOCM_DTR)
827                 control_state |= TIOCM_DTR;
828         if (clear & TIOCM_RTS)
829                 control_state &= ~TIOCM_RTS;
830         if (clear & TIOCM_DTR)
831                 control_state &= ~TIOCM_DTR;
832
833         priv->control_state = control_state;
834         spin_unlock_irqrestore(&priv->lock, flags);
835         return mct_u232_set_modem_ctrl(serial, control_state);
836 }
837
838 static void mct_u232_throttle(struct tty_struct *tty)
839 {
840         struct usb_serial_port *port = tty->driver_data;
841         struct mct_u232_private *priv = usb_get_serial_port_data(port);
842         unsigned int control_state;
843
844         dbg("%s - port %d", __func__, port->number);
845
846         spin_lock_irq(&priv->lock);
847         priv->rx_flags |= THROTTLED;
848         if (C_CRTSCTS(tty)) {
849                 priv->control_state &= ~TIOCM_RTS;
850                 control_state = priv->control_state;
851                 spin_unlock_irq(&priv->lock);
852                 (void) mct_u232_set_modem_ctrl(port->serial, control_state);
853         } else {
854                 spin_unlock_irq(&priv->lock);
855         }
856 }
857
858 static void mct_u232_unthrottle(struct tty_struct *tty)
859 {
860         struct usb_serial_port *port = tty->driver_data;
861         struct mct_u232_private *priv = usb_get_serial_port_data(port);
862         unsigned int control_state;
863
864         dbg("%s - port %d", __func__, port->number);
865
866         spin_lock_irq(&priv->lock);
867         if ((priv->rx_flags & THROTTLED) && C_CRTSCTS(tty)) {
868                 priv->rx_flags &= ~THROTTLED;
869                 priv->control_state |= TIOCM_RTS;
870                 control_state = priv->control_state;
871                 spin_unlock_irq(&priv->lock);
872                 (void) mct_u232_set_modem_ctrl(port->serial, control_state);
873         } else {
874                 spin_unlock_irq(&priv->lock);
875         }
876 }
877
878 static int  mct_u232_ioctl(struct tty_struct *tty,
879                         unsigned int cmd, unsigned long arg)
880 {
881         DEFINE_WAIT(wait);
882         struct usb_serial_port *port = tty->driver_data;
883         struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
884         struct async_icount cnow, cprev;
885         unsigned long flags;
886
887         dbg("%s - port %d, cmd = 0x%x", __func__, port->number, cmd);
888
889         switch (cmd) {
890
891         case TIOCMIWAIT:
892
893                 dbg("%s (%d) TIOCMIWAIT", __func__,  port->number);
894
895                 spin_lock_irqsave(&mct_u232_port->lock, flags);
896                 cprev = mct_u232_port->icount;
897                 spin_unlock_irqrestore(&mct_u232_port->lock, flags);
898                 for ( ; ; ) {
899                         prepare_to_wait(&mct_u232_port->msr_wait,
900                                         &wait, TASK_INTERRUPTIBLE);
901                         schedule();
902                         finish_wait(&mct_u232_port->msr_wait, &wait);
903                         /* see if a signal did it */
904                         if (signal_pending(current))
905                                 return -ERESTARTSYS;
906                         spin_lock_irqsave(&mct_u232_port->lock, flags);
907                         cnow = mct_u232_port->icount;
908                         spin_unlock_irqrestore(&mct_u232_port->lock, flags);
909                         if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
910                             cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
911                                 return -EIO; /* no change => error */
912                         if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
913                             ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
914                             ((arg & TIOCM_CD)  && (cnow.dcd != cprev.dcd)) ||
915                             ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts))) {
916                                 return 0;
917                         }
918                         cprev = cnow;
919                 }
920
921         }
922         return -ENOIOCTLCMD;
923 }
924
925 static int  mct_u232_get_icount(struct tty_struct *tty,
926                         struct serial_icounter_struct *icount)
927 {
928         struct usb_serial_port *port = tty->driver_data;
929         struct mct_u232_private *mct_u232_port = usb_get_serial_port_data(port);
930         struct async_icount *ic = &mct_u232_port->icount;
931         unsigned long flags;
932
933         spin_lock_irqsave(&mct_u232_port->lock, flags);
934
935         icount->cts = ic->cts;
936         icount->dsr = ic->dsr;
937         icount->rng = ic->rng;
938         icount->dcd = ic->dcd;
939         icount->rx = ic->rx;
940         icount->tx = ic->tx;
941         icount->frame = ic->frame;
942         icount->overrun = ic->overrun;
943         icount->parity = ic->parity;
944         icount->brk = ic->brk;
945         icount->buf_overrun = ic->buf_overrun;
946
947         spin_unlock_irqrestore(&mct_u232_port->lock, flags);
948
949         dbg("%s (%d) TIOCGICOUNT RX=%d, TX=%d",
950                 __func__,  port->number, icount->rx, icount->tx);
951         return 0;
952 }
953
954 static int __init mct_u232_init(void)
955 {
956         int retval;
957         retval = usb_serial_register(&mct_u232_device);
958         if (retval)
959                 goto failed_usb_serial_register;
960         retval = usb_register(&mct_u232_driver);
961         if (retval)
962                 goto failed_usb_register;
963         printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
964                DRIVER_DESC "\n");
965         return 0;
966 failed_usb_register:
967         usb_serial_deregister(&mct_u232_device);
968 failed_usb_serial_register:
969         return retval;
970 }
971
972
973 static void __exit mct_u232_exit(void)
974 {
975         usb_deregister(&mct_u232_driver);
976         usb_serial_deregister(&mct_u232_device);
977 }
978
979 module_init(mct_u232_init);
980 module_exit(mct_u232_exit);
981
982 MODULE_AUTHOR(DRIVER_AUTHOR);
983 MODULE_DESCRIPTION(DRIVER_DESC);
984 MODULE_LICENSE("GPL");
985
986 module_param(debug, bool, S_IRUGO | S_IWUSR);
987 MODULE_PARM_DESC(debug, "Debug enabled or not");