kobil_sct.c 21 KB

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