u3g.c revision 1.20.2.3 1 1.20.2.3 yamt /* $NetBSD: u3g.c,v 1.20.2.3 2012/10/30 17:22:07 yamt 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.20.2.3 yamt __KERNEL_RCSID(0, "$NetBSD: u3g.c,v 1.20.2.3 2012/10/30 17:22:07 yamt 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.19 veego { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E1750 },
186 1.18 apb { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E1820 },
187 1.1 joerg { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E220 },
188 1.20.2.3 yamt { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_EM770W },
189 1.11 pooka { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_K3765 },
190 1.13 riz { USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_MOBILE },
191 1.13 riz /* OEM: Merlin */
192 1.13 riz { USB_VENDOR_MERLIN, USB_PRODUCT_MERLIN_V620 },
193 1.1 joerg /* OEM: Novatel */
194 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_ES620 },
195 1.20.2.2 yamt { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_EU8X0D },
196 1.1 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D },
197 1.13 riz #if 0
198 1.14 riz /* These are matched in u3ginit_match() */
199 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MC950D_DRIVER },
200 1.14 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760_DRIVER },
201 1.13 riz #endif
202 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINU740 },
203 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_MERLINV620 },
204 1.13 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_S720 },
205 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U720 },
206 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U727 },
207 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U740_2 },
208 1.14 riz { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U760 },
209 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_U870 },
210 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_V740 },
211 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_X950D },
212 1.3 joerg { USB_VENDOR_NOVATEL2, USB_PRODUCT_NOVATEL2_XU870 },
213 1.13 riz /* OEM: Option N.V. */
214 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_QUADPLUSUMTS },
215 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_HSDPA },
216 1.13 riz { USB_VENDOR_OPTIONNV, USB_PRODUCT_OPTIONNV_GTMAXHSUPA },
217 1.13 riz /* OEM: Qualcomm, Inc. */
218 1.13 riz { USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_CDMA_MSM },
219 1.13 riz { USB_VENDOR_QUALCOMMINC, USB_PRODUCT_QUALCOMMINC_ZTE_MF626 },
220 1.20.2.3 yamt { USB_VENDOR_QUALCOMM, USB_PRODUCT_QUALCOMM_NTT_DOCOMO_L02C_MODEM },
221 1.1 joerg
222 1.3 joerg /* OEM: Sierra Wireless: */
223 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC595U },
224 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC597E },
225 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC875U },
226 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880 },
227 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880E },
228 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC880U },
229 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881 },
230 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881E },
231 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AC881U },
232 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD580 },
233 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD595 },
234 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_AIRCARD875 },
235 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_C597 },
236 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_EM5625 },
237 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720 },
238 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5720_2 },
239 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC5725 },
240 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755 },
241 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_2 },
242 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8755_3 },
243 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8765 },
244 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8775_2 },
245 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8780 },
246 1.3 joerg { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MC8781 },
247 1.13 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_MINI5725 },
248 1.12 riz { USB_VENDOR_SIERRA, USB_PRODUCT_SIERRA_USB305 },
249 1.17 scw
250 1.17 scw /* Toshiba */
251 1.17 scw { USB_VENDOR_TOSHIBA, USB_PRODUCT_TOSHIBA_HSDPA_MODEM_EU870DT1 },
252 1.20 christos
253 1.20 christos /* 4G Systems */
254 1.20 christos { USB_VENDOR_4GSYSTEMS, USB_PRODUCT_4GSYSTEMS_XSSTICK_P14 },
255 1.1 joerg };
256 1.1 joerg
257 1.1 joerg static int
258 1.20 christos send_bulkmsg(usbd_device_handle dev, void *cmd, size_t cmdlen)
259 1.2 joerg {
260 1.2 joerg usbd_interface_handle iface;
261 1.2 joerg usb_interface_descriptor_t *id;
262 1.2 joerg usb_endpoint_descriptor_t *ed;
263 1.2 joerg usbd_pipe_handle pipe;
264 1.2 joerg usbd_xfer_handle xfer;
265 1.2 joerg int err, i;
266 1.2 joerg
267 1.2 joerg /* Move the device into the configured state. */
268 1.9 martin err = usbd_set_config_index(dev, 0, 0);
269 1.2 joerg if (err) {
270 1.2 joerg aprint_error("u3g: failed to set configuration index\n");
271 1.2 joerg return UMATCH_NONE;
272 1.2 joerg }
273 1.2 joerg
274 1.9 martin err = usbd_device2interface_handle(dev, 0, &iface);
275 1.2 joerg if (err != 0) {
276 1.11 pooka aprint_error("u3ginit: failed to get interface\n");
277 1.2 joerg return UMATCH_NONE;
278 1.2 joerg }
279 1.2 joerg
280 1.2 joerg id = usbd_get_interface_descriptor(iface);
281 1.2 joerg ed = NULL;
282 1.2 joerg for (i = 0 ; i < id->bNumEndpoints ; i++) {
283 1.2 joerg ed = usbd_interface2endpoint_descriptor(iface, i);
284 1.2 joerg if (ed == NULL)
285 1.2 joerg continue;
286 1.2 joerg if (UE_GET_DIR(ed->bEndpointAddress) != UE_DIR_OUT)
287 1.2 joerg continue;
288 1.2 joerg if ((ed->bmAttributes & UE_XFERTYPE) == UE_BULK)
289 1.2 joerg break;
290 1.2 joerg }
291 1.2 joerg
292 1.2 joerg if (i == id->bNumEndpoints)
293 1.2 joerg return UMATCH_NONE;
294 1.2 joerg
295 1.11 pooka err = usbd_open_pipe(iface, ed->bEndpointAddress,
296 1.11 pooka USBD_EXCLUSIVE_USE, &pipe);
297 1.2 joerg if (err != 0) {
298 1.11 pooka aprint_error("u3ginit: failed to open bulk transfer pipe %d\n",
299 1.2 joerg ed->bEndpointAddress);
300 1.2 joerg return UMATCH_NONE;
301 1.2 joerg }
302 1.2 joerg
303 1.9 martin xfer = usbd_alloc_xfer(dev);
304 1.2 joerg if (xfer != NULL) {
305 1.11 pooka usbd_setup_xfer(xfer, pipe, NULL, cmd, cmdlen,
306 1.2 joerg USBD_SYNCHRONOUS, USBD_DEFAULT_TIMEOUT, NULL);
307 1.2 joerg
308 1.2 joerg err = usbd_transfer(xfer);
309 1.11 pooka
310 1.11 pooka #if 0 /* XXXpooka: at least my huawei "fails" this always, but still detaches */
311 1.2 joerg if (err)
312 1.11 pooka aprint_error("u3ginit: transfer failed\n");
313 1.11 pooka #else
314 1.11 pooka err = 0;
315 1.11 pooka #endif
316 1.2 joerg usbd_free_xfer(xfer);
317 1.2 joerg } else {
318 1.11 pooka aprint_error("u3ginit: failed to allocate xfer\n");
319 1.2 joerg err = USBD_NOMEM;
320 1.2 joerg }
321 1.2 joerg
322 1.2 joerg usbd_abort_pipe(pipe);
323 1.2 joerg usbd_close_pipe(pipe);
324 1.2 joerg
325 1.2 joerg return (err == USBD_NORMAL_COMPLETION ? UMATCH_HIGHEST : UMATCH_NONE);
326 1.2 joerg }
327 1.2 joerg
328 1.2 joerg static int
329 1.11 pooka u3g_novatel_reinit(usbd_device_handle dev)
330 1.11 pooka {
331 1.11 pooka unsigned char cmd[31];
332 1.11 pooka
333 1.11 pooka memset(cmd, 0, sizeof(cmd));
334 1.11 pooka /* Byte 0..3: Command Block Wrapper (CBW) signature */
335 1.11 pooka cmd[0] = 0x55;
336 1.11 pooka cmd[1] = 0x53;
337 1.11 pooka cmd[2] = 0x42;
338 1.11 pooka cmd[3] = 0x43;
339 1.11 pooka /* 4..7: CBW Tag, has to unique, but only a single transfer used. */
340 1.11 pooka cmd[4] = 0x01;
341 1.11 pooka /* 8..11: CBW Transfer Length, no data here */
342 1.11 pooka /* 12: CBW Flag: output, so 0 */
343 1.11 pooka /* 13: CBW Lun: 0 */
344 1.11 pooka /* 14: CBW Length */
345 1.11 pooka cmd[14] = 0x06;
346 1.11 pooka /* Rest is the SCSI payload */
347 1.11 pooka /* 0: SCSI START/STOP opcode */
348 1.11 pooka cmd[15] = 0x1b;
349 1.11 pooka /* 1..3 unused */
350 1.11 pooka /* 4 Load/Eject command */
351 1.11 pooka cmd[19] = 0x02;
352 1.11 pooka /* 5: unused */
353 1.11 pooka
354 1.11 pooka return send_bulkmsg(dev, cmd, sizeof(cmd));
355 1.11 pooka }
356 1.11 pooka
357 1.11 pooka static int
358 1.1 joerg u3g_huawei_reinit(usbd_device_handle dev)
359 1.1 joerg {
360 1.9 martin /*
361 1.9 martin * The Huawei device presents itself as a umass device with Windows
362 1.1 joerg * drivers on it. After installation of the driver, it reinits into a
363 1.1 joerg * 3G serial device.
364 1.1 joerg */
365 1.1 joerg usb_device_request_t req;
366 1.1 joerg usb_config_descriptor_t *cdesc;
367 1.1 joerg
368 1.1 joerg /* Get the config descriptor */
369 1.1 joerg cdesc = usbd_get_config_descriptor(dev);
370 1.9 martin if (cdesc == NULL) {
371 1.9 martin usb_device_descriptor_t dd;
372 1.9 martin
373 1.9 martin if (usbd_get_device_desc(dev, &dd) != 0)
374 1.9 martin return (UMATCH_NONE);
375 1.9 martin
376 1.9 martin if (dd.bNumConfigurations != 1)
377 1.9 martin return (UMATCH_NONE);
378 1.9 martin
379 1.9 martin if (usbd_set_config_index(dev, 0, 1) != 0)
380 1.9 martin return (UMATCH_NONE);
381 1.9 martin
382 1.9 martin cdesc = usbd_get_config_descriptor(dev);
383 1.9 martin
384 1.9 martin if (cdesc == NULL)
385 1.9 martin return (UMATCH_NONE);
386 1.9 martin }
387 1.1 joerg
388 1.9 martin /*
389 1.9 martin * One iface means umass mode, more than 1 (4 usually) means 3G mode.
390 1.9 martin *
391 1.9 martin * XXX: We should check the first interface's device class just to be
392 1.9 martin * sure. If it's a mass storage device, then we can be fairly certain
393 1.9 martin * it needs a mode-switch.
394 1.9 martin */
395 1.1 joerg if (cdesc->bNumInterface > 1)
396 1.9 martin return (UMATCH_NONE);
397 1.1 joerg
398 1.1 joerg req.bmRequestType = UT_WRITE_DEVICE;
399 1.1 joerg req.bRequest = UR_SET_FEATURE;
400 1.1 joerg USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
401 1.1 joerg USETW(req.wIndex, UHF_PORT_SUSPEND);
402 1.1 joerg USETW(req.wLength, 0);
403 1.1 joerg
404 1.1 joerg (void) usbd_do_request(dev, &req, 0);
405 1.1 joerg
406 1.11 pooka return (UMATCH_HIGHEST); /* Prevent umass from attaching */
407 1.11 pooka }
408 1.11 pooka
409 1.11 pooka static int
410 1.11 pooka u3g_huawei_k3765_reinit(usbd_device_handle dev)
411 1.11 pooka {
412 1.11 pooka unsigned char cmd[31];
413 1.11 pooka
414 1.11 pooka /* magic string adapted from some webpage */
415 1.11 pooka memset(cmd, 0, sizeof(cmd));
416 1.11 pooka cmd[0] = 0x55;
417 1.11 pooka cmd[1] = 0x53;
418 1.11 pooka cmd[2] = 0x42;
419 1.11 pooka cmd[3] = 0x43;
420 1.11 pooka cmd[15]= 0x11;
421 1.11 pooka cmd[16]= 0x06;
422 1.11 pooka
423 1.11 pooka return send_bulkmsg(dev, cmd, sizeof(cmd));
424 1.1 joerg }
425 1.1 joerg
426 1.1 joerg static int
427 1.4 christos u3g_sierra_reinit(usbd_device_handle dev)
428 1.4 christos {
429 1.4 christos /* Some Sierra devices presents themselves as a umass device with
430 1.4 christos * Windows drivers on it. After installation of the driver, it
431 1.4 christos * reinits into a * 3G serial device.
432 1.4 christos */
433 1.4 christos usb_device_request_t req;
434 1.4 christos
435 1.4 christos req.bmRequestType = UT_VENDOR;
436 1.4 christos req.bRequest = UR_SET_INTERFACE;
437 1.4 christos USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
438 1.4 christos USETW(req.wIndex, UHF_PORT_CONNECTION);
439 1.4 christos USETW(req.wLength, 0);
440 1.4 christos
441 1.4 christos (void) usbd_do_request(dev, &req, 0);
442 1.4 christos
443 1.4 christos return (UMATCH_HIGHEST); /* Match to prevent umass from attaching */
444 1.4 christos }
445 1.4 christos
446 1.20 christos static int
447 1.20 christos u3g_4gsystems_reinit(usbd_device_handle dev)
448 1.20 christos {
449 1.20 christos /* magic string adapted from usb_modeswitch database */
450 1.20 christos static unsigned char cmd[31] = {
451 1.20 christos 0x55, 0x53, 0x42, 0x43, 0x12, 0x34, 0x56, 0x78, 0x80, 0x00,
452 1.20 christos 0x00, 0x00, 0x80, 0x00, 0x06, 0x06, 0xf5, 0x04, 0x02, 0x52,
453 1.20 christos 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
454 1.20 christos 0x00
455 1.20 christos };
456 1.20 christos
457 1.20 christos return send_bulkmsg(dev, cmd, sizeof(cmd));
458 1.20 christos }
459 1.20 christos
460 1.9 martin /*
461 1.9 martin * First personality:
462 1.9 martin *
463 1.9 martin * Claim the entire device if a mode-switch is required.
464 1.9 martin */
465 1.9 martin
466 1.4 christos static int
467 1.9 martin u3ginit_match(device_t parent, cfdata_t match, void *aux)
468 1.1 joerg {
469 1.1 joerg struct usb_attach_arg *uaa = aux;
470 1.1 joerg
471 1.11 pooka /*
472 1.11 pooka * Huawei changes product when it is configured as a modem.
473 1.11 pooka */
474 1.16 christos switch (uaa->vendor) {
475 1.16 christos case USB_VENDOR_HUAWEI:
476 1.11 pooka if (uaa->product == USB_PRODUCT_HUAWEI_K3765)
477 1.11 pooka return UMATCH_NONE;
478 1.11 pooka
479 1.15 kardel switch (uaa->product) {
480 1.15 kardel case USB_PRODUCT_HUAWEI_E1750INIT:
481 1.15 kardel case USB_PRODUCT_HUAWEI_K3765INIT:
482 1.11 pooka return u3g_huawei_k3765_reinit(uaa->device);
483 1.15 kardel break;
484 1.15 kardel default:
485 1.11 pooka return u3g_huawei_reinit(uaa->device);
486 1.15 kardel break;
487 1.15 kardel }
488 1.16 christos break;
489 1.1 joerg
490 1.16 christos case USB_VENDOR_NOVATEL2:
491 1.14 riz switch (uaa->product){
492 1.14 riz case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
493 1.14 riz case USB_PRODUCT_NOVATEL2_U760_DRIVER:
494 1.14 riz return u3g_novatel_reinit(uaa->device);
495 1.14 riz break;
496 1.14 riz default:
497 1.14 riz break;
498 1.14 riz }
499 1.16 christos break;
500 1.16 christos
501 1.16 christos case USB_VENDOR_SIERRA:
502 1.16 christos if (uaa->product == USB_PRODUCT_SIERRA_INSTALLER)
503 1.16 christos return u3g_sierra_reinit(uaa->device);
504 1.16 christos break;
505 1.16 christos
506 1.16 christos case USB_VENDOR_QUALCOMMINC:
507 1.16 christos if (uaa->product == USB_PRODUCT_QUALCOMMINC_ZTE_STOR)
508 1.16 christos return u3g_novatel_reinit(uaa->device);
509 1.16 christos break;
510 1.16 christos
511 1.20.2.3 yamt case USB_VENDOR_QUALCOMM:
512 1.20.2.3 yamt if (uaa->product == USB_PRODUCT_QUALCOMM_NTT_DOCOMO_L02C_STORAGE)
513 1.20.2.3 yamt return u3g_novatel_reinit(uaa->device);
514 1.20.2.3 yamt break;
515 1.20.2.3 yamt
516 1.20 christos case USB_VENDOR_4GSYSTEMS:
517 1.20.2.1 yamt if (uaa->product == USB_PRODUCT_4GSYSTEMS_XSSTICK_P14_INSTALLER)
518 1.20 christos return u3g_4gsystems_reinit(uaa->device);
519 1.20 christos break;
520 1.20 christos
521 1.16 christos default:
522 1.16 christos break;
523 1.14 riz }
524 1.2 joerg
525 1.1 joerg return UMATCH_NONE;
526 1.1 joerg }
527 1.1 joerg
528 1.1 joerg static void
529 1.9 martin u3ginit_attach(device_t parent, device_t self, void *aux)
530 1.1 joerg {
531 1.1 joerg struct usb_attach_arg *uaa = aux;
532 1.1 joerg
533 1.1 joerg aprint_naive("\n");
534 1.9 martin aprint_normal(": Switching to 3G mode\n");
535 1.1 joerg
536 1.14 riz if (uaa->vendor == USB_VENDOR_NOVATEL2) {
537 1.14 riz switch (uaa->product) {
538 1.14 riz case USB_PRODUCT_NOVATEL2_MC950D_DRIVER:
539 1.14 riz case USB_PRODUCT_NOVATEL2_U760_DRIVER:
540 1.14 riz /* About to disappear... */
541 1.14 riz return;
542 1.14 riz break;
543 1.14 riz default:
544 1.14 riz break;
545 1.14 riz }
546 1.2 joerg }
547 1.2 joerg
548 1.1 joerg /* Move the device into the configured state. */
549 1.9 martin (void) usbd_set_config_index(uaa->device, 0, 1);
550 1.9 martin }
551 1.9 martin
552 1.9 martin static int
553 1.9 martin u3ginit_detach(device_t self, int flags)
554 1.9 martin {
555 1.9 martin
556 1.9 martin return (0);
557 1.9 martin }
558 1.9 martin
559 1.9 martin
560 1.9 martin /*
561 1.9 martin * Second personality:
562 1.9 martin *
563 1.9 martin * Claim only those interfaces required for 3G modem operation.
564 1.9 martin */
565 1.9 martin
566 1.9 martin static int
567 1.9 martin u3g_match(device_t parent, cfdata_t match, void *aux)
568 1.9 martin {
569 1.9 martin struct usbif_attach_arg *uaa = aux;
570 1.9 martin usbd_interface_handle iface;
571 1.9 martin usb_interface_descriptor_t *id;
572 1.9 martin usbd_status error;
573 1.9 martin
574 1.9 martin if (!usb_lookup(u3g_devs, uaa->vendor, uaa->product))
575 1.9 martin return (UMATCH_NONE);
576 1.9 martin
577 1.9 martin error = usbd_device2interface_handle(uaa->device, uaa->ifaceno, &iface);
578 1.1 joerg if (error) {
579 1.9 martin printf("u3g_match: failed to get interface, err=%s\n",
580 1.9 martin usbd_errstr(error));
581 1.9 martin return (UMATCH_NONE);
582 1.9 martin }
583 1.9 martin
584 1.9 martin id = usbd_get_interface_descriptor(iface);
585 1.9 martin if (id == NULL) {
586 1.9 martin printf("u3g_match: failed to get interface descriptor\n");
587 1.9 martin return (UMATCH_NONE);
588 1.1 joerg }
589 1.1 joerg
590 1.9 martin /*
591 1.9 martin * 3G modems generally report vendor-specific class
592 1.9 martin *
593 1.9 martin * XXX: this may be too generalised.
594 1.9 martin */
595 1.9 martin return ((id->bInterfaceClass == UICLASS_VENDOR) ?
596 1.9 martin UMATCH_VENDOR_PRODUCT : UMATCH_NONE);
597 1.9 martin }
598 1.9 martin
599 1.9 martin static void
600 1.9 martin u3g_attach(device_t parent, device_t self, void *aux)
601 1.9 martin {
602 1.9 martin struct u3g_softc *sc = device_private(self);
603 1.9 martin struct usbif_attach_arg *uaa = aux;
604 1.9 martin usbd_device_handle dev = uaa->device;
605 1.9 martin usbd_interface_handle iface;
606 1.9 martin usb_interface_descriptor_t *id;
607 1.9 martin usb_endpoint_descriptor_t *ed;
608 1.9 martin struct ucom_attach_args uca;
609 1.9 martin usbd_status error;
610 1.9 martin int n, intr_address, intr_size;
611 1.1 joerg
612 1.9 martin aprint_naive("\n");
613 1.9 martin aprint_normal("\n");
614 1.1 joerg
615 1.9 martin sc->sc_dev = self;
616 1.9 martin sc->sc_dying = false;
617 1.9 martin sc->sc_udev = dev;
618 1.2 joerg
619 1.9 martin error = usbd_device2interface_handle(dev, uaa->ifaceno, &iface);
620 1.9 martin if (error) {
621 1.9 martin aprint_error_dev(self, "failed to get interface, err=%s\n",
622 1.9 martin usbd_errstr(error));
623 1.4 christos return;
624 1.4 christos }
625 1.4 christos
626 1.9 martin id = usbd_get_interface_descriptor(iface);
627 1.1 joerg
628 1.9 martin uca.info = "3G Modem";
629 1.9 martin uca.ibufsize = U3G_BUFF_SIZE;
630 1.9 martin uca.obufsize = U3G_BUFF_SIZE;
631 1.9 martin uca.ibufsizepad = U3G_BUFF_SIZE;
632 1.9 martin uca.portno = uaa->ifaceno;
633 1.9 martin uca.opkthdrlen = 0;
634 1.9 martin uca.device = dev;
635 1.9 martin uca.iface = iface;
636 1.9 martin uca.methods = &u3g_methods;
637 1.9 martin uca.arg = sc;
638 1.9 martin uca.bulkin = uca.bulkout = -1;
639 1.9 martin
640 1.9 martin sc->sc_outpins = 0;
641 1.9 martin sc->sc_msr = UMSR_DSR | UMSR_CTS | UMSR_DCD;
642 1.9 martin sc->sc_ifaceno = uaa->ifaceno;
643 1.9 martin sc->sc_open = false;
644 1.9 martin sc->sc_purging = false;
645 1.9 martin
646 1.9 martin intr_address = -1;
647 1.9 martin intr_size = 0;
648 1.9 martin
649 1.9 martin for (n = 0; n < id->bNumEndpoints; n++) {
650 1.9 martin ed = usbd_interface2endpoint_descriptor(iface, n);
651 1.9 martin if (ed == NULL) {
652 1.9 martin aprint_error_dev(self, "no endpoint descriptor "
653 1.9 martin "for %d (interface: %d)\n", n, sc->sc_ifaceno);
654 1.9 martin sc->sc_dying = true;
655 1.1 joerg return;
656 1.1 joerg }
657 1.1 joerg
658 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
659 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
660 1.9 martin intr_address = ed->bEndpointAddress;
661 1.9 martin intr_size = UGETW(ed->wMaxPacketSize);
662 1.9 martin } else
663 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
664 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
665 1.9 martin uca.bulkin = ed->bEndpointAddress;
666 1.9 martin } else
667 1.9 martin if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
668 1.9 martin UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
669 1.9 martin uca.bulkout = ed->bEndpointAddress;
670 1.1 joerg }
671 1.9 martin }
672 1.9 martin
673 1.9 martin if (uca.bulkin == -1) {
674 1.9 martin aprint_error_dev(self, "Missing bulk in for interface %d\n",
675 1.9 martin sc->sc_ifaceno);
676 1.9 martin sc->sc_dying = true;
677 1.9 martin return;
678 1.9 martin }
679 1.1 joerg
680 1.9 martin if (uca.bulkout == -1) {
681 1.9 martin aprint_error_dev(self, "Missing bulk out for interface %d\n",
682 1.9 martin sc->sc_ifaceno);
683 1.9 martin sc->sc_dying = true;
684 1.9 martin return;
685 1.1 joerg }
686 1.1 joerg
687 1.9 martin sc->sc_ucom = config_found_sm_loc(self, "ucombus",
688 1.9 martin NULL, &uca, ucomprint, ucomsubmatch);
689 1.9 martin
690 1.9 martin /*
691 1.9 martin * If the interface has an interrupt pipe, open it immediately so
692 1.9 martin * that we can track input pin state changes regardless of whether
693 1.9 martin * the tty(4) device is open or not.
694 1.9 martin */
695 1.9 martin if (intr_address != -1) {
696 1.9 martin sc->sc_intr_buff = malloc(intr_size, M_USBDEV, M_WAITOK);
697 1.9 martin error = usbd_open_pipe_intr(iface, intr_address,
698 1.9 martin USBD_SHORT_XFER_OK, &sc->sc_intr_pipe, sc, sc->sc_intr_buff,
699 1.9 martin intr_size, u3g_intr, 100);
700 1.1 joerg if (error) {
701 1.9 martin aprint_error_dev(self, "cannot open interrupt pipe "
702 1.9 martin "(addr %d)\n", intr_address);
703 1.1 joerg return;
704 1.1 joerg }
705 1.9 martin } else {
706 1.9 martin sc->sc_intr_pipe = NULL;
707 1.9 martin sc->sc_intr_buff = NULL;
708 1.1 joerg }
709 1.1 joerg
710 1.1 joerg if (!pmf_device_register(self, NULL, NULL))
711 1.1 joerg aprint_error_dev(self, "couldn't establish power handler\n");
712 1.1 joerg }
713 1.1 joerg
714 1.1 joerg static int
715 1.1 joerg u3g_detach(device_t self, int flags)
716 1.1 joerg {
717 1.1 joerg struct u3g_softc *sc = device_private(self);
718 1.9 martin int rv;
719 1.1 joerg
720 1.9 martin if (sc->sc_dying)
721 1.2 joerg return 0;
722 1.2 joerg
723 1.1 joerg pmf_device_deregister(self);
724 1.1 joerg
725 1.9 martin if (sc->sc_ucom != NULL) {
726 1.9 martin rv = config_detach(sc->sc_ucom, flags);
727 1.9 martin if (rv != 0) {
728 1.9 martin aprint_verbose_dev(self, "Can't deallocate "
729 1.9 martin "port (%d)", rv);
730 1.1 joerg }
731 1.1 joerg }
732 1.1 joerg
733 1.1 joerg if (sc->sc_intr_pipe != NULL) {
734 1.9 martin (void) usbd_abort_pipe(sc->sc_intr_pipe);
735 1.9 martin (void) usbd_close_pipe(sc->sc_intr_pipe);
736 1.1 joerg sc->sc_intr_pipe = NULL;
737 1.1 joerg }
738 1.9 martin if (sc->sc_intr_buff != NULL) {
739 1.9 martin free(sc->sc_intr_buff, M_USBDEV);
740 1.9 martin sc->sc_intr_buff = NULL;
741 1.9 martin }
742 1.1 joerg
743 1.9 martin return (0);
744 1.1 joerg }
745 1.1 joerg
746 1.1 joerg static void
747 1.1 joerg u3g_childdet(device_t self, device_t child)
748 1.1 joerg {
749 1.1 joerg struct u3g_softc *sc = device_private(self);
750 1.9 martin
751 1.9 martin if (sc->sc_ucom == child)
752 1.9 martin sc->sc_ucom = NULL;
753 1.9 martin }
754 1.9 martin
755 1.9 martin static int
756 1.9 martin u3g_activate(device_t self, enum devact act)
757 1.9 martin {
758 1.9 martin struct u3g_softc *sc = device_private(self);
759 1.9 martin int rv;
760 1.9 martin
761 1.9 martin switch (act) {
762 1.9 martin case DVACT_DEACTIVATE:
763 1.9 martin if (sc->sc_ucom != NULL && config_deactivate(sc->sc_ucom))
764 1.9 martin rv = -1;
765 1.9 martin else
766 1.9 martin rv = 0;
767 1.9 martin break;
768 1.9 martin
769 1.9 martin default:
770 1.9 martin rv = 0;
771 1.9 martin break;
772 1.9 martin }
773 1.9 martin
774 1.9 martin return (rv);
775 1.9 martin }
776 1.9 martin
777 1.9 martin static void
778 1.9 martin u3g_intr(usbd_xfer_handle xfer, usbd_private_handle priv, usbd_status status)
779 1.9 martin {
780 1.9 martin struct u3g_softc *sc = (struct u3g_softc *)priv;
781 1.9 martin u_char *buf;
782 1.9 martin
783 1.9 martin if (sc->sc_dying)
784 1.9 martin return;
785 1.9 martin
786 1.9 martin if (status != USBD_NORMAL_COMPLETION) {
787 1.9 martin if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
788 1.9 martin return;
789 1.9 martin usbd_clear_endpoint_stall_async(sc->sc_intr_pipe);
790 1.9 martin return;
791 1.9 martin }
792 1.9 martin
793 1.9 martin buf = sc->sc_intr_buff;
794 1.9 martin if (buf[0] == 0xa1 && buf[1] == 0x20) {
795 1.9 martin u_char msr;
796 1.9 martin
797 1.9 martin msr = sc->sc_msr & ~(UMSR_DCD | UMSR_DSR | UMSR_RI);
798 1.9 martin
799 1.9 martin if (buf[8] & U3G_INPIN_DCD)
800 1.9 martin msr |= UMSR_DCD;
801 1.9 martin
802 1.9 martin if (buf[8] & U3G_INPIN_DSR)
803 1.9 martin msr |= UMSR_DSR;
804 1.9 martin
805 1.9 martin if (buf[8] & U3G_INPIN_RI)
806 1.9 martin msr |= UMSR_RI;
807 1.9 martin
808 1.9 martin if (msr != sc->sc_msr) {
809 1.9 martin sc->sc_msr = msr;
810 1.9 martin if (sc->sc_open)
811 1.9 martin ucom_status_change(device_private(sc->sc_ucom));
812 1.9 martin }
813 1.9 martin }
814 1.9 martin }
815 1.9 martin
816 1.9 martin /*ARGSUSED*/
817 1.9 martin static void
818 1.9 martin u3g_get_status(void *arg, int portno, u_char *lsr, u_char *msr)
819 1.9 martin {
820 1.9 martin struct u3g_softc *sc = arg;
821 1.9 martin
822 1.9 martin if (lsr != NULL)
823 1.9 martin *lsr = 0; /* LSR isn't supported */
824 1.9 martin if (msr != NULL)
825 1.9 martin *msr = sc->sc_msr;
826 1.9 martin }
827 1.9 martin
828 1.9 martin /*ARGSUSED*/
829 1.9 martin static void
830 1.9 martin u3g_set(void *arg, int portno, int reg, int onoff)
831 1.9 martin {
832 1.9 martin struct u3g_softc *sc = arg;
833 1.9 martin usb_device_request_t req;
834 1.9 martin uint16_t mask, new_state;
835 1.9 martin usbd_status err;
836 1.9 martin
837 1.9 martin if (sc->sc_dying)
838 1.9 martin return;
839 1.9 martin
840 1.9 martin switch (reg) {
841 1.9 martin case UCOM_SET_DTR:
842 1.9 martin mask = U3G_OUTPIN_DTR;
843 1.9 martin break;
844 1.9 martin case UCOM_SET_RTS:
845 1.9 martin mask = U3G_OUTPIN_RTS;
846 1.9 martin break;
847 1.9 martin default:
848 1.9 martin return;
849 1.9 martin }
850 1.9 martin
851 1.9 martin new_state = sc->sc_outpins & ~mask;
852 1.9 martin if (onoff)
853 1.9 martin new_state |= mask;
854 1.9 martin
855 1.9 martin if (new_state == sc->sc_outpins)
856 1.9 martin return;
857 1.9 martin
858 1.9 martin sc->sc_outpins = new_state;
859 1.9 martin
860 1.9 martin req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
861 1.9 martin req.bRequest = U3G_SET_PIN;
862 1.9 martin USETW(req.wValue, new_state);
863 1.9 martin USETW(req.wIndex, sc->sc_ifaceno);
864 1.9 martin USETW(req.wLength, 0);
865 1.9 martin
866 1.9 martin err = usbd_do_request(sc->sc_udev, &req, 0);
867 1.9 martin if (err == USBD_STALLED)
868 1.9 martin usbd_clear_endpoint_stall(sc->sc_udev->default_pipe);
869 1.9 martin }
870 1.9 martin
871 1.9 martin /*ARGSUSED*/
872 1.9 martin static int
873 1.9 martin u3g_open(void *arg, int portno)
874 1.9 martin {
875 1.9 martin struct u3g_softc *sc = arg;
876 1.9 martin usb_device_request_t req;
877 1.9 martin usb_endpoint_descriptor_t *ed;
878 1.9 martin usb_interface_descriptor_t *id;
879 1.9 martin usbd_interface_handle ih;
880 1.9 martin usbd_status err;
881 1.1 joerg int i;
882 1.1 joerg
883 1.9 martin if (sc->sc_dying)
884 1.9 martin return (0);
885 1.9 martin
886 1.9 martin err = usbd_device2interface_handle(sc->sc_udev, portno, &ih);
887 1.9 martin if (err)
888 1.9 martin return (EIO);
889 1.9 martin
890 1.9 martin id = usbd_get_interface_descriptor(ih);
891 1.9 martin
892 1.9 martin for (i = 0; i < id->bNumEndpoints; i++) {
893 1.9 martin ed = usbd_interface2endpoint_descriptor(ih, i);
894 1.9 martin if (ed == NULL)
895 1.9 martin return (EIO);
896 1.9 martin
897 1.9 martin if (UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
898 1.9 martin /* Issue ENDPOINT_HALT request */
899 1.9 martin req.bmRequestType = UT_WRITE_ENDPOINT;
900 1.9 martin req.bRequest = UR_CLEAR_FEATURE;
901 1.9 martin USETW(req.wValue, UF_ENDPOINT_HALT);
902 1.9 martin USETW(req.wIndex, ed->bEndpointAddress);
903 1.9 martin USETW(req.wLength, 0);
904 1.9 martin err = usbd_do_request(sc->sc_udev, &req, 0);
905 1.9 martin if (err)
906 1.9 martin return (EIO);
907 1.9 martin }
908 1.1 joerg }
909 1.9 martin
910 1.9 martin sc->sc_open = true;
911 1.9 martin sc->sc_purging = true;
912 1.9 martin getmicrotime(&sc->sc_purge_start);
913 1.9 martin
914 1.9 martin return (0);
915 1.1 joerg }
916 1.1 joerg
917 1.9 martin /*ARGSUSED*/
918 1.9 martin static void
919 1.9 martin u3g_close(void *arg, int portno)
920 1.9 martin {
921 1.9 martin struct u3g_softc *sc = arg;
922 1.9 martin
923 1.9 martin sc->sc_open = false;
924 1.9 martin }
925 1.9 martin
926 1.9 martin /*ARGSUSED*/
927 1.9 martin static void
928 1.9 martin u3g_read(void *arg, int portno, u_char **cpp, uint32_t *ccp)
929 1.9 martin {
930 1.9 martin struct u3g_softc *sc = arg;
931 1.9 martin struct timeval curr_tv, diff_tv;
932 1.9 martin
933 1.9 martin /*
934 1.9 martin * If we're not purging input data following first open, do nothing.
935 1.9 martin */
936 1.9 martin if (sc->sc_purging == false)
937 1.9 martin return;
938 1.9 martin
939 1.9 martin /*
940 1.9 martin * Otherwise check if the purge timeout has expired
941 1.9 martin */
942 1.9 martin getmicrotime(&curr_tv);
943 1.9 martin timersub(&curr_tv, &sc->sc_purge_start, &diff_tv);
944 1.9 martin
945 1.9 martin if (diff_tv.tv_sec >= U3G_PURGE_SECS) {
946 1.9 martin /* Timeout expired. */
947 1.9 martin sc->sc_purging = false;
948 1.9 martin } else {
949 1.9 martin /* Still purging. Adjust the caller's byte count. */
950 1.9 martin *ccp = 0;
951 1.9 martin }
952 1.9 martin }
953 1.9 martin
954 1.9 martin /*ARGSUSED*/
955 1.9 martin static void
956 1.9 martin u3g_write(void *arg, int portno, u_char *to, u_char *from, u_int32_t *count)
957 1.9 martin {
958 1.9 martin struct u3g_softc *sc = arg;
959 1.9 martin
960 1.9 martin /*
961 1.9 martin * Stop purging as soon as the first data is written to the device.
962 1.9 martin */
963 1.9 martin sc->sc_purging = false;
964 1.9 martin memcpy(to, from, *count);
965 1.9 martin }
966