oti6858.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900
  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. struct usb_serial_port *port; /* USB port with which associated */
  175. };
  176. static void setup_line(struct work_struct *work)
  177. {
  178. struct oti6858_private *priv = container_of(work,
  179. struct oti6858_private, delayed_setup_work.work);
  180. struct usb_serial_port *port = priv->port;
  181. struct oti6858_control_pkt *new_setup;
  182. unsigned long flags;
  183. int result;
  184. new_setup = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
  185. if (new_setup == NULL) {
  186. dev_err(&port->dev, "%s(): out of memory!\n", __func__);
  187. /* we will try again */
  188. schedule_delayed_work(&priv->delayed_setup_work,
  189. msecs_to_jiffies(2));
  190. return;
  191. }
  192. result = usb_control_msg(port->serial->dev,
  193. usb_rcvctrlpipe(port->serial->dev, 0),
  194. OTI6858_REQ_T_GET_STATUS,
  195. OTI6858_REQ_GET_STATUS,
  196. 0, 0,
  197. new_setup, OTI6858_CTRL_PKT_SIZE,
  198. 100);
  199. if (result != OTI6858_CTRL_PKT_SIZE) {
  200. dev_err(&port->dev, "%s(): error reading status\n", __func__);
  201. kfree(new_setup);
  202. /* we will try again */
  203. schedule_delayed_work(&priv->delayed_setup_work,
  204. msecs_to_jiffies(2));
  205. return;
  206. }
  207. spin_lock_irqsave(&priv->lock, flags);
  208. if (!OTI6858_CTRL_EQUALS_PENDING(new_setup, priv)) {
  209. new_setup->divisor = priv->pending_setup.divisor;
  210. new_setup->control = priv->pending_setup.control;
  211. new_setup->frame_fmt = priv->pending_setup.frame_fmt;
  212. spin_unlock_irqrestore(&priv->lock, flags);
  213. result = usb_control_msg(port->serial->dev,
  214. usb_sndctrlpipe(port->serial->dev, 0),
  215. OTI6858_REQ_T_SET_LINE,
  216. OTI6858_REQ_SET_LINE,
  217. 0, 0,
  218. new_setup, OTI6858_CTRL_PKT_SIZE,
  219. 100);
  220. } else {
  221. spin_unlock_irqrestore(&priv->lock, flags);
  222. result = 0;
  223. }
  224. kfree(new_setup);
  225. spin_lock_irqsave(&priv->lock, flags);
  226. if (result != OTI6858_CTRL_PKT_SIZE)
  227. priv->transient = 0;
  228. priv->setup_done = 1;
  229. spin_unlock_irqrestore(&priv->lock, flags);
  230. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  231. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  232. if (result != 0) {
  233. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  234. __func__, result);
  235. }
  236. }
  237. static void send_data(struct work_struct *work)
  238. {
  239. struct oti6858_private *priv = container_of(work,
  240. struct oti6858_private, delayed_write_work.work);
  241. struct usb_serial_port *port = priv->port;
  242. int count = 0, result;
  243. unsigned long flags;
  244. u8 *allow;
  245. spin_lock_irqsave(&priv->lock, flags);
  246. if (priv->flags.write_urb_in_use) {
  247. spin_unlock_irqrestore(&priv->lock, flags);
  248. schedule_delayed_work(&priv->delayed_write_work,
  249. msecs_to_jiffies(2));
  250. return;
  251. }
  252. priv->flags.write_urb_in_use = 1;
  253. spin_unlock_irqrestore(&priv->lock, flags);
  254. spin_lock_irqsave(&port->lock, flags);
  255. count = kfifo_len(&port->write_fifo);
  256. spin_unlock_irqrestore(&port->lock, flags);
  257. if (count > port->bulk_out_size)
  258. count = port->bulk_out_size;
  259. if (count != 0) {
  260. allow = kmalloc(1, GFP_KERNEL);
  261. if (!allow) {
  262. dev_err_console(port, "%s(): kmalloc failed\n",
  263. __func__);
  264. return;
  265. }
  266. result = usb_control_msg(port->serial->dev,
  267. usb_rcvctrlpipe(port->serial->dev, 0),
  268. OTI6858_REQ_T_CHECK_TXBUFF,
  269. OTI6858_REQ_CHECK_TXBUFF,
  270. count, 0, allow, 1, 100);
  271. if (result != 1 || *allow != 0)
  272. count = 0;
  273. kfree(allow);
  274. }
  275. if (count == 0) {
  276. priv->flags.write_urb_in_use = 0;
  277. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  278. result = usb_submit_urb(port->interrupt_in_urb, GFP_NOIO);
  279. if (result != 0) {
  280. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  281. __func__, result);
  282. }
  283. return;
  284. }
  285. count = kfifo_out_locked(&port->write_fifo,
  286. port->write_urb->transfer_buffer,
  287. count, &port->lock);
  288. port->write_urb->transfer_buffer_length = count;
  289. result = usb_submit_urb(port->write_urb, GFP_NOIO);
  290. if (result != 0) {
  291. dev_err_console(port, "%s(): usb_submit_urb() failed with error %d\n",
  292. __func__, result);
  293. priv->flags.write_urb_in_use = 0;
  294. }
  295. usb_serial_port_softint(port);
  296. }
  297. static int oti6858_port_probe(struct usb_serial_port *port)
  298. {
  299. struct oti6858_private *priv;
  300. priv = kzalloc(sizeof(*priv), GFP_KERNEL);
  301. if (!priv)
  302. return -ENOMEM;
  303. spin_lock_init(&priv->lock);
  304. priv->port = port;
  305. INIT_DELAYED_WORK(&priv->delayed_setup_work, setup_line);
  306. INIT_DELAYED_WORK(&priv->delayed_write_work, send_data);
  307. usb_set_serial_port_data(port, priv);
  308. return 0;
  309. }
  310. static int oti6858_port_remove(struct usb_serial_port *port)
  311. {
  312. struct oti6858_private *priv;
  313. priv = usb_get_serial_port_data(port);
  314. kfree(priv);
  315. return 0;
  316. }
  317. static int oti6858_write(struct tty_struct *tty, struct usb_serial_port *port,
  318. const unsigned char *buf, int count)
  319. {
  320. if (!count)
  321. return count;
  322. count = kfifo_in_locked(&port->write_fifo, buf, count, &port->lock);
  323. return count;
  324. }
  325. static int oti6858_write_room(struct tty_struct *tty)
  326. {
  327. struct usb_serial_port *port = tty->driver_data;
  328. int room = 0;
  329. unsigned long flags;
  330. spin_lock_irqsave(&port->lock, flags);
  331. room = kfifo_avail(&port->write_fifo);
  332. spin_unlock_irqrestore(&port->lock, flags);
  333. return room;
  334. }
  335. static int oti6858_chars_in_buffer(struct tty_struct *tty)
  336. {
  337. struct usb_serial_port *port = tty->driver_data;
  338. int chars = 0;
  339. unsigned long flags;
  340. spin_lock_irqsave(&port->lock, flags);
  341. chars = kfifo_len(&port->write_fifo);
  342. spin_unlock_irqrestore(&port->lock, flags);
  343. return chars;
  344. }
  345. static void oti6858_init_termios(struct tty_struct *tty)
  346. {
  347. tty->termios = tty_std_termios;
  348. tty->termios.c_cflag = B38400 | CS8 | CREAD | HUPCL | CLOCAL;
  349. tty->termios.c_ispeed = 38400;
  350. tty->termios.c_ospeed = 38400;
  351. }
  352. static void oti6858_set_termios(struct tty_struct *tty,
  353. struct usb_serial_port *port, struct ktermios *old_termios)
  354. {
  355. struct oti6858_private *priv = usb_get_serial_port_data(port);
  356. unsigned long flags;
  357. unsigned int cflag;
  358. u8 frame_fmt, control;
  359. __le16 divisor;
  360. int br;
  361. if (!tty)
  362. return;
  363. cflag = tty->termios.c_cflag;
  364. spin_lock_irqsave(&priv->lock, flags);
  365. divisor = priv->pending_setup.divisor;
  366. frame_fmt = priv->pending_setup.frame_fmt;
  367. control = priv->pending_setup.control;
  368. spin_unlock_irqrestore(&priv->lock, flags);
  369. frame_fmt &= ~FMT_DATA_BITS_MASK;
  370. switch (cflag & CSIZE) {
  371. case CS5:
  372. frame_fmt |= FMT_DATA_BITS_5;
  373. break;
  374. case CS6:
  375. frame_fmt |= FMT_DATA_BITS_6;
  376. break;
  377. case CS7:
  378. frame_fmt |= FMT_DATA_BITS_7;
  379. break;
  380. default:
  381. case CS8:
  382. frame_fmt |= FMT_DATA_BITS_8;
  383. break;
  384. }
  385. /* manufacturer claims that this device can work with baud rates
  386. * up to 3 Mbps; I've tested it only on 115200 bps, so I can't
  387. * guarantee that any other baud rate will work (especially
  388. * the higher ones)
  389. */
  390. br = tty_get_baud_rate(tty);
  391. if (br == 0) {
  392. divisor = 0;
  393. } else {
  394. int real_br;
  395. int new_divisor;
  396. br = min(br, OTI6858_MAX_BAUD_RATE);
  397. new_divisor = (96000000 + 8 * br) / (16 * br);
  398. real_br = 96000000 / (16 * new_divisor);
  399. divisor = cpu_to_le16(new_divisor);
  400. tty_encode_baud_rate(tty, real_br, real_br);
  401. }
  402. frame_fmt &= ~FMT_STOP_BITS_MASK;
  403. if ((cflag & CSTOPB) != 0)
  404. frame_fmt |= FMT_STOP_BITS_2;
  405. else
  406. frame_fmt |= FMT_STOP_BITS_1;
  407. frame_fmt &= ~FMT_PARITY_MASK;
  408. if ((cflag & PARENB) != 0) {
  409. if ((cflag & PARODD) != 0)
  410. frame_fmt |= FMT_PARITY_ODD;
  411. else
  412. frame_fmt |= FMT_PARITY_EVEN;
  413. } else {
  414. frame_fmt |= FMT_PARITY_NONE;
  415. }
  416. control &= ~CONTROL_MASK;
  417. if ((cflag & CRTSCTS) != 0)
  418. control |= (CONTROL_DTR_HIGH | CONTROL_RTS_HIGH);
  419. /* change control lines if we are switching to or from B0 */
  420. /* FIXME:
  421. spin_lock_irqsave(&priv->lock, flags);
  422. control = priv->line_control;
  423. if ((cflag & CBAUD) == B0)
  424. priv->line_control &= ~(CONTROL_DTR | CONTROL_RTS);
  425. else
  426. priv->line_control |= (CONTROL_DTR | CONTROL_RTS);
  427. if (control != priv->line_control) {
  428. control = priv->line_control;
  429. spin_unlock_irqrestore(&priv->lock, flags);
  430. set_control_lines(serial->dev, control);
  431. } else {
  432. spin_unlock_irqrestore(&priv->lock, flags);
  433. }
  434. */
  435. spin_lock_irqsave(&priv->lock, flags);
  436. if (divisor != priv->pending_setup.divisor
  437. || control != priv->pending_setup.control
  438. || frame_fmt != priv->pending_setup.frame_fmt) {
  439. priv->pending_setup.divisor = divisor;
  440. priv->pending_setup.control = control;
  441. priv->pending_setup.frame_fmt = frame_fmt;
  442. }
  443. spin_unlock_irqrestore(&priv->lock, flags);
  444. }
  445. static int oti6858_open(struct tty_struct *tty, struct usb_serial_port *port)
  446. {
  447. struct oti6858_private *priv = usb_get_serial_port_data(port);
  448. struct ktermios tmp_termios;
  449. struct usb_serial *serial = port->serial;
  450. struct oti6858_control_pkt *buf;
  451. unsigned long flags;
  452. int result;
  453. usb_clear_halt(serial->dev, port->write_urb->pipe);
  454. usb_clear_halt(serial->dev, port->read_urb->pipe);
  455. buf = kmalloc(OTI6858_CTRL_PKT_SIZE, GFP_KERNEL);
  456. if (buf == NULL) {
  457. dev_err(&port->dev, "%s(): out of memory!\n", __func__);
  458. return -ENOMEM;
  459. }
  460. result = usb_control_msg(serial->dev, usb_rcvctrlpipe(serial->dev, 0),
  461. OTI6858_REQ_T_GET_STATUS,
  462. OTI6858_REQ_GET_STATUS,
  463. 0, 0,
  464. buf, OTI6858_CTRL_PKT_SIZE,
  465. 100);
  466. if (result != OTI6858_CTRL_PKT_SIZE) {
  467. /* assume default (after power-on reset) values */
  468. buf->divisor = cpu_to_le16(0x009c); /* 38400 bps */
  469. buf->frame_fmt = 0x03; /* 8N1 */
  470. buf->something = 0x43;
  471. buf->control = 0x4c; /* DTR, RTS */
  472. buf->tx_status = 0x00;
  473. buf->pin_state = 0x5b; /* RTS, CTS, DSR, DTR, RI, DCD */
  474. buf->rx_bytes_avail = 0x00;
  475. }
  476. spin_lock_irqsave(&priv->lock, flags);
  477. memcpy(&priv->status, buf, OTI6858_CTRL_PKT_SIZE);
  478. priv->pending_setup.divisor = buf->divisor;
  479. priv->pending_setup.frame_fmt = buf->frame_fmt;
  480. priv->pending_setup.control = buf->control;
  481. spin_unlock_irqrestore(&priv->lock, flags);
  482. kfree(buf);
  483. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  484. result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
  485. if (result != 0) {
  486. dev_err(&port->dev, "%s(): usb_submit_urb() failed with error %d\n",
  487. __func__, result);
  488. oti6858_close(port);
  489. return result;
  490. }
  491. /* setup termios */
  492. if (tty)
  493. oti6858_set_termios(tty, port, &tmp_termios);
  494. port->port.drain_delay = 256; /* FIXME: check the FIFO length */
  495. return 0;
  496. }
  497. static void oti6858_close(struct usb_serial_port *port)
  498. {
  499. struct oti6858_private *priv = usb_get_serial_port_data(port);
  500. unsigned long flags;
  501. spin_lock_irqsave(&port->lock, flags);
  502. /* clear out any remaining data in the buffer */
  503. kfifo_reset_out(&port->write_fifo);
  504. spin_unlock_irqrestore(&port->lock, flags);
  505. dev_dbg(&port->dev, "%s(): after buf_clear()\n", __func__);
  506. /* cancel scheduled setup */
  507. cancel_delayed_work_sync(&priv->delayed_setup_work);
  508. cancel_delayed_work_sync(&priv->delayed_write_work);
  509. /* shutdown our urbs */
  510. dev_dbg(&port->dev, "%s(): shutting down urbs\n", __func__);
  511. usb_kill_urb(port->write_urb);
  512. usb_kill_urb(port->read_urb);
  513. usb_kill_urb(port->interrupt_in_urb);
  514. }
  515. static int oti6858_tiocmset(struct tty_struct *tty,
  516. unsigned int set, unsigned int clear)
  517. {
  518. struct usb_serial_port *port = tty->driver_data;
  519. struct oti6858_private *priv = usb_get_serial_port_data(port);
  520. unsigned long flags;
  521. u8 control;
  522. dev_dbg(&port->dev, "%s(set = 0x%08x, clear = 0x%08x)\n",
  523. __func__, set, clear);
  524. /* FIXME: check if this is correct (active high/low) */
  525. spin_lock_irqsave(&priv->lock, flags);
  526. control = priv->pending_setup.control;
  527. if ((set & TIOCM_RTS) != 0)
  528. control |= CONTROL_RTS_HIGH;
  529. if ((set & TIOCM_DTR) != 0)
  530. control |= CONTROL_DTR_HIGH;
  531. if ((clear & TIOCM_RTS) != 0)
  532. control &= ~CONTROL_RTS_HIGH;
  533. if ((clear & TIOCM_DTR) != 0)
  534. control &= ~CONTROL_DTR_HIGH;
  535. if (control != priv->pending_setup.control)
  536. priv->pending_setup.control = control;
  537. spin_unlock_irqrestore(&priv->lock, flags);
  538. return 0;
  539. }
  540. static int oti6858_tiocmget(struct tty_struct *tty)
  541. {
  542. struct usb_serial_port *port = tty->driver_data;
  543. struct oti6858_private *priv = usb_get_serial_port_data(port);
  544. unsigned long flags;
  545. unsigned pin_state;
  546. unsigned result = 0;
  547. spin_lock_irqsave(&priv->lock, flags);
  548. pin_state = priv->status.pin_state & PIN_MASK;
  549. spin_unlock_irqrestore(&priv->lock, flags);
  550. /* FIXME: check if this is correct (active high/low) */
  551. if ((pin_state & PIN_RTS) != 0)
  552. result |= TIOCM_RTS;
  553. if ((pin_state & PIN_CTS) != 0)
  554. result |= TIOCM_CTS;
  555. if ((pin_state & PIN_DSR) != 0)
  556. result |= TIOCM_DSR;
  557. if ((pin_state & PIN_DTR) != 0)
  558. result |= TIOCM_DTR;
  559. if ((pin_state & PIN_RI) != 0)
  560. result |= TIOCM_RI;
  561. if ((pin_state & PIN_DCD) != 0)
  562. result |= TIOCM_CD;
  563. dev_dbg(&port->dev, "%s() = 0x%08x\n", __func__, result);
  564. return result;
  565. }
  566. static int wait_modem_info(struct usb_serial_port *port, unsigned int arg)
  567. {
  568. struct oti6858_private *priv = usb_get_serial_port_data(port);
  569. unsigned long flags;
  570. unsigned int prev, status;
  571. unsigned int changed;
  572. spin_lock_irqsave(&priv->lock, flags);
  573. prev = priv->status.pin_state;
  574. spin_unlock_irqrestore(&priv->lock, flags);
  575. while (1) {
  576. wait_event_interruptible(port->delta_msr_wait,
  577. port->serial->disconnected ||
  578. priv->status.pin_state != prev);
  579. if (signal_pending(current))
  580. return -ERESTARTSYS;
  581. if (port->serial->disconnected)
  582. return -EIO;
  583. spin_lock_irqsave(&priv->lock, flags);
  584. status = priv->status.pin_state & PIN_MASK;
  585. spin_unlock_irqrestore(&priv->lock, flags);
  586. changed = prev ^ status;
  587. /* FIXME: check if this is correct (active high/low) */
  588. if (((arg & TIOCM_RNG) && (changed & PIN_RI)) ||
  589. ((arg & TIOCM_DSR) && (changed & PIN_DSR)) ||
  590. ((arg & TIOCM_CD) && (changed & PIN_DCD)) ||
  591. ((arg & TIOCM_CTS) && (changed & PIN_CTS)))
  592. return 0;
  593. prev = status;
  594. }
  595. /* NOTREACHED */
  596. return 0;
  597. }
  598. static int oti6858_ioctl(struct tty_struct *tty,
  599. unsigned int cmd, unsigned long arg)
  600. {
  601. struct usb_serial_port *port = tty->driver_data;
  602. dev_dbg(&port->dev, "%s(cmd = 0x%04x, arg = 0x%08lx)\n", __func__, cmd, arg);
  603. switch (cmd) {
  604. case TIOCMIWAIT:
  605. dev_dbg(&port->dev, "%s(): TIOCMIWAIT\n", __func__);
  606. return wait_modem_info(port, arg);
  607. default:
  608. dev_dbg(&port->dev, "%s(): 0x%04x not supported\n", __func__, cmd);
  609. break;
  610. }
  611. return -ENOIOCTLCMD;
  612. }
  613. static void oti6858_read_int_callback(struct urb *urb)
  614. {
  615. struct usb_serial_port *port = urb->context;
  616. struct oti6858_private *priv = usb_get_serial_port_data(port);
  617. int transient = 0, can_recv = 0, resubmit = 1;
  618. int status = urb->status;
  619. switch (status) {
  620. case 0:
  621. /* success */
  622. break;
  623. case -ECONNRESET:
  624. case -ENOENT:
  625. case -ESHUTDOWN:
  626. /* this urb is terminated, clean up */
  627. dev_dbg(&urb->dev->dev, "%s(): urb shutting down with status: %d\n",
  628. __func__, status);
  629. return;
  630. default:
  631. dev_dbg(&urb->dev->dev, "%s(): nonzero urb status received: %d\n",
  632. __func__, status);
  633. break;
  634. }
  635. if (status == 0 && urb->actual_length == OTI6858_CTRL_PKT_SIZE) {
  636. struct oti6858_control_pkt *xs = urb->transfer_buffer;
  637. unsigned long flags;
  638. spin_lock_irqsave(&priv->lock, flags);
  639. if (!priv->transient) {
  640. if (!OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
  641. if (xs->rx_bytes_avail == 0) {
  642. priv->transient = 4;
  643. priv->setup_done = 0;
  644. resubmit = 0;
  645. dev_dbg(&port->dev, "%s(): scheduling setup_line()\n", __func__);
  646. schedule_delayed_work(&priv->delayed_setup_work, 0);
  647. }
  648. }
  649. } else {
  650. if (OTI6858_CTRL_EQUALS_PENDING(xs, priv)) {
  651. priv->transient = 0;
  652. } else if (!priv->setup_done) {
  653. resubmit = 0;
  654. } else if (--priv->transient == 0) {
  655. if (xs->rx_bytes_avail == 0) {
  656. priv->transient = 4;
  657. priv->setup_done = 0;
  658. resubmit = 0;
  659. dev_dbg(&port->dev, "%s(): scheduling setup_line()\n", __func__);
  660. schedule_delayed_work(&priv->delayed_setup_work, 0);
  661. }
  662. }
  663. }
  664. if (!priv->transient) {
  665. if (xs->pin_state != priv->status.pin_state)
  666. wake_up_interruptible(&port->delta_msr_wait);
  667. memcpy(&priv->status, xs, OTI6858_CTRL_PKT_SIZE);
  668. }
  669. if (!priv->transient && xs->rx_bytes_avail != 0) {
  670. can_recv = xs->rx_bytes_avail;
  671. priv->flags.read_urb_in_use = 1;
  672. }
  673. transient = priv->transient;
  674. spin_unlock_irqrestore(&priv->lock, flags);
  675. }
  676. if (can_recv) {
  677. int result;
  678. result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
  679. if (result != 0) {
  680. priv->flags.read_urb_in_use = 0;
  681. dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
  682. " error %d\n", __func__, result);
  683. } else {
  684. resubmit = 0;
  685. }
  686. } else if (!transient) {
  687. unsigned long flags;
  688. int count;
  689. spin_lock_irqsave(&port->lock, flags);
  690. count = kfifo_len(&port->write_fifo);
  691. spin_unlock_irqrestore(&port->lock, flags);
  692. spin_lock_irqsave(&priv->lock, flags);
  693. if (priv->flags.write_urb_in_use == 0 && count != 0) {
  694. schedule_delayed_work(&priv->delayed_write_work, 0);
  695. resubmit = 0;
  696. }
  697. spin_unlock_irqrestore(&priv->lock, flags);
  698. }
  699. if (resubmit) {
  700. int result;
  701. /* dev_dbg(&urb->dev->dev, "%s(): submitting interrupt urb\n", __func__); */
  702. result = usb_submit_urb(urb, GFP_ATOMIC);
  703. if (result != 0) {
  704. dev_err(&urb->dev->dev,
  705. "%s(): usb_submit_urb() failed with"
  706. " error %d\n", __func__, result);
  707. }
  708. }
  709. }
  710. static void oti6858_read_bulk_callback(struct urb *urb)
  711. {
  712. struct usb_serial_port *port = urb->context;
  713. struct oti6858_private *priv = usb_get_serial_port_data(port);
  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. if (urb->actual_length > 0) {
  726. tty_insert_flip_string(&port->port, data, urb->actual_length);
  727. tty_flip_buffer_push(&port->port);
  728. }
  729. /* schedule the interrupt urb */
  730. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  731. if (result != 0 && result != -EPERM) {
  732. dev_err(&port->dev, "%s(): usb_submit_urb() failed,"
  733. " error %d\n", __func__, result);
  734. }
  735. }
  736. static void oti6858_write_bulk_callback(struct urb *urb)
  737. {
  738. struct usb_serial_port *port = urb->context;
  739. struct oti6858_private *priv = usb_get_serial_port_data(port);
  740. int status = urb->status;
  741. int result;
  742. switch (status) {
  743. case 0:
  744. /* success */
  745. break;
  746. case -ECONNRESET:
  747. case -ENOENT:
  748. case -ESHUTDOWN:
  749. /* this urb is terminated, clean up */
  750. dev_dbg(&urb->dev->dev, "%s(): urb shutting down with status: %d\n", __func__, status);
  751. priv->flags.write_urb_in_use = 0;
  752. return;
  753. default:
  754. /* error in the urb, so we have to resubmit it */
  755. dev_dbg(&urb->dev->dev, "%s(): nonzero write bulk status received: %d\n", __func__, status);
  756. dev_dbg(&urb->dev->dev, "%s(): overflow in write\n", __func__);
  757. port->write_urb->transfer_buffer_length = 1;
  758. result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
  759. if (result) {
  760. dev_err_console(port, "%s(): usb_submit_urb() failed,"
  761. " error %d\n", __func__, result);
  762. } else {
  763. return;
  764. }
  765. }
  766. priv->flags.write_urb_in_use = 0;
  767. /* schedule the interrupt urb if we are still open */
  768. dev_dbg(&port->dev, "%s(): submitting interrupt urb\n", __func__);
  769. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  770. if (result != 0) {
  771. dev_err(&port->dev, "%s(): failed submitting int urb,"
  772. " error %d\n", __func__, result);
  773. }
  774. }
  775. module_usb_serial_driver(serial_drivers, id_table);
  776. MODULE_DESCRIPTION(OTI6858_DESCRIPTION);
  777. MODULE_AUTHOR(OTI6858_AUTHOR);
  778. MODULE_LICENSE("GPL");