u3g.c revision 1.16.2.1 1 1.16.2.1 jruoho /* $NetBSD: u3g.c,v 1.16.2.1 2011/06/06 09:08:42 jruoho Exp $ */
2 1.9 martin
3 1.9 martin /*-
4 1.9 martin * Copyright (c) 2009 The NetBSD Foundation, Inc.
5 1.9 martin * All rights reserved.
6 1.9 martin *
7 1.9 martin * This code is derived from software contributed to The NetBSD Foundation.
8 1.9 martin *
9 1.9 martin * Redistribution and use in source and binary forms, with or without
10 1.9 martin * modification, are permitted provided that the following conditions
11 1.9 martin * are met:
12 1.9 martin * 1. Redistributions of source code must retain the above copyright
13 1.9 martin * notice, this list of conditions and the following disclaimer.
14 1.9 martin * 2. Redistributions in binary form must reproduce the above copyright
15 1.9 martin * notice, this list of conditions and the following disclaimer in the
16 1.9 martin * documentation and/or other materials provided with the distribution.
17 1.9 martin *
18 1.9 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
19 1.9 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20 1.9 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21 1.9 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
22 1.9 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23 1.9 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24 1.9 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25 1.9 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26 1.9 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27 1.9 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28 1.9 martin * POSSIBILITY OF SUCH DAMAGE.
29 1.9 martin */
30 1.7 plunky
31 1.1 joerg /*
32 1.1 joerg * Copyright (c) 2008 AnyWi Technologies
33 1.1 joerg * Author: Andrea Guzzo <aguzzo (at) anywi.com>
34 1.1 joerg * * based on uark.c 1.1 2006/08/14 08:30:22 jsg *
35 1.1 joerg * * parts from ubsa.c 183348 2008-09-25 12:00:56Z phk *
36 1.1 joerg *
37 1.1 joerg * Permission to use, copy, modify, and distribute this software for any
38 1.1 joerg * purpose with or without fee is hereby granted, provided that the above
39 1.1 joerg * copyright notice and this permission notice appear in all copies.
40 1.1 joerg *
41 1.1 joerg * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
42 1.1 joerg * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
43 1.1 joerg * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
44 1.1 joerg * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
45 1.1 joerg * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
46 1.1 joerg * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
47 1.1 joerg * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
48 1.1 joerg *
49 1.1 joerg * $FreeBSD$
50 1.1 joerg */
51 1.1 joerg
52 1.7 plunky #include <sys/cdefs.h>
53 1.16.2.1 jruoho __KERNEL_RCSID(0, "$NetBSD: u3g.c,v 1.16.2.1 2011/06/06 09:08:42 jruoho Exp $");
54 1.7 plunky
55 1.1 joerg #include <sys/param.h>
56 1.1 joerg #include <sys/systm.h>
57 1.1 joerg #include <sys/kernel.h>
58 1.1 joerg #include <sys/malloc.h>
59 1.1 joerg #include <sys/bus.h>
60 1.1 joerg #include <sys/conf.h>
61 1.1 joerg #include <sys/tty.h>
62 1.1 joerg
63 1.1 joerg #include <dev/usb/usb.h>
64 1.1 joerg #include <dev/usb/usbdi.h>
65 1.1 joerg #include <dev/usb/usbdivar.h>
66 1.1 joerg #include <dev/usb/usbdi_util.h>
67 1.1 joerg
68 1.1 joerg #include <dev/usb/ucomvar.h>
69 1.1 joerg
70 1.1 joerg #include "usbdevs.h"
71 1.1 joerg
72 1.9 martin /*
73 1.9 martin * We read/write data from/to the device in 4KB chunks to maximise
74 1.9 martin * performance.
75 1.9 martin */
76 1.9 martin #define U3G_BUFF_SIZE 4096
77 1.9 martin
78 1.9 martin /*
79 1.9 martin * Some 3G devices (the Huawei E160/E220 springs to mind here) buffer up
80 1.9 martin * data internally even when the USB pipes are closed. So on first open,
81 1.9 martin * we can receive a large chunk of stale data.
82 1.9 martin *
83 1.9 martin * This causes a real problem because the default TTYDEF_LFLAG (applied
84 1.9 martin * on first open) has the ECHO flag set, resulting in all the stale data
85 1.9 martin * being echoed straight back to the device by the tty(4) layer. Some
86 1.9 martin * devices (again, the Huawei E160/E220 for example) react to this spew
87 1.9 martin * by going catatonic.
88 1.9 martin *
89 1.9 martin * All this happens before the application gets a chance to disable ECHO.
90 1.9 martin *
91 1.9 martin * We work around this by ignoring all data received from the device for
92 1.9 martin * a period of two seconds, or until the application starts sending data -
93 1.9 martin * whichever comes first.
94 1.9 martin */
95 1.9 martin #define U3G_PURGE_SECS 2
96 1.9 martin
97 1.9 martin /*
98 1.9 martin * Define bits for the virtual modem control pins.
99 1.9 martin * The input pin states are reported via the interrupt pipe on some devices.
100 1.9 martin */
101 1.9 martin #define U3G_OUTPIN_DTR (1u << 0)
102 1.9 martin #define U3G_OUTPIN_RTS (1u << 1)
103 1.9 martin #define U3G_INPIN_DCD (1u << 0)
104 1.9 martin #define U3G_INPIN_DSR (1u << 1)
105 1.9 martin #define U3G_INPIN_RI (1u << 3)
106 1.9 martin
107 1.9 martin /*
108 1.9 martin * USB request to set the output pin status
109 1.9 martin */
110 1.9 martin #define U3G_SET_PIN 0x22
111 1.1 joerg
112 1.1 joerg struct u3g_softc {
113 1.9 martin device_t sc_dev;
114 1.9 martin usbd_device_handle sc_udev;
115 1.9 martin bool sc_dying; /* We're going away */
116 1.9 martin
117 1.9 martin device_t sc_ucom; /* Child ucom(4) handle */
118 1.9 martin int sc_ifaceno; /* Device interface number */
119 1.9 martin
120 1.9 martin bool sc_open; /* Device is in use */
121 1.9 martin bool sc_purging; /* Purging stale data */
122 1.9 martin struct timeval sc_purge_start; /* Control duration of purge */
123 1.9 martin
124 1.9 martin u_char sc_msr; /* Emulated 'msr' */
125 1.9 martin uint16_t sc_outpins; /* Output pin state */
126 1.9 martin
127 1.9 martin usbd_pipe_handle sc_intr_pipe; /* Interrupt pipe */
128 1.9 martin u_char *sc_intr_buff; /* Interrupt buffer */
129 1.1 joerg };
130 1.1 joerg
131 1.9 martin /*
132 1.9 martin * The device driver has two personalities. The first uses the 'usbdevif'
133 1.9 martin * interface attribute so that a match will claim the entire USB device
134 1.9 martin * for itself. This is used for when a device needs to be mode-switched
135 1.9 martin * and ensures any other interfaces present cannot be claimed by other
136 1.9 martin * drivers while the mode-switch is in progress.
137 1.9 martin *
138 1.9 martin * The second personality uses the 'usbifif' interface attribute so that
139 1.9 martin * it can claim the 3G modem interfaces for itself, leaving others (such
140 1.9 martin * as the mass storage interfaces on some devices) for other drivers.
141 1.9 martin */
142 1.9 martin static int u3ginit_match(device_t, cfdata_t, void *);
143 1.9 martin static void u3ginit_attach(device_t, device_t, void *);
144 1.9 martin static int u3ginit_detach(device_t, int);
145 1.9 martin
146 1.9 martin CFATTACH_DECL2_NEW(u3ginit, 0, u3ginit_match,
147 1.9 martin u3ginit_attach, u3ginit_detach, NULL, NULL, NULL);
148 1.9 martin
149 1.9 martin
150 1.9 martin static int u3g_match(device_t, cfdata_t, void *);
151 1.9 martin static void u3g_attach(device_t, device_t, void *);
152 1.9 martin static int u3g_detach(device_t, int);
153 1.9 martin static int u3g_activate(device_t, enum devact);
154 1.9 martin static void u3g_childdet(device_t, device_t);
155 1.9 martin
156 1.9 martin CFATTACH_DECL2_NEW(u3g, sizeof(struct u3g_softc), u3g_match,
157 1.9 martin u3g_attach, u3g_detach, u3g_activate, NULL, u3g_childdet);
158 1.9 martin
159 1.9 martin
160 1.9 martin static void u3g_intr(usbd_xfer_handle, usbd_private_handle, usbd_status);
161 1.9 martin static void u3g_get_status(void *, int, u_char *, u_char *);
162 1.9 martin static void u3g_set(void *, int, int, int);
163 1.9 martin static int u3g_open(void *, int);
164 1.9 martin static void u3g_close(void *, int);
165 1.9 martin static void u3g_read(void *, int, u_char **, uint32_t *);
166 1.9 martin static void u3g_write(void *, int, u_char *, u_char *, u_int32_t *);
167 1.9 martin
168 1.1 joerg struct ucom_methods u3g_methods = {
169 1.9 martin u3g_get_status,
170 1.9 martin u3g_set,
171 1.1 joerg NULL,
172 1.1 joerg NULL,
173 1.9 martin u3g_open,
174 1.9 martin u3g_close,
175 1.9 martin u3g_read,
176 1.9 martin u3g_write,
177 1.1 joerg };
178 1.1 joerg
179 1.9 martin /*
180 1.9 martin * Allegedly supported devices
181 1.9 martin */
182 1.1 joerg static const struct usb_devno u3g_devs[] = {
183 1.13 riz { USB_VENDOR_DELL, USB_PRODUCT_DELL_W5500 },
184 1.1 joerg /* OEM: Huawei */
185 1.1 joerg { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E220 },
186 1.11 pooka { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_K3765 },
187 1.13 riz { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_MOBILE },
188 1.13 riz /* OEM: Merlin */
189 1.13 riz { USB_VENDOR_MERLIN, USB_PRODUCT_MERLIN_V620 },
190 1.1 joerg /* OEM: Novatel */
191 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_ES620 },
192 1.1 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D },
193 1.13 riz #if 0
194 1.14 riz /* These are matched in u3ginit_match() */
195 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D_DRIVER },
196 1.14 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760_DRIVER },
197 1.13 riz #endif
198 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINU740 },
199 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINV620 },
200 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_S720 },
201 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U720 },
202 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U727 },
203 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U740_2 },
204 1.14 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760 },
205 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U870 },
206 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_V740 },
207 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_X950D },
208 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_XU870 },
209 1.13 riz /* OEM: Option N.V. */
210 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_QUADPLUSUMTS },
211 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_HSDPA },
212 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_GTMAXHSUPA },
213 1.13 riz /* OEM: Qualcomm, Inc. */
214 1.13 riz { USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_CDMA_MSM },
215 1.13 riz { USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_ZTE_MF626 },
216 1.1 joerg
217 1.3 joerg /* OEM: Sierra Wireless: */
218 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC595U },
219 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC597E },
220 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC875U },
221 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880 },
222 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880E },
223 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880U },
224 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881 },
225 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881E },
226 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881U },
227 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD580 },
228 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD595 },
229 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD875 },
230 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_C597 },
231 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_EM5625 },
232 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720 },
233 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720_2 },
234 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5725 },
235 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755 },
236 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_2 },
237 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_3 },
238 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8765 },
239 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8775_2 },
240 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8780 },
241 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8781 },
242 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MINI5725 },
243 1.12 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_USB305 },
244 1.16.2.1 jruoho
245 1.16.2.1 jruoho /* Toshiba */
246 1.16.2.1 jruoho { USB_VENDOR_TOSHIBA, USB_PRODUCT_TOSHIBA_HSDPA_MODEM_EU870DT1 },
247 1.1 joerg };
248 1.1 joerg
249 1.1 joerg static int
250 1.11 pooka send_bulkmsg(usbd_device_handle dev, char *cmd, size_t cmdlen)
251 1.2 joerg {
252 1.2 joerg usbd_interface_handle iface;
253 1.2 joerg usb_interface_descriptor_t *id;
254 1.2 joerg usb_endpoint_descriptor_t *ed;
255 1.2 joerg usbd_pipe_handle pipe;
256 1.2 joerg usbd_xfer_handle xfer;
257 1.2 joerg int err, i;
258 1.2 joerg
259 1.2 joerg /* Move the device into the configured state. */
260 1.9 martin err = usbd_set_config_index(dev, 0, 0);
261 1.2 joerg if (err) {
262 1.2 joerg aprint_error("u3g: failed to set configuration index\n");
263 1.2 joerg return UMATCH_NONE;
264 1.2 joerg }
265 1.2 joerg
266 1.9 martin err = usbd_device2interface_handle(dev, 0, &iface);
267 1.2 joerg if (err != 0) {
268 1.11 pooka aprint_error("u3ginit: failed to get interface\n");
269 1.2 joerg return UMATCH_NONE;
270 1.2 joerg }
271 1.2 joerg
272 1.2 joerg id = usbd_get_interface_descriptor(iface);
273 1.2 joerg ed = NULL;
274 1.2 joerg for (i = 0 ; i < id->bNumEndpoints ; i++) {
275 1.2 joerg ed = usbd_interface2endpoint_descriptor(iface, i);
276 1.2 joerg if (ed == NULL)
277 1.2 joerg continue;
278 1.2 joerg if (UE_GET_DIR(ed->bEndpointAddress) != UE_DIR_OUT)
279 1.2 joerg continue;
280 1.2 joerg if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK)
281 1.2 joerg break;
282 1.2 joerg }
283 1.2 joerg
284 1.2 joerg if (i == id->bNumEndpoints)
285 1.2 joerg return UMATCH_NONE;
286 1.2 joerg
287 1.11 pooka err = usbd_open_pipe(iface, ed->bEndpointAddress,
288 1.11 pooka USBD_EXCLUSIVE_USE, &pipe);
289 1.2 joerg if (err != 0) {
290 1.11 pooka aprint_error("u3ginit: failed to open bulk transfer pipe %d\n",
291 1.2 joerg ed->bEndpointAddress);
292 1.2 joerg return UMATCH_NONE;
293 1.2 joerg }
294 1.2 joerg
295 1.9 martin xfer = usbd_alloc_xfer(dev);
296 1.2 joerg if (xfer != NULL) {
297 1.11 pooka usbd_setup_xfer(xfer, pipe, NULL, cmd, cmdlen,
298 1.2 joerg USBD_SYNCHRONOUS, USBD_DEFAULT_TIMEOUT, NULL);
299 1.2 joerg
300 1.2 joerg err = usbd_transfer(xfer);
301 1.11 pooka
302 1.11 pooka #if 0 /* XXXpooka: at least my huawei "fails" this always, but still detaches */
303 1.2 joerg if (err)
304 1.11 pooka aprint_error("u3ginit: transfer failed\n");
305 1.11 pooka #else
306 1.11 pooka err = 0;
307 1.11 pooka #endif
308 1.2 joerg usbd_free_xfer(xfer);
309 1.2 joerg } else {
310 1.11 pooka aprint_error("u3ginit: failed to allocate xfer\n");
311 1.2 joerg err = USBD_NOMEM;
312 1.2 joerg }
313 1.2 joerg
314 1.2 joerg usbd_abort_pipe(pipe);
315 1.2 joerg usbd_close_pipe(pipe);
316 1.2 joerg
317 1.2 joerg return (err == USBD_NORMAL_COMPLETION ? UMATCH_HIGHEST : UMATCH_NONE);
318 1.2 joerg }
319 1.2 joerg
320 1.2 joerg static int
321 1.11 pooka u3g_novatel_reinit(usbd_device_handle dev)
322 1.11 pooka {
323 1.11 pooka unsigned char cmd[31];
324 1.11 pooka
325 1.11 pooka memset(cmd, 0, sizeof(cmd));
326 1.11 pooka /* Byte 0..3: Command Block Wrapper (CBW) signature */
327 1.11 pooka cmd[0] = 0x55;
328 1.11 pooka cmd[1] = 0x53;
329 1.11 pooka cmd[2] = 0x42;
330 1.11 pooka cmd[3] = 0x43;
331 1.11 pooka /* 4..7: CBW Tag, has to unique, but only a single transfer used. */
332 1.11 pooka cmd[4] = 0x01;
333 1.11 pooka /* 8..11: CBW Transfer Length, no data here */
334 1.11 pooka /* 12: CBW Flag: output, so 0 */
335 1.11 pooka /* 13: CBW Lun: 0 */
336 1.11 pooka /* 14: CBW Length */
337 1.11 pooka cmd[14] = 0x06;
338 1.11 pooka /* Rest is the SCSI payload */
339 1.11 pooka /* 0: SCSI START/STOP opcode */
340 1.11 pooka cmd[15] = 0x1b;
341 1.11 pooka /* 1..3 unused */
342 1.11 pooka /* 4 Load/Eject command */
343 1.11 pooka cmd[19] = 0x02;
344 1.11 pooka /* 5: unused */
345 1.11 pooka
346 1.11 pooka return send_bulkmsg(dev, cmd, sizeof(cmd));
347 1.11 pooka }
348 1.11 pooka
349 1.11 pooka static int
350 1.1 joerg u3g_huawei_reinit(usbd_device_handle dev)
351 1.1 joerg {
352 1.9 martin /*
353 1.9 martin * The Huawei device presents itself as a umass device with Windows
354 1.1 joerg * drivers on it. After installation of the driver, it reinits into a
355 1.1 joerg * 3G serial device.
356 1.1 joerg */
357 1.1 joerg usb_device_request_t req;
358 1.1 joerg usb_config_descriptor_t *cdesc;
359 1.1 joerg
360 1.1 joerg /* Get the config descriptor */
361 1.1 joerg cdesc = usbd_get_config_descriptor(dev);
362 1.9 martin if (cdesc == NULL) {
363 1.9 martin usb_device_descriptor_t dd;
364 1.9 martin
365 1.9 martin if (usbd_get_device_desc(dev, &dd) != 0)
366 1.9 martin return (UMATCH_NONE);
367 1.9 martin
368 1.9 martin if (dd.bNumConfigurations != 1)
369 1.9 martin return (UMATCH_NONE);
370 1.9 martin
371 1.9 martin if (usbd_set_config_index(dev, 0, 1) != 0)
372 1.9 martin return (UMATCH_NONE);
373 1.9 martin
374 1.9 martin cdesc = usbd_get_config_descriptor(dev);
375 1.9 martin
376 1.9 martin if (cdesc == NULL)
377 1.9 martin return (UMATCH_NONE);
378 1.9 martin }
379 1.1 joerg
380 1.9 martin /*
381 1.9 martin * One iface means umass mode, more than 1 (4 usually) means 3G mode.
382 1.9 martin *
383 1.9 martin * XXX: We should check the first interface's device class just to be
384 1.9 martin * sure. If it's a mass storage device, then we can be fairly certain
385 1.9 martin * it needs a mode-switch.
386 1.9 martin */
387 1.1 joerg if (cdesc->bNumInterface > 1)
388 1.9 martin return (UMATCH_NONE);
389 1.1 joerg
390 1.1 joerg req.bmRequestType = UT_WRITE_DEVICE;
391 1.1 joerg req.bRequest = UR_SET_FEATURE;
392 1.1 joerg USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
393 1.1 joerg USETW(req.wIndex, UHF_PORT_SUSPEND);
394 1.1 joerg USETW(req.wLength, 0);
395 1.1 joerg
396 1.1 joerg (void) usbd_do_request(dev, &req, 0);
397 1.1 joerg
398 1.11 pooka return (UMATCH_HIGHEST); /* Prevent umass from attaching */
399 1.11 pooka }
400 1.11 pooka
401 1.11 pooka static int
402 1.11 pooka u3g_huawei_k3765_reinit(usbd_device_handle dev)
403 1.11 pooka {
404 1.11 pooka unsigned char cmd[31];
405 1.11 pooka
406 1.11 pooka /* magic string adapted from some webpage */
407 1.11 pooka memset(cmd, 0, sizeof(cmd));
408 1.11 pooka cmd[0] = 0x55;
409 1.11 pooka cmd[1] = 0x53;
410 1.11 pooka cmd[2] = 0x42;
411 1.11 pooka cmd[3] = 0x43;
412 1.11 pooka cmd[15]= 0x11;
413 1.11 pooka cmd[16]= 0x06;
414 1.11 pooka
415 1.11 pooka return send_bulkmsg(dev, cmd, sizeof(cmd));
416 1.1 joerg }
417 1.1 joerg
418 1.1 joerg static int
419 1.4 christos u3g_sierra_reinit(usbd_device_handle dev)
420 1.4 christos {
421 1.4 christos /* Some Sierra devices presents themselves as a umass device with
422 1.4 christos * Windows drivers on it. After installation of the driver, it
423 1.4 christos * reinits into a * 3G serial device.
424 1.4 christos */
425 1.4 christos usb_device_request_t req;
426 1.4 christos
427 1.4 christos req.bmRequestType = UT_VENDOR;
428 1.4 christos req.bRequest = UR_SET_INTERFACE;
429 1.4 christos USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
430 1.4 christos USETW(req.wIndex, UHF_PORT_CONNECTION);
431 1.4 christos USETW(req.wLength, 0);
432 1.4 christos
433 1.4 christos (void) usbd_do_request(dev, &req, 0);
434 1.4 christos
435 1.4 christos return (UMATCH_HIGHEST); /* Match to prevent umass from attaching */
436 1.4 christos }
437 1.4 christos
438 1.9 martin /*
439 1.9 martin * First personality:
440 1.9 martin *
441 1.9 martin * Claim the entire device if a mode-switch is required.
442 1.9 martin */
443 1.9 martin
444 1.4 christos static int
445 1.9 martin u3ginit_match(device_t parent, cfdata_t match, void *aux)
446 1.1 joerg {
447 1.1 joerg struct usb_attach_arg *uaa = aux;
448 1.1 joerg
449 1.11 pooka /*
450 1.11 pooka * Huawei changes product when it is configured as a modem.
451 1.11 pooka */
452 1.16 christos switch (uaa->vendor) {
453 1.16 christos case USB_VENDOR_HUAWEI:
454 1.11 pooka if (uaa->product == USB_PRODUCT_HUAWEI_K3765)
455 1.11 pooka return UMATCH_NONE;
456 1.11 pooka
457 1.15 kardel switch (uaa->product) {
458 1.15 kardel case USB_PRODUCT_HUAWEI_E1750INIT:
459 1.15 kardel case USB_PRODUCT_HUAWEI_K3765INIT:
460 1.11 pooka return u3g_huawei_k3765_reinit(uaa->device);
461 1.15 kardel break;
462 1.15 kardel default:
463 1.11 pooka return u3g_huawei_reinit(uaa->device);
464 1.15 kardel break;
465 1.15 kardel }
466 1.16 christos break;
467 1.1 joerg
468 1.16 christos case USB_VENDOR_NOVATEL2:
469 1.14 riz switch (uaa->product){
470 1.14 riz case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
471 1.14 riz case USB_PRODUCT_NOVATEL2_U760_DRIVER:
472 1.14 riz return u3g_novatel_reinit(uaa->device);
473 1.14 riz break;
474 1.14 riz default:
475 1.14 riz break;
476 1.14 riz }
477 1.16 christos break;
478 1.16 christos
479 1.16 christos case USB_VENDOR_SIERRA:
480 1.16 christos if (uaa->product == USB_PRODUCT_SIERRA_INSTALLER)
481 1.16 christos return u3g_sierra_reinit(uaa->device);
482 1.16 christos break;
483 1.16 christos
484 1.16 christos case USB_VENDOR_QUALCOMMINC:
485 1.16 christos if (uaa->product == USB_PRODUCT_QUALCOMMINC_ZTE_STOR)
486 1.16 christos return u3g_novatel_reinit(uaa->device);
487 1.16 christos break;
488 1.16 christos
489 1.16 christos default:
490 1.16 christos break;
491 1.14 riz }
492 1.2 joerg
493 1.1 joerg return UMATCH_NONE;
494 1.1 joerg }
495 1.1 joerg
496 1.1 joerg static void
497 1.9 martin u3ginit_attach(device_t parent, device_t self, void *aux)
498 1.1 joerg {
499 1.1 joerg struct usb_attach_arg *uaa = aux;
500 1.1 joerg
501 1.1 joerg aprint_naive("\n");
502 1.9 martin aprint_normal(": Switching to 3G mode\n");
503 1.1 joerg
504 1.14 riz if (uaa->vendor == USB_VENDOR_NOVATEL2) {
505 1.14 riz switch (uaa->product) {
506 1.14 riz case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
507 1.14 riz case USB_PRODUCT_NOVATEL2_U760_DRIVER:
508 1.14 riz /* About to disappear... */
509 1.14 riz return;
510 1.14 riz break;
511 1.14 riz default:
512 1.14 riz break;
513 1.14 riz }
514 1.2 joerg }
515 1.2 joerg
516 1.1 joerg /* Move the device into the configured state. */
517 1.9 martin (void) usbd_set_config_index(uaa->device, 0, 1);
518 1.9 martin }
519 1.9 martin
520 1.9 martin static int
521 1.9 martin u3ginit_detach(device_t self, int flags)
522 1.9 martin {
523 1.9 martin
524 1.9 martin return (0);
525 1.9 martin }
526 1.9 martin
527 1.9 martin
528 1.9 martin /*
529 1.9 martin * Second personality:
530 1.9 martin *
531 1.9 martin * Claim only those interfaces required for 3G modem operation.
532 1.9 martin */
533 1.9 martin
534 1.9 martin static int
535 1.9 martin u3g_match(device_t parent, cfdata_t match, void *aux)
536 1.9 martin {
537 1.9 martin struct usbif_attach_arg *uaa = aux;
538 1.9 martin usbd_interface_handle iface;
539 1.9 martin usb_interface_descriptor_t *id;
540 1.9 martin usbd_status error;
541 1.9 martin
542 1.9 martin if (!usb_lookup(u3g_devs, uaa->vendor, uaa->product))
543 1.9 martin return (UMATCH_NONE);
544 1.9 martin
545 1.9 martin error = usbd_device2interface_handle(uaa->device, uaa->ifaceno, &iface);
546 1.1 joerg if (error) {
547 1.9 martin printf("u3g_match: failed to get interface, err=%s\n",
548 1.9 martin usbd_errstr(error));
549 1.9 martin return (UMATCH_NONE);
550 1.9 martin }
551 1.9 martin
552 1.9 martin id = usbd_get_interface_descriptor(iface);
553 1.9 martin if (id == NULL) {
554 1.9 martin printf("u3g_match: failed to get interface descriptor\n");
555 1.9 martin return (UMATCH_NONE);
556 1.1 joerg }
557 1.1 joerg
558 1.9 martin /*
559 1.9 martin * 3G modems generally report vendor-specific class
560 1.9 martin *
561 1.9 martin * XXX: this may be too generalised.
562 1.9 martin */
563 1.9 martin return ((id->bInterfaceClass == UICLASS_VENDOR) ?
564 1.9 martin UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
565 1.9 martin }
566 1.9 martin
567 1.9 martin static void
568 1.9 martin u3g_attach(device_t parent, device_t self, void *aux)
569 1.9 martin {
570 1.9 martin struct u3g_softc *sc = device_private(self);
571 1.9 martin struct usbif_attach_arg *uaa = aux;
572 1.9 martin usbd_device_handle dev = uaa->device;
573 1.9 martin usbd_interface_handle iface;
574 1.9 martin usb_interface_descriptor_t *id;
575 1.9 martin usb_endpoint_descriptor_t *ed;
576 1.9 martin struct ucom_attach_args uca;
577 1.9 martin usbd_status error;
578 1.9 martin int n, intr_address, intr_size;
579 1.1 joerg
580 1.9 martin aprint_naive("\n");
581 1.9 martin aprint_normal("\n");
582 1.1 joerg
583 1.9 martin sc->sc_dev = self;
584 1.9 martin sc->sc_dying = false;
585 1.9 martin sc->sc_udev = dev;
586 1.2 joerg
587 1.9 martin error = usbd_device2interface_handle(dev, uaa->ifaceno, &iface);
588 1.9 martin if (error) {
589 1.9 martin aprint_error_dev(self, "failed to get interface, err=%s\n",
590 1.9 martin usbd_errstr(error));
591 1.4 christos return;
592 1.4 christos }
593 1.4 christos
594 1.9 martin id = usbd_get_interface_descriptor(iface);
595 1.1 joerg
596 1.9 martin uca.info = "3G Modem";
597 1.9 martin uca.ibufsize = U3G_BUFF_SIZE;
598 1.9 martin uca.obufsize = U3G_BUFF_SIZE;
599 1.9 martin uca.ibufsizepad = U3G_BUFF_SIZE;
600 1.9 martin uca.portno = uaa->ifaceno;
601 1.9 martin uca.opkthdrlen = 0;
602 1.9 martin uca.device = dev;
603 1.9 martin uca.iface = iface;
604 1.9 martin uca.methods = &u3g_methods;
605 1.9 martin uca.arg = sc;
606 1.9 martin uca.bulkin = uca.bulkout = -1;
607 1.9 martin
608 1.9 martin sc->sc_outpins = 0;
609 1.9 martin sc->sc_msr = UMSR_DSR | UMSR_CTS | UMSR_DCD;
610 1.9 martin sc->sc_ifaceno = uaa->ifaceno;
611 1.9 martin sc->sc_open = false;
612 1.9 martin sc->sc_purging = false;
613 1.9 martin
614 1.9 martin intr_address = -1;
615 1.9 martin intr_size = 0;
616 1.9 martin
617 1.9 martin for (n = 0; n < id->bNumEndpoints; n++) {
618 1.9 martin ed = usbd_interface2endpoint_descriptor(iface, n);
619 1.9 martin if (ed == NULL) {
620 1.9 martin aprint_error_dev(self, "no endpoint descriptor "
621 1.9 martin "for %d (interface: %d)\n", n, sc->sc_ifaceno);
622 1.9 martin sc->sc_dying = true;
623 1.1 joerg return;
624 1.1 joerg }
625 1.1 joerg
626 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
627 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
628 1.9 martin intr_address = ed->bEndpointAddress;
629 1.9 martin intr_size = UGETW(ed->wMaxPacketSize);
630 1.9 martin } else
631 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
632 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
633 1.9 martin uca.bulkin = ed->bEndpointAddress;
634 1.9 martin } else
635 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
636 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
637 1.9 martin uca.bulkout = ed->bEndpointAddress;
638 1.1 joerg }
639 1.9 martin }
640 1.9 martin
641 1.9 martin if (uca.bulkin == -1) {
642 1.9 martin aprint_error_dev(self, "Missing bulk in for interface %d\n",
643 1.9 martin sc->sc_ifaceno);
644 1.9 martin sc->sc_dying = true;
645 1.9 martin return;
646 1.9 martin }
647 1.1 joerg
648 1.9 martin if (uca.bulkout == -1) {
649 1.9 martin aprint_error_dev(self, "Missing bulk out for interface %d\n",
650 1.9 martin sc->sc_ifaceno);
651 1.9 martin sc->sc_dying = true;
652 1.9 martin return;
653 1.1 joerg }
654 1.1 joerg
655 1.9 martin sc->sc_ucom = config_found_sm_loc(self, "ucombus",
656 1.9 martin NULL, &uca, ucomprint, ucomsubmatch);
657 1.9 martin
658 1.9 martin /*
659 1.9 martin * If the interface has an interrupt pipe, open it immediately so
660 1.9 martin * that we can track input pin state changes regardless of whether
661 1.9 martin * the tty(4) device is open or not.
662 1.9 martin */
663 1.9 martin if (intr_address != -1) {
664 1.9 martin sc->sc_intr_buff = malloc(intr_size, M_USBDEV, M_WAITOK);
665 1.9 martin error = usbd_open_pipe_intr(iface, intr_address,
666 1.9 martin USBD_SHORT_XFER_OK, &sc->sc_intr_pipe, sc, sc->sc_intr_buff,
667 1.9 martin intr_size, u3g_intr, 100);
668 1.1 joerg if (error) {
669 1.9 martin aprint_error_dev(self, "cannot open interrupt pipe "
670 1.9 martin "(addr %d)\n", intr_address);
671 1.1 joerg return;
672 1.1 joerg }
673 1.9 martin } else {
674 1.9 martin sc->sc_intr_pipe = NULL;
675 1.9 martin sc->sc_intr_buff = NULL;
676 1.1 joerg }
677 1.1 joerg
678 1.1 joerg if (!pmf_device_register(self, NULL, NULL))
679 1.1 joerg aprint_error_dev(self, "couldn't establish power handler\n");
680 1.1 joerg }
681 1.1 joerg
682 1.1 joerg static int
683 1.1 joerg u3g_detach(device_t self, int flags)
684 1.1 joerg {
685 1.1 joerg struct u3g_softc *sc = device_private(self);
686 1.9 martin int rv;
687 1.1 joerg
688 1.9 martin if (sc->sc_dying)
689 1.2 joerg return 0;
690 1.2 joerg
691 1.1 joerg pmf_device_deregister(self);
692 1.1 joerg
693 1.9 martin if (sc->sc_ucom != NULL) {
694 1.9 martin rv = config_detach(sc->sc_ucom, flags);
695 1.9 martin if (rv != 0) {
696 1.9 martin aprint_verbose_dev(self, "Can't deallocate "
697 1.9 martin "port (%d)", rv);
698 1.1 joerg }
699 1.1 joerg }
700 1.1 joerg
701 1.1 joerg if (sc->sc_intr_pipe != NULL) {
702 1.9 martin (void) usbd_abort_pipe(sc->sc_intr_pipe);
703 1.9 martin (void) usbd_close_pipe(sc->sc_intr_pipe);
704 1.1 joerg sc->sc_intr_pipe = NULL;
705 1.1 joerg }
706 1.9 martin if (sc->sc_intr_buff != NULL) {
707 1.9 martin free(sc->sc_intr_buff, M_USBDEV);
708 1.9 martin sc->sc_intr_buff = NULL;
709 1.9 martin }
710 1.1 joerg
711 1.9 martin return (0);
712 1.1 joerg }
713 1.1 joerg
714 1.1 joerg static void
715 1.1 joerg u3g_childdet(device_t self, device_t child)
716 1.1 joerg {
717 1.1 joerg struct u3g_softc *sc = device_private(self);
718 1.9 martin
719 1.9 martin if (sc->sc_ucom == child)
720 1.9 martin sc->sc_ucom = NULL;
721 1.9 martin }
722 1.9 martin
723 1.9 martin static int
724 1.9 martin u3g_activate(device_t self, enum devact act)
725 1.9 martin {
726 1.9 martin struct u3g_softc *sc = device_private(self);
727 1.9 martin int rv;
728 1.9 martin
729 1.9 martin switch (act) {
730 1.9 martin case DVACT_DEACTIVATE:
731 1.9 martin if (sc->sc_ucom != NULL && config_deactivate(sc->sc_ucom))
732 1.9 martin rv = -1;
733 1.9 martin else
734 1.9 martin rv = 0;
735 1.9 martin break;
736 1.9 martin
737 1.9 martin default:
738 1.9 martin rv = 0;
739 1.9 martin break;
740 1.9 martin }
741 1.9 martin
742 1.9 martin return (rv);
743 1.9 martin }
744 1.9 martin
745 1.9 martin static void
746 1.9 martin u3g_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
747 1.9 martin {
748 1.9 martin struct u3g_softc *sc = (struct u3g_softc *)priv;
749 1.9 martin u_char *buf;
750 1.9 martin
751 1.9 martin if (sc->sc_dying)
752 1.9 martin return;
753 1.9 martin
754 1.9 martin if (status != USBD_NORMAL_COMPLETION) {
755 1.9 martin if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
756 1.9 martin return;
757 1.9 martin usbd_clear_endpoint_stall_async(sc->sc_intr_pipe);
758 1.9 martin return;
759 1.9 martin }
760 1.9 martin
761 1.9 martin buf = sc->sc_intr_buff;
762 1.9 martin if (buf[0] == 0xa1 && buf[1] == 0x20) {
763 1.9 martin u_char msr;
764 1.9 martin
765 1.9 martin msr = sc->sc_msr & ~(UMSR_DCD | UMSR_DSR | UMSR_RI);
766 1.9 martin
767 1.9 martin if (buf[8] & U3G_INPIN_DCD)
768 1.9 martin msr |= UMSR_DCD;
769 1.9 martin
770 1.9 martin if (buf[8] & U3G_INPIN_DSR)
771 1.9 martin msr |= UMSR_DSR;
772 1.9 martin
773 1.9 martin if (buf[8] & U3G_INPIN_RI)
774 1.9 martin msr |= UMSR_RI;
775 1.9 martin
776 1.9 martin if (msr != sc->sc_msr) {
777 1.9 martin sc->sc_msr = msr;
778 1.9 martin if (sc->sc_open)
779 1.9 martin ucom_status_change(device_private(sc->sc_ucom));
780 1.9 martin }
781 1.9 martin }
782 1.9 martin }
783 1.9 martin
784 1.9 martin /*ARGSUSED*/
785 1.9 martin static void
786 1.9 martin u3g_get_status(void *arg, int portno, u_char *lsr, u_char *msr)
787 1.9 martin {
788 1.9 martin struct u3g_softc *sc = arg;
789 1.9 martin
790 1.9 martin if (lsr != NULL)
791 1.9 martin *lsr = 0; /* LSR isn't supported */
792 1.9 martin if (msr != NULL)
793 1.9 martin *msr = sc->sc_msr;
794 1.9 martin }
795 1.9 martin
796 1.9 martin /*ARGSUSED*/
797 1.9 martin static void
798 1.9 martin u3g_set(void *arg, int portno, int reg, int onoff)
799 1.9 martin {
800 1.9 martin struct u3g_softc *sc = arg;
801 1.9 martin usb_device_request_t req;
802 1.9 martin uint16_t mask, new_state;
803 1.9 martin usbd_status err;
804 1.9 martin
805 1.9 martin if (sc->sc_dying)
806 1.9 martin return;
807 1.9 martin
808 1.9 martin switch (reg) {
809 1.9 martin case UCOM_SET_DTR:
810 1.9 martin mask = U3G_OUTPIN_DTR;
811 1.9 martin break;
812 1.9 martin case UCOM_SET_RTS:
813 1.9 martin mask = U3G_OUTPIN_RTS;
814 1.9 martin break;
815 1.9 martin default:
816 1.9 martin return;
817 1.9 martin }
818 1.9 martin
819 1.9 martin new_state = sc->sc_outpins & ~mask;
820 1.9 martin if (onoff)
821 1.9 martin new_state |= mask;
822 1.9 martin
823 1.9 martin if (new_state == sc->sc_outpins)
824 1.9 martin return;
825 1.9 martin
826 1.9 martin sc->sc_outpins = new_state;
827 1.9 martin
828 1.9 martin req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
829 1.9 martin req.bRequest = U3G_SET_PIN;
830 1.9 martin USETW(req.wValue, new_state);
831 1.9 martin USETW(req.wIndex, sc->sc_ifaceno);
832 1.9 martin USETW(req.wLength, 0);
833 1.9 martin
834 1.9 martin err = usbd_do_request(sc->sc_udev, &req, 0);
835 1.9 martin if (err == USBD_STALLED)
836 1.9 martin usbd_clear_endpoint_stall(sc->sc_udev->default_pipe);
837 1.9 martin }
838 1.9 martin
839 1.9 martin /*ARGSUSED*/
840 1.9 martin static int
841 1.9 martin u3g_open(void *arg, int portno)
842 1.9 martin {
843 1.9 martin struct u3g_softc *sc = arg;
844 1.9 martin usb_device_request_t req;
845 1.9 martin usb_endpoint_descriptor_t *ed;
846 1.9 martin usb_interface_descriptor_t *id;
847 1.9 martin usbd_interface_handle ih;
848 1.9 martin usbd_status err;
849 1.1 joerg int i;
850 1.1 joerg
851 1.9 martin if (sc->sc_dying)
852 1.9 martin return (0);
853 1.9 martin
854 1.9 martin err = usbd_device2interface_handle(sc->sc_udev, portno, &ih);
855 1.9 martin if (err)
856 1.9 martin return (EIO);
857 1.9 martin
858 1.9 martin id = usbd_get_interface_descriptor(ih);
859 1.9 martin
860 1.9 martin for (i = 0; i < id->bNumEndpoints; i++) {
861 1.9 martin ed = usbd_interface2endpoint_descriptor(ih, i);
862 1.9 martin if (ed == NULL)
863 1.9 martin return (EIO);
864 1.9 martin
865 1.9 martin if (UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
866 1.9 martin /* Issue ENDPOINT_HALT request */
867 1.9 martin req.bmRequestType = UT_WRITE_ENDPOINT;
868 1.9 martin req.bRequest = UR_CLEAR_FEATURE;
869 1.9 martin USETW(req.wValue, UF_ENDPOINT_HALT);
870 1.9 martin USETW(req.wIndex, ed->bEndpointAddress);
871 1.9 martin USETW(req.wLength, 0);
872 1.9 martin err = usbd_do_request(sc->sc_udev, &req, 0);
873 1.9 martin if (err)
874 1.9 martin return (EIO);
875 1.9 martin }
876 1.1 joerg }
877 1.9 martin
878 1.9 martin sc->sc_open = true;
879 1.9 martin sc->sc_purging = true;
880 1.9 martin getmicrotime(&sc->sc_purge_start);
881 1.9 martin
882 1.9 martin return (0);
883 1.1 joerg }
884 1.1 joerg
885 1.9 martin /*ARGSUSED*/
886 1.9 martin static void
887 1.9 martin u3g_close(void *arg, int portno)
888 1.9 martin {
889 1.9 martin struct u3g_softc *sc = arg;
890 1.9 martin
891 1.9 martin sc->sc_open = false;
892 1.9 martin }
893 1.9 martin
894 1.9 martin /*ARGSUSED*/
895 1.9 martin static void
896 1.9 martin u3g_read(void *arg, int portno, u_char **cpp, uint32_t *ccp)
897 1.9 martin {
898 1.9 martin struct u3g_softc *sc = arg;
899 1.9 martin struct timeval curr_tv, diff_tv;
900 1.9 martin
901 1.9 martin /*
902 1.9 martin * If we're not purging input data following first open, do nothing.
903 1.9 martin */
904 1.9 martin if (sc->sc_purging == false)
905 1.9 martin return;
906 1.9 martin
907 1.9 martin /*
908 1.9 martin * Otherwise check if the purge timeout has expired
909 1.9 martin */
910 1.9 martin getmicrotime(&curr_tv);
911 1.9 martin timersub(&curr_tv, &sc->sc_purge_start, &diff_tv);
912 1.9 martin
913 1.9 martin if (diff_tv.tv_sec >= U3G_PURGE_SECS) {
914 1.9 martin /* Timeout expired. */
915 1.9 martin sc->sc_purging = false;
916 1.9 martin } else {
917 1.9 martin /* Still purging. Adjust the caller's byte count. */
918 1.9 martin *ccp = 0;
919 1.9 martin }
920 1.9 martin }
921 1.9 martin
922 1.9 martin /*ARGSUSED*/
923 1.9 martin static void
924 1.9 martin u3g_write(void *arg, int portno, u_char *to, u_char *from, u_int32_t *count)
925 1.9 martin {
926 1.9 martin struct u3g_softc *sc = arg;
927 1.9 martin
928 1.9 martin /*
929 1.9 martin * Stop purging as soon as the first data is written to the device.
930 1.9 martin */
931 1.9 martin sc->sc_purging = false;
932 1.9 martin memcpy(to, from, *count);
933 1.9 martin }
934