kobil_sct.c 20 KB

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