drivers/usb/serial/oti6858.c

   1 /*
   2  * Ours Technology Inc. OTi-6858 USB to serial adapter driver.
   3  *
   4  * Copyleft  (C) 2007 Kees Lemmens (adapted for kernel 2.6.20)
   5  * Copyright (C) 2006 Tomasz Michal Lukaszewski (FIXME: add e-mail)
   6  * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
   7  * Copyright (C) 2003 IBM Corp.
   8  *
   9  * Many thanks to the authors of pl2303 driver: all functions in this file
  10  * are heavily based on pl2303 code, buffering code is a 1-to-1 copy.
  11  *
  12  * Warning! You use this driver on your own risk! The only official
  13  * description of this device I have is datasheet from manufacturer,
  14  * and it doesn't contain almost any information needed to write a driver.
  15  * Almost all knowlegde used while writing this driver was gathered by:
  16  *  - analyzing traffic between device and the M$ Windows 2000 driver,
  17  *  - trying different bit combinations and checking pin states
  18  *    with a voltmeter,
  19  *  - receiving malformed frames and producing buffer overflows
  20  *    to learn how errors are reported,
  21  * So, THIS CODE CAN DESTROY OTi-6858 AND ANY OTHER DEVICES, THAT ARE
  22  * CONNECTED TO IT!
  23  *
  24  * This program is free software; you can redistribute it and/or modify
  25  * it under the terms of the GNU General Public License as published by
  26  * the Free Software Foundation; either version 2 of the License.
  27  *
  28  * See Documentation/usb/usb-serial.txt for more information on using this
  29  * driver
  30  *
  31  * TODO:
  32  *  - implement correct flushing for ioctls and oti6858_close()
  33  *  - check how errors (rx overflow, parity error, framing error) are reported
  34  *  - implement oti6858_break_ctl()
  35  *  - implement more ioctls
  36  *  - test/implement flow control
  37  *  - allow setting custom baud rates
  38  */
  39
  40 #include <linux/kernel.h>
  41 #include <linux/errno.h>
  42 #include <linux/init.h>
  43 #include <linux/slab.h>
  44 #include <linux/tty.h>
  45 #include <linux/tty_driver.h>
  46 #include <linux/tty_flip.h>
  47 #include <linux/serial.h>
  48 #include <linux/module.h>
  49 #include <linux/moduleparam.h>
  50 #include <linux/spinlock.h>
  51 #include <linux/usb.h>
  52 #include <linux/usb/serial.h>
  53 #include <linux/uaccess.h>
  54 #include <linux/kfifo.h>
  55 #include "oti6858.h"
  56
  57 #define OTI6858_DESCRIPTION \
  58         "Ours Technology Inc. OTi-6858 USB to serial adapter driver"
  59 #define OTI6858_AUTHOR "Tomasz Michal Lukaszewski <FIXME@FIXME>"
  60 #define OTI6858_VERSION "0.2"
  61
  62 static const struct usb_device_id id_table[] = {
  63         { USB_DEVICE(OTI6858_VENDOR_ID, OTI6858_PRODUCT_ID) },
  64         { }
  65 };
  66
  67 MODULE_DEVICE_TABLE(usb, id_table);
  68
  69 static struct usb_driver oti6858_driver = {
  70         .name =         "oti6858",
  71         .probe =        usb_serial_probe,
  72         .disconnect =   usb_serial_disconnect,
  73         .id_table =     id_table,
  74         .no_dynamic_id =        1,
  75 };
  76
  77 static int debug;
  78
  79 /* requests */
  80 #define OTI6858_REQ_GET_STATUS          (USB_DIR_IN | USB_TYPE_VENDOR | 0x00)
  81 #define OTI6858_REQ_T_GET_STATUS        0x01
  82
  83 #define OTI6858_REQ_SET_LINE            (USB_DIR_OUT | USB_TYPE_VENDOR | 0x00)
  84 #define OTI6858_REQ_T_SET_LINE          0x00
  85
  86 #define OTI6858_REQ_CHECK_TXBUFF        (USB_DIR_IN | USB_TYPE_VENDOR | 0x01)
  87 #define OTI6858_REQ_T_CHECK_TXBUFF      0x00
  88
  89 /* format of the control packet */
  90 struct oti6858_control_pkt {
  91         __le16  divisor;        /* baud rate = 96000000 / (16 * divisor), LE */
  92 #define OTI6858_MAX_BAUD_RATE   3000000
  93         u8      frame_fmt;
  94 #define FMT_STOP_BITS_MASK      0xc0
  95 #define FMT_STOP_BITS_1         0x00
  96 #define FMT_STOP_BITS_2         0x40    /* 1.5 stop bits if FMT_DATA_BITS_5 */
  97 #define FMT_PARITY_MASK         0x38
  98 #define FMT_PARITY_NONE         0x00
  99 #define FMT_PARITY_ODD          0x08
 100 #define FMT_PARITY_EVEN         0x18
 101 #define FMT_PARITY_MARK         0x28
 102 #define FMT_PARITY_SPACE        0x38
 103 #define FMT_DATA_BITS_MASK      0x03
 104 #define FMT_DATA_BITS_5         0x00
 105 #define FMT_DATA_BITS_6         0x01
 106 #define FMT_DATA_BITS_7         0x02
 107 #define FMT_DATA_BITS_8         0x03
 108         u8      something;      /* always equals 0x43 */
 109         u8      control;        /* settings of flow control lines */
 110 #define CONTROL_MASK            0x0c
 111 #define CONTROL_DTR_HIGH        0x08
 112 #define CONTROL_RTS_HIGH        0x04
 113         u8      tx_status;
 114 #define TX_BUFFER_EMPTIED       0x09
 115         u8      pin_state;
 116 #define PIN_MASK                0x3f
 117 #define PIN_RTS                 0x20    /* output pin */
 118 #define PIN_CTS                 0x10    /* input pin, active low */
 119 #define PIN_DSR                 0x08    /* input pin, active low */
 120 #define PIN_DTR                 0x04    /* output pin */
 121 #define PIN_RI                  0x02    /* input pin, active low */
 122 #define PIN_DCD                 0x01    /* input pin, active low */
 123         u8      rx_bytes_avail;         /* number of bytes in rx buffer */;
 124 };
 125
 126 #define OTI6858_CTRL_PKT_SIZE   sizeof(struct oti6858_control_pkt)
 127 #define OTI6858_CTRL_EQUALS_PENDING(a, priv) \
 128         (((a)->divisor == (priv)->pending_setup.divisor) \
 129           && ((a)->control == (priv)->pending_setup.control) \
 130           && ((a)->frame_fmt == (priv)->pending_setup.frame_fmt))
 131
 132 /* function prototypes */
 133 static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port);
 134 static void oti6858_close(struct usb_serial_port *port);
 135 static void oti6858_set_termios(struct tty_struct *tty,
 136                         struct usb_serial_port *port, struct ktermios *old);
 137 static void oti6858_init_termios(struct tty_struct *tty);
 138 static int oti6858_ioctl(struct tty_struct *tty,
 139                         unsigned int cmd, unsigned long arg);
 140 static void oti6858_read_int_callback(struct urb *urb);
 141 static void oti6858_read_bulk_callback(struct urb *urb);
 142 static void oti6858_write_bulk_callback(struct urb *urb);
 143 static int oti6858_write(struct tty_struct *tty, struct usb_serial_port *port,
 144                         const unsigned char *buf, int count);
 145 static int oti6858_write_room(struct tty_struct *tty);
 146 static int oti6858_chars_in_buffer(struct tty_struct *tty);
 147 static int oti6858_tiocmget(struct tty_struct *tty);
 148 static int oti6858_tiocmset(struct tty_struct *tty,
 149                                 unsigned int set, unsigned int clear);
 150 static int oti6858_startup(struct usb_serial *serial);
 151 static void oti6858_release(struct usb_serial *serial);
 152
 153 /* device info */
 154 static struct usb_serial_driver oti6858_device = {
 155         .driver = {
 156                 .owner =        THIS_MODULE,
 157                 .name =         "oti6858",
 158         },
 159         .id_table =             id_table,
 160         .usb_driver =           &oti6858_driver,
 161         .num_ports =            1,
 162         .open =                 oti6858_open,
 163         .close =                oti6858_close,
 164         .write =                oti6858_write,
 165         .ioctl =                oti6858_ioctl,
 166         .set_termios =          oti6858_set_termios,
 167         .init_termios =         oti6858_init_termios,
 168         .tiocmget =             oti6858_tiocmget,
 169         .tiocmset =             oti6858_tiocmset,
 170         .read_bulk_callback =   oti6858_read_bulk_callback,
 171         .read_int_callback =    oti6858_read_int_callback,
 172         .write_bulk_callback =  oti6858_write_bulk_callback,
 173         .write_room =           oti6858_write_room,
 174         .chars_in_buffer =      oti6858_chars_in_buffer,
 175         .attach =               oti6858_startup,
 176         .release =              oti6858_release,
 177 };
 178
 179 struct oti6858_private {
 180         spinlock_t lock;
 181
 182         struct oti6858_control_pkt status;
 183
 184         struct {
 185                 u8 read_urb_in_use;
 186                 u8 write_urb_in_use;
 187         } flags;
 188         struct delayed_work delayed_write_work;
 189
 190         struct {
 191                 __le16 divisor;
 192                 u8 frame_fmt;
 193                 u8 control;
 194         } pending_setup;
 195         u8 transient;
 196         u8 setup_done;
 197         struct delayed_work delayed_setup_work;
 198
 199         wait_queue_head_t intr_wait;
 200         struct usb_serial_port *port;   /* USB port with which associated */
 201 };
 202
 203 static void setup_line(struct work_struct *work)
 204 {
 205         struct oti6858_private *priv = container_of(work,
 206                         struct oti6858_private, delayed_setup_work.work);
 207         struct usb_serial_port *port = priv->port;
 208         struct oti6858_control_pkt *new_setup;
 209         unsigned long flags;
 210         int result;
 211
 212         dbg("%s(port = %d)", __func__, port->number);
 213
 214         new_setup = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
 215         if (new_setup == NULL) {
 216                 dev_err(&port->dev, "%s(): out of memory!\n", __func__);
 217                 /* we will try again */
 218                 schedule_delayed_work(&priv->delayed_setup_work,
 219                                                 msecs_to_jiffies(2));
 220                 return;
 221         }
 222
 223         result = usb_control_msg(port->serial->dev,
 224                                 usb_rcvctrlpipe(port->serial->dev, 0),
 225                                 OTI6858_REQ_T_GET_STATUS,
 226                                 OTI6858_REQ_GET_STATUS,
 227                                 0, 0,
 228                                 new_setup, OTI6858_CTRL_PKT_SIZE,
 229                                 100);
 230
 231         if (result != OTI6858_CTRL_PKT_SIZE) {
 232                 dev_err(&port->dev, "%s(): error reading status\n", __func__);
 233                 kfree(new_setup);
 234                 /* we will try again */
 235                 schedule_delayed_work(&priv->delayed_setup_work,
 236                                                         msecs_to_jiffies(2));
 237                 return;
 238         }
 239
 240         spin_lock_irqsave(&priv->lock, flags);
 241         if (!OTI6858_CTRL_EQUALS_PENDING(new_setup, priv)) {
 242                 new_setup->divisor = priv->pending_setup.divisor;
 243                 new_setup->control = priv->pending_setup.control;
 244                 new_setup->frame_fmt = priv->pending_setup.frame_fmt;
 245
 246                 spin_unlock_irqrestore(&priv->lock, flags);
 247                 result = usb_control_msg(port->serial->dev,
 248                                         usb_sndctrlpipe(port->serial->dev, 0),
 249                                         OTI6858_REQ_T_SET_LINE,
 250                                         OTI6858_REQ_SET_LINE,
 251                                         0, 0,
 252                                         new_setup, OTI6858_CTRL_PKT_SIZE,
 253                                         100);
 254         } else {
 255                 spin_unlock_irqrestore(&priv->lock, flags);
 256                 result = 0;
 257         }
 258         kfree(new_setup);
 259
 260         spin_lock_irqsave(&priv->lock, flags);
 261         if (result != OTI6858_CTRL_PKT_SIZE)
 262                 priv->transient = 0;
 263         priv->setup_done = 1;
 264         spin_unlock_irqrestore(&priv->lock, flags);
 265
 266         dbg("%s(): submitting interrupt urb", __func__);
 267         result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
 268         if (result != 0) {
 269                 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
 270                                 " with error %d\n", __func__, result);
 271         }
 272 }
 273
 274 static void send_data(struct work_struct *work)
 275 {
 276         struct oti6858_private *priv = container_of(work,
 277                         struct oti6858_private, delayed_write_work.work);
 278         struct usb_serial_port *port = priv->port;
 279         int count = 0, result;
 280         unsigned long flags;
 281         u8 *allow;
 282
 283         dbg("%s(port = %d)", __func__, port->number);
 284
 285         spin_lock_irqsave(&priv->lock, flags);
 286         if (priv->flags.write_urb_in_use) {
 287                 spin_unlock_irqrestore(&priv->lock, flags);
 288                 schedule_delayed_work(&priv->delayed_write_work,
 289                                                 msecs_to_jiffies(2));
 290                 return;
 291         }
 292         priv->flags.write_urb_in_use = 1;
 293         spin_unlock_irqrestore(&priv->lock, flags);
 294
 295         spin_lock_irqsave(&port->lock, flags);
 296         count = kfifo_len(&port->write_fifo);
 297         spin_unlock_irqrestore(&port->lock, flags);
 298
 299         if (count > port->bulk_out_size)
 300                 count = port->bulk_out_size;
 301
 302         if (count != 0) {
 303                 allow = kmalloc(1, GFP_KERNEL);
 304                 if (!allow) {
 305                         dev_err(&port->dev, "%s(): kmalloc failed\n",
 306                                         __func__);
 307                         return;
 308                 }
 309                 result = usb_control_msg(port->serial->dev,
 310                                 usb_rcvctrlpipe(port->serial->dev, 0),
 311                                 OTI6858_REQ_T_CHECK_TXBUFF,
 312                                 OTI6858_REQ_CHECK_TXBUFF,
 313                                 count, 0, allow, 1, 100);
 314                 if (result != 1 || *allow != 0)
 315                         count = 0;
 316                 kfree(allow);
 317         }
 318
 319         if (count == 0) {
 320                 priv->flags.write_urb_in_use = 0;
 321
 322                 dbg("%s(): submitting interrupt urb", __func__);
 323                 result = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO);
 324                 if (result != 0) {
 325                         dev_err(&port->dev, "%s(): usb_submit_urb() failed"
 326                                 " with error %d\n", __func__, result);
 327                 }
 328                 return;
 329         }
 330
 331         count = kfifo_out_locked(&port->write_fifo,
 332                                         port->write_urb->transfer_buffer,
 333                                         count, &port->lock);
 334         port->write_urb->transfer_buffer_length = count;
 335         result = usb_submit_urb(port->write_urb, GFP_NOIO);
 336         if (result != 0) {
 337                 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
 338                                " with error %d\n", __func__, result);
 339                 priv->flags.write_urb_in_use = 0;
 340         }
 341
 342         usb_serial_port_softint(port);
 343 }
 344
 345 static int oti6858_startup(struct usb_serial *serial)
 346 {
 347         struct usb_serial_port *port = serial->port[0];
 348         struct oti6858_private *priv;
 349         int i;
 350
 351         for (i = 0; i < serial->num_ports; ++i) {
 352                 priv = kzalloc(sizeof(struct oti6858_private), GFP_KERNEL);
 353                 if (!priv)
 354                         break;
 355
 356                 spin_lock_init(&priv->lock);
 357                 init_waitqueue_head(&priv->intr_wait);
 358 /*              INIT_WORK(&priv->setup_work, setup_line, serial->port[i]); */
 359 /*              INIT_WORK(&priv->write_work, send_data, serial->port[i]); */
 360                 priv->port = port;
 361                 INIT_DELAYED_WORK(&priv->delayed_setup_work, setup_line);
 362                 INIT_DELAYED_WORK(&priv->delayed_write_work, send_data);
 363
 364                 usb_set_serial_port_data(serial->port[i], priv);
 365         }
 366         if (i == serial->num_ports)
 367                 return 0;
 368
 369         for (--i; i >= 0; --i) {
 370                 priv = usb_get_serial_port_data(serial->port[i]);
 371                 kfree(priv);
 372                 usb_set_serial_port_data(serial->port[i], NULL);
 373         }
 374         return -ENOMEM;
 375 }
 376
 377 static int oti6858_write(struct tty_struct *tty, struct usb_serial_port *port,
 378                         const unsigned char *buf, int count)
 379 {
 380         dbg("%s(port = %d, count = %d)", __func__, port->number, count);
 381
 382         if (!count)
 383                 return count;
 384
 385         count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock);
 386
 387         return count;
 388 }
 389
 390 static int oti6858_write_room(struct tty_struct *tty)
 391 {
 392         struct usb_serial_port *port = tty->driver_data;
 393         int room = 0;
 394         unsigned long flags;
 395
 396         dbg("%s(port = %d)", __func__, port->number);
 397
 398         spin_lock_irqsave(&port->lock, flags);
 399         room = kfifo_avail(&port->write_fifo);
 400         spin_unlock_irqrestore(&port->lock, flags);
 401
 402         return room;
 403 }
 404
 405 static int oti6858_chars_in_buffer(struct tty_struct *tty)
 406 {
 407         struct usb_serial_port *port = tty->driver_data;
 408         int chars = 0;
 409         unsigned long flags;
 410
 411         dbg("%s(port = %d)", __func__, port->number);
 412
 413         spin_lock_irqsave(&port->lock, flags);
 414         chars = kfifo_len(&port->write_fifo);
 415         spin_unlock_irqrestore(&port->lock, flags);
 416
 417         return chars;
 418 }
 419
 420 static void oti6858_init_termios(struct tty_struct *tty)
 421 {
 422         *(tty->termios) = tty_std_termios;
 423         tty->termios->c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL;
 424         tty->termios->c_ispeed = 38400;
 425         tty->termios->c_ospeed = 38400;
 426 }
 427
 428 static void oti6858_set_termios(struct tty_struct *tty,
 429                 struct usb_serial_port *port, struct ktermios *old_termios)
 430 {
 431         struct oti6858_private *priv = usb_get_serial_port_data(port);
 432         unsigned long flags;
 433         unsigned int cflag;
 434         u8 frame_fmt, control;
 435         __le16 divisor;
 436         int br;
 437
 438         dbg("%s(port = %d)", __func__, port->number);
 439
 440         if (!tty) {
 441                 dbg("%s(): no tty structures", __func__);
 442                 return;
 443         }
 444
 445         cflag = tty->termios->c_cflag;
 446
 447         spin_lock_irqsave(&priv->lock, flags);
 448         divisor = priv->pending_setup.divisor;
 449         frame_fmt = priv->pending_setup.frame_fmt;
 450         control = priv->pending_setup.control;
 451         spin_unlock_irqrestore(&priv->lock, flags);
 452
 453         frame_fmt &= ~FMT_DATA_BITS_MASK;
 454         switch (cflag & CSIZE) {
 455         case CS5:
 456                 frame_fmt |= FMT_DATA_BITS_5;
 457                 break;
 458         case CS6:
 459                 frame_fmt |= FMT_DATA_BITS_6;
 460                 break;
 461         case CS7:
 462                 frame_fmt |= FMT_DATA_BITS_7;
 463                 break;
 464         default:
 465         case CS8:
 466                 frame_fmt |= FMT_DATA_BITS_8;
 467                 break;
 468         }
 469
 470         /* manufacturer claims that this device can work with baud rates
 471          * up to 3 Mbps; I've tested it only on 115200 bps, so I can't
 472          * guarantee that any other baud rate will work (especially
 473          * the higher ones)
 474          */
 475         br = tty_get_baud_rate(tty);
 476         if (br == 0) {
 477                 divisor = 0;
 478         } else {
 479                 int real_br;
 480                 int new_divisor;
 481                 br = min(br, OTI6858_MAX_BAUD_RATE);
 482
 483                 new_divisor = (96000000 + 8 * br) / (16 * br);
 484                 real_br = 96000000 / (16 * new_divisor);
 485                 divisor = cpu_to_le16(new_divisor);
 486                 tty_encode_baud_rate(tty, real_br, real_br);
 487         }
 488
 489         frame_fmt &= ~FMT_STOP_BITS_MASK;
 490         if ((cflag & CSTOPB) != 0)
 491                 frame_fmt |= FMT_STOP_BITS_2;
 492         else
 493                 frame_fmt |= FMT_STOP_BITS_1;
 494
 495         frame_fmt &= ~FMT_PARITY_MASK;
 496         if ((cflag & PARENB) != 0) {
 497                 if ((cflag & PARODD) != 0)
 498                         frame_fmt |= FMT_PARITY_ODD;
 499                 else
 500                         frame_fmt |= FMT_PARITY_EVEN;
 501         } else {
 502                 frame_fmt |= FMT_PARITY_NONE;
 503         }
 504
 505         control &= ~CONTROL_MASK;
 506         if ((cflag & CRTSCTS) != 0)
 507                 control |= (CONTROL_DTR_HIGH | CONTROL_RTS_HIGH);
 508
 509         /* change control lines if we are switching to or from B0 */
 510         /* FIXME:
 511         spin_lock_irqsave(&priv->lock, flags);
 512         control = priv->line_control;
 513         if ((cflag & CBAUD) == B0)
 514                 priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
 515         else
 516                 priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
 517         if (control != priv->line_control) {
 518                 control = priv->line_control;
 519                 spin_unlock_irqrestore(&priv->lock, flags);
 520                 set_control_lines(serial->dev, control);
 521         } else {
 522                 spin_unlock_irqrestore(&priv->lock, flags);
 523         }
 524         */
 525
 526         spin_lock_irqsave(&priv->lock, flags);
 527         if (divisor != priv->pending_setup.divisor
 528                         || control != priv->pending_setup.control
 529                         || frame_fmt != priv->pending_setup.frame_fmt) {
 530                 priv->pending_setup.divisor = divisor;
 531                 priv->pending_setup.control = control;
 532                 priv->pending_setup.frame_fmt = frame_fmt;
 533         }
 534         spin_unlock_irqrestore(&priv->lock, flags);
 535 }
 536
 537 static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port)
 538 {
 539         struct oti6858_private *priv = usb_get_serial_port_data(port);
 540         struct ktermios tmp_termios;
 541         struct usb_serial *serial = port->serial;
 542         struct oti6858_control_pkt *buf;
 543         unsigned long flags;
 544         int result;
 545
 546         dbg("%s(port = %d)", __func__, port->number);
 547
 548         usb_clear_halt(serial->dev, port->write_urb->pipe);
 549         usb_clear_halt(serial->dev, port->read_urb->pipe);
 550
 551         buf = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
 552         if (buf == NULL) {
 553                 dev_err(&port->dev, "%s(): out of memory!\n", __func__);
 554                 return -ENOMEM;
 555         }
 556
 557         result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
 558                                 OTI6858_REQ_T_GET_STATUS,
 559                                 OTI6858_REQ_GET_STATUS,
 560                                 0, 0,
 561                                 buf, OTI6858_CTRL_PKT_SIZE,
 562                                 100);
 563         if (result != OTI6858_CTRL_PKT_SIZE) {
 564                 /* assume default (after power-on reset) values */
 565                 buf->divisor = cpu_to_le16(0x009c);     /* 38400 bps */
 566                 buf->frame_fmt = 0x03;  /* 8N1 */
 567                 buf->something = 0x43;
 568                 buf->control = 0x4c;    /* DTR, RTS */
 569                 buf->tx_status = 0x00;
 570                 buf->pin_state = 0x5b;  /* RTS, CTS, DSR, DTR, RI, DCD */
 571                 buf->rx_bytes_avail = 0x00;
 572         }
 573
 574         spin_lock_irqsave(&priv->lock, flags);
 575         memcpy(&priv->status, buf, OTI6858_CTRL_PKT_SIZE);
 576         priv->pending_setup.divisor = buf->divisor;
 577         priv->pending_setup.frame_fmt = buf->frame_fmt;
 578         priv->pending_setup.control = buf->control;
 579         spin_unlock_irqrestore(&priv->lock, flags);
 580         kfree(buf);
 581
 582         dbg("%s(): submitting interrupt urb", __func__);
 583         result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
 584         if (result != 0) {
 585                 dev_err(&port->dev, "%s(): usb_submit_urb() failed"
 586                                " with error %d\n", __func__, result);
 587                 oti6858_close(port);
 588                 return -EPROTO;
 589         }
 590
 591         /* setup termios */
 592         if (tty)
 593                 oti6858_set_termios(tty, port, &tmp_termios);
 594         port->port.drain_delay = 256;   /* FIXME: check the FIFO length */
 595         return 0;
 596 }
 597
 598 static void oti6858_close(struct usb_serial_port *port)
 599 {
 600         struct oti6858_private *priv = usb_get_serial_port_data(port);
 601         unsigned long flags;
 602
 603         dbg("%s(port = %d)", __func__, port->number);
 604
 605         spin_lock_irqsave(&port->lock, flags);
 606         /* clear out any remaining data in the buffer */
 607         kfifo_reset_out(&port->write_fifo);
 608         spin_unlock_irqrestore(&port->lock, flags);
 609
 610         dbg("%s(): after buf_clear()", __func__);
 611
 612         /* cancel scheduled setup */
 613         cancel_delayed_work_sync(&priv->delayed_setup_work);
 614         cancel_delayed_work_sync(&priv->delayed_write_work);
 615
 616         /* shutdown our urbs */
 617         dbg("%s(): shutting down urbs", __func__);
 618         usb_kill_urb(port->write_urb);
 619         usb_kill_urb(port->read_urb);
 620         usb_kill_urb(port->interrupt_in_urb);
 621 }
 622
 623 static int oti6858_tiocmset(struct tty_struct *tty,
 624                                 unsigned int set, unsigned int clear)
 625 {
 626         struct usb_serial_port *port = tty->driver_data;
 627         struct oti6858_private *priv = usb_get_serial_port_data(port);
 628         unsigned long flags;
 629         u8 control;
 630
 631         dbg("%s(port = %d, set = 0x%08x, clear = 0x%08x)",
 632                                 __func__, port->number, set, clear);
 633
 634         if (!usb_get_intfdata(port->serial->interface))
 635                 return -ENODEV;
 636
 637         /* FIXME: check if this is correct (active high/low) */
 638         spin_lock_irqsave(&priv->lock, flags);
 639         control = priv->pending_setup.control;
 640         if ((set & TIOCM_RTS) != 0)
 641                 control |= CONTROL_RTS_HIGH;
 642         if ((set & TIOCM_DTR) != 0)
 643                 control |= CONTROL_DTR_HIGH;
 644         if ((clear & TIOCM_RTS) != 0)
 645                 control &= ~CONTROL_RTS_HIGH;
 646         if ((clear & TIOCM_DTR) != 0)
 647                 control &= ~CONTROL_DTR_HIGH;
 648
 649         if (control != priv->pending_setup.control)
 650                 priv->pending_setup.control = control;
 651
 652         spin_unlock_irqrestore(&priv->lock, flags);
 653         return 0;
 654 }
 655
 656 static int oti6858_tiocmget(struct tty_struct *tty)
 657 {
 658         struct usb_serial_port *port = tty->driver_data;
 659         struct oti6858_private *priv = usb_get_serial_port_data(port);
 660         unsigned long flags;
 661         unsigned pin_state;
 662         unsigned result = 0;
 663
 664         dbg("%s(port = %d)", __func__, port->number);
 665
 666         if (!usb_get_intfdata(port->serial->interface))
 667                 return -ENODEV;
 668
 669         spin_lock_irqsave(&priv->lock, flags);
 670         pin_state = priv->status.pin_state & PIN_MASK;
 671         spin_unlock_irqrestore(&priv->lock, flags);
 672
 673         /* FIXME: check if this is correct (active high/low) */
 674         if ((pin_state & PIN_RTS) != 0)
 675                 result |= TIOCM_RTS;
 676         if ((pin_state & PIN_CTS) != 0)
 677                 result |= TIOCM_CTS;
 678         if ((pin_state & PIN_DSR) != 0)
 679                 result |= TIOCM_DSR;
 680         if ((pin_state & PIN_DTR) != 0)
 681                 result |= TIOCM_DTR;
 682         if ((pin_state & PIN_RI) != 0)
 683                 result |= TIOCM_RI;
 684         if ((pin_state & PIN_DCD) != 0)
 685                 result |= TIOCM_CD;
 686
 687         dbg("%s() = 0x%08x", __func__, result);
 688
 689         return result;
 690 }
 691
 692 static int wait_modem_info(struct usb_serial_port *port, unsigned int arg)
 693 {
 694         struct oti6858_private *priv = usb_get_serial_port_data(port);
 695         unsigned long flags;
 696         unsigned int prev, status;
 697         unsigned int changed;
 698
 699         spin_lock_irqsave(&priv->lock, flags);
 700         prev = priv->status.pin_state;
 701         spin_unlock_irqrestore(&priv->lock, flags);
 702
 703         while (1) {
 704                 wait_event_interruptible(priv->intr_wait,
 705                                         priv->status.pin_state != prev);
 706                 if (signal_pending(current))
 707                         return -ERESTARTSYS;
 708
 709                 spin_lock_irqsave(&priv->lock, flags);
 710                 status = priv->status.pin_state & PIN_MASK;
 711                 spin_unlock_irqrestore(&priv->lock, flags);
 712
 713                 changed = prev ^ status;
 714                 /* FIXME: check if this is correct (active high/low) */
 715                 if (((arg & TIOCM_RNG) && (changed & PIN_RI)) ||
 716                     ((arg & TIOCM_DSR) && (changed & PIN_DSR)) ||
 717                     ((arg & TIOCM_CD)  && (changed & PIN_DCD)) ||
 718                     ((arg & TIOCM_CTS) && (changed & PIN_CTS)))
 719                         return 0;
 720                 prev = status;
 721         }
 722
 723         /* NOTREACHED */
 724         return 0;
 725 }
 726
 727 static int oti6858_ioctl(struct tty_struct *tty,
 728                         unsigned int cmd, unsigned long arg)
 729 {
 730         struct usb_serial_port *port = tty->driver_data;
 731
 732         dbg("%s(port = %d, cmd = 0x%04x, arg = 0x%08lx)",
 733                                 __func__, port->number, cmd, arg);
 734
 735         switch (cmd) {
 736         case TIOCMIWAIT:
 737                 dbg("%s(): TIOCMIWAIT", __func__);
 738                 return wait_modem_info(port, arg);
 739         default:
 740                 dbg("%s(): 0x%04x not supported", __func__, cmd);
 741                 break;
 742         }
 743         return -ENOIOCTLCMD;
 744 }
 745
 746
 747 static void oti6858_release(struct usb_serial *serial)
 748 {
 749         int i;
 750
 751         dbg("%s()", __func__);
 752
 753         for (i = 0; i < serial->num_ports; ++i)
 754                 kfree(usb_get_serial_port_data(serial->port[i]));
 755 }
 756
 757 static void oti6858_read_int_callback(struct urb *urb)
 758 {
 759         struct usb_serial_port *port =  urb->context;
 760         struct oti6858_private *priv = usb_get_serial_port_data(port);
 761         int transient = 0, can_recv = 0, resubmit = 1;
 762         int status = urb->status;
 763
 764         dbg("%s(port = %d, status = %d)",
 765                                 __func__, port->number, status);
 766
 767         switch (status) {
 768         case 0:
 769                 /* success */
 770                 break;
 771         case -ECONNRESET:
 772         case -ENOENT:
 773         case -ESHUTDOWN:
 774                 /* this urb is terminated, clean up */
 775                 dbg("%s(): urb shutting down with status: %d",
 776                                         __func__, status);
 777                 return;
 778         default:
 779                 dbg("%s(): nonzero urb status received: %d",
 780                                         __func__, status);
 781                 break;
 782         }
 783
 784         if (status == 0 && urb->actual_length == OTI6858_CTRL_PKT_SIZE) {
 785                 struct oti6858_control_pkt *xs = urb->transfer_buffer;
 786                 unsigned long flags;
 787
 788                 spin_lock_irqsave(&priv->lock, flags);
 789
 790                 if (!priv->transient) {
 791                         if (!OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
 792                                 if (xs->rx_bytes_avail == 0) {
 793                                         priv->transient = 4;
 794                                         priv->setup_done = 0;
 795                                         resubmit = 0;
 796                                         dbg("%s(): scheduling setup_line()",
 797                                             __func__);
 798                                         schedule_delayed_work(&priv->delayed_setup_work, 0);
 799                                 }
 800                         }
 801                 } else {
 802                         if (OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
 803                                 priv->transient = 0;
 804                         } else if (!priv->setup_done) {
 805                                 resubmit = 0;
 806                         } else if (--priv->transient == 0) {
 807                                 if (xs->rx_bytes_avail == 0) {
 808                                         priv->transient = 4;
 809                                         priv->setup_done = 0;
 810                                         resubmit = 0;
 811                                         dbg("%s(): scheduling setup_line()",
 812                                             __func__);
 813                                         schedule_delayed_work(&priv->delayed_setup_work, 0);
 814                                 }
 815                         }
 816                 }
 817
 818                 if (!priv->transient) {
 819                         if (xs->pin_state != priv->status.pin_state)
 820                                 wake_up_interruptible(&priv->intr_wait);
 821                         memcpy(&priv->status, xs, OTI6858_CTRL_PKT_SIZE);
 822                 }
 823
 824                 if (!priv->transient && xs->rx_bytes_avail != 0) {
 825                         can_recv = xs->rx_bytes_avail;
 826                         priv->flags.read_urb_in_use = 1;
 827                 }
 828
 829                 transient = priv->transient;
 830                 spin_unlock_irqrestore(&priv->lock, flags);
 831         }
 832
 833         if (can_recv) {
 834                 int result;
 835
 836                 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
 837                 if (result != 0) {
 838                         priv->flags.read_urb_in_use = 0;
 839                         dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
 840                                         " error %d\n", __func__, result);
 841                 } else {
 842                         resubmit = 0;
 843                 }
 844         } else if (!transient) {
 845                 unsigned long flags;
 846                 int count;
 847
 848                 spin_lock_irqsave(&port->lock, flags);
 849                 count = kfifo_len(&port->write_fifo);
 850                 spin_unlock_irqrestore(&port->lock, flags);
 851
 852                 spin_lock_irqsave(&priv->lock, flags);
 853                 if (priv->flags.write_urb_in_use == 0 && count != 0) {
 854                         schedule_delayed_work(&priv->delayed_write_work, 0);
 855                         resubmit = 0;
 856                 }
 857                 spin_unlock_irqrestore(&priv->lock, flags);
 858         }
 859
 860         if (resubmit) {
 861                 int result;
 862
 863 /*              dbg("%s(): submitting interrupt urb", __func__); */
 864                 result = usb_submit_urb(urb, GFP_ATOMIC);
 865                 if (result != 0) {
 866                         dev_err(&urb->dev->dev,
 867                                         "%s(): usb_submit_urb() failed with"
 868                                         " error %d\n", __func__, result);
 869                 }
 870         }
 871 }
 872
 873 static void oti6858_read_bulk_callback(struct urb *urb)
 874 {
 875         struct usb_serial_port *port =  urb->context;
 876         struct oti6858_private *priv = usb_get_serial_port_data(port);
 877         struct tty_struct *tty;
 878         unsigned char *data = urb->transfer_buffer;
 879         unsigned long flags;
 880         int status = urb->status;
 881         int result;
 882
 883         dbg("%s(port = %d, status = %d)",
 884                                 __func__, port->number, status);
 885
 886         spin_lock_irqsave(&priv->lock, flags);
 887         priv->flags.read_urb_in_use = 0;
 888         spin_unlock_irqrestore(&priv->lock, flags);
 889
 890         if (status != 0) {
 891                 dbg("%s(): unable to handle the error, exiting", __func__);
 892                 return;
 893         }
 894
 895         tty = tty_port_tty_get(&port->port);
 896         if (tty != NULL && urb->actual_length > 0) {
 897                 tty_insert_flip_string(tty, data, urb->actual_length);
 898                 tty_flip_buffer_push(tty);
 899         }
 900         tty_kref_put(tty);
 901
 902         /* schedule the interrupt urb */
 903         result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
 904         if (result != 0 && result != -EPERM) {
 905                 dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
 906                                 " error %d\n", __func__, result);
 907         }
 908 }
 909
 910 static void oti6858_write_bulk_callback(struct urb *urb)
 911 {
 912         struct usb_serial_port *port =  urb->context;
 913         struct oti6858_private *priv = usb_get_serial_port_data(port);
 914         int status = urb->status;
 915         int result;
 916
 917         dbg("%s(port = %d, status = %d)",
 918                                 __func__, port->number, status);
 919
 920         switch (status) {
 921         case 0:
 922                 /* success */
 923                 break;
 924         case -ECONNRESET:
 925         case -ENOENT:
 926         case -ESHUTDOWN:
 927                 /* this urb is terminated, clean up */
 928                 dbg("%s(): urb shutting down with status: %d",
 929                                         __func__, status);
 930                 priv->flags.write_urb_in_use = 0;
 931                 return;
 932         default:
 933                 /* error in the urb, so we have to resubmit it */
 934                 dbg("%s(): nonzero write bulk status received: %d",
 935                                         __func__, status);
 936                 dbg("%s(): overflow in write", __func__);
 937
 938                 port->write_urb->transfer_buffer_length = 1;
 939                 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
 940                 if (result) {
 941                         dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
 942                                         " error %d\n", __func__, result);
 943                 } else {
 944                         return;
 945                 }
 946         }
 947
 948         priv->flags.write_urb_in_use = 0;
 949
 950         /* schedule the interrupt urb if we are still open */
 951         dbg("%s(): submitting interrupt urb", __func__);
 952         result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
 953         if (result != 0) {
 954                 dev_err(&port->dev, "%s(): failed submitting int urb,"
 955                                         " error %d\n", __func__, result);
 956         }
 957 }
 958
 959 /* module description and (de)initialization */
 960
 961 static int __init oti6858_init(void)
 962 {
 963         int retval;
 964
 965         retval = usb_serial_register(&oti6858_device);
 966         if (retval == 0) {
 967                 retval = usb_register(&oti6858_driver);
 968                 if (retval)
 969                         usb_serial_deregister(&oti6858_device);
 970         }
 971         return retval;
 972 }
 973
 974 static void __exit oti6858_exit(void)
 975 {
 976         usb_deregister(&oti6858_driver);
 977         usb_serial_deregister(&oti6858_device);
 978 }
 979
 980 module_init(oti6858_init);
 981 module_exit(oti6858_exit);
 982
 983 MODULE_DESCRIPTION(OTI6858_DESCRIPTION);
 984 MODULE_AUTHOR(OTI6858_AUTHOR);
 985 MODULE_VERSION(OTI6858_VERSION);
 986 MODULE_LICENSE("GPL");
 987
 988 module_param(debug, bool, S_IRUGO | S_IWUSR);
 989 MODULE_PARM_DESC(debug, "enable debug output");
 990