Commit | Line | Data |
---|---|---|
69de51fd | 1 | /* |
033a3fb9 KL |
2 | USB Driver for Sierra Wireless |
3 | ||
f3564de4 | 4 | Copyright (C) 2006, 2007, 2008 Kevin Lloyd <klloyd@sierrawireless.com> |
033a3fb9 KL |
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> | |
033a3fb9 KL |
15 | */ |
16 | ||
f3564de4 KL |
17 | #define DRIVER_VERSION "v.1.2.9c" |
18 | #define DRIVER_AUTHOR "Kevin Lloyd <klloyd@sierrawireless.com>" | |
033a3fb9 | 19 | #define DRIVER_DESC "USB Driver for Sierra Wireless USB modems" |
69de51fd KL |
20 | |
21 | #include <linux/kernel.h> | |
033a3fb9 KL |
22 | #include <linux/jiffies.h> |
23 | #include <linux/errno.h> | |
69de51fd | 24 | #include <linux/tty.h> |
033a3fb9 | 25 | #include <linux/tty_flip.h> |
69de51fd KL |
26 | #include <linux/module.h> |
27 | #include <linux/usb.h> | |
a969888c | 28 | #include <linux/usb/serial.h> |
228426ed | 29 | #include <linux/usb/ch9.h> |
69de51fd | 30 | |
228426ed KL |
31 | #define SWIMS_USB_REQUEST_SetPower 0x00 |
32 | #define SWIMS_USB_REQUEST_SetNmea 0x07 | |
112225b1 | 33 | #define SWIMS_USB_REQUEST_SetMode 0x0B |
112225b1 KL |
34 | #define SWIMS_SET_MODE_Modem 0x0001 |
35 | ||
36 | /* per port private data */ | |
37 | #define N_IN_URB 4 | |
38 | #define N_OUT_URB 4 | |
39 | #define IN_BUFLEN 4096 | |
40 | ||
41 | static int debug; | |
228426ed KL |
42 | static int nmea; |
43 | static int truinstall = 1; | |
112225b1 KL |
44 | |
45 | enum devicetype { | |
46 | DEVICE_3_PORT = 0, | |
47 | DEVICE_1_PORT = 1, | |
48 | DEVICE_INSTALLER = 2, | |
49 | }; | |
50 | ||
82a24e68 | 51 | static int sierra_set_power_state(struct usb_device *udev, __u16 swiState) |
112225b1 KL |
52 | { |
53 | int result; | |
898eb71c | 54 | dev_dbg(&udev->dev, "%s", "SET POWER STATE\n"); |
112225b1 | 55 | result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), |
228426ed | 56 | SWIMS_USB_REQUEST_SetPower, /* __u8 request */ |
f3564de4 | 57 | USB_TYPE_VENDOR, /* __u8 request type */ |
228426ed KL |
58 | swiState, /* __u16 value */ |
59 | 0, /* __u16 index */ | |
60 | NULL, /* void *data */ | |
61 | 0, /* __u16 size */ | |
62 | USB_CTRL_SET_TIMEOUT); /* int timeout */ | |
112225b1 KL |
63 | return result; |
64 | } | |
65 | ||
228426ed | 66 | static int sierra_set_ms_mode(struct usb_device *udev, __u16 eSWocMode) |
112225b1 KL |
67 | { |
68 | int result; | |
898eb71c | 69 | dev_dbg(&udev->dev, "%s", "DEVICE MODE SWITCH\n"); |
112225b1 KL |
70 | result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), |
71 | SWIMS_USB_REQUEST_SetMode, /* __u8 request */ | |
f3564de4 | 72 | USB_TYPE_VENDOR, /* __u8 request type */ |
228426ed KL |
73 | eSWocMode, /* __u16 value */ |
74 | 0x0000, /* __u16 index */ | |
112225b1 KL |
75 | NULL, /* void *data */ |
76 | 0, /* __u16 size */ | |
77 | USB_CTRL_SET_TIMEOUT); /* int timeout */ | |
78 | return result; | |
79 | } | |
80 | ||
228426ed | 81 | static int sierra_vsc_set_nmea(struct usb_device *udev, __u16 enable) |
112225b1 KL |
82 | { |
83 | int result; | |
228426ed KL |
84 | dev_dbg(&udev->dev, "%s", "NMEA Enable sent\n"); |
85 | result = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), | |
86 | SWIMS_USB_REQUEST_SetNmea, /* __u8 request */ | |
f3564de4 | 87 | USB_TYPE_VENDOR, /* __u8 request type */ |
228426ed KL |
88 | enable, /* __u16 value */ |
89 | 0x0000, /* __u16 index */ | |
90 | NULL, /* void *data */ | |
91 | 0, /* __u16 size */ | |
92 | USB_CTRL_SET_TIMEOUT); /* int timeout */ | |
93 | return result; | |
94 | } | |
95 | ||
96 | static int sierra_calc_num_ports(struct usb_serial *serial) | |
97 | { | |
98 | int result; | |
99 | int *num_ports = usb_get_serial_data(serial); | |
100 | ||
101 | result = *num_ports; | |
102 | ||
103 | if (result) { | |
104 | kfree(num_ports); | |
105 | usb_set_serial_data(serial, NULL); | |
106 | } | |
107 | ||
108 | return result; | |
109 | } | |
110 | ||
111 | static int sierra_probe(struct usb_serial *serial, | |
112 | const struct usb_device_id *id) | |
113 | { | |
114 | int result = 0; | |
112225b1 | 115 | struct usb_device *udev; |
228426ed KL |
116 | int *num_ports; |
117 | u8 ifnum; | |
112225b1 | 118 | |
228426ed KL |
119 | num_ports = kmalloc(sizeof(*num_ports), GFP_KERNEL); |
120 | if (!num_ports) | |
121 | return -ENOMEM; | |
122 | ||
123 | ifnum = serial->interface->cur_altsetting->desc.bInterfaceNumber; | |
124 | udev = serial->dev; | |
112225b1 KL |
125 | |
126 | /* Check if in installer mode */ | |
228426ed KL |
127 | if (truinstall && id->driver_info == DEVICE_INSTALLER) { |
128 | dev_dbg(&udev->dev, "%s", "FOUND TRU-INSTALL DEVICE(SW)\n"); | |
112225b1 | 129 | result = sierra_set_ms_mode(udev, SWIMS_SET_MODE_Modem); |
228426ed KL |
130 | /* Don't bind to the device when in installer mode */ |
131 | kfree(num_ports); | |
112225b1 | 132 | return -EIO; |
228426ed KL |
133 | } else if (id->driver_info == DEVICE_1_PORT) |
134 | *num_ports = 1; | |
135 | else if (ifnum == 0x99) | |
136 | *num_ports = 0; | |
137 | else | |
138 | *num_ports = 3; | |
139 | /* | |
140 | * save off our num_ports info so that we can use it in the | |
141 | * calc_num_ports callback | |
142 | */ | |
143 | usb_set_serial_data(serial, (void *)num_ports); | |
112225b1 | 144 | |
228426ed | 145 | return result; |
112225b1 | 146 | } |
033a3fb9 | 147 | |
69de51fd | 148 | static struct usb_device_id id_table [] = { |
e43062dd | 149 | { USB_DEVICE(0x1199, 0x0017) }, /* Sierra Wireless EM5625 */ |
69de51fd | 150 | { USB_DEVICE(0x1199, 0x0018) }, /* Sierra Wireless MC5720 */ |
e43062dd | 151 | { USB_DEVICE(0x1199, 0x0218) }, /* Sierra Wireless MC5720 */ |
9454c46a | 152 | { USB_DEVICE(0x0f30, 0x1b1d) }, /* Sierra Wireless MC5720 */ |
69de51fd | 153 | { USB_DEVICE(0x1199, 0x0020) }, /* Sierra Wireless MC5725 */ |
b9e13ac3 | 154 | { USB_DEVICE(0x1199, 0x0220) }, /* Sierra Wireless MC5725 */ |
69de51fd | 155 | { USB_DEVICE(0x1199, 0x0019) }, /* Sierra Wireless AirCard 595 */ |
e43062dd | 156 | { USB_DEVICE(0x1199, 0x0021) }, /* Sierra Wireless AirCard 597E */ |
9454c46a | 157 | { USB_DEVICE(0x1199, 0x0120) }, /* Sierra Wireless USB Dongle 595U */ |
69a90f81 | 158 | { USB_DEVICE_AND_INTERFACE_INFO(0x1199, 0x0023, 0xFF, 0xFF, 0xFF) }, /* Sierra Wireless C597 */ |
9454c46a | 159 | |
69de51fd | 160 | { USB_DEVICE(0x1199, 0x6802) }, /* Sierra Wireless MC8755 */ |
e43062dd | 161 | { USB_DEVICE(0x1199, 0x6804) }, /* Sierra Wireless MC8755 */ |
69de51fd | 162 | { USB_DEVICE(0x1199, 0x6803) }, /* Sierra Wireless MC8765 */ |
9454c46a | 163 | { USB_DEVICE(0x1199, 0x6812) }, /* Sierra Wireless MC8775 & AC 875U */ |
ed0ccdbb | 164 | { USB_DEVICE(0x1199, 0x6813) }, /* Sierra Wireless MC8775 (Thinkpad internal) */ |
7f170a63 | 165 | { USB_DEVICE(0x1199, 0x6815) }, /* Sierra Wireless MC8775 */ |
8f7f85e9 | 166 | { USB_DEVICE(0x03f0, 0x1e1d) }, /* HP hs2300 a.k.a MC8775 */ |
69de51fd | 167 | { USB_DEVICE(0x1199, 0x6820) }, /* Sierra Wireless AirCard 875 */ |
9454c46a KL |
168 | { USB_DEVICE(0x1199, 0x6832) }, /* Sierra Wireless MC8780*/ |
169 | { USB_DEVICE(0x1199, 0x6833) }, /* Sierra Wireless MC8781*/ | |
170 | { USB_DEVICE(0x1199, 0x6850) }, /* Sierra Wireless AirCard 880 */ | |
171 | { USB_DEVICE(0x1199, 0x6851) }, /* Sierra Wireless AirCard 881 */ | |
172 | { USB_DEVICE(0x1199, 0x6852) }, /* Sierra Wireless AirCard 880 E */ | |
173 | { USB_DEVICE(0x1199, 0x6853) }, /* Sierra Wireless AirCard 881 E */ | |
6835b32c | 174 | { USB_DEVICE(0x1199, 0x6855) }, /* Sierra Wireless AirCard 880 U */ |
62aad3ab | 175 | { USB_DEVICE(0x1199, 0x6856) }, /* Sierra Wireless AirCard 881 U */ |
033a3fb9 | 176 | |
6835b32c KL |
177 | { USB_DEVICE(0x1199, 0x6468) }, /* Sierra Wireless MP3G - EVDO */ |
178 | { USB_DEVICE(0x1199, 0x6469) }, /* Sierra Wireless MP3G - UMTS/HSPA */ | |
179 | ||
112225b1 KL |
180 | { USB_DEVICE(0x1199, 0x0112), .driver_info = DEVICE_1_PORT }, /* Sierra Wireless AirCard 580 */ |
181 | { USB_DEVICE(0x0F3D, 0x0112), .driver_info = DEVICE_1_PORT }, /* Airprime/Sierra PC 5220 */ | |
182 | ||
183 | { USB_DEVICE(0x1199, 0x0FFF), .driver_info = DEVICE_INSTALLER}, | |
033a3fb9 KL |
184 | { } |
185 | }; | |
964ee1de | 186 | MODULE_DEVICE_TABLE(usb, id_table); |
033a3fb9 | 187 | |
69de51fd | 188 | static struct usb_driver sierra_driver = { |
033a3fb9 | 189 | .name = "sierra", |
228426ed | 190 | .probe = usb_serial_probe, |
033a3fb9 KL |
191 | .disconnect = usb_serial_disconnect, |
192 | .id_table = id_table, | |
964ee1de | 193 | .no_dynamic_id = 1, |
033a3fb9 KL |
194 | }; |
195 | ||
033a3fb9 | 196 | struct sierra_port_private { |
17c23274 GKH |
197 | spinlock_t lock; /* lock the structure */ |
198 | int outstanding_urbs; /* number of out urbs in flight */ | |
199 | ||
4f4f9c53 | 200 | /* Input endpoints and buffers for this port */ |
033a3fb9 | 201 | struct urb *in_urbs[N_IN_URB]; |
4f4f9c53 | 202 | char *in_buffer[N_IN_URB]; |
033a3fb9 KL |
203 | |
204 | /* Settings for the port */ | |
205 | int rts_state; /* Handshaking pins (outputs) */ | |
206 | int dtr_state; | |
207 | int cts_state; /* Handshaking pins (inputs) */ | |
208 | int dsr_state; | |
209 | int dcd_state; | |
210 | int ri_state; | |
033a3fb9 KL |
211 | }; |
212 | ||
964ee1de | 213 | static int sierra_send_setup(struct usb_serial_port *port) |
69de51fd | 214 | { |
964ee1de GKH |
215 | struct usb_serial *serial = port->serial; |
216 | struct sierra_port_private *portdata; | |
228426ed | 217 | __u16 interface = 0; |
033a3fb9 | 218 | |
964ee1de | 219 | dbg("%s", __FUNCTION__); |
033a3fb9 | 220 | |
964ee1de | 221 | portdata = usb_get_serial_port_data(port); |
033a3fb9 | 222 | |
964ee1de GKH |
223 | if (port->tty) { |
224 | int val = 0; | |
225 | if (portdata->dtr_state) | |
226 | val |= 0x01; | |
227 | if (portdata->rts_state) | |
228 | val |= 0x02; | |
033a3fb9 | 229 | |
228426ed KL |
230 | /* Determine which port is targeted */ |
231 | if (port->bulk_out_endpointAddress == 2) | |
232 | interface = 0; | |
233 | else if (port->bulk_out_endpointAddress == 4) | |
234 | interface = 1; | |
235 | else if (port->bulk_out_endpointAddress == 5) | |
236 | interface = 2; | |
237 | ||
964ee1de GKH |
238 | return usb_control_msg(serial->dev, |
239 | usb_rcvctrlpipe(serial->dev, 0), | |
228426ed KL |
240 | 0x22, 0x21, val, interface, |
241 | NULL, 0, USB_CTRL_SET_TIMEOUT); | |
964ee1de | 242 | } |
69de51fd | 243 | |
964ee1de | 244 | return 0; |
69de51fd KL |
245 | } |
246 | ||
033a3fb9 KL |
247 | static void sierra_rx_throttle(struct usb_serial_port *port) |
248 | { | |
249 | dbg("%s", __FUNCTION__); | |
250 | } | |
251 | ||
252 | static void sierra_rx_unthrottle(struct usb_serial_port *port) | |
253 | { | |
254 | dbg("%s", __FUNCTION__); | |
255 | } | |
256 | ||
257 | static void sierra_break_ctl(struct usb_serial_port *port, int break_state) | |
258 | { | |
259 | /* Unfortunately, I don't know how to send a break */ | |
260 | dbg("%s", __FUNCTION__); | |
261 | } | |
262 | ||
263 | static void sierra_set_termios(struct usb_serial_port *port, | |
606d099c | 264 | struct ktermios *old_termios) |
033a3fb9 KL |
265 | { |
266 | dbg("%s", __FUNCTION__); | |
ed1f12ec | 267 | tty_termios_copy_hw(port->tty->termios, old_termios); |
033a3fb9 KL |
268 | sierra_send_setup(port); |
269 | } | |
270 | ||
271 | static int sierra_tiocmget(struct usb_serial_port *port, struct file *file) | |
272 | { | |
273 | unsigned int value; | |
274 | struct sierra_port_private *portdata; | |
275 | ||
276 | portdata = usb_get_serial_port_data(port); | |
277 | ||
278 | value = ((portdata->rts_state) ? TIOCM_RTS : 0) | | |
279 | ((portdata->dtr_state) ? TIOCM_DTR : 0) | | |
280 | ((portdata->cts_state) ? TIOCM_CTS : 0) | | |
281 | ((portdata->dsr_state) ? TIOCM_DSR : 0) | | |
282 | ((portdata->dcd_state) ? TIOCM_CAR : 0) | | |
283 | ((portdata->ri_state) ? TIOCM_RNG : 0); | |
284 | ||
285 | return value; | |
286 | } | |
287 | ||
288 | static int sierra_tiocmset(struct usb_serial_port *port, struct file *file, | |
289 | unsigned int set, unsigned int clear) | |
290 | { | |
291 | struct sierra_port_private *portdata; | |
292 | ||
293 | portdata = usb_get_serial_port_data(port); | |
294 | ||
295 | if (set & TIOCM_RTS) | |
296 | portdata->rts_state = 1; | |
297 | if (set & TIOCM_DTR) | |
298 | portdata->dtr_state = 1; | |
299 | ||
300 | if (clear & TIOCM_RTS) | |
301 | portdata->rts_state = 0; | |
302 | if (clear & TIOCM_DTR) | |
303 | portdata->dtr_state = 0; | |
304 | return sierra_send_setup(port); | |
305 | } | |
306 | ||
307 | static int sierra_ioctl(struct usb_serial_port *port, struct file *file, | |
308 | unsigned int cmd, unsigned long arg) | |
309 | { | |
310 | return -ENOIOCTLCMD; | |
311 | } | |
312 | ||
17c23274 GKH |
313 | static void sierra_outdat_callback(struct urb *urb) |
314 | { | |
315 | struct usb_serial_port *port = urb->context; | |
316 | struct sierra_port_private *portdata = usb_get_serial_port_data(port); | |
317 | int status = urb->status; | |
318 | unsigned long flags; | |
319 | ||
320 | dbg("%s - port %d", __FUNCTION__, port->number); | |
321 | ||
322 | /* free up the transfer buffer, as usb_free_urb() does not do this */ | |
323 | kfree(urb->transfer_buffer); | |
324 | ||
325 | if (status) | |
326 | dbg("%s - nonzero write bulk status received: %d", | |
327 | __FUNCTION__, status); | |
328 | ||
329 | spin_lock_irqsave(&portdata->lock, flags); | |
330 | --portdata->outstanding_urbs; | |
331 | spin_unlock_irqrestore(&portdata->lock, flags); | |
332 | ||
333 | usb_serial_port_softint(port); | |
334 | } | |
335 | ||
033a3fb9 KL |
336 | /* Write */ |
337 | static int sierra_write(struct usb_serial_port *port, | |
338 | const unsigned char *buf, int count) | |
339 | { | |
17c23274 GKH |
340 | struct sierra_port_private *portdata = usb_get_serial_port_data(port); |
341 | struct usb_serial *serial = port->serial; | |
342 | unsigned long flags; | |
343 | unsigned char *buffer; | |
344 | struct urb *urb; | |
345 | int status; | |
033a3fb9 KL |
346 | |
347 | portdata = usb_get_serial_port_data(port); | |
348 | ||
349 | dbg("%s: write (%d chars)", __FUNCTION__, count); | |
350 | ||
17c23274 GKH |
351 | spin_lock_irqsave(&portdata->lock, flags); |
352 | if (portdata->outstanding_urbs > N_OUT_URB) { | |
353 | spin_unlock_irqrestore(&portdata->lock, flags); | |
354 | dbg("%s - write limit hit\n", __FUNCTION__); | |
355 | return 0; | |
356 | } | |
357 | portdata->outstanding_urbs++; | |
358 | spin_unlock_irqrestore(&portdata->lock, flags); | |
359 | ||
360 | buffer = kmalloc(count, GFP_ATOMIC); | |
361 | if (!buffer) { | |
362 | dev_err(&port->dev, "out of memory\n"); | |
363 | count = -ENOMEM; | |
364 | goto error_no_buffer; | |
365 | } | |
033a3fb9 | 366 | |
17c23274 GKH |
367 | urb = usb_alloc_urb(0, GFP_ATOMIC); |
368 | if (!urb) { | |
369 | dev_err(&port->dev, "no more free urbs\n"); | |
370 | count = -ENOMEM; | |
371 | goto error_no_urb; | |
372 | } | |
033a3fb9 | 373 | |
17c23274 | 374 | memcpy(buffer, buf, count); |
033a3fb9 | 375 | |
17c23274 GKH |
376 | usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, buffer); |
377 | ||
378 | usb_fill_bulk_urb(urb, serial->dev, | |
379 | usb_sndbulkpipe(serial->dev, | |
380 | port->bulk_out_endpointAddress), | |
381 | buffer, count, sierra_outdat_callback, port); | |
382 | ||
383 | /* send it down the pipe */ | |
384 | status = usb_submit_urb(urb, GFP_ATOMIC); | |
385 | if (status) { | |
386 | dev_err(&port->dev, "%s - usb_submit_urb(write bulk) failed " | |
387 | "with status = %d\n", __FUNCTION__, status); | |
388 | count = status; | |
389 | goto error; | |
033a3fb9 KL |
390 | } |
391 | ||
17c23274 GKH |
392 | /* we are done with this urb, so let the host driver |
393 | * really free it when it is finished with it */ | |
394 | usb_free_urb(urb); | |
395 | ||
396 | return count; | |
397 | error: | |
398 | usb_free_urb(urb); | |
399 | error_no_urb: | |
400 | kfree(buffer); | |
401 | error_no_buffer: | |
402 | spin_lock_irqsave(&portdata->lock, flags); | |
403 | --portdata->outstanding_urbs; | |
404 | spin_unlock_irqrestore(&portdata->lock, flags); | |
033a3fb9 KL |
405 | return count; |
406 | } | |
407 | ||
408 | static void sierra_indat_callback(struct urb *urb) | |
409 | { | |
410 | int err; | |
411 | int endpoint; | |
412 | struct usb_serial_port *port; | |
413 | struct tty_struct *tty; | |
414 | unsigned char *data = urb->transfer_buffer; | |
17dd2215 | 415 | int status = urb->status; |
033a3fb9 KL |
416 | |
417 | dbg("%s: %p", __FUNCTION__, urb); | |
418 | ||
419 | endpoint = usb_pipeendpoint(urb->pipe); | |
420 | port = (struct usb_serial_port *) urb->context; | |
421 | ||
17dd2215 | 422 | if (status) { |
033a3fb9 | 423 | dbg("%s: nonzero status: %d on endpoint %02x.", |
17dd2215 | 424 | __FUNCTION__, status, endpoint); |
033a3fb9 KL |
425 | } else { |
426 | tty = port->tty; | |
427 | if (urb->actual_length) { | |
428 | tty_buffer_request_room(tty, urb->actual_length); | |
429 | tty_insert_flip_string(tty, data, urb->actual_length); | |
430 | tty_flip_buffer_push(tty); | |
431 | } else { | |
432 | dbg("%s: empty read urb received", __FUNCTION__); | |
433 | } | |
434 | ||
435 | /* Resubmit urb so we continue receiving */ | |
17dd2215 | 436 | if (port->open_count && status != -ESHUTDOWN) { |
033a3fb9 KL |
437 | err = usb_submit_urb(urb, GFP_ATOMIC); |
438 | if (err) | |
17c23274 | 439 | dev_err(&port->dev, "resubmit read urb failed." |
898eb71c | 440 | "(%d)\n", err); |
033a3fb9 KL |
441 | } |
442 | } | |
443 | return; | |
444 | } | |
445 | ||
033a3fb9 KL |
446 | static void sierra_instat_callback(struct urb *urb) |
447 | { | |
448 | int err; | |
17dd2215 | 449 | int status = urb->status; |
033a3fb9 KL |
450 | struct usb_serial_port *port = (struct usb_serial_port *) urb->context; |
451 | struct sierra_port_private *portdata = usb_get_serial_port_data(port); | |
452 | struct usb_serial *serial = port->serial; | |
453 | ||
454 | dbg("%s", __FUNCTION__); | |
f3564de4 | 455 | dbg("%s: urb %p port %p has data %p", __FUNCTION__, urb, port, portdata); |
033a3fb9 | 456 | |
17dd2215 | 457 | if (status == 0) { |
033a3fb9 KL |
458 | struct usb_ctrlrequest *req_pkt = |
459 | (struct usb_ctrlrequest *)urb->transfer_buffer; | |
460 | ||
461 | if (!req_pkt) { | |
462 | dbg("%s: NULL req_pkt\n", __FUNCTION__); | |
463 | return; | |
464 | } | |
465 | if ((req_pkt->bRequestType == 0xA1) && | |
466 | (req_pkt->bRequest == 0x20)) { | |
467 | int old_dcd_state; | |
468 | unsigned char signals = *((unsigned char *) | |
469 | urb->transfer_buffer + | |
470 | sizeof(struct usb_ctrlrequest)); | |
471 | ||
472 | dbg("%s: signal x%x", __FUNCTION__, signals); | |
473 | ||
474 | old_dcd_state = portdata->dcd_state; | |
475 | portdata->cts_state = 1; | |
476 | portdata->dcd_state = ((signals & 0x01) ? 1 : 0); | |
477 | portdata->dsr_state = ((signals & 0x02) ? 1 : 0); | |
478 | portdata->ri_state = ((signals & 0x08) ? 1 : 0); | |
479 | ||
480 | if (port->tty && !C_CLOCAL(port->tty) && | |
481 | old_dcd_state && !portdata->dcd_state) | |
482 | tty_hangup(port->tty); | |
483 | } else { | |
484 | dbg("%s: type %x req %x", __FUNCTION__, | |
f3564de4 | 485 | req_pkt->bRequestType, req_pkt->bRequest); |
033a3fb9 KL |
486 | } |
487 | } else | |
17dd2215 | 488 | dbg("%s: error %d", __FUNCTION__, status); |
033a3fb9 KL |
489 | |
490 | /* Resubmit urb so we continue receiving IRQ data */ | |
17dd2215 | 491 | if (status != -ESHUTDOWN) { |
033a3fb9 KL |
492 | urb->dev = serial->dev; |
493 | err = usb_submit_urb(urb, GFP_ATOMIC); | |
494 | if (err) | |
495 | dbg("%s: resubmit intr urb failed. (%d)", | |
496 | __FUNCTION__, err); | |
497 | } | |
498 | } | |
499 | ||
500 | static int sierra_write_room(struct usb_serial_port *port) | |
501 | { | |
17c23274 GKH |
502 | struct sierra_port_private *portdata = usb_get_serial_port_data(port); |
503 | unsigned long flags; | |
033a3fb9 | 504 | |
17c23274 | 505 | dbg("%s - port %d", __FUNCTION__, port->number); |
033a3fb9 | 506 | |
17c23274 GKH |
507 | /* try to give a good number back based on if we have any free urbs at |
508 | * this point in time */ | |
509 | spin_lock_irqsave(&portdata->lock, flags); | |
510 | if (portdata->outstanding_urbs > N_OUT_URB * 2 / 3) { | |
511 | spin_unlock_irqrestore(&portdata->lock, flags); | |
512 | dbg("%s - write limit hit\n", __FUNCTION__); | |
513 | return 0; | |
033a3fb9 | 514 | } |
17c23274 | 515 | spin_unlock_irqrestore(&portdata->lock, flags); |
033a3fb9 | 516 | |
17c23274 | 517 | return 2048; |
033a3fb9 KL |
518 | } |
519 | ||
520 | static int sierra_chars_in_buffer(struct usb_serial_port *port) | |
521 | { | |
17c23274 GKH |
522 | dbg("%s - port %d", __FUNCTION__, port->number); |
523 | ||
524 | /* | |
525 | * We can't really account for how much data we | |
526 | * have sent out, but hasn't made it through to the | |
527 | * device as we can't see the backend here, so just | |
528 | * tell the tty layer that everything is flushed. | |
529 | */ | |
530 | return 0; | |
033a3fb9 KL |
531 | } |
532 | ||
533 | static int sierra_open(struct usb_serial_port *port, struct file *filp) | |
534 | { | |
535 | struct sierra_port_private *portdata; | |
536 | struct usb_serial *serial = port->serial; | |
9e85c5f6 | 537 | int i; |
033a3fb9 | 538 | struct urb *urb; |
e43062dd | 539 | int result; |
033a3fb9 KL |
540 | |
541 | portdata = usb_get_serial_port_data(port); | |
542 | ||
543 | dbg("%s", __FUNCTION__); | |
544 | ||
545 | /* Set some sane defaults */ | |
546 | portdata->rts_state = 1; | |
547 | portdata->dtr_state = 1; | |
548 | ||
549 | /* Reset low level data toggle and start reading from endpoints */ | |
550 | for (i = 0; i < N_IN_URB; i++) { | |
551 | urb = portdata->in_urbs[i]; | |
9e85c5f6 | 552 | if (!urb) |
033a3fb9 KL |
553 | continue; |
554 | if (urb->dev != serial->dev) { | |
555 | dbg("%s: dev %p != %p", __FUNCTION__, | |
556 | urb->dev, serial->dev); | |
557 | continue; | |
558 | } | |
559 | ||
560 | /* | |
561 | * make sure endpoint data toggle is synchronized with the | |
562 | * device | |
563 | */ | |
564 | usb_clear_halt(urb->dev, urb->pipe); | |
565 | ||
9e85c5f6 GKH |
566 | result = usb_submit_urb(urb, GFP_KERNEL); |
567 | if (result) { | |
898eb71c | 568 | dev_err(&port->dev, "submit urb %d failed (%d) %d\n", |
9e85c5f6 | 569 | i, result, urb->transfer_buffer_length); |
033a3fb9 KL |
570 | } |
571 | } | |
572 | ||
033a3fb9 KL |
573 | port->tty->low_latency = 1; |
574 | ||
575 | sierra_send_setup(port); | |
576 | ||
9e85c5f6 GKH |
577 | /* start up the interrupt endpoint if we have one */ |
578 | if (port->interrupt_in_urb) { | |
579 | result = usb_submit_urb(port->interrupt_in_urb, GFP_KERNEL); | |
580 | if (result) | |
898eb71c | 581 | dev_err(&port->dev, "submit irq_in urb failed %d\n", |
9e85c5f6 GKH |
582 | result); |
583 | } | |
584 | return 0; | |
033a3fb9 KL |
585 | } |
586 | ||
033a3fb9 KL |
587 | static void sierra_close(struct usb_serial_port *port, struct file *filp) |
588 | { | |
589 | int i; | |
590 | struct usb_serial *serial = port->serial; | |
591 | struct sierra_port_private *portdata; | |
592 | ||
593 | dbg("%s", __FUNCTION__); | |
594 | portdata = usb_get_serial_port_data(port); | |
595 | ||
596 | portdata->rts_state = 0; | |
597 | portdata->dtr_state = 0; | |
598 | ||
599 | if (serial->dev) { | |
e33fe4d8 ON |
600 | mutex_lock(&serial->disc_mutex); |
601 | if (!serial->disconnected) | |
602 | sierra_send_setup(port); | |
603 | mutex_unlock(&serial->disc_mutex); | |
033a3fb9 KL |
604 | |
605 | /* Stop reading/writing urbs */ | |
606 | for (i = 0; i < N_IN_URB; i++) | |
9e85c5f6 | 607 | usb_kill_urb(portdata->in_urbs[i]); |
033a3fb9 KL |
608 | } |
609 | ||
9e85c5f6 | 610 | usb_kill_urb(port->interrupt_in_urb); |
033a3fb9 | 611 | |
9e85c5f6 | 612 | port->tty = NULL; |
033a3fb9 KL |
613 | } |
614 | ||
033a3fb9 KL |
615 | static int sierra_startup(struct usb_serial *serial) |
616 | { | |
033a3fb9 KL |
617 | struct usb_serial_port *port; |
618 | struct sierra_port_private *portdata; | |
9e85c5f6 GKH |
619 | struct urb *urb; |
620 | int i; | |
621 | int j; | |
033a3fb9 KL |
622 | |
623 | dbg("%s", __FUNCTION__); | |
624 | ||
228426ed | 625 | /* Set Device mode to D0 */ |
112225b1 KL |
626 | sierra_set_power_state(serial->dev, 0x0000); |
627 | ||
228426ed KL |
628 | /* Check NMEA and set */ |
629 | if (nmea) | |
630 | sierra_vsc_set_nmea(serial->dev, 1); | |
631 | ||
033a3fb9 KL |
632 | /* Now setup per port private data */ |
633 | for (i = 0; i < serial->num_ports; i++) { | |
634 | port = serial->port[i]; | |
635 | portdata = kzalloc(sizeof(*portdata), GFP_KERNEL); | |
636 | if (!portdata) { | |
637 | dbg("%s: kmalloc for sierra_port_private (%d) failed!.", | |
638 | __FUNCTION__, i); | |
17c23274 | 639 | return -ENOMEM; |
033a3fb9 | 640 | } |
17c23274 | 641 | spin_lock_init(&portdata->lock); |
4f4f9c53 ON |
642 | for (j = 0; j < N_IN_URB; j++) { |
643 | portdata->in_buffer[j] = kmalloc(IN_BUFLEN, GFP_KERNEL); | |
644 | if (!portdata->in_buffer[j]) { | |
645 | for (--j; j >= 0; j--) | |
646 | kfree(portdata->in_buffer[j]); | |
647 | kfree(portdata); | |
648 | return -ENOMEM; | |
649 | } | |
650 | } | |
033a3fb9 KL |
651 | |
652 | usb_set_serial_port_data(port, portdata); | |
653 | ||
9e85c5f6 GKH |
654 | /* initialize the in urbs */ |
655 | for (j = 0; j < N_IN_URB; ++j) { | |
656 | urb = usb_alloc_urb(0, GFP_KERNEL); | |
657 | if (urb == NULL) { | |
658 | dbg("%s: alloc for in port failed.", | |
659 | __FUNCTION__); | |
660 | continue; | |
661 | } | |
662 | /* Fill URB using supplied data. */ | |
663 | usb_fill_bulk_urb(urb, serial->dev, | |
664 | usb_rcvbulkpipe(serial->dev, | |
665 | port->bulk_in_endpointAddress), | |
666 | portdata->in_buffer[j], IN_BUFLEN, | |
667 | sierra_indat_callback, port); | |
668 | portdata->in_urbs[j] = urb; | |
669 | } | |
033a3fb9 KL |
670 | } |
671 | ||
17c23274 | 672 | return 0; |
033a3fb9 KL |
673 | } |
674 | ||
675 | static void sierra_shutdown(struct usb_serial *serial) | |
676 | { | |
677 | int i, j; | |
678 | struct usb_serial_port *port; | |
679 | struct sierra_port_private *portdata; | |
680 | ||
681 | dbg("%s", __FUNCTION__); | |
682 | ||
033a3fb9 KL |
683 | for (i = 0; i < serial->num_ports; ++i) { |
684 | port = serial->port[i]; | |
f094e4f3 GKH |
685 | if (!port) |
686 | continue; | |
033a3fb9 | 687 | portdata = usb_get_serial_port_data(port); |
f094e4f3 GKH |
688 | if (!portdata) |
689 | continue; | |
033a3fb9 KL |
690 | |
691 | for (j = 0; j < N_IN_URB; j++) { | |
9e85c5f6 GKH |
692 | usb_kill_urb(portdata->in_urbs[j]); |
693 | usb_free_urb(portdata->in_urbs[j]); | |
4f4f9c53 | 694 | kfree(portdata->in_buffer[j]); |
033a3fb9 | 695 | } |
9e85c5f6 GKH |
696 | kfree(portdata); |
697 | usb_set_serial_port_data(port, NULL); | |
033a3fb9 KL |
698 | } |
699 | } | |
700 | ||
228426ed | 701 | static struct usb_serial_driver sierra_device = { |
964ee1de GKH |
702 | .driver = { |
703 | .owner = THIS_MODULE, | |
704 | .name = "sierra1", | |
705 | }, | |
228426ed KL |
706 | .description = "Sierra USB modem", |
707 | .id_table = id_table, | |
d9b1b787 | 708 | .usb_driver = &sierra_driver, |
964ee1de | 709 | .num_interrupt_in = NUM_DONT_CARE, |
228426ed KL |
710 | .num_bulk_in = NUM_DONT_CARE, |
711 | .num_bulk_out = NUM_DONT_CARE, | |
712 | .calc_num_ports = sierra_calc_num_ports, | |
713 | .probe = sierra_probe, | |
964ee1de GKH |
714 | .open = sierra_open, |
715 | .close = sierra_close, | |
716 | .write = sierra_write, | |
717 | .write_room = sierra_write_room, | |
718 | .chars_in_buffer = sierra_chars_in_buffer, | |
719 | .throttle = sierra_rx_throttle, | |
720 | .unthrottle = sierra_rx_unthrottle, | |
721 | .ioctl = sierra_ioctl, | |
722 | .set_termios = sierra_set_termios, | |
723 | .break_ctl = sierra_break_ctl, | |
724 | .tiocmget = sierra_tiocmget, | |
725 | .tiocmset = sierra_tiocmset, | |
726 | .attach = sierra_startup, | |
727 | .shutdown = sierra_shutdown, | |
728 | .read_int_callback = sierra_instat_callback, | |
729 | }; | |
730 | ||
731 | /* Functions used by new usb-serial code. */ | |
732 | static int __init sierra_init(void) | |
733 | { | |
734 | int retval; | |
228426ed | 735 | retval = usb_serial_register(&sierra_device); |
964ee1de | 736 | if (retval) |
228426ed | 737 | goto failed_device_register; |
964ee1de GKH |
738 | |
739 | ||
740 | retval = usb_register(&sierra_driver); | |
741 | if (retval) | |
742 | goto failed_driver_register; | |
743 | ||
744 | info(DRIVER_DESC ": " DRIVER_VERSION); | |
745 | ||
746 | return 0; | |
747 | ||
748 | failed_driver_register: | |
228426ed KL |
749 | usb_serial_deregister(&sierra_device); |
750 | failed_device_register: | |
964ee1de GKH |
751 | return retval; |
752 | } | |
753 | ||
754 | static void __exit sierra_exit(void) | |
755 | { | |
756 | usb_deregister (&sierra_driver); | |
228426ed | 757 | usb_serial_deregister(&sierra_device); |
964ee1de GKH |
758 | } |
759 | ||
760 | module_init(sierra_init); | |
761 | module_exit(sierra_exit); | |
762 | ||
033a3fb9 KL |
763 | MODULE_AUTHOR(DRIVER_AUTHOR); |
764 | MODULE_DESCRIPTION(DRIVER_DESC); | |
765 | MODULE_VERSION(DRIVER_VERSION); | |
69de51fd | 766 | MODULE_LICENSE("GPL"); |
033a3fb9 | 767 | |
228426ed KL |
768 | module_param(truinstall, bool, 0); |
769 | MODULE_PARM_DESC(truinstall, "TRU-Install support"); | |
770 | ||
771 | module_param(nmea, bool, 0); | |
772 | MODULE_PARM_DESC(nmea, "NMEA streaming"); | |
773 | ||
033a3fb9 KL |
774 | #ifdef CONFIG_USB_DEBUG |
775 | module_param(debug, bool, S_IRUGO | S_IWUSR); | |
776 | MODULE_PARM_DESC(debug, "Debug messages"); | |
777 | #endif | |
778 |