Loading...
1/*
2 * REINER SCT cyberJack pinpad/e-com USB Chipcard Reader Driver
3 *
4 * Copyright (C) 2001 REINER SCT
5 * Author: Matthias Bruestle
6 *
7 * Contact: support@reiner-sct.com (see MAINTAINERS)
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 * In case of problems, please write to the contact e-mail address
22 * mentioned above.
23 *
24 * Please note that later models of the cyberjack reader family are
25 * supported by a libusb-based userspace device driver.
26 *
27 * Homepage: http://www.reiner-sct.de/support/treiber_cyberjack.php#linux
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 int debug;
47
48/*
49 * Version Information
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/* Function prototypes */
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 { } /* Terminating entry */
76};
77
78MODULE_DEVICE_TABLE(usb, id_table);
79
80static struct usb_driver cyberjack_driver = {
81 .name = "cyberjack",
82 .probe = usb_serial_probe,
83 .disconnect = usb_serial_disconnect,
84 .id_table = id_table,
85 .no_dynamic_id = 1,
86};
87
88static struct usb_serial_driver cyberjack_device = {
89 .driver = {
90 .owner = THIS_MODULE,
91 .name = "cyberjack",
92 },
93 .description = "Reiner SCT Cyberjack USB card reader",
94 .usb_driver = &cyberjack_driver,
95 .id_table = id_table,
96 .num_ports = 1,
97 .attach = cyberjack_startup,
98 .disconnect = cyberjack_disconnect,
99 .release = cyberjack_release,
100 .open = cyberjack_open,
101 .close = cyberjack_close,
102 .write = cyberjack_write,
103 .write_room = cyberjack_write_room,
104 .read_int_callback = cyberjack_read_int_callback,
105 .read_bulk_callback = cyberjack_read_bulk_callback,
106 .write_bulk_callback = cyberjack_write_bulk_callback,
107};
108
109struct cyberjack_private {
110 spinlock_t lock; /* Lock for SMP */
111 short rdtodo; /* Bytes still to read */
112 unsigned char wrbuf[5*64]; /* Buffer for collecting data to write */
113 short wrfilled; /* Overall data size we already got */
114 short wrsent; /* Data already sent */
115};
116
117/* do some startup allocations not currently performed by usb_serial_probe() */
118static int cyberjack_startup(struct usb_serial *serial)
119{
120 struct cyberjack_private *priv;
121 int i;
122
123 dbg("%s", __func__);
124
125 /* allocate the private data structure */
126 priv = kmalloc(sizeof(struct cyberjack_private), GFP_KERNEL);
127 if (!priv)
128 return -ENOMEM;
129
130 /* set initial values */
131 spin_lock_init(&priv->lock);
132 priv->rdtodo = 0;
133 priv->wrfilled = 0;
134 priv->wrsent = 0;
135 usb_set_serial_port_data(serial->port[0], priv);
136
137 init_waitqueue_head(&serial->port[0]->write_wait);
138
139 for (i = 0; i < serial->num_ports; ++i) {
140 int result;
141 serial->port[i]->interrupt_in_urb->dev = serial->dev;
142 result = usb_submit_urb(serial->port[i]->interrupt_in_urb,
143 GFP_KERNEL);
144 if (result)
145 dev_err(&serial->dev->dev,
146 "usb_submit_urb(read int) failed\n");
147 dbg("%s - usb_submit_urb(int urb)", __func__);
148 }
149
150 return 0;
151}
152
153static void cyberjack_disconnect(struct usb_serial *serial)
154{
155 int i;
156
157 dbg("%s", __func__);
158
159 for (i = 0; i < serial->num_ports; ++i)
160 usb_kill_urb(serial->port[i]->interrupt_in_urb);
161}
162
163static void cyberjack_release(struct usb_serial *serial)
164{
165 int i;
166
167 dbg("%s", __func__);
168
169 for (i = 0; i < serial->num_ports; ++i) {
170 /* My special items, the standard routines free my urbs */
171 kfree(usb_get_serial_port_data(serial->port[i]));
172 }
173}
174
175static int cyberjack_open(struct tty_struct *tty,
176 struct usb_serial_port *port)
177{
178 struct cyberjack_private *priv;
179 unsigned long flags;
180 int result = 0;
181
182 dbg("%s - port %d", __func__, port->number);
183
184 dbg("%s - usb_clear_halt", __func__);
185 usb_clear_halt(port->serial->dev, port->write_urb->pipe);
186
187 priv = usb_get_serial_port_data(port);
188 spin_lock_irqsave(&priv->lock, flags);
189 priv->rdtodo = 0;
190 priv->wrfilled = 0;
191 priv->wrsent = 0;
192 spin_unlock_irqrestore(&priv->lock, flags);
193
194 return result;
195}
196
197static void cyberjack_close(struct usb_serial_port *port)
198{
199 dbg("%s - port %d", __func__, port->number);
200
201 if (port->serial->dev) {
202 /* shutdown any bulk reads that might be going on */
203 usb_kill_urb(port->write_urb);
204 usb_kill_urb(port->read_urb);
205 }
206}
207
208static int cyberjack_write(struct tty_struct *tty,
209 struct usb_serial_port *port, const unsigned char *buf, int count)
210{
211 struct usb_serial *serial = port->serial;
212 struct cyberjack_private *priv = usb_get_serial_port_data(port);
213 unsigned long flags;
214 int result;
215 int wrexpected;
216
217 dbg("%s - port %d", __func__, port->number);
218
219 if (count == 0) {
220 dbg("%s - write request of 0 bytes", __func__);
221 return 0;
222 }
223
224 spin_lock_bh(&port->lock);
225 if (port->write_urb_busy) {
226 spin_unlock_bh(&port->lock);
227 dbg("%s - already writing", __func__);
228 return 0;
229 }
230 port->write_urb_busy = 1;
231 spin_unlock_bh(&port->lock);
232
233 spin_lock_irqsave(&priv->lock, flags);
234
235 if (count+priv->wrfilled > sizeof(priv->wrbuf)) {
236 /* To much data for buffer. Reset buffer. */
237 priv->wrfilled = 0;
238 port->write_urb_busy = 0;
239 spin_unlock_irqrestore(&priv->lock, flags);
240 return 0;
241 }
242
243 /* Copy data */
244 memcpy(priv->wrbuf + priv->wrfilled, buf, count);
245
246 usb_serial_debug_data(debug, &port->dev, __func__, count,
247 priv->wrbuf + priv->wrfilled);
248 priv->wrfilled += count;
249
250 if (priv->wrfilled >= 3) {
251 wrexpected = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
252 dbg("%s - expected data: %d", __func__, wrexpected);
253 } else
254 wrexpected = sizeof(priv->wrbuf);
255
256 if (priv->wrfilled >= wrexpected) {
257 /* We have enough data to begin transmission */
258 int length;
259
260 dbg("%s - transmitting data (frame 1)", __func__);
261 length = (wrexpected > port->bulk_out_size) ?
262 port->bulk_out_size : wrexpected;
263
264 memcpy(port->write_urb->transfer_buffer, priv->wrbuf, length);
265 priv->wrsent = length;
266
267 /* set up our urb */
268 usb_fill_bulk_urb(port->write_urb, serial->dev,
269 usb_sndbulkpipe(serial->dev, port->bulk_out_endpointAddress),
270 port->write_urb->transfer_buffer, length,
271 ((serial->type->write_bulk_callback) ?
272 serial->type->write_bulk_callback :
273 cyberjack_write_bulk_callback),
274 port);
275
276 /* send the data out the bulk port */
277 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
278 if (result) {
279 dev_err(&port->dev,
280 "%s - failed submitting write urb, error %d",
281 __func__, result);
282 /* Throw away data. No better idea what to do with it. */
283 priv->wrfilled = 0;
284 priv->wrsent = 0;
285 spin_unlock_irqrestore(&priv->lock, flags);
286 port->write_urb_busy = 0;
287 return 0;
288 }
289
290 dbg("%s - priv->wrsent=%d", __func__, priv->wrsent);
291 dbg("%s - priv->wrfilled=%d", __func__, priv->wrfilled);
292
293 if (priv->wrsent >= priv->wrfilled) {
294 dbg("%s - buffer cleaned", __func__);
295 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
296 priv->wrfilled = 0;
297 priv->wrsent = 0;
298 }
299 }
300
301 spin_unlock_irqrestore(&priv->lock, flags);
302
303 return count;
304}
305
306static int cyberjack_write_room(struct tty_struct *tty)
307{
308 /* FIXME: .... */
309 return CYBERJACK_LOCAL_BUF_SIZE;
310}
311
312static void cyberjack_read_int_callback(struct urb *urb)
313{
314 struct usb_serial_port *port = urb->context;
315 struct cyberjack_private *priv = usb_get_serial_port_data(port);
316 unsigned char *data = urb->transfer_buffer;
317 int status = urb->status;
318 int result;
319
320 dbg("%s - port %d", __func__, port->number);
321
322 /* the urb might have been killed. */
323 if (status)
324 return;
325
326 usb_serial_debug_data(debug, &port->dev, __func__,
327 urb->actual_length, data);
328
329 /* React only to interrupts signaling a bulk_in transfer */
330 if (urb->actual_length == 4 && data[0] == 0x01) {
331 short old_rdtodo;
332
333 /* This is a announcement of coming bulk_ins. */
334 unsigned short size = ((unsigned short)data[3]<<8)+data[2]+3;
335
336 spin_lock(&priv->lock);
337
338 old_rdtodo = priv->rdtodo;
339
340 if (old_rdtodo + size < old_rdtodo) {
341 dbg("To many bulk_in urbs to do.");
342 spin_unlock(&priv->lock);
343 goto resubmit;
344 }
345
346 /* "+=" is probably more fault tollerant than "=" */
347 priv->rdtodo += size;
348
349 dbg("%s - rdtodo: %d", __func__, priv->rdtodo);
350
351 spin_unlock(&priv->lock);
352
353 if (!old_rdtodo) {
354 port->read_urb->dev = port->serial->dev;
355 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
356 if (result)
357 dev_err(&port->dev, "%s - failed resubmitting "
358 "read urb, error %d\n",
359 __func__, result);
360 dbg("%s - usb_submit_urb(read urb)", __func__);
361 }
362 }
363
364resubmit:
365 port->interrupt_in_urb->dev = port->serial->dev;
366 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
367 if (result)
368 dev_err(&port->dev, "usb_submit_urb(read int) failed\n");
369 dbg("%s - usb_submit_urb(int urb)", __func__);
370}
371
372static void cyberjack_read_bulk_callback(struct urb *urb)
373{
374 struct usb_serial_port *port = urb->context;
375 struct cyberjack_private *priv = usb_get_serial_port_data(port);
376 struct tty_struct *tty;
377 unsigned char *data = urb->transfer_buffer;
378 short todo;
379 int result;
380 int status = urb->status;
381
382 dbg("%s - port %d", __func__, port->number);
383
384 usb_serial_debug_data(debug, &port->dev, __func__,
385 urb->actual_length, data);
386 if (status) {
387 dbg("%s - nonzero read bulk status received: %d",
388 __func__, status);
389 return;
390 }
391
392 tty = tty_port_tty_get(&port->port);
393 if (!tty) {
394 dbg("%s - ignoring since device not open", __func__);
395 return;
396 }
397 if (urb->actual_length) {
398 tty_insert_flip_string(tty, data, urb->actual_length);
399 tty_flip_buffer_push(tty);
400 }
401 tty_kref_put(tty);
402
403 spin_lock(&priv->lock);
404
405 /* Reduce urbs to do by one. */
406 priv->rdtodo -= urb->actual_length;
407 /* Just to be sure */
408 if (priv->rdtodo < 0)
409 priv->rdtodo = 0;
410 todo = priv->rdtodo;
411
412 spin_unlock(&priv->lock);
413
414 dbg("%s - rdtodo: %d", __func__, todo);
415
416 /* Continue to read if we have still urbs to do. */
417 if (todo /* || (urb->actual_length==port->bulk_in_endpointAddress)*/) {
418 port->read_urb->dev = port->serial->dev;
419 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
420 if (result)
421 dev_err(&port->dev, "%s - failed resubmitting read "
422 "urb, error %d\n", __func__, result);
423 dbg("%s - usb_submit_urb(read urb)", __func__);
424 }
425}
426
427static void cyberjack_write_bulk_callback(struct urb *urb)
428{
429 struct usb_serial_port *port = urb->context;
430 struct cyberjack_private *priv = usb_get_serial_port_data(port);
431 int status = urb->status;
432
433 dbg("%s - port %d", __func__, port->number);
434
435 port->write_urb_busy = 0;
436 if (status) {
437 dbg("%s - nonzero write bulk status received: %d",
438 __func__, status);
439 return;
440 }
441
442 spin_lock(&priv->lock);
443
444 /* only do something if we have more data to send */
445 if (priv->wrfilled) {
446 int length, blksize, result;
447
448 dbg("%s - transmitting data (frame n)", __func__);
449
450 length = ((priv->wrfilled - priv->wrsent) > port->bulk_out_size) ?
451 port->bulk_out_size : (priv->wrfilled - priv->wrsent);
452
453 memcpy(port->write_urb->transfer_buffer,
454 priv->wrbuf + priv->wrsent, length);
455 priv->wrsent += length;
456
457 /* set up our urb */
458 usb_fill_bulk_urb(port->write_urb, port->serial->dev,
459 usb_sndbulkpipe(port->serial->dev, port->bulk_out_endpointAddress),
460 port->write_urb->transfer_buffer, length,
461 ((port->serial->type->write_bulk_callback) ?
462 port->serial->type->write_bulk_callback :
463 cyberjack_write_bulk_callback),
464 port);
465
466 /* send the data out the bulk port */
467 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
468 if (result) {
469 dev_err(&port->dev,
470 "%s - failed submitting write urb, error %d\n",
471 __func__, result);
472 /* Throw away data. No better idea what to do with it. */
473 priv->wrfilled = 0;
474 priv->wrsent = 0;
475 goto exit;
476 }
477
478 dbg("%s - priv->wrsent=%d", __func__, priv->wrsent);
479 dbg("%s - priv->wrfilled=%d", __func__, priv->wrfilled);
480
481 blksize = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
482
483 if (priv->wrsent >= priv->wrfilled ||
484 priv->wrsent >= blksize) {
485 dbg("%s - buffer cleaned", __func__);
486 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
487 priv->wrfilled = 0;
488 priv->wrsent = 0;
489 }
490 }
491
492exit:
493 spin_unlock(&priv->lock);
494 usb_serial_port_softint(port);
495}
496
497static int __init cyberjack_init(void)
498{
499 int retval;
500 retval = usb_serial_register(&cyberjack_device);
501 if (retval)
502 goto failed_usb_serial_register;
503 retval = usb_register(&cyberjack_driver);
504 if (retval)
505 goto failed_usb_register;
506
507 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_VERSION " "
508 DRIVER_AUTHOR "\n");
509 printk(KERN_INFO KBUILD_MODNAME ": " DRIVER_DESC "\n");
510
511 return 0;
512failed_usb_register:
513 usb_serial_deregister(&cyberjack_device);
514failed_usb_serial_register:
515 return retval;
516}
517
518static void __exit cyberjack_exit(void)
519{
520 usb_deregister(&cyberjack_driver);
521 usb_serial_deregister(&cyberjack_device);
522}
523
524module_init(cyberjack_init);
525module_exit(cyberjack_exit);
526
527MODULE_AUTHOR(DRIVER_AUTHOR);
528MODULE_DESCRIPTION(DRIVER_DESC);
529MODULE_VERSION(DRIVER_VERSION);
530MODULE_LICENSE("GPL");
531
532module_param(debug, bool, S_IRUGO | S_IWUSR);
533MODULE_PARM_DESC(debug, "Debug enabled or not");
1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * REINER SCT cyberJack pinpad/e-com USB Chipcard Reader Driver
4 *
5 * Copyright (C) 2001 REINER SCT
6 * Author: Matthias Bruestle
7 *
8 * Contact: support@reiner-sct.com (see MAINTAINERS)
9 *
10 * This program is largely derived from work by the linux-usb group
11 * and associated source files. Please see the usb/serial files for
12 * individual credits and copyrights.
13 *
14 * Thanks to Greg Kroah-Hartman (greg@kroah.com) for his help and
15 * patience.
16 *
17 * In case of problems, please write to the contact e-mail address
18 * mentioned above.
19 *
20 * Please note that later models of the cyberjack reader family are
21 * supported by a libusb-based userspace device driver.
22 *
23 * Homepage: http://www.reiner-sct.de/support/treiber_cyberjack.php#linux
24 */
25
26
27#include <linux/kernel.h>
28#include <linux/errno.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>
35#include <linux/uaccess.h>
36#include <linux/usb.h>
37#include <linux/usb/serial.h>
38
39#define CYBERJACK_LOCAL_BUF_SIZE 32
40
41#define DRIVER_AUTHOR "Matthias Bruestle"
42#define DRIVER_DESC "REINER SCT cyberJack pinpad/e-com USB Chipcard Reader Driver"
43
44
45#define CYBERJACK_VENDOR_ID 0x0C4B
46#define CYBERJACK_PRODUCT_ID 0x0100
47
48/* Function prototypes */
49static int cyberjack_port_probe(struct usb_serial_port *port);
50static void cyberjack_port_remove(struct usb_serial_port *port);
51static int cyberjack_open(struct tty_struct *tty,
52 struct usb_serial_port *port);
53static void cyberjack_close(struct usb_serial_port *port);
54static int cyberjack_write(struct tty_struct *tty,
55 struct usb_serial_port *port, const unsigned char *buf, int count);
56static unsigned int cyberjack_write_room(struct tty_struct *tty);
57static void cyberjack_read_int_callback(struct urb *urb);
58static void cyberjack_read_bulk_callback(struct urb *urb);
59static void cyberjack_write_bulk_callback(struct urb *urb);
60
61static const struct usb_device_id id_table[] = {
62 { USB_DEVICE(CYBERJACK_VENDOR_ID, CYBERJACK_PRODUCT_ID) },
63 { } /* Terminating entry */
64};
65
66MODULE_DEVICE_TABLE(usb, id_table);
67
68static struct usb_serial_driver cyberjack_device = {
69 .driver = {
70 .owner = THIS_MODULE,
71 .name = "cyberjack",
72 },
73 .description = "Reiner SCT Cyberjack USB card reader",
74 .id_table = id_table,
75 .num_ports = 1,
76 .num_bulk_out = 1,
77 .port_probe = cyberjack_port_probe,
78 .port_remove = cyberjack_port_remove,
79 .open = cyberjack_open,
80 .close = cyberjack_close,
81 .write = cyberjack_write,
82 .write_room = cyberjack_write_room,
83 .read_int_callback = cyberjack_read_int_callback,
84 .read_bulk_callback = cyberjack_read_bulk_callback,
85 .write_bulk_callback = cyberjack_write_bulk_callback,
86};
87
88static struct usb_serial_driver * const serial_drivers[] = {
89 &cyberjack_device, NULL
90};
91
92struct cyberjack_private {
93 spinlock_t lock; /* Lock for SMP */
94 short rdtodo; /* Bytes still to read */
95 unsigned char wrbuf[5*64]; /* Buffer for collecting data to write */
96 short wrfilled; /* Overall data size we already got */
97 short wrsent; /* Data already sent */
98};
99
100static int cyberjack_port_probe(struct usb_serial_port *port)
101{
102 struct cyberjack_private *priv;
103 int result;
104
105 priv = kmalloc(sizeof(struct cyberjack_private), GFP_KERNEL);
106 if (!priv)
107 return -ENOMEM;
108
109 spin_lock_init(&priv->lock);
110 priv->rdtodo = 0;
111 priv->wrfilled = 0;
112 priv->wrsent = 0;
113
114 usb_set_serial_port_data(port, priv);
115
116 result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL);
117 if (result)
118 dev_err(&port->dev, "usb_submit_urb(read int) failed\n");
119
120 return 0;
121}
122
123static void cyberjack_port_remove(struct usb_serial_port *port)
124{
125 struct cyberjack_private *priv;
126
127 usb_kill_urb(port->interrupt_in_urb);
128
129 priv = usb_get_serial_port_data(port);
130 kfree(priv);
131}
132
133static int cyberjack_open(struct tty_struct *tty,
134 struct usb_serial_port *port)
135{
136 struct cyberjack_private *priv;
137 unsigned long flags;
138
139 dev_dbg(&port->dev, "%s - usb_clear_halt\n", __func__);
140 usb_clear_halt(port->serial->dev, port->write_urb->pipe);
141
142 priv = usb_get_serial_port_data(port);
143 spin_lock_irqsave(&priv->lock, flags);
144 priv->rdtodo = 0;
145 priv->wrfilled = 0;
146 priv->wrsent = 0;
147 spin_unlock_irqrestore(&priv->lock, flags);
148
149 return 0;
150}
151
152static void cyberjack_close(struct usb_serial_port *port)
153{
154 usb_kill_urb(port->write_urb);
155 usb_kill_urb(port->read_urb);
156}
157
158static int cyberjack_write(struct tty_struct *tty,
159 struct usb_serial_port *port, const unsigned char *buf, int count)
160{
161 struct device *dev = &port->dev;
162 struct cyberjack_private *priv = usb_get_serial_port_data(port);
163 unsigned long flags;
164 int result;
165 int wrexpected;
166
167 if (count == 0) {
168 dev_dbg(dev, "%s - write request of 0 bytes\n", __func__);
169 return 0;
170 }
171
172 if (!test_and_clear_bit(0, &port->write_urbs_free)) {
173 dev_dbg(dev, "%s - already writing\n", __func__);
174 return 0;
175 }
176
177 spin_lock_irqsave(&priv->lock, flags);
178
179 if (count+priv->wrfilled > sizeof(priv->wrbuf)) {
180 /* To much data for buffer. Reset buffer. */
181 priv->wrfilled = 0;
182 spin_unlock_irqrestore(&priv->lock, flags);
183 set_bit(0, &port->write_urbs_free);
184 return 0;
185 }
186
187 /* Copy data */
188 memcpy(priv->wrbuf + priv->wrfilled, buf, count);
189
190 usb_serial_debug_data(dev, __func__, count, priv->wrbuf + priv->wrfilled);
191 priv->wrfilled += count;
192
193 if (priv->wrfilled >= 3) {
194 wrexpected = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
195 dev_dbg(dev, "%s - expected data: %d\n", __func__, wrexpected);
196 } else
197 wrexpected = sizeof(priv->wrbuf);
198
199 if (priv->wrfilled >= wrexpected) {
200 /* We have enough data to begin transmission */
201 int length;
202
203 dev_dbg(dev, "%s - transmitting data (frame 1)\n", __func__);
204 length = (wrexpected > port->bulk_out_size) ?
205 port->bulk_out_size : wrexpected;
206
207 memcpy(port->write_urb->transfer_buffer, priv->wrbuf, length);
208 priv->wrsent = length;
209
210 /* set up our urb */
211 port->write_urb->transfer_buffer_length = length;
212
213 /* send the data out the bulk port */
214 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
215 if (result) {
216 dev_err(&port->dev,
217 "%s - failed submitting write urb, error %d\n",
218 __func__, result);
219 /* Throw away data. No better idea what to do with it. */
220 priv->wrfilled = 0;
221 priv->wrsent = 0;
222 spin_unlock_irqrestore(&priv->lock, flags);
223 set_bit(0, &port->write_urbs_free);
224 return 0;
225 }
226
227 dev_dbg(dev, "%s - priv->wrsent=%d\n", __func__, priv->wrsent);
228 dev_dbg(dev, "%s - priv->wrfilled=%d\n", __func__, priv->wrfilled);
229
230 if (priv->wrsent >= priv->wrfilled) {
231 dev_dbg(dev, "%s - buffer cleaned\n", __func__);
232 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
233 priv->wrfilled = 0;
234 priv->wrsent = 0;
235 }
236 }
237
238 spin_unlock_irqrestore(&priv->lock, flags);
239
240 return count;
241}
242
243static unsigned int cyberjack_write_room(struct tty_struct *tty)
244{
245 /* FIXME: .... */
246 return CYBERJACK_LOCAL_BUF_SIZE;
247}
248
249static void cyberjack_read_int_callback(struct urb *urb)
250{
251 struct usb_serial_port *port = urb->context;
252 struct cyberjack_private *priv = usb_get_serial_port_data(port);
253 struct device *dev = &port->dev;
254 unsigned char *data = urb->transfer_buffer;
255 int status = urb->status;
256 unsigned long flags;
257 int result;
258
259 /* the urb might have been killed. */
260 if (status)
261 return;
262
263 usb_serial_debug_data(dev, __func__, urb->actual_length, data);
264
265 /* React only to interrupts signaling a bulk_in transfer */
266 if (urb->actual_length == 4 && data[0] == 0x01) {
267 short old_rdtodo;
268
269 /* This is a announcement of coming bulk_ins. */
270 unsigned short size = ((unsigned short)data[3]<<8)+data[2]+3;
271
272 spin_lock_irqsave(&priv->lock, flags);
273
274 old_rdtodo = priv->rdtodo;
275
276 if (old_rdtodo > SHRT_MAX - size) {
277 dev_dbg(dev, "Too many bulk_in urbs to do.\n");
278 spin_unlock_irqrestore(&priv->lock, flags);
279 goto resubmit;
280 }
281
282 /* "+=" is probably more fault tolerant than "=" */
283 priv->rdtodo += size;
284
285 dev_dbg(dev, "%s - rdtodo: %d\n", __func__, priv->rdtodo);
286
287 spin_unlock_irqrestore(&priv->lock, flags);
288
289 if (!old_rdtodo) {
290 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
291 if (result)
292 dev_err(dev, "%s - failed resubmitting read urb, error %d\n",
293 __func__, result);
294 dev_dbg(dev, "%s - usb_submit_urb(read urb)\n", __func__);
295 }
296 }
297
298resubmit:
299 result = usb_submit_urb(port->interrupt_in_urb, GFP_ATOMIC);
300 if (result)
301 dev_err(&port->dev, "usb_submit_urb(read int) failed\n");
302 dev_dbg(dev, "%s - usb_submit_urb(int urb)\n", __func__);
303}
304
305static void cyberjack_read_bulk_callback(struct urb *urb)
306{
307 struct usb_serial_port *port = urb->context;
308 struct cyberjack_private *priv = usb_get_serial_port_data(port);
309 struct device *dev = &port->dev;
310 unsigned char *data = urb->transfer_buffer;
311 unsigned long flags;
312 short todo;
313 int result;
314 int status = urb->status;
315
316 usb_serial_debug_data(dev, __func__, urb->actual_length, data);
317 if (status) {
318 dev_dbg(dev, "%s - nonzero read bulk status received: %d\n",
319 __func__, status);
320 return;
321 }
322
323 if (urb->actual_length) {
324 tty_insert_flip_string(&port->port, data, urb->actual_length);
325 tty_flip_buffer_push(&port->port);
326 }
327
328 spin_lock_irqsave(&priv->lock, flags);
329
330 /* Reduce urbs to do by one. */
331 priv->rdtodo -= urb->actual_length;
332 /* Just to be sure */
333 if (priv->rdtodo < 0)
334 priv->rdtodo = 0;
335 todo = priv->rdtodo;
336
337 spin_unlock_irqrestore(&priv->lock, flags);
338
339 dev_dbg(dev, "%s - rdtodo: %d\n", __func__, todo);
340
341 /* Continue to read if we have still urbs to do. */
342 if (todo /* || (urb->actual_length==port->bulk_in_endpointAddress)*/) {
343 result = usb_submit_urb(port->read_urb, GFP_ATOMIC);
344 if (result)
345 dev_err(dev, "%s - failed resubmitting read urb, error %d\n",
346 __func__, result);
347 dev_dbg(dev, "%s - usb_submit_urb(read urb)\n", __func__);
348 }
349}
350
351static void cyberjack_write_bulk_callback(struct urb *urb)
352{
353 struct usb_serial_port *port = urb->context;
354 struct cyberjack_private *priv = usb_get_serial_port_data(port);
355 struct device *dev = &port->dev;
356 int status = urb->status;
357 unsigned long flags;
358 bool resubmitted = false;
359
360 if (status) {
361 dev_dbg(dev, "%s - nonzero write bulk status received: %d\n",
362 __func__, status);
363 set_bit(0, &port->write_urbs_free);
364 return;
365 }
366
367 spin_lock_irqsave(&priv->lock, flags);
368
369 /* only do something if we have more data to send */
370 if (priv->wrfilled) {
371 int length, blksize, result;
372
373 dev_dbg(dev, "%s - transmitting data (frame n)\n", __func__);
374
375 length = ((priv->wrfilled - priv->wrsent) > port->bulk_out_size) ?
376 port->bulk_out_size : (priv->wrfilled - priv->wrsent);
377
378 memcpy(port->write_urb->transfer_buffer,
379 priv->wrbuf + priv->wrsent, length);
380 priv->wrsent += length;
381
382 /* set up our urb */
383 port->write_urb->transfer_buffer_length = length;
384
385 /* send the data out the bulk port */
386 result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
387 if (result) {
388 dev_err(dev, "%s - failed submitting write urb, error %d\n",
389 __func__, result);
390 /* Throw away data. No better idea what to do with it. */
391 priv->wrfilled = 0;
392 priv->wrsent = 0;
393 goto exit;
394 }
395
396 resubmitted = true;
397
398 dev_dbg(dev, "%s - priv->wrsent=%d\n", __func__, priv->wrsent);
399 dev_dbg(dev, "%s - priv->wrfilled=%d\n", __func__, priv->wrfilled);
400
401 blksize = ((int)priv->wrbuf[2]<<8)+priv->wrbuf[1]+3;
402
403 if (priv->wrsent >= priv->wrfilled ||
404 priv->wrsent >= blksize) {
405 dev_dbg(dev, "%s - buffer cleaned\n", __func__);
406 memset(priv->wrbuf, 0, sizeof(priv->wrbuf));
407 priv->wrfilled = 0;
408 priv->wrsent = 0;
409 }
410 }
411
412exit:
413 spin_unlock_irqrestore(&priv->lock, flags);
414 if (!resubmitted)
415 set_bit(0, &port->write_urbs_free);
416 usb_serial_port_softint(port);
417}
418
419module_usb_serial_driver(serial_drivers, id_table);
420
421MODULE_AUTHOR(DRIVER_AUTHOR);
422MODULE_DESCRIPTION(DRIVER_DESC);
423MODULE_LICENSE("GPL");