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