Linux Audio

Check our new training course

Linux BSP upgrade and security maintenance

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