]>
Commit | Line | Data |
---|---|---|
58cfe911 MU |
1 | /* |
2 | Option Card (PCMCIA to) USB to Serial Driver | |
3 | ||
4 | Copyright (C) 2005 Matthias Urlichs <smurf@smurf.noris.de> | |
5 | ||
6 | This driver is free software; you can redistribute it and/or modify | |
7 | it under the terms of Version 2 of the GNU General Public License as | |
8 | published by the Free Software Foundation. | |
9 | ||
10 | Portions copied from the Keyspan driver by Hugh Blemings <hugh@blemings.org> | |
11 | ||
12 | History: | |
13 | ||
14 | 2005-05-19 v0.1 Initial version, based on incomplete docs | |
ba460e48 | 15 | and analysis of misbehavior with the standard driver |
58cfe911 MU |
16 | 2005-05-20 v0.2 Extended the input buffer to avoid losing |
17 | random 64-byte chunks of data | |
18 | 2005-05-21 v0.3 implemented chars_in_buffer() | |
19 | turned on low_latency | |
20 | simplified the code somewhat | |
ba460e48 MU |
21 | 2005-05-24 v0.4 option_write() sometimes deadlocked under heavy load |
22 | removed some dead code | |
23 | added sponsor notice | |
24 | coding style clean-up | |
25 | 2005-06-20 v0.4.1 add missing braces :-/ | |
26 | killed end-of-line whitespace | |
27 | 2005-07-15 v0.4.2 rename WLAN product to FUSION, add FUSION2 | |
b6137383 | 28 | 2005-09-10 v0.4.3 added HUAWEI E600 card and Audiovox AirCard |
b27c73dc MU |
29 | 2005-09-20 v0.4.4 increased recv buffer size: the card sometimes |
30 | wants to send >2000 bytes. | |
ba460e48 MU |
31 | |
32 | Work sponsored by: Sigos GmbH, Germany <info@sigos.de> | |
33 | ||
58cfe911 | 34 | */ |
ba460e48 MU |
35 | |
36 | #define DRIVER_VERSION "v0.4" | |
58cfe911 MU |
37 | #define DRIVER_AUTHOR "Matthias Urlichs <smurf@smurf.noris.de>" |
38 | #define DRIVER_DESC "Option Card (PC-Card to) USB to Serial Driver" | |
39 | ||
40 | #include <linux/config.h> | |
41 | #include <linux/kernel.h> | |
42 | #include <linux/jiffies.h> | |
43 | #include <linux/errno.h> | |
44 | #include <linux/tty.h> | |
45 | #include <linux/tty_flip.h> | |
46 | #include <linux/module.h> | |
47 | #include <linux/usb.h> | |
48 | #include "usb-serial.h" | |
49 | ||
50 | /* Function prototypes */ | |
7bb75aee AM |
51 | static int option_open(struct usb_serial_port *port, struct file *filp); |
52 | static void option_close(struct usb_serial_port *port, struct file *filp); | |
53 | static int option_startup(struct usb_serial *serial); | |
54 | static void option_shutdown(struct usb_serial *serial); | |
55 | static void option_rx_throttle(struct usb_serial_port *port); | |
56 | static void option_rx_unthrottle(struct usb_serial_port *port); | |
57 | static int option_write_room(struct usb_serial_port *port); | |
58cfe911 MU |
58 | |
59 | static void option_instat_callback(struct urb *urb, struct pt_regs *regs); | |
60 | ||
7bb75aee AM |
61 | static int option_write(struct usb_serial_port *port, |
62 | const unsigned char *buf, int count); | |
58cfe911 | 63 | |
7bb75aee AM |
64 | static int option_chars_in_buffer(struct usb_serial_port *port); |
65 | static int option_ioctl(struct usb_serial_port *port, struct file *file, | |
66 | unsigned int cmd, unsigned long arg); | |
67 | static void option_set_termios(struct usb_serial_port *port, | |
68 | struct termios *old); | |
69 | static void option_break_ctl(struct usb_serial_port *port, int break_state); | |
70 | static int option_tiocmget(struct usb_serial_port *port, struct file *file); | |
71 | static int option_tiocmset(struct usb_serial_port *port, struct file *file, | |
72 | unsigned int set, unsigned int clear); | |
73 | static int option_send_setup(struct usb_serial_port *port); | |
58cfe911 MU |
74 | |
75 | /* Vendor and product IDs */ | |
ba460e48 | 76 | #define OPTION_VENDOR_ID 0x0AF0 |
b6137383 MU |
77 | #define HUAWEI_VENDOR_ID 0x12D1 |
78 | #define AUDIOVOX_VENDOR_ID 0x0F3D | |
ba460e48 MU |
79 | |
80 | #define OPTION_PRODUCT_OLD 0x5000 | |
81 | #define OPTION_PRODUCT_FUSION 0x6000 | |
82 | #define OPTION_PRODUCT_FUSION2 0x6300 | |
b6137383 MU |
83 | #define HUAWEI_PRODUCT_E600 0x1001 |
84 | #define AUDIOVOX_PRODUCT_AIRCARD 0x0112 | |
58cfe911 | 85 | |
58cfe911 MU |
86 | static struct usb_device_id option_ids[] = { |
87 | { USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_OLD) }, | |
ba460e48 MU |
88 | { USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUSION) }, |
89 | { USB_DEVICE(OPTION_VENDOR_ID, OPTION_PRODUCT_FUSION2) }, | |
b6137383 MU |
90 | { USB_DEVICE(HUAWEI_VENDOR_ID, HUAWEI_PRODUCT_E600) }, |
91 | { USB_DEVICE(AUDIOVOX_VENDOR_ID, AUDIOVOX_PRODUCT_AIRCARD) }, | |
58cfe911 MU |
92 | { } /* Terminating entry */ |
93 | }; | |
94 | ||
95 | MODULE_DEVICE_TABLE(usb, option_ids); | |
96 | ||
97 | static struct usb_driver option_driver = { | |
58cfe911 MU |
98 | .name = "option", |
99 | .probe = usb_serial_probe, | |
100 | .disconnect = usb_serial_disconnect, | |
101 | .id_table = option_ids, | |
ba9dc657 | 102 | .no_dynamic_id = 1, |
58cfe911 MU |
103 | }; |
104 | ||
105 | /* The card has three separate interfaces, wich the serial driver | |
106 | * recognizes separately, thus num_port=1. | |
107 | */ | |
ea65370d | 108 | static struct usb_serial_driver option_3port_device = { |
18fcac35 GKH |
109 | .driver = { |
110 | .owner = THIS_MODULE, | |
269bda1c | 111 | .name = "option", |
18fcac35 | 112 | }, |
269bda1c | 113 | .description = "Option 3G data card", |
ba460e48 MU |
114 | .id_table = option_ids, |
115 | .num_interrupt_in = NUM_DONT_CARE, | |
116 | .num_bulk_in = NUM_DONT_CARE, | |
117 | .num_bulk_out = NUM_DONT_CARE, | |
118 | .num_ports = 1, /* 3, but the card reports its ports separately */ | |
119 | .open = option_open, | |
120 | .close = option_close, | |
121 | .write = option_write, | |
122 | .write_room = option_write_room, | |
123 | .chars_in_buffer = option_chars_in_buffer, | |
124 | .throttle = option_rx_throttle, | |
125 | .unthrottle = option_rx_unthrottle, | |
126 | .ioctl = option_ioctl, | |
127 | .set_termios = option_set_termios, | |
128 | .break_ctl = option_break_ctl, | |
129 | .tiocmget = option_tiocmget, | |
130 | .tiocmset = option_tiocmset, | |
131 | .attach = option_startup, | |
132 | .shutdown = option_shutdown, | |
133 | .read_int_callback = option_instat_callback, | |
58cfe911 MU |
134 | }; |
135 | ||
ba460e48 | 136 | #ifdef CONFIG_USB_DEBUG |
58cfe911 | 137 | static int debug; |
ba460e48 MU |
138 | #else |
139 | #define debug 0 | |
140 | #endif | |
141 | ||
58cfe911 MU |
142 | /* per port private data */ |
143 | ||
ba460e48 MU |
144 | #define N_IN_URB 4 |
145 | #define N_OUT_URB 1 | |
b27c73dc | 146 | #define IN_BUFLEN 4096 |
ba460e48 | 147 | #define OUT_BUFLEN 128 |
58cfe911 MU |
148 | |
149 | struct option_port_private { | |
150 | /* Input endpoints and buffer for this port */ | |
ba460e48 MU |
151 | struct urb *in_urbs[N_IN_URB]; |
152 | char in_buffer[N_IN_URB][IN_BUFLEN]; | |
58cfe911 | 153 | /* Output endpoints and buffer for this port */ |
ba460e48 MU |
154 | struct urb *out_urbs[N_OUT_URB]; |
155 | char out_buffer[N_OUT_URB][OUT_BUFLEN]; | |
58cfe911 MU |
156 | |
157 | /* Settings for the port */ | |
ba460e48 MU |
158 | int rts_state; /* Handshaking pins (outputs) */ |
159 | int dtr_state; | |
160 | int cts_state; /* Handshaking pins (inputs) */ | |
161 | int dsr_state; | |
162 | int dcd_state; | |
163 | int ri_state; | |
164 | ||
165 | unsigned long tx_start_time[N_OUT_URB]; | |
58cfe911 MU |
166 | }; |
167 | ||
58cfe911 | 168 | /* Functions used by new usb-serial code. */ |
7bb75aee | 169 | static int __init option_init(void) |
58cfe911 MU |
170 | { |
171 | int retval; | |
172 | retval = usb_serial_register(&option_3port_device); | |
173 | if (retval) | |
174 | goto failed_3port_device_register; | |
175 | retval = usb_register(&option_driver); | |
176 | if (retval) | |
177 | goto failed_driver_register; | |
178 | ||
179 | info(DRIVER_DESC ": " DRIVER_VERSION); | |
180 | ||
181 | return 0; | |
182 | ||
183 | failed_driver_register: | |
184 | usb_serial_deregister (&option_3port_device); | |
185 | failed_3port_device_register: | |
186 | return retval; | |
187 | } | |
188 | ||
7bb75aee | 189 | static void __exit option_exit(void) |
58cfe911 MU |
190 | { |
191 | usb_deregister (&option_driver); | |
192 | usb_serial_deregister (&option_3port_device); | |
193 | } | |
194 | ||
195 | module_init(option_init); | |
196 | module_exit(option_exit); | |
197 | ||
7bb75aee | 198 | static void option_rx_throttle(struct usb_serial_port *port) |
58cfe911 MU |
199 | { |
200 | dbg("%s", __FUNCTION__); | |
201 | } | |
202 | ||
7bb75aee | 203 | static void option_rx_unthrottle(struct usb_serial_port *port) |
58cfe911 MU |
204 | { |
205 | dbg("%s", __FUNCTION__); | |
206 | } | |
207 | ||
7bb75aee | 208 | static void option_break_ctl(struct usb_serial_port *port, int break_state) |
58cfe911 MU |
209 | { |
210 | /* Unfortunately, I don't know how to send a break */ | |
ba460e48 | 211 | dbg("%s", __FUNCTION__); |
58cfe911 MU |
212 | } |
213 | ||
7bb75aee AM |
214 | static void option_set_termios(struct usb_serial_port *port, |
215 | struct termios *old_termios) | |
58cfe911 MU |
216 | { |
217 | dbg("%s", __FUNCTION__); | |
218 | ||
219 | option_send_setup(port); | |
220 | } | |
221 | ||
7bb75aee | 222 | static int option_tiocmget(struct usb_serial_port *port, struct file *file) |
58cfe911 | 223 | { |
ba460e48 MU |
224 | unsigned int value; |
225 | struct option_port_private *portdata; | |
58cfe911 MU |
226 | |
227 | portdata = usb_get_serial_port_data(port); | |
228 | ||
229 | value = ((portdata->rts_state) ? TIOCM_RTS : 0) | | |
230 | ((portdata->dtr_state) ? TIOCM_DTR : 0) | | |
231 | ((portdata->cts_state) ? TIOCM_CTS : 0) | | |
232 | ((portdata->dsr_state) ? TIOCM_DSR : 0) | | |
233 | ((portdata->dcd_state) ? TIOCM_CAR : 0) | | |
234 | ((portdata->ri_state) ? TIOCM_RNG : 0); | |
235 | ||
236 | return value; | |
237 | } | |
238 | ||
7bb75aee AM |
239 | static int option_tiocmset(struct usb_serial_port *port, struct file *file, |
240 | unsigned int set, unsigned int clear) | |
58cfe911 | 241 | { |
ba460e48 | 242 | struct option_port_private *portdata; |
58cfe911 MU |
243 | |
244 | portdata = usb_get_serial_port_data(port); | |
245 | ||
246 | if (set & TIOCM_RTS) | |
247 | portdata->rts_state = 1; | |
248 | if (set & TIOCM_DTR) | |
249 | portdata->dtr_state = 1; | |
250 | ||
251 | if (clear & TIOCM_RTS) | |
252 | portdata->rts_state = 0; | |
253 | if (clear & TIOCM_DTR) | |
254 | portdata->dtr_state = 0; | |
255 | return option_send_setup(port); | |
256 | } | |
257 | ||
7bb75aee AM |
258 | static int option_ioctl(struct usb_serial_port *port, struct file *file, |
259 | unsigned int cmd, unsigned long arg) | |
58cfe911 MU |
260 | { |
261 | return -ENOIOCTLCMD; | |
262 | } | |
263 | ||
264 | /* Write */ | |
7bb75aee AM |
265 | static int option_write(struct usb_serial_port *port, |
266 | const unsigned char *buf, int count) | |
58cfe911 | 267 | { |
ba460e48 MU |
268 | struct option_port_private *portdata; |
269 | int i; | |
270 | int left, todo; | |
271 | struct urb *this_urb = NULL; /* spurious */ | |
272 | int err; | |
58cfe911 MU |
273 | |
274 | portdata = usb_get_serial_port_data(port); | |
275 | ||
276 | dbg("%s: write (%d chars)", __FUNCTION__, count); | |
277 | ||
58cfe911 MU |
278 | i = 0; |
279 | left = count; | |
ba460e48 | 280 | for (i=0; left > 0 && i < N_OUT_URB; i++) { |
58cfe911 MU |
281 | todo = left; |
282 | if (todo > OUT_BUFLEN) | |
283 | todo = OUT_BUFLEN; | |
284 | ||
ba460e48 MU |
285 | this_urb = portdata->out_urbs[i]; |
286 | if (this_urb->status == -EINPROGRESS) { | |
7bb75aee AM |
287 | if (time_before(jiffies, |
288 | portdata->tx_start_time[i] + 10 * HZ)) | |
58cfe911 | 289 | continue; |
58cfe911 | 290 | usb_unlink_urb(this_urb); |
ba460e48 | 291 | continue; |
58cfe911 | 292 | } |
ba460e48 | 293 | if (this_urb->status != 0) |
7bb75aee AM |
294 | dbg("usb_write %p failed (err=%d)", |
295 | this_urb, this_urb->status); | |
58cfe911 | 296 | |
7bb75aee AM |
297 | dbg("%s: endpoint %d buf %d", __FUNCTION__, |
298 | usb_pipeendpoint(this_urb->pipe), i); | |
58cfe911 | 299 | |
ba460e48 | 300 | /* send the data */ |
58cfe911 | 301 | memcpy (this_urb->transfer_buffer, buf, todo); |
58cfe911 MU |
302 | this_urb->transfer_buffer_length = todo; |
303 | ||
58cfe911 MU |
304 | this_urb->dev = port->serial->dev; |
305 | err = usb_submit_urb(this_urb, GFP_ATOMIC); | |
306 | if (err) { | |
7bb75aee AM |
307 | dbg("usb_submit_urb %p (write bulk) failed " |
308 | "(%d, has %d)", this_urb, | |
309 | err, this_urb->status); | |
58cfe911 MU |
310 | continue; |
311 | } | |
312 | portdata->tx_start_time[i] = jiffies; | |
313 | buf += todo; | |
314 | left -= todo; | |
315 | } | |
316 | ||
317 | count -= left; | |
58cfe911 MU |
318 | dbg("%s: wrote (did %d)", __FUNCTION__, count); |
319 | return count; | |
320 | } | |
321 | ||
7bb75aee | 322 | static void option_indat_callback(struct urb *urb, struct pt_regs *regs) |
58cfe911 | 323 | { |
33f0f88f | 324 | int err; |
58cfe911 MU |
325 | int endpoint; |
326 | struct usb_serial_port *port; | |
327 | struct tty_struct *tty; | |
328 | unsigned char *data = urb->transfer_buffer; | |
329 | ||
330 | dbg("%s: %p", __FUNCTION__, urb); | |
331 | ||
332 | endpoint = usb_pipeendpoint(urb->pipe); | |
333 | port = (struct usb_serial_port *) urb->context; | |
334 | ||
335 | if (urb->status) { | |
336 | dbg("%s: nonzero status: %d on endpoint %02x.", | |
337 | __FUNCTION__, urb->status, endpoint); | |
338 | } else { | |
339 | tty = port->tty; | |
340 | if (urb->actual_length) { | |
33f0f88f AC |
341 | tty_buffer_request_room(tty, urb->actual_length); |
342 | tty_insert_flip_string(tty, data, urb->actual_length); | |
58cfe911 MU |
343 | tty_flip_buffer_push(tty); |
344 | } else { | |
345 | dbg("%s: empty read urb received", __FUNCTION__); | |
346 | } | |
347 | ||
348 | /* Resubmit urb so we continue receiving */ | |
349 | if (port->open_count && urb->status != -ESHUTDOWN) { | |
350 | err = usb_submit_urb(urb, GFP_ATOMIC); | |
351 | if (err) | |
7bb75aee AM |
352 | printk(KERN_ERR "%s: resubmit read urb failed. " |
353 | "(%d)", __FUNCTION__, err); | |
58cfe911 MU |
354 | } |
355 | } | |
356 | return; | |
357 | } | |
358 | ||
7bb75aee | 359 | static void option_outdat_callback(struct urb *urb, struct pt_regs *regs) |
58cfe911 MU |
360 | { |
361 | struct usb_serial_port *port; | |
362 | ||
363 | dbg("%s", __FUNCTION__); | |
364 | ||
365 | port = (struct usb_serial_port *) urb->context; | |
366 | ||
367 | if (port->open_count) | |
368 | schedule_work(&port->work); | |
369 | } | |
370 | ||
7bb75aee | 371 | static void option_instat_callback(struct urb *urb, struct pt_regs *regs) |
58cfe911 MU |
372 | { |
373 | int err; | |
374 | struct usb_serial_port *port = (struct usb_serial_port *) urb->context; | |
375 | struct option_port_private *portdata = usb_get_serial_port_data(port); | |
376 | struct usb_serial *serial = port->serial; | |
377 | ||
378 | dbg("%s", __FUNCTION__); | |
379 | dbg("%s: urb %p port %p has data %p", __FUNCTION__,urb,port,portdata); | |
380 | ||
381 | if (urb->status == 0) { | |
382 | struct usb_ctrlrequest *req_pkt = | |
383 | (struct usb_ctrlrequest *)urb->transfer_buffer; | |
384 | ||
385 | if (!req_pkt) { | |
386 | dbg("%s: NULL req_pkt\n", __FUNCTION__); | |
387 | return; | |
388 | } | |
7bb75aee AM |
389 | if ((req_pkt->bRequestType == 0xA1) && |
390 | (req_pkt->bRequest == 0x20)) { | |
58cfe911 MU |
391 | int old_dcd_state; |
392 | unsigned char signals = *((unsigned char *) | |
7bb75aee AM |
393 | urb->transfer_buffer + |
394 | sizeof(struct usb_ctrlrequest)); | |
58cfe911 MU |
395 | |
396 | dbg("%s: signal x%x", __FUNCTION__, signals); | |
397 | ||
398 | old_dcd_state = portdata->dcd_state; | |
399 | portdata->cts_state = 1; | |
400 | portdata->dcd_state = ((signals & 0x01) ? 1 : 0); | |
401 | portdata->dsr_state = ((signals & 0x02) ? 1 : 0); | |
402 | portdata->ri_state = ((signals & 0x08) ? 1 : 0); | |
403 | ||
7bb75aee AM |
404 | if (port->tty && !C_CLOCAL(port->tty) && |
405 | old_dcd_state && !portdata->dcd_state) | |
58cfe911 | 406 | tty_hangup(port->tty); |
7bb75aee AM |
407 | } else { |
408 | dbg("%s: type %x req %x", __FUNCTION__, | |
409 | req_pkt->bRequestType,req_pkt->bRequest); | |
410 | } | |
58cfe911 MU |
411 | } else |
412 | dbg("%s: error %d", __FUNCTION__, urb->status); | |
413 | ||
414 | /* Resubmit urb so we continue receiving IRQ data */ | |
415 | if (urb->status != -ESHUTDOWN) { | |
416 | urb->dev = serial->dev; | |
417 | err = usb_submit_urb(urb, GFP_ATOMIC); | |
418 | if (err) | |
7bb75aee AM |
419 | dbg("%s: resubmit intr urb failed. (%d)", |
420 | __FUNCTION__, err); | |
58cfe911 MU |
421 | } |
422 | } | |
423 | ||
7bb75aee | 424 | static int option_write_room(struct usb_serial_port *port) |
58cfe911 MU |
425 | { |
426 | struct option_port_private *portdata; | |
427 | int i; | |
428 | int data_len = 0; | |
429 | struct urb *this_urb; | |
430 | ||
431 | portdata = usb_get_serial_port_data(port); | |
432 | ||
ba460e48 | 433 | for (i=0; i < N_OUT_URB; i++) { |
58cfe911 MU |
434 | this_urb = portdata->out_urbs[i]; |
435 | if (this_urb && this_urb->status != -EINPROGRESS) | |
436 | data_len += OUT_BUFLEN; | |
ba460e48 | 437 | } |
58cfe911 MU |
438 | |
439 | dbg("%s: %d", __FUNCTION__, data_len); | |
440 | return data_len; | |
441 | } | |
442 | ||
7bb75aee | 443 | static int option_chars_in_buffer(struct usb_serial_port *port) |
58cfe911 MU |
444 | { |
445 | struct option_port_private *portdata; | |
446 | int i; | |
447 | int data_len = 0; | |
448 | struct urb *this_urb; | |
449 | ||
450 | portdata = usb_get_serial_port_data(port); | |
451 | ||
ba460e48 | 452 | for (i=0; i < N_OUT_URB; i++) { |
58cfe911 MU |
453 | this_urb = portdata->out_urbs[i]; |
454 | if (this_urb && this_urb->status == -EINPROGRESS) | |
455 | data_len += this_urb->transfer_buffer_length; | |
ba460e48 | 456 | } |
58cfe911 MU |
457 | dbg("%s: %d", __FUNCTION__, data_len); |
458 | return data_len; | |
459 | } | |
460 | ||
7bb75aee | 461 | static int option_open(struct usb_serial_port *port, struct file *filp) |
58cfe911 | 462 | { |
ba460e48 MU |
463 | struct option_port_private *portdata; |
464 | struct usb_serial *serial = port->serial; | |
465 | int i, err; | |
466 | struct urb *urb; | |
58cfe911 MU |
467 | |
468 | portdata = usb_get_serial_port_data(port); | |
469 | ||
470 | dbg("%s", __FUNCTION__); | |
471 | ||
472 | /* Set some sane defaults */ | |
473 | portdata->rts_state = 1; | |
474 | portdata->dtr_state = 1; | |
475 | ||
476 | /* Reset low level data toggle and start reading from endpoints */ | |
477 | for (i = 0; i < N_IN_URB; i++) { | |
478 | urb = portdata->in_urbs[i]; | |
479 | if (! urb) | |
480 | continue; | |
481 | if (urb->dev != serial->dev) { | |
7bb75aee AM |
482 | dbg("%s: dev %p != %p", __FUNCTION__, |
483 | urb->dev, serial->dev); | |
58cfe911 MU |
484 | continue; |
485 | } | |
486 | ||
7bb75aee AM |
487 | /* |
488 | * make sure endpoint data toggle is synchronized with the | |
489 | * device | |
490 | */ | |
58cfe911 MU |
491 | usb_clear_halt(urb->dev, urb->pipe); |
492 | ||
493 | err = usb_submit_urb(urb, GFP_KERNEL); | |
494 | if (err) { | |
7bb75aee AM |
495 | dbg("%s: submit urb %d failed (%d) %d", |
496 | __FUNCTION__, i, err, | |
58cfe911 MU |
497 | urb->transfer_buffer_length); |
498 | } | |
499 | } | |
500 | ||
501 | /* Reset low level data toggle on out endpoints */ | |
502 | for (i = 0; i < N_OUT_URB; i++) { | |
503 | urb = portdata->out_urbs[i]; | |
504 | if (! urb) | |
505 | continue; | |
506 | urb->dev = serial->dev; | |
7bb75aee AM |
507 | /* usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe), |
508 | usb_pipeout(urb->pipe), 0); */ | |
58cfe911 MU |
509 | } |
510 | ||
511 | port->tty->low_latency = 1; | |
512 | ||
513 | option_send_setup(port); | |
514 | ||
515 | return (0); | |
516 | } | |
517 | ||
7bb75aee | 518 | static inline void stop_urb(struct urb *urb) |
58cfe911 | 519 | { |
242cf670 | 520 | if (urb && urb->status == -EINPROGRESS) |
58cfe911 | 521 | usb_kill_urb(urb); |
58cfe911 MU |
522 | } |
523 | ||
7bb75aee | 524 | static void option_close(struct usb_serial_port *port, struct file *filp) |
58cfe911 | 525 | { |
ba460e48 MU |
526 | int i; |
527 | struct usb_serial *serial = port->serial; | |
528 | struct option_port_private *portdata; | |
58cfe911 MU |
529 | |
530 | dbg("%s", __FUNCTION__); | |
531 | portdata = usb_get_serial_port_data(port); | |
532 | ||
533 | portdata->rts_state = 0; | |
534 | portdata->dtr_state = 0; | |
535 | ||
536 | if (serial->dev) { | |
537 | option_send_setup(port); | |
538 | ||
539 | /* Stop reading/writing urbs */ | |
540 | for (i = 0; i < N_IN_URB; i++) | |
541 | stop_urb(portdata->in_urbs[i]); | |
542 | for (i = 0; i < N_OUT_URB; i++) | |
543 | stop_urb(portdata->out_urbs[i]); | |
544 | } | |
545 | port->tty = NULL; | |
546 | } | |
547 | ||
58cfe911 | 548 | /* Helper functions used by option_setup_urbs */ |
7bb75aee AM |
549 | static struct urb *option_setup_urb(struct usb_serial *serial, int endpoint, |
550 | int dir, void *ctx, char *buf, int len, | |
551 | void (*callback)(struct urb *, struct pt_regs *regs)) | |
58cfe911 MU |
552 | { |
553 | struct urb *urb; | |
554 | ||
555 | if (endpoint == -1) | |
556 | return NULL; /* endpoint not needed */ | |
557 | ||
558 | urb = usb_alloc_urb(0, GFP_KERNEL); /* No ISO */ | |
559 | if (urb == NULL) { | |
560 | dbg("%s: alloc for endpoint %d failed.", __FUNCTION__, endpoint); | |
561 | return NULL; | |
562 | } | |
563 | ||
564 | /* Fill URB using supplied data. */ | |
565 | usb_fill_bulk_urb(urb, serial->dev, | |
566 | usb_sndbulkpipe(serial->dev, endpoint) | dir, | |
567 | buf, len, callback, ctx); | |
568 | ||
569 | return urb; | |
570 | } | |
571 | ||
572 | /* Setup urbs */ | |
7bb75aee | 573 | static void option_setup_urbs(struct usb_serial *serial) |
58cfe911 | 574 | { |
ba460e48 MU |
575 | int j; |
576 | struct usb_serial_port *port; | |
577 | struct option_port_private *portdata; | |
58cfe911 MU |
578 | |
579 | dbg("%s", __FUNCTION__); | |
580 | ||
581 | port = serial->port[0]; | |
582 | portdata = usb_get_serial_port_data(port); | |
583 | ||
584 | /* Do indat endpoints first */ | |
585 | for (j = 0; j <= N_IN_URB; ++j) { | |
586 | portdata->in_urbs[j] = option_setup_urb (serial, | |
587 | port->bulk_in_endpointAddress, USB_DIR_IN, port, | |
588 | portdata->in_buffer[j], IN_BUFLEN, option_indat_callback); | |
589 | } | |
590 | ||
591 | /* outdat endpoints */ | |
592 | for (j = 0; j <= N_OUT_URB; ++j) { | |
593 | portdata->out_urbs[j] = option_setup_urb (serial, | |
594 | port->bulk_out_endpointAddress, USB_DIR_OUT, port, | |
595 | portdata->out_buffer[j], OUT_BUFLEN, option_outdat_callback); | |
596 | } | |
597 | } | |
598 | ||
7bb75aee | 599 | static int option_send_setup(struct usb_serial_port *port) |
58cfe911 MU |
600 | { |
601 | struct usb_serial *serial = port->serial; | |
602 | struct option_port_private *portdata; | |
603 | ||
604 | dbg("%s", __FUNCTION__); | |
605 | ||
606 | portdata = usb_get_serial_port_data(port); | |
607 | ||
608 | if (port->tty) { | |
609 | int val = 0; | |
610 | if (portdata->dtr_state) | |
611 | val |= 0x01; | |
612 | if (portdata->rts_state) | |
613 | val |= 0x02; | |
614 | ||
7bb75aee AM |
615 | return usb_control_msg(serial->dev, |
616 | usb_rcvctrlpipe(serial->dev, 0), | |
617 | 0x22,0x21,val,0,NULL,0,USB_CTRL_SET_TIMEOUT); | |
58cfe911 MU |
618 | } |
619 | ||
620 | return 0; | |
621 | } | |
622 | ||
7bb75aee | 623 | static int option_startup(struct usb_serial *serial) |
58cfe911 | 624 | { |
ba460e48 MU |
625 | int i, err; |
626 | struct usb_serial_port *port; | |
627 | struct option_port_private *portdata; | |
58cfe911 MU |
628 | |
629 | dbg("%s", __FUNCTION__); | |
630 | ||
631 | /* Now setup per port private data */ | |
632 | for (i = 0; i < serial->num_ports; i++) { | |
633 | port = serial->port[i]; | |
7bb75aee | 634 | portdata = kmalloc(sizeof(*portdata), GFP_KERNEL); |
58cfe911 | 635 | if (!portdata) { |
7bb75aee AM |
636 | dbg("%s: kmalloc for option_port_private (%d) failed!.", |
637 | __FUNCTION__, i); | |
58cfe911 MU |
638 | return (1); |
639 | } | |
640 | memset(portdata, 0, sizeof(struct option_port_private)); | |
641 | ||
642 | usb_set_serial_port_data(port, portdata); | |
643 | ||
644 | if (! port->interrupt_in_urb) | |
645 | continue; | |
646 | err = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL); | |
647 | if (err) | |
7bb75aee AM |
648 | dbg("%s: submit irq_in urb failed %d", |
649 | __FUNCTION__, err); | |
58cfe911 MU |
650 | } |
651 | ||
652 | option_setup_urbs(serial); | |
653 | ||
654 | return (0); | |
655 | } | |
656 | ||
7bb75aee | 657 | static void option_shutdown(struct usb_serial *serial) |
58cfe911 | 658 | { |
ba460e48 MU |
659 | int i, j; |
660 | struct usb_serial_port *port; | |
661 | struct option_port_private *portdata; | |
58cfe911 MU |
662 | |
663 | dbg("%s", __FUNCTION__); | |
664 | ||
665 | /* Stop reading/writing urbs */ | |
666 | for (i = 0; i < serial->num_ports; ++i) { | |
667 | port = serial->port[i]; | |
668 | portdata = usb_get_serial_port_data(port); | |
669 | for (j = 0; j < N_IN_URB; j++) | |
670 | stop_urb(portdata->in_urbs[j]); | |
671 | for (j = 0; j < N_OUT_URB; j++) | |
672 | stop_urb(portdata->out_urbs[j]); | |
673 | } | |
674 | ||
675 | /* Now free them */ | |
676 | for (i = 0; i < serial->num_ports; ++i) { | |
677 | port = serial->port[i]; | |
678 | portdata = usb_get_serial_port_data(port); | |
679 | ||
680 | for (j = 0; j < N_IN_URB; j++) { | |
681 | if (portdata->in_urbs[j]) { | |
682 | usb_free_urb(portdata->in_urbs[j]); | |
683 | portdata->in_urbs[j] = NULL; | |
684 | } | |
685 | } | |
686 | for (j = 0; j < N_OUT_URB; j++) { | |
687 | if (portdata->out_urbs[j]) { | |
688 | usb_free_urb(portdata->out_urbs[j]); | |
689 | portdata->out_urbs[j] = NULL; | |
690 | } | |
691 | } | |
692 | } | |
693 | ||
694 | /* Now free per port private data */ | |
695 | for (i = 0; i < serial->num_ports; i++) { | |
696 | port = serial->port[i]; | |
697 | kfree(usb_get_serial_port_data(port)); | |
698 | } | |
699 | } | |
700 | ||
701 | MODULE_AUTHOR(DRIVER_AUTHOR); | |
702 | MODULE_DESCRIPTION(DRIVER_DESC); | |
703 | MODULE_VERSION(DRIVER_VERSION); | |
704 | MODULE_LICENSE("GPL"); | |
705 | ||
ba460e48 | 706 | #ifdef CONFIG_USB_DEBUG |
58cfe911 MU |
707 | module_param(debug, bool, S_IRUGO | S_IWUSR); |
708 | MODULE_PARM_DESC(debug, "Debug messages"); | |
ba460e48 | 709 | #endif |
58cfe911 | 710 |