kobil_sct.c 20.5 KB
Newer Older
Linus Torvalds's avatar
Linus Torvalds committed
1 2 3
/*
 *  KOBIL USB Smart Card Terminal Driver
 *
Alan Cox's avatar
Alan Cox committed
4
 *  Copyright (C) 2002  KOBIL Systems GmbH
Linus Torvalds's avatar
Linus Torvalds committed
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22
 *  Author: Thomas Wahrenbruch
 *
 *  Contact: linuxusb@kobil.de
 *
 *  This program is largely derived from work by the linux-usb group
 *  and associated source files.  Please see the usb/serial files for
 *  individual credits and copyrights.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; either version 2 of the License, or
 *  (at your option) any later version.
 *
 *  Thanks to Greg Kroah-Hartman (greg@kroah.com) for his help and
 *  patience.
 *
 * Supported readers: USB TWIN, KAAN Standard Plus and SecOVID Reader Plus
 * (Adapter K), B1 Professional and KAAN Professional (Adapter B)
Alan Cox's avatar
Alan Cox committed
23
 *
Linus Torvalds's avatar
Linus Torvalds committed
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46
 * (21/05/2004) tw
 *      Fix bug with P'n'P readers
 *
 * (28/05/2003) tw
 *      Add support for KAAN SIM
 *
 * (12/09/2002) tw
 *      Adapted to 2.5.
 *
 * (11/08/2002) tw
 *      Initial version.
 */


#include <linux/kernel.h>
#include <linux/errno.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/tty.h>
#include <linux/tty_driver.h>
#include <linux/tty_flip.h>
#include <linux/module.h>
#include <linux/spinlock.h>
Alan Cox's avatar
Alan Cox committed
47
#include <linux/uaccess.h>
Linus Torvalds's avatar
Linus Torvalds committed
48
#include <linux/usb.h>
49
#include <linux/usb/serial.h>
Linus Torvalds's avatar
Linus Torvalds committed
50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70
#include <linux/ioctl.h>
#include "kobil_sct.h"

static int debug;

/* Version Information */
#define DRIVER_VERSION "21/05/2004"
#define DRIVER_AUTHOR "KOBIL Systems GmbH - http://www.kobil.com"
#define DRIVER_DESC "KOBIL USB Smart Card Terminal Driver (experimental)"

#define KOBIL_VENDOR_ID			0x0D46
#define KOBIL_ADAPTER_B_PRODUCT_ID	0x2011
#define KOBIL_ADAPTER_K_PRODUCT_ID	0x2012
#define KOBIL_USBTWIN_PRODUCT_ID	0x0078
#define KOBIL_KAAN_SIM_PRODUCT_ID       0x0081

#define KOBIL_TIMEOUT		500
#define KOBIL_BUF_LENGTH	300


/* Function prototypes */
Alan Cox's avatar
Alan Cox committed
71
static int  kobil_startup(struct usb_serial *serial);
72
static void kobil_release(struct usb_serial *serial);
73
static int  kobil_open(struct tty_struct *tty, struct usb_serial_port *port);
74
static void kobil_close(struct usb_serial_port *port);
Alan Cox's avatar
Alan Cox committed
75
static int  kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
Linus Torvalds's avatar
Linus Torvalds committed
76
			 const unsigned char *buf, int count);
Alan Cox's avatar
Alan Cox committed
77 78
static int  kobil_write_room(struct tty_struct *tty);
static int  kobil_ioctl(struct tty_struct *tty, struct file *file,
Linus Torvalds's avatar
Linus Torvalds committed
79
			unsigned int cmd, unsigned long arg);
Alan Cox's avatar
Alan Cox committed
80 81
static int  kobil_tiocmget(struct tty_struct *tty, struct file *file);
static int  kobil_tiocmset(struct tty_struct *tty, struct file *file,
Linus Torvalds's avatar
Linus Torvalds committed
82
			   unsigned int set, unsigned int clear);
Alan Cox's avatar
Alan Cox committed
83 84 85
static void kobil_read_int_callback(struct urb *urb);
static void kobil_write_callback(struct urb *purb);
static void kobil_set_termios(struct tty_struct *tty,
Alan Cox's avatar
Alan Cox committed
86
			struct usb_serial_port *port, struct ktermios *old);
Linus Torvalds's avatar
Linus Torvalds committed
87 88 89 90 91 92 93 94 95 96 97


static struct usb_device_id id_table [] = {
	{ USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_B_PRODUCT_ID) },
	{ USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_ADAPTER_K_PRODUCT_ID) },
	{ USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_USBTWIN_PRODUCT_ID) },
	{ USB_DEVICE(KOBIL_VENDOR_ID, KOBIL_KAAN_SIM_PRODUCT_ID) },
	{ }			/* Terminating entry */
};


Alan Cox's avatar
Alan Cox committed
98
MODULE_DEVICE_TABLE(usb, id_table);
Linus Torvalds's avatar
Linus Torvalds committed
99 100 101 102 103 104

static struct usb_driver kobil_driver = {
	.name =		"kobil",
	.probe =	usb_serial_probe,
	.disconnect =	usb_serial_disconnect,
	.id_table =	id_table,
105
	.no_dynamic_id = 	1,
Linus Torvalds's avatar
Linus Torvalds committed
106 107 108
};


109
static struct usb_serial_driver kobil_device = {
110 111
	.driver = {
		.owner =	THIS_MODULE,
112
		.name =		"kobil",
113
	},
114
	.description =		"KOBIL USB smart card terminal",
115
	.usb_driver = 		&kobil_driver,
Linus Torvalds's avatar
Linus Torvalds committed
116 117 118
	.id_table =		id_table,
	.num_ports =		1,
	.attach =		kobil_startup,
119
	.release =		kobil_release,
Linus Torvalds's avatar
Linus Torvalds committed
120
	.ioctl =		kobil_ioctl,
Alan Cox's avatar
Alan Cox committed
121
	.set_termios =		kobil_set_termios,
Linus Torvalds's avatar
Linus Torvalds committed
122 123 124 125 126 127 128 129 130 131 132 133 134
	.tiocmget =		kobil_tiocmget,
	.tiocmset =		kobil_tiocmset,
	.open =			kobil_open,
	.close =		kobil_close,
	.write =		kobil_write,
	.write_room =		kobil_write_room,
	.read_int_callback =	kobil_read_int_callback,
};


struct kobil_private {
	int write_int_endpoint_address;
	int read_int_endpoint_address;
Alan Cox's avatar
Alan Cox committed
135 136 137
	unsigned char buf[KOBIL_BUF_LENGTH]; /* buffer for the APDU to send */
	int filled;  /* index of the last char in buf */
	int cur_pos; /* index of the next char to send in buf */
Linus Torvalds's avatar
Linus Torvalds committed
138 139 140 141
	__u16 device_type;
};


Alan Cox's avatar
Alan Cox committed
142
static int kobil_startup(struct usb_serial *serial)
Linus Torvalds's avatar
Linus Torvalds committed
143 144 145 146 147 148 149 150 151 152
{
	int i;
	struct kobil_private *priv;
	struct usb_device *pdev;
	struct usb_host_config *actconfig;
	struct usb_interface *interface;
	struct usb_host_interface *altsetting;
	struct usb_host_endpoint *endpoint;

	priv = kmalloc(sizeof(struct kobil_private), GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
153
	if (!priv)
Linus Torvalds's avatar
Linus Torvalds committed
154 155 156 157 158 159
		return -ENOMEM;

	priv->filled = 0;
	priv->cur_pos = 0;
	priv->device_type = le16_to_cpu(serial->dev->descriptor.idProduct);

Alan Cox's avatar
Alan Cox committed
160
	switch (priv->device_type) {
Linus Torvalds's avatar
Linus Torvalds committed
161 162 163 164
	case KOBIL_ADAPTER_B_PRODUCT_ID:
		printk(KERN_DEBUG "KOBIL B1 PRO / KAAN PRO detected\n");
		break;
	case KOBIL_ADAPTER_K_PRODUCT_ID:
Alan Cox's avatar
Alan Cox committed
165 166
		printk(KERN_DEBUG
		  "KOBIL KAAN Standard Plus / SecOVID Reader Plus detected\n");
Linus Torvalds's avatar
Linus Torvalds committed
167 168 169 170 171 172 173 174 175 176
		break;
	case KOBIL_USBTWIN_PRODUCT_ID:
		printk(KERN_DEBUG "KOBIL USBTWIN detected\n");
		break;
	case KOBIL_KAAN_SIM_PRODUCT_ID:
		printk(KERN_DEBUG "KOBIL KAAN SIM detected\n");
		break;
	}
	usb_set_serial_port_data(serial->port[0], priv);

Alan Cox's avatar
Alan Cox committed
177
	/* search for the necessary endpoints */
Linus Torvalds's avatar
Linus Torvalds committed
178
	pdev = serial->dev;
Alan Cox's avatar
Alan Cox committed
179 180
	actconfig = pdev->actconfig;
	interface = actconfig->interface[0];
Linus Torvalds's avatar
Linus Torvalds committed
181
	altsetting = interface->cur_altsetting;
Alan Cox's avatar
Alan Cox committed
182 183 184
	endpoint = altsetting->endpoint;

	for (i = 0; i < altsetting->desc.bNumEndpoints; i++) {
Linus Torvalds's avatar
Linus Torvalds committed
185
		endpoint = &altsetting->endpoint[i];
186
		if (usb_endpoint_is_int_out(&endpoint->desc)) {
Alan Cox's avatar
Alan Cox committed
187 188 189 190 191
			dbg("%s Found interrupt out endpoint. Address: %d",
				__func__, endpoint->desc.bEndpointAddress);
			priv->write_int_endpoint_address =
				endpoint->desc.bEndpointAddress;
		}
192
		if (usb_endpoint_is_int_in(&endpoint->desc)) {
Alan Cox's avatar
Alan Cox committed
193 194 195 196 197
			dbg("%s Found interrupt in  endpoint. Address: %d",
				__func__, endpoint->desc.bEndpointAddress);
			priv->read_int_endpoint_address =
				endpoint->desc.bEndpointAddress;
		}
Linus Torvalds's avatar
Linus Torvalds committed
198 199 200 201 202
	}
	return 0;
}


203
static void kobil_release(struct usb_serial *serial)
Linus Torvalds's avatar
Linus Torvalds committed
204 205
{
	int i;
206
	dbg("%s - port %d", __func__, serial->port[0]->number);
Linus Torvalds's avatar
Linus Torvalds committed
207

208
	for (i = 0; i < serial->num_ports; ++i)
Linus Torvalds's avatar
Linus Torvalds committed
209 210 211 212
		kfree(usb_get_serial_port_data(serial->port[i]));
}


213
static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
214
{
Alan Cox's avatar
Alan Cox committed
215
	int result = 0;
Linus Torvalds's avatar
Linus Torvalds committed
216 217 218 219 220
	struct kobil_private *priv;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;
	int write_urb_transfer_buffer_length = 8;

221
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
222 223
	priv = usb_get_serial_port_data(port);

Alan Cox's avatar
Alan Cox committed
224
	/* someone sets the dev to 0 if the close method has been called */
Linus Torvalds's avatar
Linus Torvalds committed
225 226
	port->interrupt_in_urb->dev = port->serial->dev;

Alan Cox's avatar
Alan Cox committed
227 228 229 230
	if (tty) {

		/* Default to echo off and other sane device settings */
		tty->termios->c_lflag = 0;
Alan Cox's avatar
Alan Cox committed
231 232
		tty->termios->c_lflag &= ~(ISIG | ICANON | ECHO | IEXTEN |
								 XCASE);
Alan Cox's avatar
Alan Cox committed
233
		tty->termios->c_iflag = IGNBRK | IGNPAR | IXOFF;
Alan Cox's avatar
Alan Cox committed
234 235 236 237
		/* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */
		tty->termios->c_oflag &= ~ONLCR;
	}
	/* allocate memory for transfer buffer */
238
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
239
	if (!transfer_buffer)
Linus Torvalds's avatar
Linus Torvalds committed
240
		return -ENOMEM;
Alan Cox's avatar
Alan Cox committed
241 242 243 244 245 246

	/* allocate write_urb */
	if (!port->write_urb) {
		dbg("%s - port %d  Allocating port->write_urb",
						__func__, port->number);
		port->write_urb = usb_alloc_urb(0, GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
247
		if (!port->write_urb) {
Alan Cox's avatar
Alan Cox committed
248 249
			dbg("%s - port %d usb_alloc_urb failed",
						__func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
250 251 252 253 254
			kfree(transfer_buffer);
			return -ENOMEM;
		}
	}

Alan Cox's avatar
Alan Cox committed
255 256 257 258
	/* allocate memory for write_urb transfer buffer */
	port->write_urb->transfer_buffer =
			kmalloc(write_urb_transfer_buffer_length, GFP_KERNEL);
	if (!port->write_urb->transfer_buffer) {
Linus Torvalds's avatar
Linus Torvalds committed
259 260 261 262
		kfree(transfer_buffer);
		usb_free_urb(port->write_urb);
		port->write_urb = NULL;
		return -ENOMEM;
Alan Cox's avatar
Alan Cox committed
263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309
	}

	/* get hardware version */
	result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_GetMisc,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
			  SUSBCR_MSC_GetHWVersion,
			  0,
			  transfer_buffer,
			  transfer_buffer_length,
			  KOBIL_TIMEOUT
	);
	dbg("%s - port %d Send get_HW_version URB returns: %i",
		__func__, port->number, result);
	dbg("Harware version: %i.%i.%i",
		transfer_buffer[0], transfer_buffer[1], transfer_buffer[2]);

	/* get firmware version */
	result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_GetMisc,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
			  SUSBCR_MSC_GetFWVersion,
			  0,
			  transfer_buffer,
			  transfer_buffer_length,
			  KOBIL_TIMEOUT
	);
	dbg("%s - port %d Send get_FW_version URB returns: %i",
					__func__, port->number, result);
	dbg("Firmware version: %i.%i.%i",
		transfer_buffer[0], transfer_buffer[1], transfer_buffer[2]);

	if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
			priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
		/* Setting Baudrate, Parity and Stopbits */
		result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_SetBaudRateParityAndStopBits,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
			  SUSBCR_SBR_9600 | SUSBCR_SPASB_EvenParity |
							SUSBCR_SPASB_1StopBit,
			  0,
			  transfer_buffer,
			  0,
			  KOBIL_TIMEOUT
Linus Torvalds's avatar
Linus Torvalds committed
310
		);
Alan Cox's avatar
Alan Cox committed
311 312 313 314 315 316 317 318 319 320 321 322 323
		dbg("%s - port %d Send set_baudrate URB returns: %i",
					__func__, port->number, result);

		/* reset all queues */
		result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_Misc,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
			  SUSBCR_MSC_ResetAllQueues,
			  0,
			  transfer_buffer,
			  0,
			  KOBIL_TIMEOUT
Linus Torvalds's avatar
Linus Torvalds committed
324
		);
Alan Cox's avatar
Alan Cox committed
325 326
		dbg("%s - port %d Send reset_all_queues URB returns: %i",
					__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
327
	}
Alan Cox's avatar
Alan Cox committed
328 329
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
	    priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
Linus Torvalds's avatar
Linus Torvalds committed
330
	    priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
Alan Cox's avatar
Alan Cox committed
331 332 333 334
		/* start reading (Adapter B 'cause PNP string) */
		result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
		dbg("%s - port %d Send read URB returns: %i",
					__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
335 336 337 338 339 340 341
	}

	kfree(transfer_buffer);
	return 0;
}


342
static void kobil_close(struct usb_serial_port *port)
Linus Torvalds's avatar
Linus Torvalds committed
343
{
344
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
345

346
	/* FIXME: Add rts/dtr methods */
Linus Torvalds's avatar
Linus Torvalds committed
347 348
	if (port->write_urb) {
		usb_kill_urb(port->write_urb);
Alan Cox's avatar
Alan Cox committed
349
		usb_free_urb(port->write_urb);
Linus Torvalds's avatar
Linus Torvalds committed
350 351
		port->write_urb = NULL;
	}
352
	usb_kill_urb(port->interrupt_in_urb);
Linus Torvalds's avatar
Linus Torvalds committed
353 354 355
}


356
static void kobil_read_int_callback(struct urb *urb)
Linus Torvalds's avatar
Linus Torvalds committed
357 358
{
	int result;
359
	struct usb_serial_port *port = urb->context;
Linus Torvalds's avatar
Linus Torvalds committed
360
	struct tty_struct *tty;
361 362
	unsigned char *data = urb->transfer_buffer;
	int status = urb->status;
Alan Cox's avatar
Alan Cox committed
363
/*	char *dbg_data; */
Linus Torvalds's avatar
Linus Torvalds committed
364

365
	dbg("%s - port %d", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
366

367 368
	if (status) {
		dbg("%s - port %d Read int status not zero: %d",
369
		    __func__, port->number, status);
Linus Torvalds's avatar
Linus Torvalds committed
370 371
		return;
	}
372

Alan Cox's avatar
Alan Cox committed
373
	tty = tty_port_tty_get(&port->port);
374 375
	if (urb->actual_length) {

Alan Cox's avatar
Alan Cox committed
376
		/* BEGIN DEBUG */
Linus Torvalds's avatar
Linus Torvalds committed
377
		/*
Alan Cox's avatar
Alan Cox committed
378 379
		  dbg_data = kzalloc((3 *  purb->actual_length + 10)
						* sizeof(char), GFP_KERNEL);
Linus Torvalds's avatar
Linus Torvalds committed
380
		  if (! dbg_data) {
Alan Cox's avatar
Alan Cox committed
381
			  return;
Linus Torvalds's avatar
Linus Torvalds committed
382
		  }
Alan Cox's avatar
Alan Cox committed
383 384
		  for (i = 0; i < purb->actual_length; i++) {
			  sprintf(dbg_data +3*i, "%02X ", data[i]);
Linus Torvalds's avatar
Linus Torvalds committed
385
		  }
Alan Cox's avatar
Alan Cox committed
386
		  dbg(" <-- %s", dbg_data);
Linus Torvalds's avatar
Linus Torvalds committed
387 388
		  kfree(dbg_data);
		*/
Alan Cox's avatar
Alan Cox committed
389
		/* END DEBUG */
Linus Torvalds's avatar
Linus Torvalds committed
390

391 392
		tty_buffer_request_room(tty, urb->actual_length);
		tty_insert_flip_string(tty, data, urb->actual_length);
Linus Torvalds's avatar
Linus Torvalds committed
393 394
		tty_flip_buffer_push(tty);
	}
Alan Cox's avatar
Alan Cox committed
395
	tty_kref_put(tty);
Alan Cox's avatar
Alan Cox committed
396
	/* someone sets the dev to 0 if the close method has been called */
Linus Torvalds's avatar
Linus Torvalds committed
397 398
	port->interrupt_in_urb->dev = port->serial->dev;

399
	result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
Alan Cox's avatar
Alan Cox committed
400 401
	dbg("%s - port %d Send read URB returns: %i",
			__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
402 403 404
}


Alan Cox's avatar
Alan Cox committed
405
static void kobil_write_callback(struct urb *purb)
Linus Torvalds's avatar
Linus Torvalds committed
406 407 408 409
{
}


Alan Cox's avatar
Alan Cox committed
410
static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
Linus Torvalds's avatar
Linus Torvalds committed
411 412 413 414 415
			const unsigned char *buf, int count)
{
	int length = 0;
	int result = 0;
	int todo = 0;
Alan Cox's avatar
Alan Cox committed
416
	struct kobil_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
417 418

	if (count == 0) {
Alan Cox's avatar
Alan Cox committed
419 420
		dbg("%s - port %d write request of 0 bytes",
						__func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
421 422 423 424 425 426
		return 0;
	}

	priv = usb_get_serial_port_data(port);

	if (count > (KOBIL_BUF_LENGTH - priv->filled)) {
427
		dbg("%s - port %d Error: write request bigger than buffer size", __func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
428 429 430
		return -ENOMEM;
	}

Alan Cox's avatar
Alan Cox committed
431 432 433 434
	/* Copy data to buffer */
	memcpy(priv->buf + priv->filled, buf, count);
	usb_serial_debug_data(debug, &port->dev, __func__, count,
						priv->buf + priv->filled);
Linus Torvalds's avatar
Linus Torvalds committed
435 436
	priv->filled = priv->filled + count;

Alan Cox's avatar
Alan Cox committed
437 438 439 440 441 442 443
	/* only send complete block. TWIN, KAAN SIM and adapter K
	   use the same protocol. */
	if (((priv->device_type != KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 2) && (priv->filled >= (priv->buf[1] + 3))) ||
	     ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) && (priv->filled > 3) && (priv->filled >= (priv->buf[2] + 4)))) {
		/* stop reading (except TWIN and KAAN SIM) */
		if ((priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID)
			|| (priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID))
Linus Torvalds's avatar
Linus Torvalds committed
444 445 446 447
			usb_kill_urb(port->interrupt_in_urb);

		todo = priv->filled - priv->cur_pos;

Alan Cox's avatar
Alan Cox committed
448 449
		while (todo > 0) {
			/* max 8 byte in one urb (endpoint size) */
Linus Torvalds's avatar
Linus Torvalds committed
450
			length = (todo < 8) ? todo : 8;
Alan Cox's avatar
Alan Cox committed
451 452 453 454 455 456 457 458 459 460 461 462 463
			/* copy data to transfer buffer */
			memcpy(port->write_urb->transfer_buffer,
					priv->buf + priv->cur_pos, length);
			usb_fill_int_urb(port->write_urb,
				  port->serial->dev,
				  usb_sndintpipe(port->serial->dev,
					priv->write_int_endpoint_address),
				  port->write_urb->transfer_buffer,
				  length,
				  kobil_write_callback,
				  port,
				  8
			);
Linus Torvalds's avatar
Linus Torvalds committed
464 465

			priv->cur_pos = priv->cur_pos + length;
Alan Cox's avatar
Alan Cox committed
466 467 468
			result = usb_submit_urb(port->write_urb, GFP_NOIO);
			dbg("%s - port %d Send write URB returns: %i",
					__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
469 470
			todo = priv->filled - priv->cur_pos;

Alan Cox's avatar
Alan Cox committed
471
			if (todo > 0)
Linus Torvalds's avatar
Linus Torvalds committed
472
				msleep(24);
Alan Cox's avatar
Alan Cox committed
473
		}
Linus Torvalds's avatar
Linus Torvalds committed
474 475 476 477

		priv->filled = 0;
		priv->cur_pos = 0;

Alan Cox's avatar
Alan Cox committed
478 479
		/* someone sets the dev to 0 if the close method
		   has been called */
Linus Torvalds's avatar
Linus Torvalds committed
480
		port->interrupt_in_urb->dev = port->serial->dev;
Alan Cox's avatar
Alan Cox committed
481 482 483 484 485 486

		/* start reading (except TWIN and KAAN SIM) */
		if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
			priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
			/* someone sets the dev to 0 if the close method has
			   been called */
Linus Torvalds's avatar
Linus Torvalds committed
487
			port->interrupt_in_urb->dev = port->serial->dev;
Alan Cox's avatar
Alan Cox committed
488 489 490 491 492

			result = usb_submit_urb(port->interrupt_in_urb,
								GFP_NOIO);
			dbg("%s - port %d Send read URB returns: %i",
					__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
493 494 495 496 497 498
		}
	}
	return count;
}


Alan Cox's avatar
Alan Cox committed
499
static int kobil_write_room(struct tty_struct *tty)
Linus Torvalds's avatar
Linus Torvalds committed
500
{
Alan Cox's avatar
Alan Cox committed
501
	/* dbg("%s - port %d", __func__, port->number); */
Alan Cox's avatar
Alan Cox committed
502
	/* FIXME */
Linus Torvalds's avatar
Linus Torvalds committed
503 504 505 506
	return 8;
}


Alan Cox's avatar
Alan Cox committed
507
static int kobil_tiocmget(struct tty_struct *tty, struct file *file)
Linus Torvalds's avatar
Linus Torvalds committed
508
{
Alan Cox's avatar
Alan Cox committed
509
	struct usb_serial_port *port = tty->driver_data;
Alan Cox's avatar
Alan Cox committed
510
	struct kobil_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
511 512 513 514 515
	int result;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;

	priv = usb_get_serial_port_data(port);
Alan Cox's avatar
Alan Cox committed
516 517 518
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
			|| priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
		/* This device doesn't support ioctl calls */
Linus Torvalds's avatar
Linus Torvalds committed
519 520 521
		return -EINVAL;
	}

Alan Cox's avatar
Alan Cox committed
522
	/* allocate memory for transfer buffer */
523
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
524
	if (!transfer_buffer)
Linus Torvalds's avatar
Linus Torvalds committed
525 526
		return -ENOMEM;

Alan Cox's avatar
Alan Cox committed
527 528 529 530 531 532 533 534 535 536 537
	result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_GetStatusLineState,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN,
			  0,
			  0,
			  transfer_buffer,
			  transfer_buffer_length,
			  KOBIL_TIMEOUT);

	dbg("%s - port %d Send get_status_line_state URB returns: %i. Statusline: %02x",
538
	    __func__, port->number, result, transfer_buffer[0]);
Linus Torvalds's avatar
Linus Torvalds committed
539

540 541 542
	result = 0;
	if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0)
		result = TIOCM_DSR;
Linus Torvalds's avatar
Linus Torvalds committed
543
	kfree(transfer_buffer);
544
	return result;
Linus Torvalds's avatar
Linus Torvalds committed
545 546
}

Alan Cox's avatar
Alan Cox committed
547
static int kobil_tiocmset(struct tty_struct *tty, struct file *file,
Linus Torvalds's avatar
Linus Torvalds committed
548 549
			   unsigned int set, unsigned int clear)
{
Alan Cox's avatar
Alan Cox committed
550
	struct usb_serial_port *port = tty->driver_data;
Alan Cox's avatar
Alan Cox committed
551
	struct kobil_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
552 553 554 555 556 557
	int result;
	int dtr = 0;
	int rts = 0;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;

558
	/* FIXME: locking ? */
Linus Torvalds's avatar
Linus Torvalds committed
559
	priv = usb_get_serial_port_data(port);
Alan Cox's avatar
Alan Cox committed
560 561 562
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
		|| priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
		/* This device doesn't support ioctl calls */
Linus Torvalds's avatar
Linus Torvalds committed
563 564 565
		return -EINVAL;
	}

Alan Cox's avatar
Alan Cox committed
566
	/* allocate memory for transfer buffer */
567
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
568
	if (!transfer_buffer)
Linus Torvalds's avatar
Linus Torvalds committed
569 570 571 572 573 574 575 576 577 578 579 580 581
		return -ENOMEM;

	if (set & TIOCM_RTS)
		rts = 1;
	if (set & TIOCM_DTR)
		dtr = 1;
	if (clear & TIOCM_RTS)
		rts = 0;
	if (clear & TIOCM_DTR)
		dtr = 0;

	if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) {
		if (dtr != 0)
Alan Cox's avatar
Alan Cox committed
582 583
			dbg("%s - port %d Setting DTR",
						__func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
584
		else
Alan Cox's avatar
Alan Cox committed
585 586 587 588 589 590 591 592 593 594 595
			dbg("%s - port %d Clearing DTR",
						__func__, port->number);
		result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_SetStatusLinesOrQueues,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
			  ((dtr != 0) ? SUSBCR_SSL_SETDTR : SUSBCR_SSL_CLRDTR),
			  0,
			  transfer_buffer,
			  0,
			  KOBIL_TIMEOUT);
Linus Torvalds's avatar
Linus Torvalds committed
596 597
	} else {
		if (rts != 0)
Alan Cox's avatar
Alan Cox committed
598 599
			dbg("%s - port %d Setting RTS",
						__func__, port->number);
Linus Torvalds's avatar
Linus Torvalds committed
600
		else
Alan Cox's avatar
Alan Cox committed
601 602 603 604 605 606 607 608 609 610 611
			dbg("%s - port %d Clearing RTS",
						__func__, port->number);
		result = usb_control_msg(port->serial->dev,
			usb_rcvctrlpipe(port->serial->dev, 0),
			SUSBCRequest_SetStatusLinesOrQueues,
			USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
			((rts != 0) ? SUSBCR_SSL_SETRTS : SUSBCR_SSL_CLRRTS),
			0,
			transfer_buffer,
			0,
			KOBIL_TIMEOUT);
Linus Torvalds's avatar
Linus Torvalds committed
612
	}
Alan Cox's avatar
Alan Cox committed
613 614
	dbg("%s - port %d Send set_status_line URB returns: %i",
					__func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
615 616 617 618
	kfree(transfer_buffer);
	return (result < 0) ? result : 0;
}

Alan Cox's avatar
Alan Cox committed
619 620
static void kobil_set_termios(struct tty_struct *tty,
			struct usb_serial_port *port, struct ktermios *old)
Linus Torvalds's avatar
Linus Torvalds committed
621
{
Alan Cox's avatar
Alan Cox committed
622
	struct kobil_private *priv;
Linus Torvalds's avatar
Linus Torvalds committed
623 624
	int result;
	unsigned short urb_val = 0;
Alan Cox's avatar
Alan Cox committed
625
	int c_cflag = tty->termios->c_cflag;
Alan Cox's avatar
Alan Cox committed
626
	speed_t speed;
Alan Cox's avatar
Alan Cox committed
627
	void *settings;
Linus Torvalds's avatar
Linus Torvalds committed
628 629

	priv = usb_get_serial_port_data(port);
Alan Cox's avatar
Alan Cox committed
630
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
Alan Cox's avatar
Alan Cox committed
631
			priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
Alan Cox's avatar
Alan Cox committed
632
		/* This device doesn't support ioctl calls */
Alan Cox's avatar
Alan Cox committed
633
		*tty->termios = *old;
Alan Cox's avatar
Alan Cox committed
634
		return;
Alan Cox's avatar
Alan Cox committed
635
	}
Linus Torvalds's avatar
Linus Torvalds committed
636

Alan Cox's avatar
Alan Cox committed
637 638 639 640 641 642 643 644 645 646
	speed = tty_get_baud_rate(tty);
	switch (speed) {
	case 1200:
		urb_val = SUSBCR_SBR_1200;
		break;
	default:
		speed = 9600;
	case 9600:
		urb_val = SUSBCR_SBR_9600;
		break;
Alan Cox's avatar
Alan Cox committed
647
	}
Alan Cox's avatar
Alan Cox committed
648 649
	urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits :
							SUSBCR_SPASB_1StopBit;
Alan Cox's avatar
Alan Cox committed
650 651

	settings = kzalloc(50, GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
652
	if (!settings)
Alan Cox's avatar
Alan Cox committed
653
		return;
Linus Torvalds's avatar
Linus Torvalds committed
654

Alan Cox's avatar
Alan Cox committed
655
	sprintf(settings, "%d ", speed);
Linus Torvalds's avatar
Linus Torvalds committed
656

Alan Cox's avatar
Alan Cox committed
657 658 659 660
	if (c_cflag & PARENB) {
		if  (c_cflag & PARODD) {
			urb_val |= SUSBCR_SPASB_OddParity;
			strcat(settings, "Odd Parity");
Linus Torvalds's avatar
Linus Torvalds committed
661
		} else {
Alan Cox's avatar
Alan Cox committed
662 663
			urb_val |= SUSBCR_SPASB_EvenParity;
			strcat(settings, "Even Parity");
Linus Torvalds's avatar
Linus Torvalds committed
664
		}
Alan Cox's avatar
Alan Cox committed
665 666 667 668
	} else {
		urb_val |= SUSBCR_SPASB_NoParity;
		strcat(settings, "No Parity");
	}
Alan Cox's avatar
Alan Cox committed
669 670
	tty->termios->c_cflag &= ~CMSPAR;
	tty_encode_baud_rate(tty, speed, speed);
Linus Torvalds's avatar
Linus Torvalds committed
671

Alan Cox's avatar
Alan Cox committed
672 673 674 675 676 677 678 679 680
	result = usb_control_msg(port->serial->dev,
		  usb_rcvctrlpipe(port->serial->dev, 0),
		  SUSBCRequest_SetBaudRateParityAndStopBits,
		  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
		  urb_val,
		  0,
		  settings,
		  0,
		  KOBIL_TIMEOUT
Alan Cox's avatar
Alan Cox committed
681 682 683
		);
	kfree(settings);
}
Linus Torvalds's avatar
Linus Torvalds committed
684

Alan Cox's avatar
Alan Cox committed
685 686
static int kobil_ioctl(struct tty_struct *tty, struct file *file,
					unsigned int cmd, unsigned long arg)
Alan Cox's avatar
Alan Cox committed
687
{
Alan Cox's avatar
Alan Cox committed
688
	struct usb_serial_port *port = tty->driver_data;
Alan Cox's avatar
Alan Cox committed
689
	struct kobil_private *priv = usb_get_serial_port_data(port);
Alan Cox's avatar
Alan Cox committed
690 691 692 693
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;
	int result;

Alan Cox's avatar
Alan Cox committed
694 695 696
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
			priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID)
		/* This device doesn't support ioctl calls */
Alan Cox's avatar
Alan Cox committed
697
		return -ENOIOCTLCMD;
Linus Torvalds's avatar
Linus Torvalds committed
698

Alan Cox's avatar
Alan Cox committed
699
	switch (cmd) {
Alan Cox's avatar
Alan Cox committed
700
	case TCFLSH:
701
		transfer_buffer = kmalloc(transfer_buffer_length, GFP_KERNEL);
Alan Cox's avatar
Alan Cox committed
702 703 704 705 706 707 708 709 710 711 712 713
		if (!transfer_buffer)
			return -ENOBUFS;

		result = usb_control_msg(port->serial->dev,
			  usb_rcvctrlpipe(port->serial->dev, 0),
			  SUSBCRequest_Misc,
			  USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT,
			  SUSBCR_MSC_ResetAllQueues,
			  0,
			  NULL, /* transfer_buffer, */
			  0,
			  KOBIL_TIMEOUT
Linus Torvalds's avatar
Linus Torvalds committed
714
			);
Alan Cox's avatar
Alan Cox committed
715

716
		dbg("%s - port %d Send reset_all_queues (FLUSH) URB returns: %i", __func__, port->number, result);
Linus Torvalds's avatar
Linus Torvalds committed
717
		kfree(transfer_buffer);
Alan Cox's avatar
Alan Cox committed
718
		return (result < 0) ? -EIO: 0;
Alan Cox's avatar
Alan Cox committed
719 720
	default:
		return -ENOIOCTLCMD;
Linus Torvalds's avatar
Linus Torvalds committed
721 722 723
	}
}

Alan Cox's avatar
Alan Cox committed
724
static int __init kobil_init(void)
Linus Torvalds's avatar
Linus Torvalds committed
725 726 727 728 729 730
{
	int retval;
	retval = usb_serial_register(&kobil_device);
	if (retval)
		goto failed_usb_serial_register;
	retval = usb_register(&kobil_driver);
Alan Cox's avatar
Alan Cox committed
731
	if (retval)
Linus Torvalds's avatar
Linus Torvalds committed
732 733
		goto failed_usb_register;

734 735
	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
	       DRIVER_DESC "\n");
Linus Torvalds's avatar
Linus Torvalds committed
736 737 738 739 740 741 742 743 744

	return 0;
failed_usb_register:
	usb_serial_deregister(&kobil_device);
failed_usb_serial_register:
	return retval;
}


Alan Cox's avatar
Alan Cox committed
745
static void __exit kobil_exit(void)
Linus Torvalds's avatar
Linus Torvalds committed
746
{
Alan Cox's avatar
Alan Cox committed
747 748
	usb_deregister(&kobil_driver);
	usb_serial_deregister(&kobil_device);
Linus Torvalds's avatar
Linus Torvalds committed
749 750 751 752 753
}

module_init(kobil_init);
module_exit(kobil_exit);

Alan Cox's avatar
Alan Cox committed
754 755 756
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");
Linus Torvalds's avatar
Linus Torvalds committed
757 758 759

module_param(debug, bool, S_IRUGO | S_IWUSR);
MODULE_PARM_DESC(debug, "Debug enabled or not");