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