kobil_sct.c 19.6 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 *  KOBIL USB Smart Card Terminal Driver
 *
A
Alan Cox 已提交
4
 *  Copyright (C) 2002  KOBIL Systems GmbH
L
Linus Torvalds 已提交
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
 *  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)
 */


#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>
A
Alan Cox 已提交
35
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
36
#include <linux/usb.h>
37
#include <linux/usb/serial.h>
L
Linus Torvalds 已提交
38 39 40
#include <linux/ioctl.h>
#include "kobil_sct.h"

41
static bool debug;
L
Linus Torvalds 已提交
42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58

/* 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 */
A
Alan Cox 已提交
59
static int  kobil_startup(struct usb_serial *serial);
60
static void kobil_release(struct usb_serial *serial);
61
static int  kobil_open(struct tty_struct *tty, struct usb_serial_port *port);
62
static void kobil_close(struct usb_serial_port *port);
A
Alan Cox 已提交
63
static int  kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
L
Linus Torvalds 已提交
64
			 const unsigned char *buf, int count);
A
Alan Cox 已提交
65
static int  kobil_write_room(struct tty_struct *tty);
66
static int  kobil_ioctl(struct tty_struct *tty,
L
Linus Torvalds 已提交
67
			unsigned int cmd, unsigned long arg);
68
static int  kobil_tiocmget(struct tty_struct *tty);
69
static int  kobil_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
70
			   unsigned int set, unsigned int clear);
A
Alan Cox 已提交
71 72 73
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,
A
Alan Cox 已提交
74
			struct usb_serial_port *port, struct ktermios *old);
A
Alan Cox 已提交
75
static void kobil_init_termios(struct tty_struct *tty);
L
Linus Torvalds 已提交
76

77
static const struct usb_device_id id_table[] = {
L
Linus Torvalds 已提交
78 79 80 81 82 83 84 85
	{ 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 */
};


A
Alan Cox 已提交
86
MODULE_DEVICE_TABLE(usb, id_table);
L
Linus Torvalds 已提交
87 88 89 90 91 92

static struct usb_driver kobil_driver = {
	.name =		"kobil",
	.probe =	usb_serial_probe,
	.disconnect =	usb_serial_disconnect,
	.id_table =	id_table,
93
	.no_dynamic_id = 	1,
L
Linus Torvalds 已提交
94 95 96
};


97
static struct usb_serial_driver kobil_device = {
98 99
	.driver = {
		.owner =	THIS_MODULE,
100
		.name =		"kobil",
101
	},
102
	.description =		"KOBIL USB smart card terminal",
103
	.usb_driver = 		&kobil_driver,
L
Linus Torvalds 已提交
104 105 106
	.id_table =		id_table,
	.num_ports =		1,
	.attach =		kobil_startup,
107
	.release =		kobil_release,
L
Linus Torvalds 已提交
108
	.ioctl =		kobil_ioctl,
A
Alan Cox 已提交
109
	.set_termios =		kobil_set_termios,
A
Alan Cox 已提交
110
	.init_termios =		kobil_init_termios,
L
Linus Torvalds 已提交
111 112 113 114 115 116 117 118 119 120 121 122 123
	.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;
A
Alan Cox 已提交
124 125 126
	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 */
L
Linus Torvalds 已提交
127 128 129 130
	__u16 device_type;
};


A
Alan Cox 已提交
131
static int kobil_startup(struct usb_serial *serial)
L
Linus Torvalds 已提交
132 133 134 135 136 137 138 139 140 141
{
	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);
A
Alan Cox 已提交
142
	if (!priv)
L
Linus Torvalds 已提交
143 144 145 146 147 148
		return -ENOMEM;

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

A
Alan Cox 已提交
149
	switch (priv->device_type) {
L
Linus Torvalds 已提交
150 151 152 153
	case KOBIL_ADAPTER_B_PRODUCT_ID:
		printk(KERN_DEBUG "KOBIL B1 PRO / KAAN PRO detected\n");
		break;
	case KOBIL_ADAPTER_K_PRODUCT_ID:
A
Alan Cox 已提交
154 155
		printk(KERN_DEBUG
		  "KOBIL KAAN Standard Plus / SecOVID Reader Plus detected\n");
L
Linus Torvalds 已提交
156 157 158 159 160 161 162 163 164 165
		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);

A
Alan Cox 已提交
166
	/* search for the necessary endpoints */
L
Linus Torvalds 已提交
167
	pdev = serial->dev;
A
Alan Cox 已提交
168 169
	actconfig = pdev->actconfig;
	interface = actconfig->interface[0];
L
Linus Torvalds 已提交
170
	altsetting = interface->cur_altsetting;
A
Alan Cox 已提交
171 172 173
	endpoint = altsetting->endpoint;

	for (i = 0; i < altsetting->desc.bNumEndpoints; i++) {
L
Linus Torvalds 已提交
174
		endpoint = &altsetting->endpoint[i];
175
		if (usb_endpoint_is_int_out(&endpoint->desc)) {
A
Alan Cox 已提交
176 177 178 179 180
			dbg("%s Found interrupt out endpoint. Address: %d",
				__func__, endpoint->desc.bEndpointAddress);
			priv->write_int_endpoint_address =
				endpoint->desc.bEndpointAddress;
		}
181
		if (usb_endpoint_is_int_in(&endpoint->desc)) {
A
Alan Cox 已提交
182 183 184 185 186
			dbg("%s Found interrupt in  endpoint. Address: %d",
				__func__, endpoint->desc.bEndpointAddress);
			priv->read_int_endpoint_address =
				endpoint->desc.bEndpointAddress;
		}
L
Linus Torvalds 已提交
187 188 189 190 191
	}
	return 0;
}


192
static void kobil_release(struct usb_serial *serial)
L
Linus Torvalds 已提交
193 194
{
	int i;
195
	dbg("%s - port %d", __func__, serial->port[0]->number);
L
Linus Torvalds 已提交
196

197
	for (i = 0; i < serial->num_ports; ++i)
L
Linus Torvalds 已提交
198 199 200
		kfree(usb_get_serial_port_data(serial->port[i]));
}

A
Alan Cox 已提交
201 202 203 204 205 206 207 208 209
static void kobil_init_termios(struct tty_struct *tty)
{
	/* Default to echo off and other sane device settings */
	tty->termios->c_lflag = 0;
	tty->termios->c_lflag &= ~(ISIG | ICANON | ECHO | IEXTEN | XCASE);
	tty->termios->c_iflag = IGNBRK | IGNPAR | IXOFF;
	/* do NOT translate CR to CR-NL (0x0A -> 0x0A 0x0D) */
	tty->termios->c_oflag &= ~ONLCR;
}
L
Linus Torvalds 已提交
210

211
static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port)
L
Linus Torvalds 已提交
212
{
A
Alan Cox 已提交
213
	int result = 0;
L
Linus Torvalds 已提交
214 215 216 217 218
	struct kobil_private *priv;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;
	int write_urb_transfer_buffer_length = 8;

219
	dbg("%s - port %d", __func__, port->number);
L
Linus Torvalds 已提交
220 221
	priv = usb_get_serial_port_data(port);

A
Alan Cox 已提交
222
	/* allocate memory for transfer buffer */
223
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
224
	if (!transfer_buffer)
L
Linus Torvalds 已提交
225
		return -ENOMEM;
A
Alan Cox 已提交
226 227 228 229 230 231

	/* 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);
L
Linus Torvalds 已提交
232
		if (!port->write_urb) {
A
Alan Cox 已提交
233 234
			dbg("%s - port %d usb_alloc_urb failed",
						__func__, port->number);
L
Linus Torvalds 已提交
235 236 237 238 239
			kfree(transfer_buffer);
			return -ENOMEM;
		}
	}

A
Alan Cox 已提交
240 241 242 243
	/* 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) {
L
Linus Torvalds 已提交
244 245 246 247
		kfree(transfer_buffer);
		usb_free_urb(port->write_urb);
		port->write_urb = NULL;
		return -ENOMEM;
A
Alan Cox 已提交
248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 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
	}

	/* 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
L
Linus Torvalds 已提交
295
		);
A
Alan Cox 已提交
296 297 298 299 300 301 302 303 304 305 306 307 308
		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
L
Linus Torvalds 已提交
309
		);
A
Alan Cox 已提交
310 311
		dbg("%s - port %d Send reset_all_queues URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
312
	}
A
Alan Cox 已提交
313 314
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
	    priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
L
Linus Torvalds 已提交
315
	    priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
A
Alan Cox 已提交
316 317 318 319
		/* 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);
L
Linus Torvalds 已提交
320 321 322 323 324 325 326
	}

	kfree(transfer_buffer);
	return 0;
}


327
static void kobil_close(struct usb_serial_port *port)
L
Linus Torvalds 已提交
328
{
329
	dbg("%s - port %d", __func__, port->number);
L
Linus Torvalds 已提交
330

331
	/* FIXME: Add rts/dtr methods */
L
Linus Torvalds 已提交
332
	if (port->write_urb) {
J
Johan Hovold 已提交
333 334
		usb_poison_urb(port->write_urb);
		kfree(port->write_urb->transfer_buffer);
A
Alan Cox 已提交
335
		usb_free_urb(port->write_urb);
L
Linus Torvalds 已提交
336 337
		port->write_urb = NULL;
	}
338
	usb_kill_urb(port->interrupt_in_urb);
L
Linus Torvalds 已提交
339 340 341
}


342
static void kobil_read_int_callback(struct urb *urb)
L
Linus Torvalds 已提交
343 344
{
	int result;
345
	struct usb_serial_port *port = urb->context;
L
Linus Torvalds 已提交
346
	struct tty_struct *tty;
347 348
	unsigned char *data = urb->transfer_buffer;
	int status = urb->status;
A
Alan Cox 已提交
349
/*	char *dbg_data; */
L
Linus Torvalds 已提交
350

351
	dbg("%s - port %d", __func__, port->number);
L
Linus Torvalds 已提交
352

353 354
	if (status) {
		dbg("%s - port %d Read int status not zero: %d",
355
		    __func__, port->number, status);
L
Linus Torvalds 已提交
356 357
		return;
	}
358

A
Alan Cox 已提交
359
	tty = tty_port_tty_get(&port->port);
360
	if (tty && urb->actual_length) {
361

A
Alan Cox 已提交
362
		/* BEGIN DEBUG */
L
Linus Torvalds 已提交
363
		/*
A
Alan Cox 已提交
364 365
		  dbg_data = kzalloc((3 *  purb->actual_length + 10)
						* sizeof(char), GFP_KERNEL);
L
Linus Torvalds 已提交
366
		  if (! dbg_data) {
A
Alan Cox 已提交
367
			  return;
L
Linus Torvalds 已提交
368
		  }
A
Alan Cox 已提交
369 370
		  for (i = 0; i < purb->actual_length; i++) {
			  sprintf(dbg_data +3*i, "%02X ", data[i]);
L
Linus Torvalds 已提交
371
		  }
A
Alan Cox 已提交
372
		  dbg(" <-- %s", dbg_data);
L
Linus Torvalds 已提交
373 374
		  kfree(dbg_data);
		*/
A
Alan Cox 已提交
375
		/* END DEBUG */
L
Linus Torvalds 已提交
376

377
		tty_insert_flip_string(tty, data, urb->actual_length);
L
Linus Torvalds 已提交
378 379
		tty_flip_buffer_push(tty);
	}
A
Alan Cox 已提交
380
	tty_kref_put(tty);
L
Linus Torvalds 已提交
381

382
	result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
A
Alan Cox 已提交
383 384
	dbg("%s - port %d Send read URB returns: %i",
			__func__, port->number, result);
L
Linus Torvalds 已提交
385 386 387
}


A
Alan Cox 已提交
388
static void kobil_write_callback(struct urb *purb)
L
Linus Torvalds 已提交
389 390 391 392
{
}


A
Alan Cox 已提交
393
static int kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
L
Linus Torvalds 已提交
394 395 396 397 398
			const unsigned char *buf, int count)
{
	int length = 0;
	int result = 0;
	int todo = 0;
A
Alan Cox 已提交
399
	struct kobil_private *priv;
L
Linus Torvalds 已提交
400 401

	if (count == 0) {
A
Alan Cox 已提交
402 403
		dbg("%s - port %d write request of 0 bytes",
						__func__, port->number);
L
Linus Torvalds 已提交
404 405 406 407 408 409
		return 0;
	}

	priv = usb_get_serial_port_data(port);

	if (count > (KOBIL_BUF_LENGTH - priv->filled)) {
410
		dbg("%s - port %d Error: write request bigger than buffer size", __func__, port->number);
L
Linus Torvalds 已提交
411 412 413
		return -ENOMEM;
	}

A
Alan Cox 已提交
414 415 416 417
	/* Copy data to buffer */
	memcpy(priv->buf + priv->filled, buf, count);
	usb_serial_debug_data(debug, &port->dev, __func__, count,
						priv->buf + priv->filled);
L
Linus Torvalds 已提交
418 419
	priv->filled = priv->filled + count;

A
Alan Cox 已提交
420 421 422 423 424 425 426
	/* 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))
L
Linus Torvalds 已提交
427 428 429 430
			usb_kill_urb(port->interrupt_in_urb);

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

A
Alan Cox 已提交
431 432
		while (todo > 0) {
			/* max 8 byte in one urb (endpoint size) */
L
Linus Torvalds 已提交
433
			length = (todo < 8) ? todo : 8;
A
Alan Cox 已提交
434 435 436 437 438 439 440 441 442 443 444 445 446
			/* 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
			);
L
Linus Torvalds 已提交
447 448

			priv->cur_pos = priv->cur_pos + length;
A
Alan Cox 已提交
449 450 451
			result = usb_submit_urb(port->write_urb, GFP_NOIO);
			dbg("%s - port %d Send write URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
452 453
			todo = priv->filled - priv->cur_pos;

A
Alan Cox 已提交
454
			if (todo > 0)
L
Linus Torvalds 已提交
455
				msleep(24);
A
Alan Cox 已提交
456
		}
L
Linus Torvalds 已提交
457 458 459 460

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

A
Alan Cox 已提交
461 462 463 464 465 466 467
		/* start reading (except TWIN and KAAN SIM) */
		if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
			priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) {
			result = usb_submit_urb(port->interrupt_in_urb,
								GFP_NOIO);
			dbg("%s - port %d Send read URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
468 469 470 471 472 473
		}
	}
	return count;
}


A
Alan Cox 已提交
474
static int kobil_write_room(struct tty_struct *tty)
L
Linus Torvalds 已提交
475
{
A
Alan Cox 已提交
476
	/* dbg("%s - port %d", __func__, port->number); */
A
Alan Cox 已提交
477
	/* FIXME */
L
Linus Torvalds 已提交
478 479 480 481
	return 8;
}


482
static int kobil_tiocmget(struct tty_struct *tty)
L
Linus Torvalds 已提交
483
{
A
Alan Cox 已提交
484
	struct usb_serial_port *port = tty->driver_data;
A
Alan Cox 已提交
485
	struct kobil_private *priv;
L
Linus Torvalds 已提交
486 487 488 489 490
	int result;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;

	priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
491 492 493
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
			|| priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
		/* This device doesn't support ioctl calls */
L
Linus Torvalds 已提交
494 495 496
		return -EINVAL;
	}

A
Alan Cox 已提交
497
	/* allocate memory for transfer buffer */
498
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
499
	if (!transfer_buffer)
L
Linus Torvalds 已提交
500 501
		return -ENOMEM;

A
Alan Cox 已提交
502 503 504 505 506 507 508 509 510 511 512
	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",
513
	    __func__, port->number, result, transfer_buffer[0]);
L
Linus Torvalds 已提交
514

515 516 517
	result = 0;
	if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0)
		result = TIOCM_DSR;
L
Linus Torvalds 已提交
518
	kfree(transfer_buffer);
519
	return result;
L
Linus Torvalds 已提交
520 521
}

522
static int kobil_tiocmset(struct tty_struct *tty,
L
Linus Torvalds 已提交
523 524
			   unsigned int set, unsigned int clear)
{
A
Alan Cox 已提交
525
	struct usb_serial_port *port = tty->driver_data;
A
Alan Cox 已提交
526
	struct kobil_private *priv;
L
Linus Torvalds 已提交
527 528 529 530 531 532
	int result;
	int dtr = 0;
	int rts = 0;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;

533
	/* FIXME: locking ? */
L
Linus Torvalds 已提交
534
	priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
535 536 537
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID
		|| priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
		/* This device doesn't support ioctl calls */
L
Linus Torvalds 已提交
538 539 540
		return -EINVAL;
	}

A
Alan Cox 已提交
541
	/* allocate memory for transfer buffer */
542
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
543
	if (!transfer_buffer)
L
Linus Torvalds 已提交
544 545 546 547 548 549 550 551 552 553 554 555 556
		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)
A
Alan Cox 已提交
557 558
			dbg("%s - port %d Setting DTR",
						__func__, port->number);
L
Linus Torvalds 已提交
559
		else
A
Alan Cox 已提交
560 561 562 563 564 565 566 567 568 569 570
			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);
L
Linus Torvalds 已提交
571 572
	} else {
		if (rts != 0)
A
Alan Cox 已提交
573 574
			dbg("%s - port %d Setting RTS",
						__func__, port->number);
L
Linus Torvalds 已提交
575
		else
A
Alan Cox 已提交
576 577 578 579 580 581 582 583 584 585 586
			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);
L
Linus Torvalds 已提交
587
	}
A
Alan Cox 已提交
588 589
	dbg("%s - port %d Send set_status_line URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
590 591 592 593
	kfree(transfer_buffer);
	return (result < 0) ? result : 0;
}

A
Alan Cox 已提交
594 595
static void kobil_set_termios(struct tty_struct *tty,
			struct usb_serial_port *port, struct ktermios *old)
L
Linus Torvalds 已提交
596
{
A
Alan Cox 已提交
597
	struct kobil_private *priv;
L
Linus Torvalds 已提交
598 599
	int result;
	unsigned short urb_val = 0;
A
Alan Cox 已提交
600
	int c_cflag = tty->termios->c_cflag;
A
Alan Cox 已提交
601
	speed_t speed;
L
Linus Torvalds 已提交
602 603

	priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
604
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
A
Alan Cox 已提交
605
			priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
A
Alan Cox 已提交
606
		/* This device doesn't support ioctl calls */
A
Alan Cox 已提交
607
		*tty->termios = *old;
A
Alan Cox 已提交
608
		return;
A
Alan Cox 已提交
609
	}
L
Linus Torvalds 已提交
610

A
Alan Cox 已提交
611 612 613 614 615 616 617 618 619 620
	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;
A
Alan Cox 已提交
621
	}
A
Alan Cox 已提交
622 623
	urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits :
							SUSBCR_SPASB_1StopBit;
A
Alan Cox 已提交
624
	if (c_cflag & PARENB) {
625
		if  (c_cflag & PARODD)
A
Alan Cox 已提交
626
			urb_val |= SUSBCR_SPASB_OddParity;
627
		else
A
Alan Cox 已提交
628
			urb_val |= SUSBCR_SPASB_EvenParity;
629
	} else
A
Alan Cox 已提交
630
		urb_val |= SUSBCR_SPASB_NoParity;
A
Alan Cox 已提交
631 632
	tty->termios->c_cflag &= ~CMSPAR;
	tty_encode_baud_rate(tty, speed, speed);
L
Linus Torvalds 已提交
633

A
Alan Cox 已提交
634 635 636 637 638 639
	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,
640
		  NULL,
A
Alan Cox 已提交
641 642
		  0,
		  KOBIL_TIMEOUT
A
Alan Cox 已提交
643 644
		);
}
L
Linus Torvalds 已提交
645

646
static int kobil_ioctl(struct tty_struct *tty,
A
Alan Cox 已提交
647
					unsigned int cmd, unsigned long arg)
A
Alan Cox 已提交
648
{
A
Alan Cox 已提交
649
	struct usb_serial_port *port = tty->driver_data;
A
Alan Cox 已提交
650
	struct kobil_private *priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
651 652 653 654
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;
	int result;

A
Alan Cox 已提交
655 656 657
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
			priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID)
		/* This device doesn't support ioctl calls */
A
Alan Cox 已提交
658
		return -ENOIOCTLCMD;
L
Linus Torvalds 已提交
659

A
Alan Cox 已提交
660
	switch (cmd) {
A
Alan Cox 已提交
661
	case TCFLSH:
662
		transfer_buffer = kmalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
663 664 665 666 667 668 669 670 671 672 673 674
		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
L
Linus Torvalds 已提交
675
			);
A
Alan Cox 已提交
676

677
		dbg("%s - port %d Send reset_all_queues (FLUSH) URB returns: %i", __func__, port->number, result);
L
Linus Torvalds 已提交
678
		kfree(transfer_buffer);
A
Alan Cox 已提交
679
		return (result < 0) ? -EIO: 0;
A
Alan Cox 已提交
680 681
	default:
		return -ENOIOCTLCMD;
L
Linus Torvalds 已提交
682 683 684
	}
}

A
Alan Cox 已提交
685
static int __init kobil_init(void)
L
Linus Torvalds 已提交
686 687 688 689 690 691
{
	int retval;
	retval = usb_serial_register(&kobil_device);
	if (retval)
		goto failed_usb_serial_register;
	retval = usb_register(&kobil_driver);
A
Alan Cox 已提交
692
	if (retval)
L
Linus Torvalds 已提交
693 694
		goto failed_usb_register;

695 696
	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
	       DRIVER_DESC "\n");
L
Linus Torvalds 已提交
697 698 699 700 701 702 703 704 705

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


A
Alan Cox 已提交
706
static void __exit kobil_exit(void)
L
Linus Torvalds 已提交
707
{
A
Alan Cox 已提交
708 709
	usb_deregister(&kobil_driver);
	usb_serial_deregister(&kobil_device);
L
Linus Torvalds 已提交
710 711 712 713 714
}

module_init(kobil_init);
module_exit(kobil_exit);

A
Alan Cox 已提交
715 716 717
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");
L
Linus Torvalds 已提交
718 719 720

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