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 | 246 | /* start reading (Adapter B 'cause PNP string) */ |
811c3707 | 247 | result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL); |
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; | |
19125283 JH |
338 | result = usb_submit_urb(port->interrupt_out_urb, |
339 | GFP_ATOMIC); | |
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 | 353 | result = usb_submit_urb(port->interrupt_in_urb, |
19125283 | 354 | GFP_ATOMIC); |
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; | |
1da177e4 | 418 | |
a40d8540 | 419 | /* FIXME: locking ? */ |
1da177e4 | 420 | priv = usb_get_serial_port_data(port); |
dee0a7cc AC |
421 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID |
422 | || priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) { | |
423 | /* This device doesn't support ioctl calls */ | |
1da177e4 LT |
424 | return -EINVAL; |
425 | } | |
426 | ||
1da177e4 LT |
427 | if (set & TIOCM_RTS) |
428 | rts = 1; | |
429 | if (set & TIOCM_DTR) | |
430 | dtr = 1; | |
431 | if (clear & TIOCM_RTS) | |
432 | rts = 0; | |
433 | if (clear & TIOCM_DTR) | |
434 | dtr = 0; | |
435 | ||
436 | if (priv->device_type == KOBIL_ADAPTER_B_PRODUCT_ID) { | |
437 | if (dtr != 0) | |
b12f7a1c | 438 | dev_dbg(dev, "%s - Setting DTR\n", __func__); |
1da177e4 | 439 | else |
b12f7a1c | 440 | dev_dbg(dev, "%s - Clearing DTR\n", __func__); |
dee0a7cc | 441 | result = usb_control_msg(port->serial->dev, |
90419cfc | 442 | usb_sndctrlpipe(port->serial->dev, 0), |
dee0a7cc AC |
443 | SUSBCRequest_SetStatusLinesOrQueues, |
444 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
445 | ((dtr != 0) ? SUSBCR_SSL_SETDTR : SUSBCR_SSL_CLRDTR), | |
446 | 0, | |
90419cfc | 447 | NULL, |
dee0a7cc AC |
448 | 0, |
449 | KOBIL_TIMEOUT); | |
1da177e4 LT |
450 | } else { |
451 | if (rts != 0) | |
b12f7a1c | 452 | dev_dbg(dev, "%s - Setting RTS\n", __func__); |
1da177e4 | 453 | else |
b12f7a1c | 454 | dev_dbg(dev, "%s - Clearing RTS\n", __func__); |
dee0a7cc | 455 | result = usb_control_msg(port->serial->dev, |
90419cfc | 456 | usb_sndctrlpipe(port->serial->dev, 0), |
dee0a7cc AC |
457 | SUSBCRequest_SetStatusLinesOrQueues, |
458 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
459 | ((rts != 0) ? SUSBCR_SSL_SETRTS : SUSBCR_SSL_CLRRTS), | |
460 | 0, | |
90419cfc | 461 | NULL, |
dee0a7cc AC |
462 | 0, |
463 | KOBIL_TIMEOUT); | |
1da177e4 | 464 | } |
b12f7a1c | 465 | dev_dbg(dev, "%s - Send set_status_line URB returns: %i\n", __func__, result); |
1da177e4 LT |
466 | return (result < 0) ? result : 0; |
467 | } | |
468 | ||
95da310e AC |
469 | static void kobil_set_termios(struct tty_struct *tty, |
470 | struct usb_serial_port *port, struct ktermios *old) | |
1da177e4 | 471 | { |
dee0a7cc | 472 | struct kobil_private *priv; |
1da177e4 LT |
473 | int result; |
474 | unsigned short urb_val = 0; | |
adc8d746 | 475 | int c_cflag = tty->termios.c_cflag; |
94d0f7ea | 476 | speed_t speed; |
1da177e4 LT |
477 | |
478 | priv = usb_get_serial_port_data(port); | |
dee0a7cc | 479 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID || |
b31f658b | 480 | priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) { |
dee0a7cc | 481 | /* This device doesn't support ioctl calls */ |
6a6c8b36 | 482 | tty_termios_copy_hw(&tty->termios, old); |
94d0f7ea | 483 | return; |
b31f658b | 484 | } |
1da177e4 | 485 | |
dee0a7cc AC |
486 | speed = tty_get_baud_rate(tty); |
487 | switch (speed) { | |
488 | case 1200: | |
489 | urb_val = SUSBCR_SBR_1200; | |
490 | break; | |
491 | default: | |
492 | speed = 9600; | |
493 | case 9600: | |
494 | urb_val = SUSBCR_SBR_9600; | |
495 | break; | |
94d0f7ea | 496 | } |
dee0a7cc AC |
497 | urb_val |= (c_cflag & CSTOPB) ? SUSBCR_SPASB_2StopBits : |
498 | SUSBCR_SPASB_1StopBit; | |
94d0f7ea | 499 | if (c_cflag & PARENB) { |
96679f6b | 500 | if (c_cflag & PARODD) |
94d0f7ea | 501 | urb_val |= SUSBCR_SPASB_OddParity; |
96679f6b | 502 | else |
94d0f7ea | 503 | urb_val |= SUSBCR_SPASB_EvenParity; |
96679f6b | 504 | } else |
94d0f7ea | 505 | urb_val |= SUSBCR_SPASB_NoParity; |
adc8d746 | 506 | tty->termios.c_cflag &= ~CMSPAR; |
95da310e | 507 | tty_encode_baud_rate(tty, speed, speed); |
1da177e4 | 508 | |
dee0a7cc | 509 | result = usb_control_msg(port->serial->dev, |
90419cfc | 510 | usb_sndctrlpipe(port->serial->dev, 0), |
dee0a7cc AC |
511 | SUSBCRequest_SetBaudRateParityAndStopBits, |
512 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
513 | urb_val, | |
514 | 0, | |
96679f6b | 515 | NULL, |
dee0a7cc AC |
516 | 0, |
517 | KOBIL_TIMEOUT | |
94d0f7ea | 518 | ); |
94d0f7ea | 519 | } |
1da177e4 | 520 | |
00a0d0d6 | 521 | static int kobil_ioctl(struct tty_struct *tty, |
dee0a7cc | 522 | unsigned int cmd, unsigned long arg) |
94d0f7ea | 523 | { |
95da310e | 524 | struct usb_serial_port *port = tty->driver_data; |
dee0a7cc | 525 | struct kobil_private *priv = usb_get_serial_port_data(port); |
94d0f7ea AC |
526 | int result; |
527 | ||
dee0a7cc AC |
528 | if (priv->device_type == KOBIL_USBTWIN_PRODUCT_ID || |
529 | priv->device_type == KOBIL_KAAN_SIM_PRODUCT_ID) | |
530 | /* This device doesn't support ioctl calls */ | |
b31f658b | 531 | return -ENOIOCTLCMD; |
1da177e4 | 532 | |
94d0f7ea | 533 | switch (cmd) { |
95da310e | 534 | case TCFLSH: |
dee0a7cc | 535 | result = usb_control_msg(port->serial->dev, |
90419cfc | 536 | usb_sndctrlpipe(port->serial->dev, 0), |
dee0a7cc AC |
537 | SUSBCRequest_Misc, |
538 | USB_TYPE_VENDOR | USB_RECIP_ENDPOINT | USB_DIR_OUT, | |
539 | SUSBCR_MSC_ResetAllQueues, | |
540 | 0, | |
90419cfc | 541 | NULL, |
dee0a7cc AC |
542 | 0, |
543 | KOBIL_TIMEOUT | |
1da177e4 | 544 | ); |
dee0a7cc | 545 | |
b12f7a1c | 546 | dev_dbg(&port->dev, |
d9a38a87 JH |
547 | "%s - Send reset_all_queues (FLUSH) URB returns: %i\n", |
548 | __func__, result); | |
95da310e | 549 | return (result < 0) ? -EIO: 0; |
94d0f7ea AC |
550 | default: |
551 | return -ENOIOCTLCMD; | |
1da177e4 | 552 | } |
1da177e4 LT |
553 | } |
554 | ||
68e24113 | 555 | module_usb_serial_driver(serial_drivers, id_table); |
1da177e4 | 556 | |
dee0a7cc AC |
557 | MODULE_AUTHOR(DRIVER_AUTHOR); |
558 | MODULE_DESCRIPTION(DRIVER_DESC); | |
559 | MODULE_LICENSE("GPL"); |