kobil_sct.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661
  1. /*
  2. * KOBIL USB Smart Card Terminal Driver
  3. *
  4. * Copyright (C) 2002 KOBIL Systems GmbH
  5. * Author: Thomas Wahrenbruch
  6. *
  7. * Contact: linuxusb@kobil.de
  8. *
  9. * This program is largely derived from work by the linux-usb group
  10. * and associated source files. Please see the usb/serial files for
  11. * individual credits and copyrights.
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License as published by
  15. * the Free Software Foundation; either version 2 of the License, or
  16. * (at your option) any later version.
  17. *
  18. * Thanks to Greg Kroah-Hartman (greg@kroah.com) for his help and
  19. * patience.
  20. *
  21. * Supported readers: USB TWIN, KAAN Standard Plus and SecOVID Reader Plus
  22. * (Adapter K), B1 Professional and KAAN Professional (Adapter B)
  23. */
  24. #include <linux/kernel.h>
  25. #include <linux/errno.h>
  26. #include <linux/init.h>
  27. #include <linux/slab.h>
  28. #include <linux/tty.h>
  29. #include <linux/tty_driver.h>
  30. #include <linux/tty_flip.h>
  31. #include <linux/module.h>
  32. #include <linux/spinlock.h>
  33. #include <linux/uaccess.h>
  34. #include <linux/usb.h>
  35. #include <linux/usb/serial.h>
  36. #include <linux/ioctl.h>
  37. #include "kobil_sct.h"
  38. /* Version Information */
  39. #define DRIVER_VERSION "21/05/2004"
  40. #define DRIVER_AUTHOR "KOBIL Systems GmbH - http://www.kobil.com"
  41. #define DRIVER_DESC "KOBIL USB Smart Card Terminal Driver (experimental)"
  42. #define KOBIL_VENDOR_ID 0x0D46
  43. #define KOBIL_ADAPTER_B_PRODUCT_ID 0x2011
  44. #define KOBIL_ADAPTER_K_PRODUCT_ID 0x2012
  45. #define KOBIL_USBTWIN_PRODUCT_ID 0x0078
  46. #define KOBIL_KAAN_SIM_PRODUCT_ID 0x0081
  47. #define KOBIL_TIMEOUT 500
  48. #define KOBIL_BUF_LENGTH 300
  49. /* Function prototypes */
  50. static int kobil_port_probe(struct usb_serial_port *probe);
  51. static int kobil_port_remove(struct usb_serial_port *probe);
  52. static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port);
  53. static void kobil_close(struct usb_serial_port *port);
  54. static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
  55. const unsigned char *buf, int count);
  56. static int kobil_write_room(struct tty_struct *tty);
  57. static int kobil_ioctl(struct tty_struct *tty,
  58. unsigned int cmd, unsigned long arg);
  59. static int kobil_tiocmget(struct tty_struct *tty);
  60. static int kobil_tiocmset(struct tty_struct *tty,
  61. unsigned int set, unsigned int clear);
  62. static void kobil_read_int_callback(struct urb *urb);
  63. static void kobil_write_callback(struct urb *purb);
  64. static void kobil_set_termios(struct tty_struct *tty,
  65. struct usb_serial_port *port, struct ktermios *old);
  66. static void kobil_init_termios(struct tty_struct *tty);
  67. static const struct usb_device_id id_table[] = {
  68. { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_B_PRODUCT_ID) },
  69. { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_K_PRODUCT_ID) },
  70. { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_USBTWIN_PRODUCT_ID) },
  71. { USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_KAAN_SIM_PRODUCT_ID) },
  72. { } /* Terminating entry */
  73. };
  74. MODULE_DEVICE_TABLE(usb, id_table);
  75. static struct usb_serial_driver kobil_device = {
  76. .driver = {
  77. .owner = THIS_MODULE,
  78. .name = "kobil",
  79. },
  80. .description = "KOBIL USB smart card terminal",
  81. .id_table = id_table,
  82. .num_ports = 1,
  83. .port_probe = kobil_port_probe,
  84. .port_remove = kobil_port_remove,
  85. .ioctl = kobil_ioctl,
  86. .set_termios = kobil_set_termios,
  87. .init_termios = kobil_init_termios,
  88. .tiocmget = kobil_tiocmget,
  89. .tiocmset = kobil_tiocmset,
  90. .open = kobil_open,
  91. .close = kobil_close,
  92. .write = kobil_write,
  93. .write_room = kobil_write_room,
  94. .read_int_callback = kobil_read_int_callback,
  95. };
  96. static struct usb_serial_driver * const serial_drivers[] = {
  97. &kobil_device, NULL
  98. };
  99. struct kobil_private {
  100. int write_int_endpoint_address;
  101. int read_int_endpoint_address;
  102. unsigned char buf[KOBIL_BUF_LENGTH]; /* buffer for the APDU to send */
  103. int filled; /* index of the last char in buf */
  104. int cur_pos; /* index of the next char to send in buf */
  105. __u16 device_type;
  106. };
  107. static int kobil_port_probe(struct usb_serial_port *port)
  108. {
  109. int i;
  110. struct usb_serial *serial = port->serial;
  111. struct kobil_private *priv;
  112. struct usb_device *pdev;
  113. struct usb_host_config *actconfig;
  114. struct usb_interface *interface;
  115. struct usb_host_interface *altsetting;
  116. struct usb_host_endpoint *endpoint;
  117. priv = kmalloc(sizeof(struct kobil_private), GFP_KERNEL);
  118. if (!priv)
  119. return -ENOMEM;
  120. priv->filled = 0;
  121. priv->cur_pos = 0;
  122. priv->device_type = le16_to_cpu(serial->dev->descriptor.idProduct);
  123. switch (priv->device_type) {
  124. case KOBIL_ADAPTER_B_PRODUCT_ID:
  125. dev_dbg(&serial->dev->dev, "KOBIL B1 PRO / KAAN PRO detected\n");
  126. break;
  127. case KOBIL_ADAPTER_K_PRODUCT_ID:
  128. dev_dbg(&serial->dev->dev, "KOBIL KAAN Standard Plus / SecOVID Reader Plus detected\n");
  129. break;
  130. case KOBIL_USBTWIN_PRODUCT_ID:
  131. dev_dbg(&serial->dev->dev, "KOBIL USBTWIN detected\n");
  132. break;
  133. case KOBIL_KAAN_SIM_PRODUCT_ID:
  134. dev_dbg(&serial->dev->dev, "KOBIL KAAN SIM detected\n");
  135. break;
  136. }
  137. usb_set_serial_port_data(port, priv);
  138. /* search for the necessary endpoints */
  139. pdev = serial->dev;
  140. actconfig = pdev->actconfig;
  141. interface = actconfig->interface[0];
  142. altsetting = interface->cur_altsetting;
  143. endpoint = altsetting->endpoint;
  144. for (i = 0; i < altsetting->desc.bNumEndpoints; i++) {
  145. endpoint = &altsetting->endpoint[i];
  146. if (usb_endpoint_is_int_out(&endpoint->desc)) {
  147. dev_dbg(&serial->dev->dev,
  148. "%s Found interrupt out endpoint. Address: %d\n",
  149. __func__, endpoint->desc.bEndpointAddress);
  150. priv->write_int_endpoint_address =
  151. endpoint->desc.bEndpointAddress;
  152. }
  153. if (usb_endpoint_is_int_in(&endpoint->desc)) {
  154. dev_dbg(&serial->dev->dev,
  155. "%s Found interrupt in endpoint. Address: %d\n",
  156. __func__, endpoint->desc.bEndpointAddress);
  157. priv->read_int_endpoint_address =
  158. endpoint->desc.bEndpointAddress;
  159. }
  160. }
  161. return 0;
  162. }
  163. static int kobil_port_remove(struct usb_serial_port *port)
  164. {
  165. struct kobil_private *priv;
  166. priv = usb_get_serial_port_data(port);
  167. kfree(priv);
  168. return 0;
  169. }
  170. static void kobil_init_termios(struct tty_struct *tty)
  171. {
  172. /* Default to echo off and other sane device settings */
  173. tty->termios.c_lflag = 0;
  174. tty->termios.c_iflag &= ~(ISIG | ICANON | ECHO | IEXTEN | XCASE);
  175. tty->termios.c_iflag |= IGNBRK | IGNPAR | IXOFF;
  176. /* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */
  177. tty->termios.c_oflag &= ~ONLCR;
  178. }
  179. static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port)
  180. {
  181. struct device *dev = &port->dev;
  182. int result = 0;
  183. struct kobil_private *priv;
  184. unsigned char *transfer_buffer;
  185. int transfer_buffer_length = 8;
  186. int write_urb_transfer_buffer_length = 8;
  187. priv = usb_get_serial_port_data(port);
  188. /* allocate memory for transfer buffer */
  189. transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
  190. if (!transfer_buffer)
  191. return -ENOMEM;
  192. /* allocate write_urb */
  193. if (!port->write_urb) {
  194. dev_dbg(dev, "%s - Allocating port->write_urb\n", __func__);
  195. port->write_urb = usb_alloc_urb(0, GFP_KERNEL);
  196. if (!port->write_urb) {
  197. dev_dbg(dev, "%s - usb_alloc_urb failed\n", __func__);
  198. kfree(transfer_buffer);
  199. return -ENOMEM;
  200. }
  201. }
  202. /* allocate memory for write_urb transfer buffer */
  203. port->write_urb->transfer_buffer =
  204. kmalloc(write_urb_transfer_buffer_length, GFP_KERNEL);
  205. if (!port->write_urb->transfer_buffer) {
  206. kfree(transfer_buffer);
  207. usb_free_urb(port->write_urb);
  208. port->write_urb = NULL;
  209. return -ENOMEM;
  210. }
  211. /* get hardware version */
  212. result = usb_control_msg(port->serial->dev,
  213. usb_rcvctrlpipe(port->serial->dev, 0),
  214. SUSBCRequest_GetMisc,
  215. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
  216. SUSBCR_MSC_GetHWVersion,
  217. 0,
  218. transfer_buffer,
  219. transfer_buffer_length,
  220. KOBIL_TIMEOUT
  221. );
  222. dev_dbg(dev, "%s - Send get_HW_version URB returns: %i\n", __func__, result);
  223. dev_dbg(dev, "Harware version: %i.%i.%i\n", transfer_buffer[0],
  224. transfer_buffer[1], transfer_buffer[2]);
  225. /* get firmware version */
  226. result = usb_control_msg(port->serial->dev,
  227. usb_rcvctrlpipe(port->serial->dev, 0),
  228. SUSBCRequest_GetMisc,
  229. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
  230. SUSBCR_MSC_GetFWVersion,
  231. 0,
  232. transfer_buffer,
  233. transfer_buffer_length,
  234. KOBIL_TIMEOUT
  235. );
  236. dev_dbg(dev, "%s - Send get_FW_version URB returns: %i\n", __func__, result);
  237. dev_dbg(dev, "Firmware version: %i.%i.%i\n", transfer_buffer[0],
  238. transfer_buffer[1], transfer_buffer[2]);
  239. if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
  240. priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
  241. /* Setting Baudrate, Parity and Stopbits */
  242. result = usb_control_msg(port->serial->dev,
  243. usb_rcvctrlpipe(port->serial->dev, 0),
  244. SUSBCRequest_SetBaudRateParityAndStopBits,
  245. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  246. SUSBCR_SBR_9600 | SUSBCR_SPASB_EvenParity |
  247. SUSBCR_SPASB_1StopBit,
  248. 0,
  249. transfer_buffer,
  250. 0,
  251. KOBIL_TIMEOUT
  252. );
  253. dev_dbg(dev, "%s - Send set_baudrate URB returns: %i\n", __func__, result);
  254. /* reset all queues */
  255. result = usb_control_msg(port->serial->dev,
  256. usb_rcvctrlpipe(port->serial->dev, 0),
  257. SUSBCRequest_Misc,
  258. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  259. SUSBCR_MSC_ResetAllQueues,
  260. 0,
  261. transfer_buffer,
  262. 0,
  263. KOBIL_TIMEOUT
  264. );
  265. dev_dbg(dev, "%s - Send reset_all_queues URB returns: %i\n", __func__, result);
  266. }
  267. if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
  268. priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
  269. priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
  270. /* start reading (Adapter B 'cause PNP string) */
  271. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  272. dev_dbg(dev, "%s - Send read URB returns: %i\n", __func__, result);
  273. }
  274. kfree(transfer_buffer);
  275. return 0;
  276. }
  277. static void kobil_close(struct usb_serial_port *port)
  278. {
  279. /* FIXME: Add rts/dtr methods */
  280. if (port->write_urb) {
  281. usb_poison_urb(port->write_urb);
  282. kfree(port->write_urb->transfer_buffer);
  283. usb_free_urb(port->write_urb);
  284. port->write_urb = NULL;
  285. }
  286. usb_kill_urb(port->interrupt_in_urb);
  287. }
  288. static void kobil_read_int_callback(struct urb *urb)
  289. {
  290. int result;
  291. struct usb_serial_port *port = urb->context;
  292. struct tty_struct *tty;
  293. unsigned char *data = urb->transfer_buffer;
  294. int status = urb->status;
  295. if (status) {
  296. dev_dbg(&port->dev, "%s - Read int status not zero: %d\n", __func__, status);
  297. return;
  298. }
  299. tty = tty_port_tty_get(&port->port);
  300. if (tty && urb->actual_length) {
  301. /* BEGIN DEBUG */
  302. /*
  303. char *dbg_data;
  304. dbg_data = kzalloc((3 * purb->actual_length + 10)
  305. * sizeof(char), GFP_KERNEL);
  306. if (! dbg_data) {
  307. return;
  308. }
  309. for (i = 0; i < purb->actual_length; i++) {
  310. sprintf(dbg_data +3*i, "%02X ", data[i]);
  311. }
  312. dev_dbg(&port->dev, " <-- %s\n", dbg_data);
  313. kfree(dbg_data);
  314. */
  315. /* END DEBUG */
  316. tty_insert_flip_string(tty, data, urb->actual_length);
  317. tty_flip_buffer_push(tty);
  318. }
  319. tty_kref_put(tty);
  320. result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
  321. dev_dbg(&port->dev, "%s - Send read URB returns: %i\n", __func__, result);
  322. }
  323. static void kobil_write_callback(struct urb *purb)
  324. {
  325. }
  326. static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
  327. const unsigned char *buf, int count)
  328. {
  329. int length = 0;
  330. int result = 0;
  331. int todo = 0;
  332. struct kobil_private *priv;
  333. if (count == 0) {
  334. dev_dbg(&port->dev, "%s - write request of 0 bytes\n", __func__);
  335. return 0;
  336. }
  337. priv = usb_get_serial_port_data(port);
  338. if (count > (KOBIL_BUF_LENGTH - priv->filled)) {
  339. dev_dbg(&port->dev, "%s - Error: write request bigger than buffer size\n", __func__);
  340. return -ENOMEM;
  341. }
  342. /* Copy data to buffer */
  343. memcpy(priv->buf + priv->filled, buf, count);
  344. usb_serial_debug_data(&port->dev, __func__, count, priv->buf + priv->filled);
  345. priv->filled = priv->filled + count;
  346. /* only send complete block. TWIN, KAAN SIM and adapter K
  347. use the same protocol. */
  348. if (((priv->device_type != KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 2) && (priv->filled >= (priv->buf[1] + 3))) ||
  349. ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 3) && (priv->filled >= (priv->buf[2] + 4)))) {
  350. /* stop reading (except TWIN and KAAN SIM) */
  351. if ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID)
  352. || (priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID))
  353. usb_kill_urb(port->interrupt_in_urb);
  354. todo = priv->filled - priv->cur_pos;
  355. while (todo > 0) {
  356. /* max 8 byte in one urb (endpoint size) */
  357. length = (todo < 8) ? todo : 8;
  358. /* copy data to transfer buffer */
  359. memcpy(port->write_urb->transfer_buffer,
  360. priv->buf + priv->cur_pos, length);
  361. usb_fill_int_urb(port->write_urb,
  362. port->serial->dev,
  363. usb_sndintpipe(port->serial->dev,
  364. priv->write_int_endpoint_address),
  365. port->write_urb->transfer_buffer,
  366. length,
  367. kobil_write_callback,
  368. port,
  369. 8
  370. );
  371. priv->cur_pos = priv->cur_pos + length;
  372. result = usb_submit_urb(port->write_urb, GFP_NOIO);
  373. dev_dbg(&port->dev, "%s - Send write URB returns: %i\n", __func__, result);
  374. todo = priv->filled - priv->cur_pos;
  375. if (todo > 0)
  376. msleep(24);
  377. }
  378. priv->filled = 0;
  379. priv->cur_pos = 0;
  380. /* start reading (except TWIN and KAAN SIM) */
  381. if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
  382. priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
  383. result = usb_submit_urb(port->interrupt_in_urb,
  384. GFP_NOIO);
  385. dev_dbg(&port->dev, "%s - Send read URB returns: %i\n", __func__, result);
  386. }
  387. }
  388. return count;
  389. }
  390. static int kobil_write_room(struct tty_struct *tty)
  391. {
  392. /* FIXME */
  393. return 8;
  394. }
  395. static int kobil_tiocmget(struct tty_struct *tty)
  396. {
  397. struct usb_serial_port *port = tty->driver_data;
  398. struct kobil_private *priv;
  399. int result;
  400. unsigned char *transfer_buffer;
  401. int transfer_buffer_length = 8;
  402. priv = usb_get_serial_port_data(port);
  403. if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
  404. || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
  405. /* This device doesn't support ioctl calls */
  406. return -EINVAL;
  407. }
  408. /* allocate memory for transfer buffer */
  409. transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
  410. if (!transfer_buffer)
  411. return -ENOMEM;
  412. result = usb_control_msg(port->serial->dev,
  413. usb_rcvctrlpipe(port->serial->dev, 0),
  414. SUSBCRequest_GetStatusLineState,
  415. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
  416. 0,
  417. 0,
  418. transfer_buffer,
  419. transfer_buffer_length,
  420. KOBIL_TIMEOUT);
  421. dev_dbg(&port->dev, "%s - Send get_status_line_state URB returns: %i. Statusline: %02x\n",
  422. __func__, result, transfer_buffer[0]);
  423. result = 0;
  424. if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0)
  425. result = TIOCM_DSR;
  426. kfree(transfer_buffer);
  427. return result;
  428. }
  429. static int kobil_tiocmset(struct tty_struct *tty,
  430. unsigned int set, unsigned int clear)
  431. {
  432. struct usb_serial_port *port = tty->driver_data;
  433. struct device *dev = &port->dev;
  434. struct kobil_private *priv;
  435. int result;
  436. int dtr = 0;
  437. int rts = 0;
  438. unsigned char *transfer_buffer;
  439. int transfer_buffer_length = 8;
  440. /* FIXME: locking ? */
  441. priv = usb_get_serial_port_data(port);
  442. if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
  443. || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
  444. /* This device doesn't support ioctl calls */
  445. return -EINVAL;
  446. }
  447. /* allocate memory for transfer buffer */
  448. transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
  449. if (!transfer_buffer)
  450. return -ENOMEM;
  451. if (set & TIOCM_RTS)
  452. rts = 1;
  453. if (set & TIOCM_DTR)
  454. dtr = 1;
  455. if (clear & TIOCM_RTS)
  456. rts = 0;
  457. if (clear & TIOCM_DTR)
  458. dtr = 0;
  459. if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) {
  460. if (dtr != 0)
  461. dev_dbg(dev, "%s - Setting DTR\n", __func__);
  462. else
  463. dev_dbg(dev, "%s - Clearing DTR\n", __func__);
  464. result = usb_control_msg(port->serial->dev,
  465. usb_rcvctrlpipe(port->serial->dev, 0),
  466. SUSBCRequest_SetStatusLinesOrQueues,
  467. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  468. ((dtr != 0) ? SUSBCR_SSL_SETDTR : SUSBCR_SSL_CLRDTR),
  469. 0,
  470. transfer_buffer,
  471. 0,
  472. KOBIL_TIMEOUT);
  473. } else {
  474. if (rts != 0)
  475. dev_dbg(dev, "%s - Setting RTS\n", __func__);
  476. else
  477. dev_dbg(dev, "%s - Clearing RTS\n", __func__);
  478. result = usb_control_msg(port->serial->dev,
  479. usb_rcvctrlpipe(port->serial->dev, 0),
  480. SUSBCRequest_SetStatusLinesOrQueues,
  481. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  482. ((rts != 0) ? SUSBCR_SSL_SETRTS : SUSBCR_SSL_CLRRTS),
  483. 0,
  484. transfer_buffer,
  485. 0,
  486. KOBIL_TIMEOUT);
  487. }
  488. dev_dbg(dev, "%s - Send set_status_line URB returns: %i\n", __func__, result);
  489. kfree(transfer_buffer);
  490. return (result < 0) ? result : 0;
  491. }
  492. static void kobil_set_termios(struct tty_struct *tty,
  493. struct usb_serial_port *port, struct ktermios *old)
  494. {
  495. struct kobil_private *priv;
  496. int result;
  497. unsigned short urb_val = 0;
  498. int c_cflag = tty->termios.c_cflag;
  499. speed_t speed;
  500. priv = usb_get_serial_port_data(port);
  501. if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
  502. priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
  503. /* This device doesn't support ioctl calls */
  504. tty_termios_copy_hw(&tty->termios, old);
  505. return;
  506. }
  507. speed = tty_get_baud_rate(tty);
  508. switch (speed) {
  509. case 1200:
  510. urb_val = SUSBCR_SBR_1200;
  511. break;
  512. default:
  513. speed = 9600;
  514. case 9600:
  515. urb_val = SUSBCR_SBR_9600;
  516. break;
  517. }
  518. urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits :
  519. SUSBCR_SPASB_1StopBit;
  520. if (c_cflag & PARENB) {
  521. if (c_cflag & PARODD)
  522. urb_val |= SUSBCR_SPASB_OddParity;
  523. else
  524. urb_val |= SUSBCR_SPASB_EvenParity;
  525. } else
  526. urb_val |= SUSBCR_SPASB_NoParity;
  527. tty->termios.c_cflag &= ~CMSPAR;
  528. tty_encode_baud_rate(tty, speed, speed);
  529. result = usb_control_msg(port->serial->dev,
  530. usb_rcvctrlpipe(port->serial->dev, 0),
  531. SUSBCRequest_SetBaudRateParityAndStopBits,
  532. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  533. urb_val,
  534. 0,
  535. NULL,
  536. 0,
  537. KOBIL_TIMEOUT
  538. );
  539. }
  540. static int kobil_ioctl(struct tty_struct *tty,
  541. unsigned int cmd, unsigned long arg)
  542. {
  543. struct usb_serial_port *port = tty->driver_data;
  544. struct kobil_private *priv = usb_get_serial_port_data(port);
  545. unsigned char *transfer_buffer;
  546. int transfer_buffer_length = 8;
  547. int result;
  548. if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
  549. priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID)
  550. /* This device doesn't support ioctl calls */
  551. return -ENOIOCTLCMD;
  552. switch (cmd) {
  553. case TCFLSH:
  554. transfer_buffer = kmalloc(transfer_buffer_length, GFP_KERNEL);
  555. if (!transfer_buffer)
  556. return -ENOBUFS;
  557. result = usb_control_msg(port->serial->dev,
  558. usb_rcvctrlpipe(port->serial->dev, 0),
  559. SUSBCRequest_Misc,
  560. USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
  561. SUSBCR_MSC_ResetAllQueues,
  562. 0,
  563. NULL, /* transfer_buffer, */
  564. 0,
  565. KOBIL_TIMEOUT
  566. );
  567. dev_dbg(&port->dev,
  568. "%s - Send reset_all_queues (FLUSH) URB returns: %i", __func__, result);
  569. kfree(transfer_buffer);
  570. return (result < 0) ? -EIO: 0;
  571. default:
  572. return -ENOIOCTLCMD;
  573. }
  574. }
  575. module_usb_serial_driver(serial_drivers, id_table);
  576. MODULE_AUTHOR(DRIVER_AUTHOR);
  577. MODULE_DESCRIPTION(DRIVER_DESC);
  578. MODULE_LICENSE("GPL");