kobil_sct.c 21 KB

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