kobil_sct.c 20.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
 *  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)
A
Alan Cox 已提交
23
 *
L
Linus Torvalds 已提交
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>
A
Alan Cox 已提交
47
#include <linux/uaccess.h>
L
Linus Torvalds 已提交
48
#include <linux/usb.h>
49
#include <linux/usb/serial.h>
L
Linus Torvalds 已提交
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 */
A
Alan Cox 已提交
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);
A
Alan Cox 已提交
75
static int  kobil_write(struct tty_struct *tty, struct usb_serial_port *port,
L
Linus Torvalds 已提交
76
			 const unsigned char *buf, int count);
A
Alan Cox 已提交
77 78
static int  kobil_write_room(struct tty_struct *tty);
static int  kobil_ioctl(struct tty_struct *tty, struct file *file,
L
Linus Torvalds 已提交
79
			unsigned int cmd, unsigned long arg);
A
Alan Cox 已提交
80 81
static int  kobil_tiocmget(struct tty_struct *tty, struct file *file);
static int  kobil_tiocmset(struct tty_struct *tty, struct file *file,
L
Linus Torvalds 已提交
82
			   unsigned int set, unsigned int clear);
A
Alan Cox 已提交
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,
A
Alan Cox 已提交
86
			struct usb_serial_port *port, struct ktermios *old);
A
Alan Cox 已提交
87
static void kobil_init_termios(struct tty_struct *tty);
L
Linus Torvalds 已提交
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 */
};


A
Alan Cox 已提交
98
MODULE_DEVICE_TABLE(usb, id_table);
L
Linus Torvalds 已提交
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,
L
Linus Torvalds 已提交
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,
L
Linus Torvalds 已提交
116 117 118
	.id_table =		id_table,
	.num_ports =		1,
	.attach =		kobil_startup,
119
	.release =		kobil_release,
L
Linus Torvalds 已提交
120
	.ioctl =		kobil_ioctl,
A
Alan Cox 已提交
121
	.set_termios =		kobil_set_termios,
A
Alan Cox 已提交
122
	.init_termios =		kobil_init_termios,
L
Linus Torvalds 已提交
123 124 125 126 127 128 129 130 131 132 133 134 135
	.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 已提交
136 137 138
	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 已提交
139 140 141 142
	__u16 device_type;
};


A
Alan Cox 已提交
143
static int kobil_startup(struct usb_serial *serial)
L
Linus Torvalds 已提交
144 145 146 147 148 149 150 151 152 153
{
	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 已提交
154
	if (!priv)
L
Linus Torvalds 已提交
155 156 157 158 159 160
		return -ENOMEM;

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

A
Alan Cox 已提交
161
	switch (priv->device_type) {
L
Linus Torvalds 已提交
162 163 164 165
	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 已提交
166 167
		printk(KERN_DEBUG
		  "KOBIL KAAN Standard Plus / SecOVID Reader Plus detected\n");
L
Linus Torvalds 已提交
168 169 170 171 172 173 174 175 176 177
		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 已提交
178
	/* search for the necessary endpoints */
L
Linus Torvalds 已提交
179
	pdev = serial->dev;
A
Alan Cox 已提交
180 181
	actconfig = pdev->actconfig;
	interface = actconfig->interface[0];
L
Linus Torvalds 已提交
182
	altsetting = interface->cur_altsetting;
A
Alan Cox 已提交
183 184 185
	endpoint = altsetting->endpoint;

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


204
static void kobil_release(struct usb_serial *serial)
L
Linus Torvalds 已提交
205 206
{
	int i;
207
	dbg("%s - port %d", __func__, serial->port[0]->number);
L
Linus Torvalds 已提交
208

209
	for (i = 0; i < serial->num_ports; ++i)
L
Linus Torvalds 已提交
210 211 212
		kfree(usb_get_serial_port_data(serial->port[i]));
}

A
Alan Cox 已提交
213 214 215 216 217 218 219 220 221
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 已提交
222

223
static int kobil_open(struct tty_struct *tty, struct usb_serial_port *port)
L
Linus Torvalds 已提交
224
{
A
Alan Cox 已提交
225
	int result = 0;
L
Linus Torvalds 已提交
226 227 228 229 230
	struct kobil_private *priv;
	unsigned char *transfer_buffer;
	int transfer_buffer_length = 8;
	int write_urb_transfer_buffer_length = 8;

231
	dbg("%s - port %d", __func__, port->number);
L
Linus Torvalds 已提交
232 233
	priv = usb_get_serial_port_data(port);

A
Alan Cox 已提交
234
	/* someone sets the dev to 0 if the close method has been called */
L
Linus Torvalds 已提交
235 236
	port->interrupt_in_urb->dev = port->serial->dev;

A
Alan Cox 已提交
237
	/* allocate memory for transfer buffer */
238
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
239
	if (!transfer_buffer)
L
Linus Torvalds 已提交
240
		return -ENOMEM;
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
247
		if (!port->write_urb) {
A
Alan Cox 已提交
248 249
			dbg("%s - port %d usb_alloc_urb failed",
						__func__, port->number);
L
Linus Torvalds 已提交
250 251 252 253 254
			kfree(transfer_buffer);
			return -ENOMEM;
		}
	}

A
Alan Cox 已提交
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) {
L
Linus Torvalds 已提交
259 260 261 262
		kfree(transfer_buffer);
		usb_free_urb(port->write_urb);
		port->write_urb = NULL;
		return -ENOMEM;
A
Alan Cox 已提交
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
L
Linus Torvalds 已提交
310
		);
A
Alan Cox 已提交
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
L
Linus Torvalds 已提交
324
		);
A
Alan Cox 已提交
325 326
		dbg("%s - port %d Send reset_all_queues URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
327
	}
A
Alan Cox 已提交
328 329
	if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID ||
	    priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID ||
L
Linus Torvalds 已提交
330
	    priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) {
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
335 336 337 338 339 340 341
	}

	kfree(transfer_buffer);
	return 0;
}


342
static void kobil_close(struct usb_serial_port *port)
L
Linus Torvalds 已提交
343
{
344
	dbg("%s - port %d", __func__, port->number);
L
Linus Torvalds 已提交
345

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


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

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

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

A
Alan Cox 已提交
373
	tty = tty_port_tty_get(&port->port);
374 375
	if (urb->actual_length) {

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

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

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


A
Alan Cox 已提交
405
static void kobil_write_callback(struct urb *purb)
L
Linus Torvalds 已提交
406 407 408 409
{
}


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

	if (count == 0) {
A
Alan Cox 已提交
419 420
		dbg("%s - port %d write request of 0 bytes",
						__func__, port->number);
L
Linus Torvalds 已提交
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);
L
Linus Torvalds 已提交
428 429 430
		return -ENOMEM;
	}

A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
435 436
	priv->filled = priv->filled + count;

A
Alan Cox 已提交
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))
L
Linus Torvalds 已提交
444 445 446 447
			usb_kill_urb(port->interrupt_in_urb);

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

A
Alan Cox 已提交
448 449
		while (todo > 0) {
			/* max 8 byte in one urb (endpoint size) */
L
Linus Torvalds 已提交
450
			length = (todo < 8) ? todo : 8;
A
Alan Cox 已提交
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
			);
L
Linus Torvalds 已提交
464 465

			priv->cur_pos = priv->cur_pos + length;
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
469 470
			todo = priv->filled - priv->cur_pos;

A
Alan Cox 已提交
471
			if (todo > 0)
L
Linus Torvalds 已提交
472
				msleep(24);
A
Alan Cox 已提交
473
		}
L
Linus Torvalds 已提交
474 475 476 477

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

A
Alan Cox 已提交
478 479
		/* someone sets the dev to 0 if the close method
		   has been called */
L
Linus Torvalds 已提交
480
		port->interrupt_in_urb->dev = port->serial->dev;
A
Alan Cox 已提交
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 */
L
Linus Torvalds 已提交
487
			port->interrupt_in_urb->dev = port->serial->dev;
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
493 494 495 496 497 498
		}
	}
	return count;
}


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


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

	priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
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 */
L
Linus Torvalds 已提交
519 520 521
		return -EINVAL;
	}

A
Alan Cox 已提交
522
	/* allocate memory for transfer buffer */
523
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
524
	if (!transfer_buffer)
L
Linus Torvalds 已提交
525 526
		return -ENOMEM;

A
Alan Cox 已提交
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]);
L
Linus Torvalds 已提交
539

540 541 542
	result = 0;
	if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0)
		result = TIOCM_DSR;
L
Linus Torvalds 已提交
543
	kfree(transfer_buffer);
544
	return result;
L
Linus Torvalds 已提交
545 546
}

A
Alan Cox 已提交
547
static int kobil_tiocmset(struct tty_struct *tty, struct file *file,
L
Linus Torvalds 已提交
548 549
			   unsigned int set, unsigned int clear)
{
A
Alan Cox 已提交
550
	struct usb_serial_port *port = tty->driver_data;
A
Alan Cox 已提交
551
	struct kobil_private *priv;
L
Linus Torvalds 已提交
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 ? */
L
Linus Torvalds 已提交
559
	priv = usb_get_serial_port_data(port);
A
Alan Cox 已提交
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 */
L
Linus Torvalds 已提交
563 564 565
		return -EINVAL;
	}

A
Alan Cox 已提交
566
	/* allocate memory for transfer buffer */
567
	transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
568
	if (!transfer_buffer)
L
Linus Torvalds 已提交
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)
A
Alan Cox 已提交
582 583
			dbg("%s - port %d Setting DTR",
						__func__, port->number);
L
Linus Torvalds 已提交
584
		else
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
596 597
	} else {
		if (rts != 0)
A
Alan Cox 已提交
598 599
			dbg("%s - port %d Setting RTS",
						__func__, port->number);
L
Linus Torvalds 已提交
600
		else
A
Alan Cox 已提交
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);
L
Linus Torvalds 已提交
612
	}
A
Alan Cox 已提交
613 614
	dbg("%s - port %d Send set_status_line URB returns: %i",
					__func__, port->number, result);
L
Linus Torvalds 已提交
615 616 617 618
	kfree(transfer_buffer);
	return (result < 0) ? result : 0;
}

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

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

A
Alan Cox 已提交
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;
A
Alan Cox 已提交
647
	}
A
Alan Cox 已提交
648 649
	urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits :
							SUSBCR_SPASB_1StopBit;
A
Alan Cox 已提交
650 651

	settings = kzalloc(50, GFP_KERNEL);
A
Alan Cox 已提交
652
	if (!settings)
A
Alan Cox 已提交
653
		return;
L
Linus Torvalds 已提交
654

A
Alan Cox 已提交
655
	sprintf(settings, "%d ", speed);
L
Linus Torvalds 已提交
656

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

A
Alan Cox 已提交
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
A
Alan Cox 已提交
681 682 683
		);
	kfree(settings);
}
L
Linus Torvalds 已提交
684

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

A
Alan Cox 已提交
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 */
A
Alan Cox 已提交
697
		return -ENOIOCTLCMD;
L
Linus Torvalds 已提交
698

A
Alan Cox 已提交
699
	switch (cmd) {
A
Alan Cox 已提交
700
	case TCFLSH:
701
		transfer_buffer = kmalloc(transfer_buffer_length, GFP_KERNEL);
A
Alan Cox 已提交
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
L
Linus Torvalds 已提交
714
			);
A
Alan Cox 已提交
715

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

A
Alan Cox 已提交
724
static int __init kobil_init(void)
L
Linus Torvalds 已提交
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);
A
Alan Cox 已提交
731
	if (retval)
L
Linus Torvalds 已提交
732 733
		goto failed_usb_register;

734 735
	printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION ":"
	       DRIVER_DESC "\n");
L
Linus Torvalds 已提交
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;
}


A
Alan Cox 已提交
745
static void __exit kobil_exit(void)
L
Linus Torvalds 已提交
746
{
A
Alan Cox 已提交
747 748
	usb_deregister(&kobil_driver);
	usb_serial_deregister(&kobil_device);
L
Linus Torvalds 已提交
749 750 751 752 753
}

module_init(kobil_init);
module_exit(kobil_exit);

A
Alan Cox 已提交
754 755 756
MODULE_AUTHOR(DRIVER_AUTHOR);
MODULE_DESCRIPTION(DRIVER_DESC);
MODULE_LICENSE("GPL");
L
Linus Torvalds 已提交
757 758 759

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