oti6858.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901
  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. #include <linux/kernel.h>
  40. #include <linux/errno.h>
  41. #include <linux/init.h>
  42. #include <linux/slab.h>
  43. #include <linux/tty.h>
  44. #include <linux/tty_driver.h>
  45. #include <linux/tty_flip.h>
  46. #include <linux/serial.h>
  47. #include <linux/module.h>
  48. #include <linux/moduleparam.h>
  49. #include <linux/spinlock.h>
  50. #include <linux/usb.h>
  51. #include <linux/usb/serial.h>
  52. #include <linux/uaccess.h>
  53. #include <linux/kfifo.h>
  54. #include "oti6858.h"
  55. #define OTI6858_DESCRIPTION \
  56. "Ours Technology Inc. OTi-6858 USB to serial adapter driver"
  57. #define OTI6858_AUTHOR "Tomasz Michal Lukaszewski <FIXME@FIXME>"
  58. static const struct usb_device_id id_table[] = {
  59. { USB_DEVICE(OTI6858_VENDOR_ID, OTI6858_PRODUCT_ID) },
  60. { }
  61. };
  62. MODULE_DEVICE_TABLE(usb, id_table);
  63. /* requests */
  64. #define OTI6858_REQ_GET_STATUS (USB_DIR_IN | USB_TYPE_VENDOR | 0x00)
  65. #define OTI6858_REQ_T_GET_STATUS 0x01
  66. #define OTI6858_REQ_SET_LINE (USB_DIR_OUT | USB_TYPE_VENDOR | 0x00)
  67. #define OTI6858_REQ_T_SET_LINE 0x00
  68. #define OTI6858_REQ_CHECK_TXBUFF (USB_DIR_IN | USB_TYPE_VENDOR | 0x01)
  69. #define OTI6858_REQ_T_CHECK_TXBUFF 0x00
  70. /* format of the control packet */
  71. struct oti6858_control_pkt {
  72. __le16 divisor; /* baud rate = 96000000 / (16 * divisor), LE */
  73. #define OTI6858_MAX_BAUD_RATE 3000000
  74. u8 frame_fmt;
  75. #define FMT_STOP_BITS_MASK 0xc0
  76. #define FMT_STOP_BITS_1 0x00
  77. #define FMT_STOP_BITS_2 0x40 /* 1.5 stop bits if FMT_DATA_BITS_5 */
  78. #define FMT_PARITY_MASK 0x38
  79. #define FMT_PARITY_NONE 0x00
  80. #define FMT_PARITY_ODD 0x08
  81. #define FMT_PARITY_EVEN 0x18
  82. #define FMT_PARITY_MARK 0x28
  83. #define FMT_PARITY_SPACE 0x38
  84. #define FMT_DATA_BITS_MASK 0x03
  85. #define FMT_DATA_BITS_5 0x00
  86. #define FMT_DATA_BITS_6 0x01
  87. #define FMT_DATA_BITS_7 0x02
  88. #define FMT_DATA_BITS_8 0x03
  89. u8 something; /* always equals 0x43 */
  90. u8 control; /* settings of flow control lines */
  91. #define CONTROL_MASK 0x0c
  92. #define CONTROL_DTR_HIGH 0x08
  93. #define CONTROL_RTS_HIGH 0x04
  94. u8 tx_status;
  95. #define TX_BUFFER_EMPTIED 0x09
  96. u8 pin_state;
  97. #define PIN_MASK 0x3f
  98. #define PIN_RTS 0x20 /* output pin */
  99. #define PIN_CTS 0x10 /* input pin, active low */
  100. #define PIN_DSR 0x08 /* input pin, active low */
  101. #define PIN_DTR 0x04 /* output pin */
  102. #define PIN_RI 0x02 /* input pin, active low */
  103. #define PIN_DCD 0x01 /* input pin, active low */
  104. u8 rx_bytes_avail; /* number of bytes in rx buffer */;
  105. };
  106. #define OTI6858_CTRL_PKT_SIZE sizeof(struct oti6858_control_pkt)
  107. #define OTI6858_CTRL_EQUALS_PENDING(a, priv) \
  108. (((a)->divisor == (priv)->pending_setup.divisor) \
  109. && ((a)->control == (priv)->pending_setup.control) \
  110. && ((a)->frame_fmt == (priv)->pending_setup.frame_fmt))
  111. /* function prototypes */
  112. static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port);
  113. static void oti6858_close(struct usb_serial_port *port);
  114. static void oti6858_set_termios(struct tty_struct *tty,
  115. struct usb_serial_port *port, struct ktermios *old);
  116. static void oti6858_init_termios(struct tty_struct *tty);
  117. static int oti6858_ioctl(struct tty_struct *tty,
  118. unsigned int cmd, unsigned long arg);
  119. static void oti6858_read_int_callback(struct urb *urb);
  120. static void oti6858_read_bulk_callback(struct urb *urb);
  121. static void oti6858_write_bulk_callback(struct urb *urb);
  122. static int oti6858_write(struct tty_struct *tty, struct usb_serial_port *port,
  123. const unsigned char *buf, int count);
  124. static int oti6858_write_room(struct tty_struct *tty);
  125. static int oti6858_chars_in_buffer(struct tty_struct *tty);
  126. static int oti6858_tiocmget(struct tty_struct *tty);
  127. static int oti6858_tiocmset(struct tty_struct *tty,
  128. unsigned int set, unsigned int clear);
  129. static int oti6858_port_probe(struct usb_serial_port *port);
  130. static int oti6858_port_remove(struct usb_serial_port *port);
  131. /* device info */
  132. static struct usb_serial_driver oti6858_device = {
  133. .driver = {
  134. .owner = THIS_MODULE,
  135. .name = "oti6858",
  136. },
  137. .id_table = id_table,
  138. .num_ports = 1,
  139. .open = oti6858_open,
  140. .close = oti6858_close,
  141. .write = oti6858_write,
  142. .ioctl = oti6858_ioctl,
  143. .set_termios = oti6858_set_termios,
  144. .init_termios = oti6858_init_termios,
  145. .tiocmget = oti6858_tiocmget,
  146. .tiocmset = oti6858_tiocmset,
  147. .read_bulk_callback = oti6858_read_bulk_callback,
  148. .read_int_callback = oti6858_read_int_callback,
  149. .write_bulk_callback = oti6858_write_bulk_callback,
  150. .write_room = oti6858_write_room,
  151. .chars_in_buffer = oti6858_chars_in_buffer,
  152. .port_probe = oti6858_port_probe,
  153. .port_remove = oti6858_port_remove,
  154. };
  155. static struct usb_serial_driver * const serial_drivers[] = {
  156. &oti6858_device, NULL
  157. };
  158. struct oti6858_private {
  159. spinlock_t lock;
  160. struct oti6858_control_pkt status;
  161. struct {
  162. u8 read_urb_in_use;
  163. u8 write_urb_in_use;
  164. } flags;
  165. struct delayed_work delayed_write_work;
  166. struct {
  167. __le16 divisor;
  168. u8 frame_fmt;
  169. u8 control;
  170. } pending_setup;
  171. u8 transient;
  172. u8 setup_done;
  173. struct delayed_work delayed_setup_work;
  174. wait_queue_head_t intr_wait;
  175. struct usb_serial_port *port; /* USB port with which associated */
  176. };
  177. static void setup_line(struct work_struct *work)
  178. {
  179. struct oti6858_private *priv = container_of(work,
  180. struct oti6858_private, delayed_setup_work.work);
  181. struct usb_serial_port *port = priv->port;
  182. struct oti6858_control_pkt *new_setup;
  183. unsigned long flags;
  184. int result;
  185. new_setup = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
  186. if (new_setup == NULL) {
  187. dev_err(&port->dev, "%s(): out of memory!\n", __func__);
  188. /* we will try again */
  189. schedule_delayed_work(&priv->delayed_setup_work,
  190. msecs_to_jiffies(2));
  191. return;
  192. }
  193. result = usb_control_msg(port->serial->dev,
  194. usb_rcvctrlpipe(port->serial->dev, 0),
  195. OTI6858_REQ_T_GET_STATUS,
  196. OTI6858_REQ_GET_STATUS,
  197. 0, 0,
  198. new_setup, OTI6858_CTRL_PKT_SIZE,
  199. 100);
  200. if (result != OTI6858_CTRL_PKT_SIZE) {
  201. dev_err(&port->dev, "%s(): error reading status\n", __func__);
  202. kfree(new_setup);
  203. /* we will try again */
  204. schedule_delayed_work(&priv->delayed_setup_work,
  205. msecs_to_jiffies(2));
  206. return;
  207. }
  208. spin_lock_irqsave(&priv->lock, flags);
  209. if (!OTI6858_CTRL_EQUALS_PENDING(new_setup, priv)) {
  210. new_setup->divisor = priv->pending_setup.divisor;
  211. new_setup->control = priv->pending_setup.control;
  212. new_setup->frame_fmt = priv->pending_setup.frame_fmt;
  213. spin_unlock_irqrestore(&priv->lock, flags);
  214. result = usb_control_msg(port->serial->dev,
  215. usb_sndctrlpipe(port->serial->dev, 0),
  216. OTI6858_REQ_T_SET_LINE,
  217. OTI6858_REQ_SET_LINE,
  218. 0, 0,
  219. new_setup, OTI6858_CTRL_PKT_SIZE,
  220. 100);
  221. } else {
  222. spin_unlock_irqrestore(&priv->lock, flags);
  223. result = 0;
  224. }
  225. kfree(new_setup);
  226. spin_lock_irqsave(&priv->lock, flags);
  227. if (result != OTI6858_CTRL_PKT_SIZE)
  228. priv->transient = 0;
  229. priv->setup_done = 1;
  230. spin_unlock_irqrestore(&priv->lock, flags);
  231. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  232. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  233. if (result != 0) {
  234. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  235. __func__, result);
  236. }
  237. }
  238. static void send_data(struct work_struct *work)
  239. {
  240. struct oti6858_private *priv = container_of(work,
  241. struct oti6858_private, delayed_write_work.work);
  242. struct usb_serial_port *port = priv->port;
  243. int count = 0, result;
  244. unsigned long flags;
  245. u8 *allow;
  246. spin_lock_irqsave(&priv->lock, flags);
  247. if (priv->flags.write_urb_in_use) {
  248. spin_unlock_irqrestore(&priv->lock, flags);
  249. schedule_delayed_work(&priv->delayed_write_work,
  250. msecs_to_jiffies(2));
  251. return;
  252. }
  253. priv->flags.write_urb_in_use = 1;
  254. spin_unlock_irqrestore(&priv->lock, flags);
  255. spin_lock_irqsave(&port->lock, flags);
  256. count = kfifo_len(&port->write_fifo);
  257. spin_unlock_irqrestore(&port->lock, flags);
  258. if (count > port->bulk_out_size)
  259. count = port->bulk_out_size;
  260. if (count != 0) {
  261. allow = kmalloc(1, GFP_KERNEL);
  262. if (!allow) {
  263. dev_err_console(port, "%s(): kmalloc failed\n",
  264. __func__);
  265. return;
  266. }
  267. result = usb_control_msg(port->serial->dev,
  268. usb_rcvctrlpipe(port->serial->dev, 0),
  269. OTI6858_REQ_T_CHECK_TXBUFF,
  270. OTI6858_REQ_CHECK_TXBUFF,
  271. count, 0, allow, 1, 100);
  272. if (result != 1 || *allow != 0)
  273. count = 0;
  274. kfree(allow);
  275. }
  276. if (count == 0) {
  277. priv->flags.write_urb_in_use = 0;
  278. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  279. result = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO);
  280. if (result != 0) {
  281. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  282. __func__, result);
  283. }
  284. return;
  285. }
  286. count = kfifo_out_locked(&port->write_fifo,
  287. port->write_urb->transfer_buffer,
  288. count, &port->lock);
  289. port->write_urb->transfer_buffer_length = count;
  290. result = usb_submit_urb(port->write_urb, GFP_NOIO);
  291. if (result != 0) {
  292. dev_err_console(port, "%s(): usb_submit_urb() failed with error %d\n",
  293. __func__, result);
  294. priv->flags.write_urb_in_use = 0;
  295. }
  296. usb_serial_port_softint(port);
  297. }
  298. static int oti6858_port_probe(struct usb_serial_port *port)
  299. {
  300. struct oti6858_private *priv;
  301. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  302. if (!priv)
  303. return -ENOMEM;
  304. spin_lock_init(&priv->lock);
  305. init_waitqueue_head(&priv->intr_wait);
  306. priv->port = port;
  307. INIT_DELAYED_WORK(&priv->delayed_setup_work, setup_line);
  308. INIT_DELAYED_WORK(&priv->delayed_write_work, send_data);
  309. usb_set_serial_port_data(port, priv);
  310. return 0;
  311. }
  312. static int oti6858_port_remove(struct usb_serial_port *port)
  313. {
  314. struct oti6858_private *priv;
  315. priv = usb_get_serial_port_data(port);
  316. kfree(priv);
  317. return 0;
  318. }
  319. static int oti6858_write(struct tty_struct *tty, struct usb_serial_port *port,
  320. const unsigned char *buf, int count)
  321. {
  322. if (!count)
  323. return count;
  324. count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock);
  325. return count;
  326. }
  327. static int oti6858_write_room(struct tty_struct *tty)
  328. {
  329. struct usb_serial_port *port = tty->driver_data;
  330. int room = 0;
  331. unsigned long flags;
  332. spin_lock_irqsave(&port->lock, flags);
  333. room = kfifo_avail(&port->write_fifo);
  334. spin_unlock_irqrestore(&port->lock, flags);
  335. return room;
  336. }
  337. static int oti6858_chars_in_buffer(struct tty_struct *tty)
  338. {
  339. struct usb_serial_port *port = tty->driver_data;
  340. int chars = 0;
  341. unsigned long flags;
  342. spin_lock_irqsave(&port->lock, flags);
  343. chars = kfifo_len(&port->write_fifo);
  344. spin_unlock_irqrestore(&port->lock, flags);
  345. return chars;
  346. }
  347. static void oti6858_init_termios(struct tty_struct *tty)
  348. {
  349. tty->termios = tty_std_termios;
  350. tty->termios.c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL;
  351. tty->termios.c_ispeed = 38400;
  352. tty->termios.c_ospeed = 38400;
  353. }
  354. static void oti6858_set_termios(struct tty_struct *tty,
  355. struct usb_serial_port *port, struct ktermios *old_termios)
  356. {
  357. struct oti6858_private *priv = usb_get_serial_port_data(port);
  358. unsigned long flags;
  359. unsigned int cflag;
  360. u8 frame_fmt, control;
  361. __le16 divisor;
  362. int br;
  363. if (!tty)
  364. return;
  365. cflag = tty->termios.c_cflag;
  366. spin_lock_irqsave(&priv->lock, flags);
  367. divisor = priv->pending_setup.divisor;
  368. frame_fmt = priv->pending_setup.frame_fmt;
  369. control = priv->pending_setup.control;
  370. spin_unlock_irqrestore(&priv->lock, flags);
  371. frame_fmt &= ~FMT_DATA_BITS_MASK;
  372. switch (cflag & CSIZE) {
  373. case CS5:
  374. frame_fmt |= FMT_DATA_BITS_5;
  375. break;
  376. case CS6:
  377. frame_fmt |= FMT_DATA_BITS_6;
  378. break;
  379. case CS7:
  380. frame_fmt |= FMT_DATA_BITS_7;
  381. break;
  382. default:
  383. case CS8:
  384. frame_fmt |= FMT_DATA_BITS_8;
  385. break;
  386. }
  387. /* manufacturer claims that this device can work with baud rates
  388. * up to 3 Mbps; I've tested it only on 115200 bps, so I can't
  389. * guarantee that any other baud rate will work (especially
  390. * the higher ones)
  391. */
  392. br = tty_get_baud_rate(tty);
  393. if (br == 0) {
  394. divisor = 0;
  395. } else {
  396. int real_br;
  397. int new_divisor;
  398. br = min(br, OTI6858_MAX_BAUD_RATE);
  399. new_divisor = (96000000 + 8 * br) / (16 * br);
  400. real_br = 96000000 / (16 * new_divisor);
  401. divisor = cpu_to_le16(new_divisor);
  402. tty_encode_baud_rate(tty, real_br, real_br);
  403. }
  404. frame_fmt &= ~FMT_STOP_BITS_MASK;
  405. if ((cflag & CSTOPB) != 0)
  406. frame_fmt |= FMT_STOP_BITS_2;
  407. else
  408. frame_fmt |= FMT_STOP_BITS_1;
  409. frame_fmt &= ~FMT_PARITY_MASK;
  410. if ((cflag & PARENB) != 0) {
  411. if ((cflag & PARODD) != 0)
  412. frame_fmt |= FMT_PARITY_ODD;
  413. else
  414. frame_fmt |= FMT_PARITY_EVEN;
  415. } else {
  416. frame_fmt |= FMT_PARITY_NONE;
  417. }
  418. control &= ~CONTROL_MASK;
  419. if ((cflag & CRTSCTS) != 0)
  420. control |= (CONTROL_DTR_HIGH | CONTROL_RTS_HIGH);
  421. /* change control lines if we are switching to or from B0 */
  422. /* FIXME:
  423. spin_lock_irqsave(&priv->lock, flags);
  424. control = priv->line_control;
  425. if ((cflag & CBAUD) == B0)
  426. priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
  427. else
  428. priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
  429. if (control != priv->line_control) {
  430. control = priv->line_control;
  431. spin_unlock_irqrestore(&priv->lock, flags);
  432. set_control_lines(serial->dev, control);
  433. } else {
  434. spin_unlock_irqrestore(&priv->lock, flags);
  435. }
  436. */
  437. spin_lock_irqsave(&priv->lock, flags);
  438. if (divisor != priv->pending_setup.divisor
  439. || control != priv->pending_setup.control
  440. || frame_fmt != priv->pending_setup.frame_fmt) {
  441. priv->pending_setup.divisor = divisor;
  442. priv->pending_setup.control = control;
  443. priv->pending_setup.frame_fmt = frame_fmt;
  444. }
  445. spin_unlock_irqrestore(&priv->lock, flags);
  446. }
  447. static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port)
  448. {
  449. struct oti6858_private *priv = usb_get_serial_port_data(port);
  450. struct ktermios tmp_termios;
  451. struct usb_serial *serial = port->serial;
  452. struct oti6858_control_pkt *buf;
  453. unsigned long flags;
  454. int result;
  455. usb_clear_halt(serial->dev, port->write_urb->pipe);
  456. usb_clear_halt(serial->dev, port->read_urb->pipe);
  457. buf = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
  458. if (buf == NULL) {
  459. dev_err(&port->dev, "%s(): out of memory!\n", __func__);
  460. return -ENOMEM;
  461. }
  462. result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
  463. OTI6858_REQ_T_GET_STATUS,
  464. OTI6858_REQ_GET_STATUS,
  465. 0, 0,
  466. buf, OTI6858_CTRL_PKT_SIZE,
  467. 100);
  468. if (result != OTI6858_CTRL_PKT_SIZE) {
  469. /* assume default (after power-on reset) values */
  470. buf->divisor = cpu_to_le16(0x009c); /* 38400 bps */
  471. buf->frame_fmt = 0x03; /* 8N1 */
  472. buf->something = 0x43;
  473. buf->control = 0x4c; /* DTR, RTS */
  474. buf->tx_status = 0x00;
  475. buf->pin_state = 0x5b; /* RTS, CTS, DSR, DTR, RI, DCD */
  476. buf->rx_bytes_avail = 0x00;
  477. }
  478. spin_lock_irqsave(&priv->lock, flags);
  479. memcpy(&priv->status, buf, OTI6858_CTRL_PKT_SIZE);
  480. priv->pending_setup.divisor = buf->divisor;
  481. priv->pending_setup.frame_fmt = buf->frame_fmt;
  482. priv->pending_setup.control = buf->control;
  483. spin_unlock_irqrestore(&priv->lock, flags);
  484. kfree(buf);
  485. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  486. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  487. if (result != 0) {
  488. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  489. __func__, result);
  490. oti6858_close(port);
  491. return result;
  492. }
  493. /* setup termios */
  494. if (tty)
  495. oti6858_set_termios(tty, port, &tmp_termios);
  496. port->port.drain_delay = 256; /* FIXME: check the FIFO length */
  497. return 0;
  498. }
  499. static void oti6858_close(struct usb_serial_port *port)
  500. {
  501. struct oti6858_private *priv = usb_get_serial_port_data(port);
  502. unsigned long flags;
  503. spin_lock_irqsave(&port->lock, flags);
  504. /* clear out any remaining data in the buffer */
  505. kfifo_reset_out(&port->write_fifo);
  506. spin_unlock_irqrestore(&port->lock, flags);
  507. dev_dbg(&port->dev, "%s(): after buf_clear()\n", __func__);
  508. /* cancel scheduled setup */
  509. cancel_delayed_work_sync(&priv->delayed_setup_work);
  510. cancel_delayed_work_sync(&priv->delayed_write_work);
  511. /* shutdown our urbs */
  512. dev_dbg(&port->dev, "%s(): shutting down urbs\n", __func__);
  513. usb_kill_urb(port->write_urb);
  514. usb_kill_urb(port->read_urb);
  515. usb_kill_urb(port->interrupt_in_urb);
  516. }
  517. static int oti6858_tiocmset(struct tty_struct *tty,
  518. unsigned int set, unsigned int clear)
  519. {
  520. struct usb_serial_port *port = tty->driver_data;
  521. struct oti6858_private *priv = usb_get_serial_port_data(port);
  522. unsigned long flags;
  523. u8 control;
  524. dev_dbg(&port->dev, "%s(set = 0x%08x, clear = 0x%08x)\n",
  525. __func__, set, clear);
  526. /* FIXME: check if this is correct (active high/low) */
  527. spin_lock_irqsave(&priv->lock, flags);
  528. control = priv->pending_setup.control;
  529. if ((set & TIOCM_RTS) != 0)
  530. control |= CONTROL_RTS_HIGH;
  531. if ((set & TIOCM_DTR) != 0)
  532. control |= CONTROL_DTR_HIGH;
  533. if ((clear & TIOCM_RTS) != 0)
  534. control &= ~CONTROL_RTS_HIGH;
  535. if ((clear & TIOCM_DTR) != 0)
  536. control &= ~CONTROL_DTR_HIGH;
  537. if (control != priv->pending_setup.control)
  538. priv->pending_setup.control = control;
  539. spin_unlock_irqrestore(&priv->lock, flags);
  540. return 0;
  541. }
  542. static int oti6858_tiocmget(struct tty_struct *tty)
  543. {
  544. struct usb_serial_port *port = tty->driver_data;
  545. struct oti6858_private *priv = usb_get_serial_port_data(port);
  546. unsigned long flags;
  547. unsigned pin_state;
  548. unsigned result = 0;
  549. spin_lock_irqsave(&priv->lock, flags);
  550. pin_state = priv->status.pin_state & PIN_MASK;
  551. spin_unlock_irqrestore(&priv->lock, flags);
  552. /* FIXME: check if this is correct (active high/low) */
  553. if ((pin_state & PIN_RTS) != 0)
  554. result |= TIOCM_RTS;
  555. if ((pin_state & PIN_CTS) != 0)
  556. result |= TIOCM_CTS;
  557. if ((pin_state & PIN_DSR) != 0)
  558. result |= TIOCM_DSR;
  559. if ((pin_state & PIN_DTR) != 0)
  560. result |= TIOCM_DTR;
  561. if ((pin_state & PIN_RI) != 0)
  562. result |= TIOCM_RI;
  563. if ((pin_state & PIN_DCD) != 0)
  564. result |= TIOCM_CD;
  565. dev_dbg(&port->dev, "%s() = 0x%08x\n", __func__, result);
  566. return result;
  567. }
  568. static int wait_modem_info(struct usb_serial_port *port, unsigned int arg)
  569. {
  570. struct oti6858_private *priv = usb_get_serial_port_data(port);
  571. unsigned long flags;
  572. unsigned int prev, status;
  573. unsigned int changed;
  574. spin_lock_irqsave(&priv->lock, flags);
  575. prev = priv->status.pin_state;
  576. spin_unlock_irqrestore(&priv->lock, flags);
  577. while (1) {
  578. wait_event_interruptible(priv->intr_wait,
  579. priv->status.pin_state != prev);
  580. if (signal_pending(current))
  581. return -ERESTARTSYS;
  582. spin_lock_irqsave(&priv->lock, flags);
  583. status = priv->status.pin_state & PIN_MASK;
  584. spin_unlock_irqrestore(&priv->lock, flags);
  585. changed = prev ^ status;
  586. /* FIXME: check if this is correct (active high/low) */
  587. if (((arg & TIOCM_RNG) && (changed & PIN_RI)) ||
  588. ((arg & TIOCM_DSR) && (changed & PIN_DSR)) ||
  589. ((arg & TIOCM_CD) && (changed & PIN_DCD)) ||
  590. ((arg & TIOCM_CTS) && (changed & PIN_CTS)))
  591. return 0;
  592. prev = status;
  593. }
  594. /* NOTREACHED */
  595. return 0;
  596. }
  597. static int oti6858_ioctl(struct tty_struct *tty,
  598. unsigned int cmd, unsigned long arg)
  599. {
  600. struct usb_serial_port *port = tty->driver_data;
  601. dev_dbg(&port->dev, "%s(cmd = 0x%04x, arg = 0x%08lx)\n", __func__, cmd, arg);
  602. switch (cmd) {
  603. case TIOCMIWAIT:
  604. dev_dbg(&port->dev, "%s(): TIOCMIWAIT\n", __func__);
  605. return wait_modem_info(port, arg);
  606. default:
  607. dev_dbg(&port->dev, "%s(): 0x%04x not supported\n", __func__, cmd);
  608. break;
  609. }
  610. return -ENOIOCTLCMD;
  611. }
  612. static void oti6858_read_int_callback(struct urb *urb)
  613. {
  614. struct usb_serial_port *port = urb->context;
  615. struct oti6858_private *priv = usb_get_serial_port_data(port);
  616. int transient = 0, can_recv = 0, resubmit = 1;
  617. int status = urb->status;
  618. switch (status) {
  619. case 0:
  620. /* success */
  621. break;
  622. case -ECONNRESET:
  623. case -ENOENT:
  624. case -ESHUTDOWN:
  625. /* this urb is terminated, clean up */
  626. dev_dbg(&urb->dev->dev, "%s(): urb shutting down with status: %d\n",
  627. __func__, status);
  628. return;
  629. default:
  630. dev_dbg(&urb->dev->dev, "%s(): nonzero urb status received: %d\n",
  631. __func__, status);
  632. break;
  633. }
  634. if (status == 0 && urb->actual_length == OTI6858_CTRL_PKT_SIZE) {
  635. struct oti6858_control_pkt *xs = urb->transfer_buffer;
  636. unsigned long flags;
  637. spin_lock_irqsave(&priv->lock, flags);
  638. if (!priv->transient) {
  639. if (!OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
  640. if (xs->rx_bytes_avail == 0) {
  641. priv->transient = 4;
  642. priv->setup_done = 0;
  643. resubmit = 0;
  644. dev_dbg(&port->dev, "%s(): scheduling setup_line()\n", __func__);
  645. schedule_delayed_work(&priv->delayed_setup_work, 0);
  646. }
  647. }
  648. } else {
  649. if (OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
  650. priv->transient = 0;
  651. } else if (!priv->setup_done) {
  652. resubmit = 0;
  653. } else if (--priv->transient == 0) {
  654. if (xs->rx_bytes_avail == 0) {
  655. priv->transient = 4;
  656. priv->setup_done = 0;
  657. resubmit = 0;
  658. dev_dbg(&port->dev, "%s(): scheduling setup_line()\n", __func__);
  659. schedule_delayed_work(&priv->delayed_setup_work, 0);
  660. }
  661. }
  662. }
  663. if (!priv->transient) {
  664. if (xs->pin_state != priv->status.pin_state)
  665. wake_up_interruptible(&priv->intr_wait);
  666. memcpy(&priv->status, xs, OTI6858_CTRL_PKT_SIZE);
  667. }
  668. if (!priv->transient && xs->rx_bytes_avail != 0) {
  669. can_recv = xs->rx_bytes_avail;
  670. priv->flags.read_urb_in_use = 1;
  671. }
  672. transient = priv->transient;
  673. spin_unlock_irqrestore(&priv->lock, flags);
  674. }
  675. if (can_recv) {
  676. int result;
  677. result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
  678. if (result != 0) {
  679. priv->flags.read_urb_in_use = 0;
  680. dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
  681. " error %d\n", __func__, result);
  682. } else {
  683. resubmit = 0;
  684. }
  685. } else if (!transient) {
  686. unsigned long flags;
  687. int count;
  688. spin_lock_irqsave(&port->lock, flags);
  689. count = kfifo_len(&port->write_fifo);
  690. spin_unlock_irqrestore(&port->lock, flags);
  691. spin_lock_irqsave(&priv->lock, flags);
  692. if (priv->flags.write_urb_in_use == 0 && count != 0) {
  693. schedule_delayed_work(&priv->delayed_write_work, 0);
  694. resubmit = 0;
  695. }
  696. spin_unlock_irqrestore(&priv->lock, flags);
  697. }
  698. if (resubmit) {
  699. int result;
  700. /* dev_dbg(&urb->dev->dev, "%s(): submitting interrupt urb\n", __func__); */
  701. result = usb_submit_urb(urb, GFP_ATOMIC);
  702. if (result != 0) {
  703. dev_err(&urb->dev->dev,
  704. "%s(): usb_submit_urb() failed with"
  705. " error %d\n", __func__, result);
  706. }
  707. }
  708. }
  709. static void oti6858_read_bulk_callback(struct urb *urb)
  710. {
  711. struct usb_serial_port *port = urb->context;
  712. struct oti6858_private *priv = usb_get_serial_port_data(port);
  713. struct tty_struct *tty;
  714. unsigned char *data = urb->transfer_buffer;
  715. unsigned long flags;
  716. int status = urb->status;
  717. int result;
  718. spin_lock_irqsave(&priv->lock, flags);
  719. priv->flags.read_urb_in_use = 0;
  720. spin_unlock_irqrestore(&priv->lock, flags);
  721. if (status != 0) {
  722. dev_dbg(&urb->dev->dev, "%s(): unable to handle the error, exiting\n", __func__);
  723. return;
  724. }
  725. tty = tty_port_tty_get(&port->port);
  726. if (tty != NULL && urb->actual_length > 0) {
  727. tty_insert_flip_string(tty, data, urb->actual_length);
  728. tty_flip_buffer_push(tty);
  729. }
  730. tty_kref_put(tty);
  731. /* schedule the interrupt urb */
  732. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  733. if (result != 0 && result != -EPERM) {
  734. dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
  735. " error %d\n", __func__, result);
  736. }
  737. }
  738. static void oti6858_write_bulk_callback(struct urb *urb)
  739. {
  740. struct usb_serial_port *port = urb->context;
  741. struct oti6858_private *priv = usb_get_serial_port_data(port);
  742. int status = urb->status;
  743. int result;
  744. switch (status) {
  745. case 0:
  746. /* success */
  747. break;
  748. case -ECONNRESET:
  749. case -ENOENT:
  750. case -ESHUTDOWN:
  751. /* this urb is terminated, clean up */
  752. dev_dbg(&urb->dev->dev, "%s(): urb shutting down with status: %d\n", __func__, status);
  753. priv->flags.write_urb_in_use = 0;
  754. return;
  755. default:
  756. /* error in the urb, so we have to resubmit it */
  757. dev_dbg(&urb->dev->dev, "%s(): nonzero write bulk status received: %d\n", __func__, status);
  758. dev_dbg(&urb->dev->dev, "%s(): overflow in write\n", __func__);
  759. port->write_urb->transfer_buffer_length = 1;
  760. result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
  761. if (result) {
  762. dev_err_console(port, "%s(): usb_submit_urb() failed,"
  763. " error %d\n", __func__, result);
  764. } else {
  765. return;
  766. }
  767. }
  768. priv->flags.write_urb_in_use = 0;
  769. /* schedule the interrupt urb if we are still open */
  770. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  771. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  772. if (result != 0) {
  773. dev_err(&port->dev, "%s(): failed submitting int urb,"
  774. " error %d\n", __func__, result);
  775. }
  776. }
  777. module_usb_serial_driver(serial_drivers, id_table);
  778. MODULE_DESCRIPTION(OTI6858_DESCRIPTION);
  779. MODULE_AUTHOR(OTI6858_AUTHOR);
  780. MODULE_LICENSE("GPL");