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; | |
feb0a36a | 339 | result = usb_submit_urb(port->interrupt_out_urb, GFP_NOIO); |
b12f7a1c | 340 | dev_dbg(&port->dev, "%s - Send write URB returns: %i\n", __func__, result); |
1da177e4 LT |
341 | todo = priv->filled - priv->cur_pos; |
342 | ||
dee0a7cc | 343 | if (todo > 0) |
1da177e4 | 344 | msleep(24); |
dee0a7cc | 345 | } |
1da177e4 | 346 | |
1da177e4 LT |
347 | priv->filled = 0; |
348 | priv->cur_pos = 0; | |
349 | ||
dee0a7cc AC |
350 | /* start reading (except TWIN and KAAN SIM) */ |
351 | if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID || | |
352 | priv->device_type == KOBIL_ADAPTER_K_PRODUCT_ID) { | |
dee0a7cc AC |
353 | result = usb_submit_urb(port->interrupt_in_urb, |
354 | GFP_NOIO); | |
b12f7a1c | 355 | dev_dbg(&port->dev, "%s - Send read URB returns: %i\n", __func__, result); |
1da177e4 LT |
356 | } |
357 | } | |
358 | return count; | |
359 | } | |
360 | ||
361 | ||
dee0a7cc | 362 | static int kobil_write_room(struct tty_struct *tty) |
1da177e4 | 363 | { |
95da310e | 364 | /* FIXME */ |
1da177e4 LT |
365 | return 8; |
366 | } | |
367 | ||
368 | ||
60b33c13 | 369 | static int kobil_tiocmget(struct tty_struct *tty) |
1da177e4 | 370 | { |
95da310e | 371 | struct usb_serial_port *port = tty->driver_data; |
dee0a7cc | 372 | struct kobil_private *priv; |
1da177e4 LT |
373 | int result; |
374 | unsigned char *transfer_buffer; | |
375 | int transfer_buffer_length = 8; | |
376 | ||
377 | priv = usb_get_serial_port_data(port); | |
dee0a7cc AC |
378 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID |
379 | || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) { | |
380 | /* This device doesn't support ioctl calls */ | |
1da177e4 LT |
381 | return -EINVAL; |
382 | } | |
383 | ||
dee0a7cc | 384 | /* allocate memory for transfer buffer */ |
80b6ca48 | 385 | transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL); |
dee0a7cc | 386 | if (!transfer_buffer) |
1da177e4 | 387 | return -ENOMEM; |
1da177e4 | 388 | |
dee0a7cc AC |
389 | result = usb_control_msg(port->serial->dev, |
390 | usb_rcvctrlpipe(port->serial->dev, 0), | |
391 | SUSBCRequest_GetStatusLineState, | |
392 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_IN, | |
393 | 0, | |
394 | 0, | |
395 | transfer_buffer, | |
396 | transfer_buffer_length, | |
397 | KOBIL_TIMEOUT); | |
398 | ||
b12f7a1c GKH |
399 | dev_dbg(&port->dev, "%s - Send get_status_line_state URB returns: %i. Statusline: %02x\n", |
400 | __func__, result, transfer_buffer[0]); | |
1da177e4 | 401 | |
a40d8540 AC |
402 | result = 0; |
403 | if ((transfer_buffer[0] & SUSBCR_GSL_DSR) != 0) | |
404 | result = TIOCM_DSR; | |
1da177e4 | 405 | kfree(transfer_buffer); |
a40d8540 | 406 | return result; |
1da177e4 LT |
407 | } |
408 | ||
20b9d177 | 409 | static int kobil_tiocmset(struct tty_struct *tty, |
1da177e4 LT |
410 | unsigned int set, unsigned int clear) |
411 | { | |
95da310e | 412 | struct usb_serial_port *port = tty->driver_data; |
b12f7a1c | 413 | struct device *dev = &port->dev; |
dee0a7cc | 414 | struct kobil_private *priv; |
1da177e4 LT |
415 | int result; |
416 | int dtr = 0; | |
417 | int rts = 0; | |
418 | unsigned char *transfer_buffer; | |
419 | int transfer_buffer_length = 8; | |
420 | ||
a40d8540 | 421 | /* FIXME: locking ? */ |
1da177e4 | 422 | priv = usb_get_serial_port_data(port); |
dee0a7cc AC |
423 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID |
424 | || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) { | |
425 | /* This device doesn't support ioctl calls */ | |
1da177e4 LT |
426 | return -EINVAL; |
427 | } | |
428 | ||
dee0a7cc | 429 | /* allocate memory for transfer buffer */ |
80b6ca48 | 430 | transfer_buffer = kzalloc(transfer_buffer_length, GFP_KERNEL); |
dee0a7cc | 431 | if (!transfer_buffer) |
1da177e4 | 432 | return -ENOMEM; |
1da177e4 LT |
433 | |
434 | if (set & TIOCM_RTS) | |
435 | rts = 1; | |
436 | if (set & TIOCM_DTR) | |
437 | dtr = 1; | |
438 | if (clear & TIOCM_RTS) | |
439 | rts = 0; | |
440 | if (clear & TIOCM_DTR) | |
441 | dtr = 0; | |
442 | ||
443 | if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) { | |
444 | if (dtr != 0) | |
b12f7a1c | 445 | dev_dbg(dev, "%s - Setting DTR\n", __func__); |
1da177e4 | 446 | else |
b12f7a1c | 447 | dev_dbg(dev, "%s - Clearing DTR\n", __func__); |
dee0a7cc AC |
448 | result = usb_control_msg(port->serial->dev, |
449 | usb_rcvctrlpipe(port->serial->dev, 0), | |
450 | SUSBCRequest_SetStatusLinesOrQueues, | |
451 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
452 | ((dtr != 0) ? SUSBCR_SSL_SETDTR : SUSBCR_SSL_CLRDTR), | |
453 | 0, | |
454 | transfer_buffer, | |
455 | 0, | |
456 | KOBIL_TIMEOUT); | |
1da177e4 LT |
457 | } else { |
458 | if (rts != 0) | |
b12f7a1c | 459 | dev_dbg(dev, "%s - Setting RTS\n", __func__); |
1da177e4 | 460 | else |
b12f7a1c | 461 | dev_dbg(dev, "%s - Clearing RTS\n", __func__); |
dee0a7cc AC |
462 | result = usb_control_msg(port->serial->dev, |
463 | usb_rcvctrlpipe(port->serial->dev, 0), | |
464 | SUSBCRequest_SetStatusLinesOrQueues, | |
465 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
466 | ((rts != 0) ? SUSBCR_SSL_SETRTS : SUSBCR_SSL_CLRRTS), | |
467 | 0, | |
468 | transfer_buffer, | |
469 | 0, | |
470 | KOBIL_TIMEOUT); | |
1da177e4 | 471 | } |
b12f7a1c | 472 | dev_dbg(dev, "%s - Send set_status_line URB returns: %i\n", __func__, result); |
1da177e4 LT |
473 | kfree(transfer_buffer); |
474 | return (result < 0) ? result : 0; | |
475 | } | |
476 | ||
95da310e AC |
477 | static void kobil_set_termios(struct tty_struct *tty, |
478 | struct usb_serial_port *port, struct ktermios *old) | |
1da177e4 | 479 | { |
dee0a7cc | 480 | struct kobil_private *priv; |
1da177e4 LT |
481 | int result; |
482 | unsigned short urb_val = 0; | |
adc8d746 | 483 | int c_cflag = tty->termios.c_cflag; |
94d0f7ea | 484 | speed_t speed; |
1da177e4 LT |
485 | |
486 | priv = usb_get_serial_port_data(port); | |
dee0a7cc | 487 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID || |
b31f658b | 488 | priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) { |
dee0a7cc | 489 | /* This device doesn't support ioctl calls */ |
6a6c8b36 | 490 | tty_termios_copy_hw(&tty->termios, old); |
94d0f7ea | 491 | return; |
b31f658b | 492 | } |
1da177e4 | 493 | |
dee0a7cc AC |
494 | speed = tty_get_baud_rate(tty); |
495 | switch (speed) { | |
496 | case 1200: | |
497 | urb_val = SUSBCR_SBR_1200; | |
498 | break; | |
499 | default: | |
500 | speed = 9600; | |
501 | case 9600: | |
502 | urb_val = SUSBCR_SBR_9600; | |
503 | break; | |
94d0f7ea | 504 | } |
dee0a7cc AC |
505 | urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits : |
506 | SUSBCR_SPASB_1StopBit; | |
94d0f7ea | 507 | if (c_cflag & PARENB) { |
96679f6b | 508 | if (c_cflag & PARODD) |
94d0f7ea | 509 | urb_val |= SUSBCR_SPASB_OddParity; |
96679f6b | 510 | else |
94d0f7ea | 511 | urb_val |= SUSBCR_SPASB_EvenParity; |
96679f6b | 512 | } else |
94d0f7ea | 513 | urb_val |= SUSBCR_SPASB_NoParity; |
adc8d746 | 514 | tty->termios.c_cflag &= ~CMSPAR; |
95da310e | 515 | tty_encode_baud_rate(tty, speed, speed); |
1da177e4 | 516 | |
dee0a7cc AC |
517 | result = usb_control_msg(port->serial->dev, |
518 | usb_rcvctrlpipe(port->serial->dev, 0), | |
519 | SUSBCRequest_SetBaudRateParityAndStopBits, | |
520 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
521 | urb_val, | |
522 | 0, | |
96679f6b | 523 | NULL, |
dee0a7cc AC |
524 | 0, |
525 | KOBIL_TIMEOUT | |
94d0f7ea | 526 | ); |
94d0f7ea | 527 | } |
1da177e4 | 528 | |
00a0d0d6 | 529 | static int kobil_ioctl(struct tty_struct *tty, |
dee0a7cc | 530 | unsigned int cmd, unsigned long arg) |
94d0f7ea | 531 | { |
95da310e | 532 | struct usb_serial_port *port = tty->driver_data; |
dee0a7cc | 533 | struct kobil_private *priv = usb_get_serial_port_data(port); |
94d0f7ea AC |
534 | unsigned char *transfer_buffer; |
535 | int transfer_buffer_length = 8; | |
536 | int result; | |
537 | ||
dee0a7cc AC |
538 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID || |
539 | priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) | |
540 | /* This device doesn't support ioctl calls */ | |
b31f658b | 541 | return -ENOIOCTLCMD; |
1da177e4 | 542 | |
94d0f7ea | 543 | switch (cmd) { |
95da310e | 544 | case TCFLSH: |
5cbded58 | 545 | transfer_buffer = kmalloc(transfer_buffer_length, GFP_KERNEL); |
dee0a7cc AC |
546 | if (!transfer_buffer) |
547 | return -ENOBUFS; | |
548 | ||
549 | result = usb_control_msg(port->serial->dev, | |
550 | usb_rcvctrlpipe(port->serial->dev, 0), | |
551 | SUSBCRequest_Misc, | |
552 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
553 | SUSBCR_MSC_ResetAllQueues, | |
554 | 0, | |
555 | NULL, /* transfer_buffer, */ | |
556 | 0, | |
557 | KOBIL_TIMEOUT | |
1da177e4 | 558 | ); |
dee0a7cc | 559 | |
b12f7a1c GKH |
560 | dev_dbg(&port->dev, |
561 | "%s - Send reset_all_queues (FLUSH) URB returns: %i", __func__, result); | |
1da177e4 | 562 | kfree(transfer_buffer); |
95da310e | 563 | return (result < 0) ? -EIO: 0; |
94d0f7ea AC |
564 | default: |
565 | return -ENOIOCTLCMD; | |
1da177e4 | 566 | } |
1da177e4 LT |
567 | } |
568 | ||
68e24113 | 569 | module_usb_serial_driver(serial_drivers, id_table); |
1da177e4 | 570 | |
dee0a7cc AC |
571 | MODULE_AUTHOR(DRIVER_AUTHOR); |
572 | MODULE_DESCRIPTION(DRIVER_DESC); | |
573 | MODULE_LICENSE("GPL"); |