]>
Commit | Line | Data |
---|---|---|
3fe70ba2 MFN |
1 | /* |
2 | * AIRcable USB Bluetooth Dongle Driver. | |
3 | * | |
4 | * Copyright (C) 2006 Manuel Francisco Naranjo (naranjo.manuel@gmail.com) | |
5 | * This program is free software; you can redistribute it and/or modify it under | |
6 | * the terms of the GNU General Public License version 2 as published by the | |
7 | * Free Software Foundation. | |
8 | * | |
9 | * The device works as an standard CDC device, it has 2 interfaces, the first | |
10 | * one is for firmware access and the second is the serial one. | |
11 | * The protocol is very simply, there are two posibilities reading or writing. | |
beb7dd86 | 12 | * When writing the first urb must have a Header that starts with 0x20 0x29 the |
3fe70ba2 MFN |
13 | * next two bytes must say how much data will be sended. |
14 | * When reading the process is almost equal except that the header starts with | |
15 | * 0x00 0x20. | |
16 | * | |
17 | * The device simply need some stuff to understand data comming from the usb | |
18 | * buffer: The First and Second byte is used for a Header, the Third and Fourth | |
19 | * tells the device the amount of information the package holds. | |
20 | * Packages are 60 bytes long Header Stuff. | |
beb7dd86 | 21 | * When writing to the device the first two bytes of the header are 0x20 0x29 |
3fe70ba2 MFN |
22 | * When reading the bytes are 0x00 0x20, or 0x00 0x10, there is an strange |
23 | * situation, when too much data arrives to the device because it sends the data | |
24 | * but with out the header. I will use a simply hack to override this situation, | |
25 | * if there is data coming that does not contain any header, then that is data | |
26 | * that must go directly to the tty, as there is no documentation about if there | |
27 | * is any other control code, I will simply check for the first | |
28 | * one. | |
29 | * | |
30 | * The driver registers himself with the USB-serial core and the USB Core. I had | |
31 | * to implement a probe function agains USB-serial, because other way, the | |
32 | * driver was attaching himself to both interfaces. I have tryed with different | |
33 | * configurations of usb_serial_driver with out exit, only the probe function | |
34 | * could handle this correctly. | |
35 | * | |
36 | * I have taken some info from a Greg Kroah-Hartman article: | |
37 | * http://www.linuxjournal.com/article/6573 | |
38 | * And from Linux Device Driver Kit CD, which is a great work, the authors taken | |
39 | * the work to recompile lots of information an knowladge in drivers development | |
40 | * and made it all avaible inside a cd. | |
41 | * URL: http://kernel.org/pub/linux/kernel/people/gregkh/ddk/ | |
42 | * | |
43 | */ | |
44 | ||
45 | #include <linux/tty.h> | |
46 | #include <linux/tty_flip.h> | |
47 | #include <linux/circ_buf.h> | |
48 | #include <linux/usb.h> | |
49 | #include <linux/usb/serial.h> | |
50 | ||
51 | static int debug; | |
52 | ||
53 | /* Vendor and Product ID */ | |
54 | #define AIRCABLE_VID 0x16CA | |
55 | #define AIRCABLE_USB_PID 0x1502 | |
56 | ||
57 | /* write buffer size defines */ | |
58 | #define AIRCABLE_BUF_SIZE 2048 | |
59 | ||
60 | /* Protocol Stuff */ | |
61 | #define HCI_HEADER_LENGTH 0x4 | |
62 | #define TX_HEADER_0 0x20 | |
63 | #define TX_HEADER_1 0x29 | |
64 | #define RX_HEADER_0 0x00 | |
65 | #define RX_HEADER_1 0x20 | |
66 | #define MAX_HCI_FRAMESIZE 60 | |
67 | #define HCI_COMPLETE_FRAME 64 | |
68 | ||
69 | /* rx_flags */ | |
70 | #define THROTTLED 0x01 | |
71 | #define ACTUALLY_THROTTLED 0x02 | |
72 | ||
73 | /* | |
74 | * Version Information | |
75 | */ | |
76 | #define DRIVER_VERSION "v1.0b2" | |
77 | #define DRIVER_AUTHOR "Naranjo, Manuel Francisco <naranjo.manuel@gmail.com>" | |
78 | #define DRIVER_DESC "AIRcable USB Driver" | |
79 | ||
80 | /* ID table that will be registered with USB core */ | |
7d40d7e8 | 81 | static const struct usb_device_id id_table[] = { |
3fe70ba2 MFN |
82 | { USB_DEVICE(AIRCABLE_VID, AIRCABLE_USB_PID) }, |
83 | { }, | |
84 | }; | |
85 | MODULE_DEVICE_TABLE(usb, id_table); | |
86 | ||
87 | ||
88 | /* Internal Structure */ | |
89 | struct aircable_private { | |
90 | spinlock_t rx_lock; /* spinlock for the receive lines */ | |
91 | struct circ_buf *tx_buf; /* write buffer */ | |
92 | struct circ_buf *rx_buf; /* read buffer */ | |
93 | int rx_flags; /* for throttilng */ | |
94 | struct work_struct rx_work; /* work cue for the receiving line */ | |
c4028958 | 95 | struct usb_serial_port *port; /* USB port with which associated */ |
3fe70ba2 MFN |
96 | }; |
97 | ||
98 | /* Private methods */ | |
99 | ||
100 | /* Circular Buffer Methods, code from ti_usb_3410_5052 used */ | |
101 | /* | |
102 | * serial_buf_clear | |
103 | * | |
104 | * Clear out all data in the circular buffer. | |
105 | */ | |
106 | static void serial_buf_clear(struct circ_buf *cb) | |
107 | { | |
108 | cb->head = cb->tail = 0; | |
109 | } | |
110 | ||
111 | /* | |
112 | * serial_buf_alloc | |
113 | * | |
114 | * Allocate a circular buffer and all associated memory. | |
115 | */ | |
116 | static struct circ_buf *serial_buf_alloc(void) | |
117 | { | |
118 | struct circ_buf *cb; | |
119 | cb = kmalloc(sizeof(struct circ_buf), GFP_KERNEL); | |
120 | if (cb == NULL) | |
121 | return NULL; | |
122 | cb->buf = kmalloc(AIRCABLE_BUF_SIZE, GFP_KERNEL); | |
123 | if (cb->buf == NULL) { | |
124 | kfree(cb); | |
125 | return NULL; | |
126 | } | |
127 | serial_buf_clear(cb); | |
128 | return cb; | |
129 | } | |
130 | ||
131 | /* | |
132 | * serial_buf_free | |
133 | * | |
134 | * Free the buffer and all associated memory. | |
135 | */ | |
136 | static void serial_buf_free(struct circ_buf *cb) | |
137 | { | |
138 | kfree(cb->buf); | |
139 | kfree(cb); | |
140 | } | |
141 | ||
142 | /* | |
143 | * serial_buf_data_avail | |
144 | * | |
145 | * Return the number of bytes of data available in the circular | |
146 | * buffer. | |
147 | */ | |
148 | static int serial_buf_data_avail(struct circ_buf *cb) | |
149 | { | |
c4d0f8cb | 150 | return CIRC_CNT(cb->head, cb->tail, AIRCABLE_BUF_SIZE); |
3fe70ba2 MFN |
151 | } |
152 | ||
153 | /* | |
154 | * serial_buf_put | |
155 | * | |
156 | * Copy data data from a user buffer and put it into the circular buffer. | |
157 | * Restrict to the amount of space available. | |
158 | * | |
159 | * Return the number of bytes copied. | |
160 | */ | |
161 | static int serial_buf_put(struct circ_buf *cb, const char *buf, int count) | |
162 | { | |
163 | int c, ret = 0; | |
164 | while (1) { | |
165 | c = CIRC_SPACE_TO_END(cb->head, cb->tail, AIRCABLE_BUF_SIZE); | |
166 | if (count < c) | |
167 | c = count; | |
168 | if (c <= 0) | |
169 | break; | |
170 | memcpy(cb->buf + cb->head, buf, c); | |
171 | cb->head = (cb->head + c) & (AIRCABLE_BUF_SIZE-1); | |
172 | buf += c; | |
173 | count -= c; | |
c4d0f8cb | 174 | ret = c; |
3fe70ba2 MFN |
175 | } |
176 | return ret; | |
177 | } | |
178 | ||
179 | /* | |
180 | * serial_buf_get | |
181 | * | |
182 | * Get data from the circular buffer and copy to the given buffer. | |
183 | * Restrict to the amount of data available. | |
184 | * | |
185 | * Return the number of bytes copied. | |
186 | */ | |
187 | static int serial_buf_get(struct circ_buf *cb, char *buf, int count) | |
188 | { | |
189 | int c, ret = 0; | |
190 | while (1) { | |
191 | c = CIRC_CNT_TO_END(cb->head, cb->tail, AIRCABLE_BUF_SIZE); | |
192 | if (count < c) | |
193 | c = count; | |
194 | if (c <= 0) | |
195 | break; | |
196 | memcpy(buf, cb->buf + cb->tail, c); | |
197 | cb->tail = (cb->tail + c) & (AIRCABLE_BUF_SIZE-1); | |
198 | buf += c; | |
199 | count -= c; | |
c4d0f8cb | 200 | ret = c; |
3fe70ba2 MFN |
201 | } |
202 | return ret; | |
203 | } | |
204 | ||
205 | /* End of circula buffer methods */ | |
206 | ||
207 | static void aircable_send(struct usb_serial_port *port) | |
208 | { | |
209 | int count, result; | |
210 | struct aircable_private *priv = usb_get_serial_port_data(port); | |
c4d0f8cb | 211 | unsigned char *buf; |
fd05e720 | 212 | __le16 *dbuf; |
441b62c1 | 213 | dbg("%s - port %d", __func__, port->number); |
3fe70ba2 MFN |
214 | if (port->write_urb_busy) |
215 | return; | |
216 | ||
217 | count = min(serial_buf_data_avail(priv->tx_buf), MAX_HCI_FRAMESIZE); | |
218 | if (count == 0) | |
219 | return; | |
220 | ||
221 | buf = kzalloc(count + HCI_HEADER_LENGTH, GFP_ATOMIC); | |
222 | if (!buf) { | |
194343d9 GKH |
223 | dev_err(&port->dev, "%s- kzalloc(%d) failed.\n", |
224 | __func__, count + HCI_HEADER_LENGTH); | |
3fe70ba2 MFN |
225 | return; |
226 | } | |
227 | ||
228 | buf[0] = TX_HEADER_0; | |
229 | buf[1] = TX_HEADER_1; | |
fd05e720 | 230 | dbuf = (__le16 *)&buf[2]; |
b19d402a | 231 | *dbuf = cpu_to_le16((u16)count); |
c4d0f8cb AC |
232 | serial_buf_get(priv->tx_buf, buf + HCI_HEADER_LENGTH, |
233 | MAX_HCI_FRAMESIZE); | |
3fe70ba2 MFN |
234 | |
235 | memcpy(port->write_urb->transfer_buffer, buf, | |
236 | count + HCI_HEADER_LENGTH); | |
237 | ||
238 | kfree(buf); | |
239 | port->write_urb_busy = 1; | |
441b62c1 | 240 | usb_serial_debug_data(debug, &port->dev, __func__, |
3fe70ba2 MFN |
241 | count + HCI_HEADER_LENGTH, |
242 | port->write_urb->transfer_buffer); | |
243 | port->write_urb->transfer_buffer_length = count + HCI_HEADER_LENGTH; | |
244 | port->write_urb->dev = port->serial->dev; | |
245 | result = usb_submit_urb(port->write_urb, GFP_ATOMIC); | |
246 | ||
247 | if (result) { | |
248 | dev_err(&port->dev, | |
249 | "%s - failed submitting write urb, error %d\n", | |
441b62c1 | 250 | __func__, result); |
3fe70ba2 MFN |
251 | port->write_urb_busy = 0; |
252 | } | |
253 | ||
254 | schedule_work(&port->work); | |
255 | } | |
256 | ||
c4028958 | 257 | static void aircable_read(struct work_struct *work) |
3fe70ba2 | 258 | { |
c4028958 DH |
259 | struct aircable_private *priv = |
260 | container_of(work, struct aircable_private, rx_work); | |
261 | struct usb_serial_port *port = priv->port; | |
3fe70ba2 MFN |
262 | struct tty_struct *tty; |
263 | unsigned char *data; | |
264 | int count; | |
c4d0f8cb | 265 | if (priv->rx_flags & THROTTLED) { |
3fe70ba2 MFN |
266 | if (priv->rx_flags & ACTUALLY_THROTTLED) |
267 | schedule_work(&priv->rx_work); | |
268 | return; | |
269 | } | |
270 | ||
271 | /* By now I will flush data to the tty in packages of no more than | |
272 | * 64 bytes, to ensure I do not get throttled. | |
273 | * Ask USB mailing list for better aproach. | |
274 | */ | |
4a90f09b | 275 | tty = tty_port_tty_get(&port->port); |
3fe70ba2 | 276 | |
7a5c7b42 | 277 | if (!tty) { |
3fe70ba2 | 278 | schedule_work(&priv->rx_work); |
194343d9 | 279 | dev_err(&port->dev, "%s - No tty available\n", __func__); |
7a5c7b42 NMF |
280 | return ; |
281 | } | |
3fe70ba2 MFN |
282 | |
283 | count = min(64, serial_buf_data_avail(priv->rx_buf)); | |
284 | ||
285 | if (count <= 0) | |
4a90f09b | 286 | goto out; /* We have finished sending everything. */ |
3fe70ba2 MFN |
287 | |
288 | tty_prepare_flip_string(tty, &data, count); | |
c4d0f8cb | 289 | if (!data) { |
4a90f09b AC |
290 | dev_err(&port->dev, "%s- kzalloc(%d) failed.", |
291 | __func__, count); | |
292 | goto out; | |
3fe70ba2 MFN |
293 | } |
294 | ||
295 | serial_buf_get(priv->rx_buf, data, count); | |
296 | ||
297 | tty_flip_buffer_push(tty); | |
298 | ||
299 | if (serial_buf_data_avail(priv->rx_buf)) | |
300 | schedule_work(&priv->rx_work); | |
4a90f09b AC |
301 | out: |
302 | tty_kref_put(tty); | |
3fe70ba2 MFN |
303 | return; |
304 | } | |
305 | /* End of private methods */ | |
306 | ||
307 | static int aircable_probe(struct usb_serial *serial, | |
308 | const struct usb_device_id *id) | |
309 | { | |
c4d0f8cb AC |
310 | struct usb_host_interface *iface_desc = serial->interface-> |
311 | cur_altsetting; | |
3fe70ba2 | 312 | struct usb_endpoint_descriptor *endpoint; |
c4d0f8cb | 313 | int num_bulk_out = 0; |
3fe70ba2 MFN |
314 | int i; |
315 | ||
316 | for (i = 0; i < iface_desc->desc.bNumEndpoints; i++) { | |
317 | endpoint = &iface_desc->endpoint[i].desc; | |
377f13bf | 318 | if (usb_endpoint_is_bulk_out(endpoint)) { |
3fe70ba2 MFN |
319 | dbg("found bulk out on endpoint %d", i); |
320 | ++num_bulk_out; | |
321 | } | |
322 | } | |
323 | ||
324 | if (num_bulk_out == 0) { | |
325 | dbg("Invalid interface, discarding"); | |
326 | return -ENODEV; | |
327 | } | |
328 | ||
329 | return 0; | |
330 | } | |
331 | ||
c4d0f8cb | 332 | static int aircable_attach(struct usb_serial *serial) |
3fe70ba2 MFN |
333 | { |
334 | struct usb_serial_port *port = serial->port[0]; | |
335 | struct aircable_private *priv; | |
336 | ||
337 | priv = kzalloc(sizeof(struct aircable_private), GFP_KERNEL); | |
c4d0f8cb | 338 | if (!priv) { |
194343d9 | 339 | dev_err(&port->dev, "%s- kmalloc(%Zd) failed.\n", __func__, |
3fe70ba2 MFN |
340 | sizeof(struct aircable_private)); |
341 | return -ENOMEM; | |
342 | } | |
343 | ||
344 | /* Allocation of Circular Buffers */ | |
345 | priv->tx_buf = serial_buf_alloc(); | |
346 | if (priv->tx_buf == NULL) { | |
347 | kfree(priv); | |
348 | return -ENOMEM; | |
349 | } | |
350 | ||
351 | priv->rx_buf = serial_buf_alloc(); | |
352 | if (priv->rx_buf == NULL) { | |
353 | kfree(priv->tx_buf); | |
354 | kfree(priv); | |
355 | return -ENOMEM; | |
356 | } | |
357 | ||
358 | priv->rx_flags &= ~(THROTTLED | ACTUALLY_THROTTLED); | |
c4028958 DH |
359 | priv->port = port; |
360 | INIT_WORK(&priv->rx_work, aircable_read); | |
3fe70ba2 MFN |
361 | |
362 | usb_set_serial_port_data(serial->port[0], priv); | |
363 | ||
364 | return 0; | |
365 | } | |
366 | ||
f9c99bb8 | 367 | static void aircable_release(struct usb_serial *serial) |
3fe70ba2 MFN |
368 | { |
369 | ||
370 | struct usb_serial_port *port = serial->port[0]; | |
371 | struct aircable_private *priv = usb_get_serial_port_data(port); | |
372 | ||
441b62c1 | 373 | dbg("%s", __func__); |
3fe70ba2 MFN |
374 | |
375 | if (priv) { | |
376 | serial_buf_free(priv->tx_buf); | |
377 | serial_buf_free(priv->rx_buf); | |
3fe70ba2 MFN |
378 | kfree(priv); |
379 | } | |
380 | } | |
381 | ||
95da310e | 382 | static int aircable_write_room(struct tty_struct *tty) |
3fe70ba2 | 383 | { |
95da310e | 384 | struct usb_serial_port *port = tty->driver_data; |
3fe70ba2 MFN |
385 | struct aircable_private *priv = usb_get_serial_port_data(port); |
386 | return serial_buf_data_avail(priv->tx_buf); | |
387 | } | |
388 | ||
95da310e | 389 | static int aircable_write(struct tty_struct *tty, struct usb_serial_port *port, |
3fe70ba2 MFN |
390 | const unsigned char *source, int count) |
391 | { | |
392 | struct aircable_private *priv = usb_get_serial_port_data(port); | |
393 | int temp; | |
394 | ||
441b62c1 | 395 | dbg("%s - port %d, %d bytes", __func__, port->number, count); |
3fe70ba2 | 396 | |
441b62c1 | 397 | usb_serial_debug_data(debug, &port->dev, __func__, count, source); |
3fe70ba2 | 398 | |
c4d0f8cb | 399 | if (!count) { |
441b62c1 | 400 | dbg("%s - write request of 0 bytes", __func__); |
3fe70ba2 MFN |
401 | return count; |
402 | } | |
403 | ||
404 | temp = serial_buf_put(priv->tx_buf, source, count); | |
405 | ||
406 | aircable_send(port); | |
407 | ||
408 | if (count > AIRCABLE_BUF_SIZE) | |
409 | count = AIRCABLE_BUF_SIZE; | |
410 | ||
411 | return count; | |
412 | ||
413 | } | |
414 | ||
7d12e780 | 415 | static void aircable_write_bulk_callback(struct urb *urb) |
3fe70ba2 MFN |
416 | { |
417 | struct usb_serial_port *port = urb->context; | |
1373dbbc | 418 | int status = urb->status; |
3fe70ba2 MFN |
419 | int result; |
420 | ||
441b62c1 | 421 | dbg("%s - urb status: %d", __func__ , status); |
3fe70ba2 MFN |
422 | |
423 | /* This has been taken from cypress_m8.c cypress_write_int_callback */ | |
1373dbbc | 424 | switch (status) { |
c4d0f8cb AC |
425 | case 0: |
426 | /* success */ | |
427 | break; | |
428 | case -ECONNRESET: | |
429 | case -ENOENT: | |
430 | case -ESHUTDOWN: | |
431 | /* this urb is terminated, clean up */ | |
432 | dbg("%s - urb shutting down with status: %d", | |
433 | __func__, status); | |
434 | port->write_urb_busy = 0; | |
435 | return; | |
436 | default: | |
437 | /* error in the urb, so we have to resubmit it */ | |
438 | dbg("%s - Overflow in write", __func__); | |
439 | dbg("%s - nonzero write bulk status received: %d", | |
440 | __func__, status); | |
441 | port->write_urb->transfer_buffer_length = 1; | |
442 | port->write_urb->dev = port->serial->dev; | |
443 | result = usb_submit_urb(port->write_urb, GFP_ATOMIC); | |
444 | if (result) | |
445 | dev_err(&urb->dev->dev, | |
446 | "%s - failed resubmitting write urb, error %d\n", | |
447 | __func__, result); | |
448 | else | |
3fe70ba2 | 449 | return; |
3fe70ba2 MFN |
450 | } |
451 | ||
452 | port->write_urb_busy = 0; | |
453 | ||
454 | aircable_send(port); | |
455 | } | |
456 | ||
7d12e780 | 457 | static void aircable_read_bulk_callback(struct urb *urb) |
3fe70ba2 MFN |
458 | { |
459 | struct usb_serial_port *port = urb->context; | |
460 | struct aircable_private *priv = usb_get_serial_port_data(port); | |
461 | struct tty_struct *tty; | |
462 | unsigned long no_packages, remaining, package_length, i; | |
463 | int result, shift = 0; | |
464 | unsigned char *temp; | |
1373dbbc | 465 | int status = urb->status; |
3fe70ba2 | 466 | |
441b62c1 | 467 | dbg("%s - port %d", __func__, port->number); |
3fe70ba2 | 468 | |
1373dbbc | 469 | if (status) { |
441b62c1 | 470 | dbg("%s - urb status = %d", __func__, status); |
1373dbbc | 471 | if (status == -EPROTO) { |
3fe70ba2 | 472 | dbg("%s - caught -EPROTO, resubmitting the urb", |
441b62c1 | 473 | __func__); |
3fe70ba2 | 474 | usb_fill_bulk_urb(port->read_urb, port->serial->dev, |
c4d0f8cb AC |
475 | usb_rcvbulkpipe(port->serial->dev, |
476 | port->bulk_in_endpointAddress), | |
477 | port->read_urb->transfer_buffer, | |
478 | port->read_urb->transfer_buffer_length, | |
479 | aircable_read_bulk_callback, port); | |
3fe70ba2 MFN |
480 | |
481 | result = usb_submit_urb(urb, GFP_ATOMIC); | |
482 | if (result) | |
483 | dev_err(&urb->dev->dev, | |
484 | "%s - failed resubmitting read urb, error %d\n", | |
441b62c1 | 485 | __func__, result); |
3fe70ba2 MFN |
486 | return; |
487 | } | |
441b62c1 | 488 | dbg("%s - unable to handle the error, exiting.", __func__); |
3fe70ba2 MFN |
489 | return; |
490 | } | |
491 | ||
441b62c1 | 492 | usb_serial_debug_data(debug, &port->dev, __func__, |
c4d0f8cb | 493 | urb->actual_length, urb->transfer_buffer); |
3fe70ba2 | 494 | |
4a90f09b | 495 | tty = tty_port_tty_get(&port->port); |
3fe70ba2 MFN |
496 | if (tty && urb->actual_length) { |
497 | if (urb->actual_length <= 2) { | |
498 | /* This is an incomplete package */ | |
499 | serial_buf_put(priv->rx_buf, urb->transfer_buffer, | |
500 | urb->actual_length); | |
501 | } else { | |
502 | temp = urb->transfer_buffer; | |
503 | if (temp[0] == RX_HEADER_0) | |
504 | shift = HCI_HEADER_LENGTH; | |
505 | ||
506 | remaining = urb->actual_length; | |
507 | no_packages = urb->actual_length / (HCI_COMPLETE_FRAME); | |
508 | ||
509 | if (urb->actual_length % HCI_COMPLETE_FRAME != 0) | |
c4d0f8cb | 510 | no_packages++; |
3fe70ba2 | 511 | |
c4d0f8cb | 512 | for (i = 0; i < no_packages; i++) { |
3fe70ba2 MFN |
513 | if (remaining > (HCI_COMPLETE_FRAME)) |
514 | package_length = HCI_COMPLETE_FRAME; | |
515 | else | |
516 | package_length = remaining; | |
517 | remaining -= package_length; | |
518 | ||
519 | serial_buf_put(priv->rx_buf, | |
520 | urb->transfer_buffer + shift + | |
521 | (HCI_COMPLETE_FRAME) * (i), | |
522 | package_length - shift); | |
523 | } | |
524 | } | |
c4028958 | 525 | aircable_read(&priv->rx_work); |
3fe70ba2 | 526 | } |
4a90f09b | 527 | tty_kref_put(tty); |
3fe70ba2 | 528 | |
1f87158e AS |
529 | /* Schedule the next read */ |
530 | usb_fill_bulk_urb(port->read_urb, port->serial->dev, | |
531 | usb_rcvbulkpipe(port->serial->dev, | |
532 | port->bulk_in_endpointAddress), | |
533 | port->read_urb->transfer_buffer, | |
534 | port->read_urb->transfer_buffer_length, | |
535 | aircable_read_bulk_callback, port); | |
536 | ||
537 | result = usb_submit_urb(urb, GFP_ATOMIC); | |
538 | if (result && result != -EPERM) | |
539 | dev_err(&urb->dev->dev, | |
540 | "%s - failed resubmitting read urb, error %d\n", | |
541 | __func__, result); | |
3fe70ba2 MFN |
542 | } |
543 | ||
544 | /* Based on ftdi_sio.c throttle */ | |
95da310e | 545 | static void aircable_throttle(struct tty_struct *tty) |
3fe70ba2 | 546 | { |
95da310e | 547 | struct usb_serial_port *port = tty->driver_data; |
3fe70ba2 | 548 | struct aircable_private *priv = usb_get_serial_port_data(port); |
3fe70ba2 | 549 | |
441b62c1 | 550 | dbg("%s - port %d", __func__, port->number); |
3fe70ba2 | 551 | |
63832515 | 552 | spin_lock_irq(&priv->rx_lock); |
3fe70ba2 | 553 | priv->rx_flags |= THROTTLED; |
63832515 | 554 | spin_unlock_irq(&priv->rx_lock); |
3fe70ba2 MFN |
555 | } |
556 | ||
557 | /* Based on ftdi_sio.c unthrottle */ | |
95da310e | 558 | static void aircable_unthrottle(struct tty_struct *tty) |
3fe70ba2 | 559 | { |
95da310e | 560 | struct usb_serial_port *port = tty->driver_data; |
3fe70ba2 MFN |
561 | struct aircable_private *priv = usb_get_serial_port_data(port); |
562 | int actually_throttled; | |
3fe70ba2 | 563 | |
441b62c1 | 564 | dbg("%s - port %d", __func__, port->number); |
3fe70ba2 | 565 | |
63832515 | 566 | spin_lock_irq(&priv->rx_lock); |
3fe70ba2 MFN |
567 | actually_throttled = priv->rx_flags & ACTUALLY_THROTTLED; |
568 | priv->rx_flags &= ~(THROTTLED | ACTUALLY_THROTTLED); | |
63832515 | 569 | spin_unlock_irq(&priv->rx_lock); |
3fe70ba2 MFN |
570 | |
571 | if (actually_throttled) | |
572 | schedule_work(&priv->rx_work); | |
573 | } | |
574 | ||
d9b1b787 JH |
575 | static struct usb_driver aircable_driver = { |
576 | .name = "aircable", | |
577 | .probe = usb_serial_probe, | |
578 | .disconnect = usb_serial_disconnect, | |
579 | .id_table = id_table, | |
580 | .no_dynamic_id = 1, | |
581 | }; | |
582 | ||
3fe70ba2 | 583 | static struct usb_serial_driver aircable_device = { |
52d67f0b JH |
584 | .driver = { |
585 | .owner = THIS_MODULE, | |
586 | .name = "aircable", | |
587 | }, | |
d9b1b787 | 588 | .usb_driver = &aircable_driver, |
3fe70ba2 MFN |
589 | .id_table = id_table, |
590 | .num_ports = 1, | |
591 | .attach = aircable_attach, | |
592 | .probe = aircable_probe, | |
f9c99bb8 | 593 | .release = aircable_release, |
3fe70ba2 MFN |
594 | .write = aircable_write, |
595 | .write_room = aircable_write_room, | |
596 | .write_bulk_callback = aircable_write_bulk_callback, | |
597 | .read_bulk_callback = aircable_read_bulk_callback, | |
598 | .throttle = aircable_throttle, | |
599 | .unthrottle = aircable_unthrottle, | |
600 | }; | |
601 | ||
c4d0f8cb | 602 | static int __init aircable_init(void) |
3fe70ba2 MFN |
603 | { |
604 | int retval; | |
605 | retval = usb_serial_register(&aircable_device); | |
606 | if (retval) | |
607 | goto failed_serial_register; | |
608 | retval = usb_register(&aircable_driver); | |
609 | if (retval) | |
610 | goto failed_usb_register; | |
611 | return 0; | |
612 | ||
3fe70ba2 | 613 | failed_usb_register: |
78c8fb37 DY |
614 | usb_serial_deregister(&aircable_device); |
615 | failed_serial_register: | |
3fe70ba2 MFN |
616 | return retval; |
617 | } | |
618 | ||
c4d0f8cb | 619 | static void __exit aircable_exit(void) |
3fe70ba2 MFN |
620 | { |
621 | usb_deregister(&aircable_driver); | |
622 | usb_serial_deregister(&aircable_device); | |
623 | } | |
624 | ||
625 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
626 | MODULE_DESCRIPTION(DRIVER_DESC); | |
627 | MODULE_VERSION(DRIVER_VERSION); | |
628 | MODULE_LICENSE("GPL"); | |
629 | ||
630 | module_init(aircable_init); | |
631 | module_exit(aircable_exit); | |
632 | ||
633 | module_param(debug, bool, S_IRUGO | S_IWUSR); | |
634 | MODULE_PARM_DESC(debug, "Debug enabled or not"); |