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