1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31#include <linux/kernel.h>
32#include <linux/errno.h>
33#include <linux/init.h>
34#include <linux/slab.h>
35#include <linux/tty.h>
36#include <linux/tty_driver.h>
37#include <linux/tty_flip.h>
38#include <linux/module.h>
39#include <linux/spinlock.h>
40#include <linux/uaccess.h>
41#include <linux/usb.h>
42#include <linux/usb/serial.h>
43
44#define CYBERJACK_LOCAL_BUF_SIZE 32
45
46static bool debug;
47
48
49
50
51#define DRIVER_VERSION "v1.01"
52#define DRIVER_AUTHOR "Matthias Bruestle"
53#define DRIVER_DESC "REINER SCT cyberJack pinpad/e-com USB Chipcard Reader Driver"
54
55
56#define CYBERJACK_VENDOR_ID 0x0C4B
57#define CYBERJACK_PRODUCT_ID 0x0100
58
59
60static int cyberjack_startup(struct usb_serial *serial);
61static void cyberjack_disconnect(struct usb_serial *serial);
62static void cyberjack_release(struct usb_serial *serial);
63static int cyberjack_open(struct tty_struct *tty,
64 struct usb_serial_port *port);
65static void cyberjack_close(struct usb_serial_port *port);
66static int cyberjack_write(struct tty_struct *tty,
67 struct usb_serial_port *port, const unsigned char *buf, int count);
68static int cyberjack_write_room(struct tty_struct *tty);
69static void cyberjack_read_int_callback(struct urb *urb);
70static void cyberjack_read_bulk_callback(struct urb *urb);
71static void cyberjack_write_bulk_callback(struct urb *urb);
72
73static const struct usb_device_id id_table[] = {
74 { USB_DEVICE(CYBERJACK_VENDOR_ID, CYBERJACK_PRODUCT_ID) },
75 { }
76};
77
78MODULE_DEVICE_TABLE(usb, id_table);
79
80static struct usb_serial_driver cyberjack_device = {
81 .driver = {
82 .owner = THIS_MODULE,
83 .name = "cyberjack",
84 },
85 .description = "Reiner SCT Cyberjack USB card reader",
86 .id_table = id_table,
87 .num_ports = 1,
88 .attach = cyberjack_startup,
89 .disconnect = cyberjack_disconnect,
90 .release = cyberjack_release,
91 .open = cyberjack_open,
92 .close = cyberjack_close,
93 .write = cyberjack_write,
94 .write_room = cyberjack_write_room,
95 .read_int_callback = cyberjack_read_int_callback,
96 .read_bulk_callback = cyberjack_read_bulk_callback,
97 .write_bulk_callback = cyberjack_write_bulk_callback,
98};
99
100static struct usb_serial_driver * const serial_drivers[] = {
101 &cyberjack_device, NULL
102};
103
104struct cyberjack_private {
105 spinlock_t lock;
106 short rdtodo;
107 unsigned char wrbuf[5*64];
108 short wrfilled;
109 short wrsent;
110};
111
112
113static int cyberjack_startup(struct usb_serial *serial)
114{
115 struct cyberjack_private *priv;
116 int i;
117
118
119 priv = kmalloc(sizeof(struct cyberjack_private), GFP_KERNEL);
120 if (!priv)
121 return -ENOMEM;
122
123
124 spin_lock_init(&priv->lock);
125 priv->rdtodo = 0;
126 priv->wrfilled = 0;
127 priv->wrsent = 0;
128 usb_set_serial_port_data(serial->port[0], priv);
129
130 init_waitqueue_head(&serial->port[0]->write_wait);
131
132 for (i = 0; i < serial->num_ports; ++i) {
133 int result;
134 result = usb_submit_urb(serial->port[i]->interrupt_in_urb,
135 GFP_KERNEL);
136 if (result)
137 dev_err(&serial->dev->dev,
138 "usb_submit_urb(read int) failed\n");
139 dbg("%s - usb_submit_urb(int urb)", __func__);
140 }
141
142 return 0;
143}
144
145static void cyberjack_disconnect(struct usb_serial *serial)
146{
147 int i;
148
149 for (i = 0; i < serial->num_ports; ++i)
150 usb_kill_urb(serial->port[i]->interrupt_in_urb);
151}
152
153static void cyberjack_release(struct usb_serial *serial)
154{
155 int i;
156
157 for (i = 0; i < serial->num_ports; ++i) {
158
159 kfree(usb_get_serial_port_data(serial->port[i]));
160 }
161}
162
163static int cyberjack_open(struct tty_struct *tty,
164 struct usb_serial_port *port)
165{
166 struct cyberjack_private *priv;
167 unsigned long flags;
168 int result = 0;
169
170 dbg("%s - usb_clear_halt", __func__);
171 usb_clear_halt(port->serial->dev, port->write_urb->pipe);
172
173 priv = usb_get_serial_port_data(port);
174 spin_lock_irqsave(&priv->lock, flags);
175 priv->rdtodo = 0;
176 priv->wrfilled = 0;
177 priv->wrsent = 0;
178 spin_unlock_irqrestore(&priv->lock, flags);
179
180 return result;
181}
182
183static void cyberjack_close(struct usb_serial_port *port)
184{
185 if (port->serial->dev) {
186
187 usb_kill_urb(port->write_urb);
188 usb_kill_urb(port->read_urb);
189 }
190}
191
192static int cyberjack_write(struct tty_struct *tty,
193 struct usb_serial_port *port, const unsigned char *buf, int count)
194{
195 struct cyberjack_private *priv = usb_get_serial_port_data(port);
196 unsigned long flags;
197 int result;
198 int wrexpected;
199
200 if (count == 0) {
201 dbg("%s - write request of 0 bytes", __func__);
202 return 0;
203 }
204
205 if (!test_and_clear_bit(0, &port->write_urbs_free)) {
206 dbg("%s - already writing", __func__);
207 return 0;
208 }
209
210 spin_lock_irqsave(&priv->lock, flags);
211
212 if (count+priv->wrfilled > sizeof(priv->wrbuf)) {
213
214 priv->wrfilled = 0;
215 spin_unlock_irqrestore(&priv->lock, flags);
216 set_bit(0, &port->write_urbs_free);
217 return 0;
218 }
219
220
221 memcpy(priv->wrbuf + priv->wrfilled, buf, count);
222
223 usb_serial_debug_data(debug, &port->dev, __func__, count,
224 priv->wrbuf + priv->wrfilled);
225 priv->wrfilled += count;
226
227 if (priv->wrfilled >= 3) {
228 wrexpected = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
229 dbg("%s - expected data: %d", __func__, wrexpected);
230 } else
231 wrexpected = sizeof(priv->wrbuf);
232
233 if (priv->wrfilled >= wrexpected) {
234
235 int length;
236
237 dbg("%s - transmitting data (frame 1)", __func__);
238 length = (wrexpected > port->bulk_out_size) ?
239 port->bulk_out_size : wrexpected;
240
241 memcpy(port->write_urb->transfer_buffer, priv->wrbuf, length);
242 priv->wrsent = length;
243
244
245 port->write_urb->transfer_buffer_length = length;
246
247
248 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
249 if (result) {
250 dev_err(&port->dev,
251 "%s - failed submitting write urb, error %d",
252 __func__, result);
253
254 priv->wrfilled = 0;
255 priv->wrsent = 0;
256 spin_unlock_irqrestore(&priv->lock, flags);
257 set_bit(0, &port->write_urbs_free);
258 return 0;
259 }
260
261 dbg("%s - priv->wrsent=%d", __func__, priv->wrsent);
262 dbg("%s - priv->wrfilled=%d", __func__, priv->wrfilled);
263
264 if (priv->wrsent >= priv->wrfilled) {
265 dbg("%s - buffer cleaned", __func__);
266 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
267 priv->wrfilled = 0;
268 priv->wrsent = 0;
269 }
270 }
271
272 spin_unlock_irqrestore(&priv->lock, flags);
273
274 return count;
275}
276
277static int cyberjack_write_room(struct tty_struct *tty)
278{
279
280 return CYBERJACK_LOCAL_BUF_SIZE;
281}
282
283static void cyberjack_read_int_callback(struct urb *urb)
284{
285 struct usb_serial_port *port = urb->context;
286 struct cyberjack_private *priv = usb_get_serial_port_data(port);
287 unsigned char *data = urb->transfer_buffer;
288 int status = urb->status;
289 int result;
290
291
292 if (status)
293 return;
294
295 usb_serial_debug_data(debug, &port->dev, __func__,
296 urb->actual_length, data);
297
298
299 if (urb->actual_length == 4 && data[0] == 0x01) {
300 short old_rdtodo;
301
302
303 unsigned short size = ((unsigned short)data[3]<<8)+data[2]+3;
304
305 spin_lock(&priv->lock);
306
307 old_rdtodo = priv->rdtodo;
308
309 if (old_rdtodo + size < old_rdtodo) {
310 dbg("To many bulk_in urbs to do.");
311 spin_unlock(&priv->lock);
312 goto resubmit;
313 }
314
315
316 priv->rdtodo += size;
317
318 dbg("%s - rdtodo: %d", __func__, priv->rdtodo);
319
320 spin_unlock(&priv->lock);
321
322 if (!old_rdtodo) {
323 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
324 if (result)
325 dev_err(&port->dev, "%s - failed resubmitting "
326 "read urb, error %d\n",
327 __func__, result);
328 dbg("%s - usb_submit_urb(read urb)", __func__);
329 }
330 }
331
332resubmit:
333 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
334 if (result)
335 dev_err(&port->dev, "usb_submit_urb(read int) failed\n");
336 dbg("%s - usb_submit_urb(int urb)", __func__);
337}
338
339static void cyberjack_read_bulk_callback(struct urb *urb)
340{
341 struct usb_serial_port *port = urb->context;
342 struct cyberjack_private *priv = usb_get_serial_port_data(port);
343 struct tty_struct *tty;
344 unsigned char *data = urb->transfer_buffer;
345 short todo;
346 int result;
347 int status = urb->status;
348
349 usb_serial_debug_data(debug, &port->dev, __func__,
350 urb->actual_length, data);
351 if (status) {
352 dbg("%s - nonzero read bulk status received: %d",
353 __func__, status);
354 return;
355 }
356
357 tty = tty_port_tty_get(&port->port);
358 if (!tty) {
359 dbg("%s - ignoring since device not open", __func__);
360 return;
361 }
362 if (urb->actual_length) {
363 tty_insert_flip_string(tty, data, urb->actual_length);
364 tty_flip_buffer_push(tty);
365 }
366 tty_kref_put(tty);
367
368 spin_lock(&priv->lock);
369
370
371 priv->rdtodo -= urb->actual_length;
372
373 if (priv->rdtodo < 0)
374 priv->rdtodo = 0;
375 todo = priv->rdtodo;
376
377 spin_unlock(&priv->lock);
378
379 dbg("%s - rdtodo: %d", __func__, todo);
380
381
382 if (todo ) {
383 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
384 if (result)
385 dev_err(&port->dev, "%s - failed resubmitting read "
386 "urb, error %d\n", __func__, result);
387 dbg("%s - usb_submit_urb(read urb)", __func__);
388 }
389}
390
391static void cyberjack_write_bulk_callback(struct urb *urb)
392{
393 struct usb_serial_port *port = urb->context;
394 struct cyberjack_private *priv = usb_get_serial_port_data(port);
395 int status = urb->status;
396
397 set_bit(0, &port->write_urbs_free);
398 if (status) {
399 dbg("%s - nonzero write bulk status received: %d",
400 __func__, status);
401 return;
402 }
403
404 spin_lock(&priv->lock);
405
406
407 if (priv->wrfilled) {
408 int length, blksize, result;
409
410 dbg("%s - transmitting data (frame n)", __func__);
411
412 length = ((priv->wrfilled - priv->wrsent) > port->bulk_out_size) ?
413 port->bulk_out_size : (priv->wrfilled - priv->wrsent);
414
415 memcpy(port->write_urb->transfer_buffer,
416 priv->wrbuf + priv->wrsent, length);
417 priv->wrsent += length;
418
419
420 port->write_urb->transfer_buffer_length = length;
421
422
423 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
424 if (result) {
425 dev_err(&port->dev,
426 "%s - failed submitting write urb, error %d\n",
427 __func__, result);
428
429 priv->wrfilled = 0;
430 priv->wrsent = 0;
431 goto exit;
432 }
433
434 dbg("%s - priv->wrsent=%d", __func__, priv->wrsent);
435 dbg("%s - priv->wrfilled=%d", __func__, priv->wrfilled);
436
437 blksize = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
438
439 if (priv->wrsent >= priv->wrfilled ||
440 priv->wrsent >= blksize) {
441 dbg("%s - buffer cleaned", __func__);
442 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
443 priv->wrfilled = 0;
444 priv->wrsent = 0;
445 }
446 }
447
448exit:
449 spin_unlock(&priv->lock);
450 usb_serial_port_softint(port);
451}
452
453module_usb_serial_driver(serial_drivers, id_table);
454
455MODULE_AUTHOR(DRIVER_AUTHOR);
456MODULE_DESCRIPTION(DRIVER_DESC);
457MODULE_VERSION(DRIVER_VERSION);
458MODULE_LICENSE("GPL");
459
460module_param(debug, bool, S_IRUGO | S_IWUSR);
461MODULE_PARM_DESC(debug, "Debug enabled or not");
462