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