uhmodem.c revision 1.18 1 1.18 mrg /* $NetBSD: uhmodem.c,v 1.18 2019/05/04 23:36:14 mrg Exp $ */
2 1.1 ichiro
3 1.1 ichiro /*
4 1.1 ichiro * Copyright (c) 2008 Yojiro UO <yuo (at) nui.org>.
5 1.1 ichiro * All rights reserved.
6 1.1 ichiro *
7 1.1 ichiro * Permission to use, copy, modify, and distribute this software for any
8 1.1 ichiro * purpose with or without fee is hereby granted, provided that the above
9 1.1 ichiro * copyright notice and this permission notice appear in all copies.
10 1.1 ichiro *
11 1.1 ichiro * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
12 1.1 ichiro * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
13 1.1 ichiro * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
14 1.1 ichiro * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
15 1.1 ichiro * WHATSOEVER RESULTING FROM LOSS OF MIND, USE, DATA OR PROFITS, WHETHER IN
16 1.1 ichiro * AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
17 1.1 ichiro * OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
18 1.1 ichiro */
19 1.1 ichiro /*-
20 1.1 ichiro * Copyright (c) 2002, Alexander Kabaev <kan.FreeBSD.org>.
21 1.1 ichiro * All rights reserved.
22 1.1 ichiro *
23 1.1 ichiro * Redistribution and use in source and binary forms, with or without
24 1.1 ichiro * modification, are permitted provided that the following conditions
25 1.1 ichiro * are met:
26 1.1 ichiro * 1. Redistributions of source code must retain the above copyright
27 1.1 ichiro * notice, this list of conditions and the following disclaimer.
28 1.1 ichiro * 2. Redistributions in binary form must reproduce the above copyright
29 1.1 ichiro * notice, this list of conditions and the following disclaimer in the
30 1.1 ichiro * documentation and/or other materials provided with the distribution.
31 1.1 ichiro *
32 1.1 ichiro * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
33 1.1 ichiro * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
34 1.1 ichiro * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
35 1.1 ichiro * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
36 1.1 ichiro * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
37 1.1 ichiro * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
38 1.1 ichiro * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
39 1.1 ichiro * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
40 1.1 ichiro * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
41 1.1 ichiro * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
42 1.1 ichiro * SUCH DAMAGE.
43 1.1 ichiro */
44 1.1 ichiro /*
45 1.1 ichiro * Copyright (c) 2001 The NetBSD Foundation, Inc.
46 1.1 ichiro * All rights reserved.
47 1.1 ichiro *
48 1.1 ichiro * This code is derived from software contributed to The NetBSD Foundation
49 1.1 ichiro * by Ichiro FUKUHARA (ichiro (at) ichiro.org).
50 1.1 ichiro *
51 1.1 ichiro * Redistribution and use in source and binary forms, with or without
52 1.1 ichiro * modification, are permitted provided that the following conditions
53 1.1 ichiro * are met:
54 1.1 ichiro * 1. Redistributions of source code must retain the above copyright
55 1.1 ichiro * notice, this list of conditions and the following disclaimer.
56 1.1 ichiro * 2. Redistributions in binary form must reproduce the above copyright
57 1.1 ichiro * notice, this list of conditions and the following disclaimer in the
58 1.1 ichiro * documentation and/or other materials provided with the distribution.
59 1.1 ichiro *
60 1.1 ichiro * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
61 1.1 ichiro * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
62 1.1 ichiro * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
63 1.1 ichiro * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
64 1.1 ichiro * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
65 1.1 ichiro * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
66 1.1 ichiro * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
67 1.1 ichiro * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
68 1.1 ichiro * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
69 1.1 ichiro * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
70 1.1 ichiro * POSSIBILITY OF SUCH DAMAGE.
71 1.1 ichiro */
72 1.1 ichiro
73 1.1 ichiro #include <sys/cdefs.h>
74 1.18 mrg __KERNEL_RCSID(0, "$NetBSD: uhmodem.c,v 1.18 2019/05/04 23:36:14 mrg Exp $");
75 1.15 skrll
76 1.15 skrll #ifdef _KERNEL_OPT
77 1.15 skrll #include "opt_usb.h"
78 1.15 skrll #endif
79 1.1 ichiro
80 1.1 ichiro #include <sys/param.h>
81 1.1 ichiro #include <sys/systm.h>
82 1.1 ichiro #include <sys/kernel.h>
83 1.14 skrll #include <sys/kmem.h>
84 1.1 ichiro #include <sys/ioccom.h>
85 1.1 ichiro #include <sys/fcntl.h>
86 1.1 ichiro #include <sys/conf.h>
87 1.1 ichiro #include <sys/tty.h>
88 1.1 ichiro #include <sys/file.h>
89 1.1 ichiro #include <sys/select.h>
90 1.1 ichiro #include <sys/proc.h>
91 1.1 ichiro #include <sys/device.h>
92 1.1 ichiro #include <sys/poll.h>
93 1.1 ichiro #include <sys/sysctl.h>
94 1.1 ichiro #include <sys/bus.h>
95 1.1 ichiro
96 1.1 ichiro #include <dev/usb/usb.h>
97 1.1 ichiro #include <dev/usb/usbdi.h>
98 1.1 ichiro #include <dev/usb/usbdi_util.h>
99 1.1 ichiro #include <dev/usb/usbdivar.h>
100 1.1 ichiro
101 1.1 ichiro #include <dev/usb/usbcdc.h>
102 1.1 ichiro #include <dev/usb/usbdevs.h>
103 1.1 ichiro #include <dev/usb/usb_quirks.h>
104 1.1 ichiro #include <dev/usb/ucomvar.h>
105 1.1 ichiro #include <dev/usb/ubsavar.h>
106 1.1 ichiro
107 1.2 ichiro /* vendor specific bRequest */
108 1.2 ichiro #define UHMODEM_REGWRITE 0x20
109 1.2 ichiro #define UHMODEM_REGREAD 0x21
110 1.2 ichiro #define UHMODEM_SETUP 0x22
111 1.1 ichiro
112 1.1 ichiro #define UHMODEMIBUFSIZE 4096
113 1.1 ichiro #define UHMODEMOBUFSIZE 4096
114 1.1 ichiro
115 1.1 ichiro #ifdef UHMODEM_DEBUG
116 1.17 mrg static int uhmodemdebug = 0;
117 1.1 ichiro #define DPRINTFN(n, x) do { \
118 1.1 ichiro if (uhmodemdebug > (n)) \
119 1.10 dyoung printf x; \
120 1.1 ichiro } while (0)
121 1.1 ichiro #else
122 1.1 ichiro #define DPRINTFN(n, x)
123 1.1 ichiro #endif
124 1.1 ichiro #define DPRINTF(x) DPRINTFN(0, x)
125 1.1 ichiro
126 1.17 mrg static int uhmodem_open(void *, int);
127 1.17 mrg static usbd_status e220_modechange_request(struct usbd_device *);
128 1.17 mrg static usbd_status uhmodem_endpointhalt(struct ubsa_softc *, int);
129 1.17 mrg static usbd_status uhmodem_regwrite(struct usbd_device *, uint8_t *, size_t);
130 1.17 mrg static usbd_status uhmodem_regread(struct usbd_device *, uint8_t *, size_t);
131 1.17 mrg static usbd_status a2502_init(struct usbd_device *);
132 1.1 ichiro #if 0
133 1.17 mrg static usbd_status uhmodem_regsetup(struct usbd_device *, uint16_t);
134 1.17 mrg static usbd_status e220_init(struct usbd_device *);
135 1.1 ichiro #endif
136 1.1 ichiro
137 1.17 mrg /* this driver uses the ubsa_softc and methods directly as-is. */
138 1.1 ichiro struct ucom_methods uhmodem_methods = {
139 1.14 skrll .ucom_get_status = ubsa_get_status,
140 1.14 skrll .ucom_set = ubsa_set,
141 1.14 skrll .ucom_param = ubsa_param,
142 1.14 skrll .ucom_open = uhmodem_open,
143 1.14 skrll .ucom_close = ubsa_close,
144 1.1 ichiro };
145 1.1 ichiro
146 1.2 ichiro struct uhmodem_type {
147 1.2 ichiro struct usb_devno uhmodem_dev;
148 1.14 skrll uint16_t uhmodem_coms; /* number of serial interfaces on the device */
149 1.14 skrll uint16_t uhmodem_flags;
150 1.2 ichiro #define E220 0x0001
151 1.2 ichiro #define A2502 0x0002
152 1.4 ichiro #define E620 0x0004 /* XXX */
153 1.4 ichiro /* Whether or not it is a device different from E220 is not clear. */
154 1.2 ichiro };
155 1.2 ichiro
156 1.17 mrg static const struct uhmodem_type uhmodem_devs[] = {
157 1.1 ichiro /* HUAWEI E220 / Emobile D0[12]HW */
158 1.2 ichiro {{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E220 }, 2, E220},
159 1.2 ichiro /* ANYDATA / NTT DoCoMo A2502 */
160 1.2 ichiro {{ USB_VENDOR_ANYDATA, USB_PRODUCT_ANYDATA_A2502 }, 3, A2502},
161 1.4 ichiro /* HUAWEI E620 */
162 1.4 ichiro {{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_MOBILE }, 3, E620},
163 1.1 ichiro };
164 1.2 ichiro #define uhmodem_lookup(v, p) ((const struct uhmodem_type *)usb_lookup(uhmodem_devs, v, p))
165 1.1 ichiro
166 1.17 mrg static int uhmodem_match(device_t, cfdata_t, void *);
167 1.17 mrg static void uhmodem_attach(device_t, device_t, void *);
168 1.17 mrg static void uhmodem_childdet(device_t, device_t);
169 1.17 mrg static int uhmodem_detach(device_t, int);
170 1.17 mrg static int uhmodem_activate(device_t, enum devact);
171 1.17 mrg
172 1.17 mrg CFATTACH_DECL2_NEW(uhmodem, sizeof(struct ubsa_softc), uhmodem_match,
173 1.3 dyoung uhmodem_attach, uhmodem_detach, uhmodem_activate, NULL, uhmodem_childdet);
174 1.1 ichiro
175 1.17 mrg static int
176 1.10 dyoung uhmodem_match(device_t parent, cfdata_t match, void *aux)
177 1.1 ichiro {
178 1.14 skrll struct usbif_attach_arg *uiaa = aux;
179 1.1 ichiro
180 1.14 skrll if (uhmodem_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product) != NULL)
181 1.1 ichiro /* XXX interface# 0,1 provide modem function, but this driver
182 1.1 ichiro handles all modem in single device. */
183 1.14 skrll if (uiaa->uiaa_ifaceno == 0)
184 1.14 skrll return UMATCH_VENDOR_PRODUCT;
185 1.14 skrll return UMATCH_NONE;
186 1.1 ichiro }
187 1.1 ichiro
188 1.17 mrg static void
189 1.10 dyoung uhmodem_attach(device_t parent, device_t self, void *aux)
190 1.1 ichiro {
191 1.17 mrg struct ubsa_softc *sc = device_private(self);
192 1.14 skrll struct usbif_attach_arg *uiaa = aux;
193 1.14 skrll struct usbd_device *dev = uiaa->uiaa_device;
194 1.1 ichiro usb_config_descriptor_t *cdesc;
195 1.1 ichiro usb_interface_descriptor_t *id;
196 1.1 ichiro usb_endpoint_descriptor_t *ed;
197 1.1 ichiro char *devinfop;
198 1.1 ichiro usbd_status err;
199 1.14 skrll struct ucom_attach_args ucaa;
200 1.1 ichiro int i;
201 1.1 ichiro int j;
202 1.1 ichiro char comname[16];
203 1.1 ichiro
204 1.8 plunky aprint_naive("\n");
205 1.8 plunky aprint_normal("\n");
206 1.8 plunky
207 1.1 ichiro devinfop = usbd_devinfo_alloc(dev, 0);
208 1.7 cube aprint_normal_dev(self, "%s\n", devinfop);
209 1.1 ichiro usbd_devinfo_free(devinfop);
210 1.1 ichiro
211 1.17 mrg sc->sc_dev = self;
212 1.17 mrg sc->sc_udev = dev;
213 1.17 mrg sc->sc_config_index = UBSA_DEFAULT_CONFIG_INDEX;
214 1.17 mrg sc->sc_numif = 1; /* defaut device has one interface */
215 1.1 ichiro
216 1.1 ichiro /* Hauwei E220 need special request to change its mode to modem */
217 1.14 skrll if ((uiaa->uiaa_ifaceno == 0) && (uiaa->uiaa_class != 255)) {
218 1.1 ichiro err = e220_modechange_request(dev);
219 1.1 ichiro if (err) {
220 1.14 skrll aprint_error_dev(self, "failed to change mode: %s\n",
221 1.7 cube usbd_errstr(err));
222 1.17 mrg sc->sc_dying = 1;
223 1.1 ichiro goto error;
224 1.1 ichiro }
225 1.7 cube aprint_error_dev(self,
226 1.7 cube "mass storage only mode, reattach to enable modem\n");
227 1.17 mrg sc->sc_dying = 1;
228 1.1 ichiro goto error;
229 1.1 ichiro }
230 1.1 ichiro
231 1.1 ichiro /*
232 1.1 ichiro * initialize rts, dtr variables to something
233 1.1 ichiro * different from boolean 0, 1
234 1.1 ichiro */
235 1.17 mrg sc->sc_dtr = -1;
236 1.17 mrg sc->sc_rts = -1;
237 1.1 ichiro
238 1.17 mrg sc->sc_quadumts = 1;
239 1.17 mrg sc->sc_config_index = 0;
240 1.17 mrg sc->sc_numif = uhmodem_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product)->uhmodem_coms;
241 1.17 mrg sc->sc_devflags = uhmodem_lookup(uiaa->uiaa_vendor, uiaa->uiaa_product)->uhmodem_flags;
242 1.1 ichiro
243 1.1 ichiro DPRINTF(("uhmodem attach: sc = %p\n", sc));
244 1.1 ichiro
245 1.1 ichiro /* Move the device into the configured state. */
246 1.17 mrg err = usbd_set_config_index(dev, sc->sc_config_index, 1);
247 1.1 ichiro if (err) {
248 1.7 cube aprint_error_dev(self, "failed to set configuration: %s\n",
249 1.7 cube usbd_errstr(err));
250 1.17 mrg sc->sc_dying = 1;
251 1.1 ichiro goto error;
252 1.1 ichiro }
253 1.1 ichiro
254 1.1 ichiro /* get the config descriptor */
255 1.17 mrg cdesc = usbd_get_config_descriptor(sc->sc_udev);
256 1.1 ichiro if (cdesc == NULL) {
257 1.7 cube aprint_error_dev(self,
258 1.7 cube "failed to get configuration descriptor\n");
259 1.17 mrg sc->sc_dying = 1;
260 1.1 ichiro goto error;
261 1.1 ichiro }
262 1.1 ichiro
263 1.17 mrg sc->sc_intr_number = -1;
264 1.17 mrg sc->sc_intr_pipe = NULL;
265 1.1 ichiro
266 1.1 ichiro /* get the interfaces */
267 1.17 mrg for (i = 0; i < sc->sc_numif; i++) {
268 1.1 ichiro err = usbd_device2interface_handle(dev, UBSA_IFACE_INDEX_OFFSET+i,
269 1.17 mrg &sc->sc_iface[i]);
270 1.1 ichiro if (err) {
271 1.1 ichiro if (i == 0){
272 1.1 ichiro /* can not get main interface */
273 1.17 mrg sc->sc_dying = 1;
274 1.1 ichiro goto error;
275 1.1 ichiro } else
276 1.1 ichiro break;
277 1.1 ichiro }
278 1.1 ichiro
279 1.1 ichiro /* Find the endpoints */
280 1.17 mrg id = usbd_get_interface_descriptor(sc->sc_iface[i]);
281 1.17 mrg sc->sc_iface_number[i] = id->bInterfaceNumber;
282 1.1 ichiro
283 1.1 ichiro /* initialize endpoints */
284 1.14 skrll ucaa.ucaa_bulkin = ucaa.ucaa_bulkout = -1;
285 1.1 ichiro
286 1.1 ichiro for (j = 0; j < id->bNumEndpoints; j++) {
287 1.1 ichiro ed = usbd_interface2endpoint_descriptor(
288 1.17 mrg sc->sc_iface[i], j);
289 1.1 ichiro if (ed == NULL) {
290 1.7 cube aprint_error_dev(self,
291 1.7 cube "no endpoint descriptor for %d "
292 1.7 cube "(interface: %d)\n", j, i);
293 1.1 ichiro break;
294 1.1 ichiro }
295 1.1 ichiro
296 1.1 ichiro if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
297 1.1 ichiro UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
298 1.17 mrg sc->sc_intr_number = ed->bEndpointAddress;
299 1.17 mrg sc->sc_isize = UGETW(ed->wMaxPacketSize);
300 1.1 ichiro } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
301 1.1 ichiro UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
302 1.14 skrll ucaa.ucaa_bulkin = ed->bEndpointAddress;
303 1.1 ichiro } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
304 1.1 ichiro UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
305 1.14 skrll ucaa.ucaa_bulkout = ed->bEndpointAddress;
306 1.1 ichiro }
307 1.1 ichiro } /* end of Endpoint loop */
308 1.1 ichiro
309 1.17 mrg if (sc->sc_intr_number == -1) {
310 1.7 cube aprint_error_dev(self, "HUAWEI E220 need to re-attach "
311 1.7 cube "to enable modem function\n");
312 1.1 ichiro if (i == 0) {
313 1.1 ichiro /* could not get intr for main tty */
314 1.17 mrg sc->sc_dying = 1;
315 1.1 ichiro goto error;
316 1.1 ichiro } else
317 1.1 ichiro break;
318 1.1 ichiro }
319 1.14 skrll if (ucaa.ucaa_bulkin == -1) {
320 1.7 cube aprint_error_dev(self,
321 1.7 cube "Could not find data bulk in\n");
322 1.17 mrg sc->sc_dying = 1;
323 1.1 ichiro goto error;
324 1.1 ichiro }
325 1.1 ichiro
326 1.14 skrll if (ucaa.ucaa_bulkout == -1) {
327 1.7 cube aprint_error_dev(self,
328 1.7 cube "Could not find data bulk out\n");
329 1.17 mrg sc->sc_dying = 1;
330 1.1 ichiro goto error;
331 1.1 ichiro }
332 1.1 ichiro
333 1.1 ichiro switch (i) {
334 1.1 ichiro case 0:
335 1.5 cegger snprintf(comname, sizeof(comname), "modem");
336 1.1 ichiro break;
337 1.1 ichiro case 1:
338 1.5 cegger snprintf(comname, sizeof(comname), "alt#1");
339 1.1 ichiro break;
340 1.1 ichiro case 2:
341 1.5 cegger snprintf(comname, sizeof(comname), "alt#2");
342 1.1 ichiro break;
343 1.1 ichiro default:
344 1.5 cegger snprintf(comname, sizeof(comname), "int#%d", i);
345 1.5 cegger break;
346 1.1 ichiro }
347 1.1 ichiro
348 1.14 skrll ucaa.ucaa_portno = i;
349 1.14 skrll /* ucaa_bulkin, ucaa_bulkout set above */
350 1.14 skrll ucaa.ucaa_ibufsize = UHMODEMIBUFSIZE;
351 1.14 skrll ucaa.ucaa_obufsize = UHMODEMOBUFSIZE;
352 1.14 skrll ucaa.ucaa_ibufsizepad = UHMODEMIBUFSIZE;
353 1.14 skrll ucaa.ucaa_opkthdrlen = 0;
354 1.14 skrll ucaa.ucaa_device = dev;
355 1.17 mrg ucaa.ucaa_iface = sc->sc_iface[i];
356 1.14 skrll ucaa.ucaa_methods = &uhmodem_methods;
357 1.18 mrg ucaa.ucaa_arg = sc;
358 1.14 skrll ucaa.ucaa_info = comname;
359 1.1 ichiro DPRINTF(("uhmodem: int#=%d, in = 0x%x, out = 0x%x, intr = 0x%x\n",
360 1.14 skrll i, ucaa.ucaa_bulkin, ucaa.ucaa_bulkout,
361 1.17 mrg sc->sc_intr_number));
362 1.17 mrg sc->sc_subdevs[i] = config_found_sm_loc(self, "ucombus", NULL,
363 1.14 skrll &ucaa, ucomprint, ucomsubmatch);
364 1.2 ichiro
365 1.2 ichiro /* issue endpoint halt to each interface */
366 1.18 mrg err = uhmodem_endpointhalt(sc, i);
367 1.14 skrll if (err)
368 1.7 cube aprint_error("%s: endpointhalt fail\n", __func__);
369 1.2 ichiro else
370 1.17 mrg usbd_delay_ms(sc->sc_udev, 50);
371 1.1 ichiro } /* end of Interface loop */
372 1.1 ichiro
373 1.17 mrg usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
374 1.17 mrg sc->sc_dev);
375 1.1 ichiro
376 1.10 dyoung return;
377 1.1 ichiro
378 1.1 ichiro error:
379 1.10 dyoung return;
380 1.1 ichiro }
381 1.1 ichiro
382 1.17 mrg static void
383 1.3 dyoung uhmodem_childdet(device_t self, device_t child)
384 1.3 dyoung {
385 1.3 dyoung int i;
386 1.17 mrg struct ubsa_softc *sc = device_private(self);
387 1.3 dyoung
388 1.17 mrg for (i = 0; i < sc->sc_numif; i++) {
389 1.17 mrg if (sc->sc_subdevs[i] == child)
390 1.3 dyoung break;
391 1.3 dyoung }
392 1.17 mrg KASSERT(i < sc->sc_numif);
393 1.17 mrg sc->sc_subdevs[i] = NULL;
394 1.3 dyoung }
395 1.3 dyoung
396 1.17 mrg static int
397 1.10 dyoung uhmodem_detach(device_t self, int flags)
398 1.1 ichiro {
399 1.17 mrg struct ubsa_softc *sc = device_private(self);
400 1.1 ichiro int i;
401 1.1 ichiro int rv = 0;
402 1.1 ichiro
403 1.1 ichiro DPRINTF(("uhmodem_detach: sc = %p\n", sc));
404 1.1 ichiro
405 1.17 mrg if (sc->sc_intr_pipe != NULL) {
406 1.17 mrg usbd_abort_pipe(sc->sc_intr_pipe);
407 1.17 mrg usbd_close_pipe(sc->sc_intr_pipe);
408 1.17 mrg kmem_free(sc->sc_intr_buf, sc->sc_isize);
409 1.17 mrg sc->sc_intr_pipe = NULL;
410 1.1 ichiro }
411 1.1 ichiro
412 1.17 mrg sc->sc_dying = 1;
413 1.17 mrg for (i = 0; i < sc->sc_numif; i++) {
414 1.17 mrg if (sc->sc_subdevs[i] != NULL)
415 1.17 mrg rv |= config_detach(sc->sc_subdevs[i], flags);
416 1.1 ichiro }
417 1.1 ichiro
418 1.17 mrg usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
419 1.17 mrg sc->sc_dev);
420 1.1 ichiro
421 1.14 skrll return rv;
422 1.1 ichiro }
423 1.1 ichiro
424 1.17 mrg static int
425 1.3 dyoung uhmodem_activate(device_t self, enum devact act)
426 1.1 ichiro {
427 1.17 mrg struct ubsa_softc *sc = device_private(self);
428 1.1 ichiro
429 1.1 ichiro switch (act) {
430 1.1 ichiro case DVACT_DEACTIVATE:
431 1.17 mrg sc->sc_dying = 1;
432 1.9 dyoung return 0;
433 1.9 dyoung default:
434 1.9 dyoung return EOPNOTSUPP;
435 1.1 ichiro }
436 1.1 ichiro }
437 1.1 ichiro
438 1.17 mrg static int
439 1.1 ichiro uhmodem_open(void *addr, int portno)
440 1.1 ichiro {
441 1.1 ichiro struct ubsa_softc *sc = addr;
442 1.1 ichiro usbd_status err;
443 1.1 ichiro
444 1.1 ichiro if (sc->sc_dying)
445 1.14 skrll return ENXIO;
446 1.1 ichiro
447 1.1 ichiro DPRINTF(("%s: sc = %p\n", __func__, sc));
448 1.1 ichiro
449 1.2 ichiro err = uhmodem_endpointhalt(sc, 0);
450 1.14 skrll if (err)
451 1.7 cube aprint_error("%s: endpointhalt fail\n", __func__);
452 1.1 ichiro else
453 1.1 ichiro usbd_delay_ms(sc->sc_udev, 50);
454 1.2 ichiro
455 1.2 ichiro if (sc->sc_devflags & A2502) {
456 1.2 ichiro err = a2502_init(sc->sc_udev);
457 1.2 ichiro if (err)
458 1.7 cube aprint_error("%s: a2502init fail\n", __func__);
459 1.2 ichiro else
460 1.2 ichiro usbd_delay_ms(sc->sc_udev, 50);
461 1.2 ichiro }
462 1.2 ichiro #if 0 /* currently disabled */
463 1.2 ichiro if (sc->sc_devflags & E220) {
464 1.2 ichiro err = e220_init(sc->sc_udev);
465 1.2 ichiro if (err)
466 1.7 cube aprint_error("%s: e220init fail\n", __func__);
467 1.2 ichiro else
468 1.2 ichiro usbd_delay_ms(sc->sc_udev, 50);
469 1.2 ichiro }
470 1.1 ichiro #endif
471 1.1 ichiro if (sc->sc_intr_number != -1 && sc->sc_intr_pipe == NULL) {
472 1.14 skrll sc->sc_intr_buf = kmem_alloc(sc->sc_isize, KM_SLEEP);
473 1.1 ichiro /* XXX only iface# = 0 has intr line */
474 1.1 ichiro /* XXX E220 specific? need to check */
475 1.1 ichiro err = usbd_open_pipe_intr(sc->sc_iface[0],
476 1.1 ichiro sc->sc_intr_number,
477 1.1 ichiro USBD_SHORT_XFER_OK,
478 1.1 ichiro &sc->sc_intr_pipe,
479 1.1 ichiro sc,
480 1.1 ichiro sc->sc_intr_buf,
481 1.1 ichiro sc->sc_isize,
482 1.1 ichiro ubsa_intr,
483 1.1 ichiro UBSA_INTR_INTERVAL);
484 1.1 ichiro if (err) {
485 1.7 cube aprint_error_dev(sc->sc_dev,
486 1.7 cube "cannot open interrupt pipe (addr %d)\n",
487 1.1 ichiro sc->sc_intr_number);
488 1.14 skrll return EIO;
489 1.1 ichiro }
490 1.1 ichiro }
491 1.1 ichiro
492 1.14 skrll return 0;
493 1.1 ichiro }
494 1.1 ichiro
495 1.1 ichiro /*
496 1.1 ichiro * Hauwei E220 needs special request to enable modem function.
497 1.1 ichiro * -- DEVICE_REMOTE_WAKEUP ruquest to endpoint 2.
498 1.1 ichiro */
499 1.17 mrg static usbd_status
500 1.14 skrll e220_modechange_request(struct usbd_device *dev)
501 1.1 ichiro {
502 1.1 ichiro #define E220_MODE_CHANGE_REQUEST 0x2
503 1.1 ichiro usb_device_request_t req;
504 1.1 ichiro usbd_status err;
505 1.1 ichiro
506 1.1 ichiro req.bmRequestType = UT_WRITE_DEVICE;
507 1.1 ichiro req.bRequest = UR_SET_FEATURE;
508 1.1 ichiro USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
509 1.1 ichiro USETW(req.wIndex, E220_MODE_CHANGE_REQUEST);
510 1.1 ichiro USETW(req.wLength, 0);
511 1.1 ichiro
512 1.1 ichiro DPRINTF(("%s: send e220 mode change request\n", __func__));
513 1.1 ichiro err = usbd_do_request(dev, &req, 0);
514 1.1 ichiro if (err) {
515 1.1 ichiro DPRINTF(("%s: E220 mode change fail\n", __func__));
516 1.14 skrll return EIO;
517 1.1 ichiro }
518 1.1 ichiro
519 1.14 skrll return 0;
520 1.1 ichiro #undef E220_MODE_CHANGE_REQUEST
521 1.1 ichiro }
522 1.1 ichiro
523 1.17 mrg static usbd_status
524 1.2 ichiro uhmodem_endpointhalt(struct ubsa_softc *sc, int iface)
525 1.2 ichiro {
526 1.2 ichiro usb_device_request_t req;
527 1.2 ichiro usb_endpoint_descriptor_t *ed;
528 1.2 ichiro usb_interface_descriptor_t *id;
529 1.2 ichiro usbd_status err;
530 1.2 ichiro int i;
531 1.2 ichiro
532 1.2 ichiro /* Find the endpoints */
533 1.2 ichiro id = usbd_get_interface_descriptor(sc->sc_iface[iface]);
534 1.2 ichiro
535 1.2 ichiro for (i = 0; i < id->bNumEndpoints; i++) {
536 1.2 ichiro ed = usbd_interface2endpoint_descriptor(sc->sc_iface[iface], i);
537 1.14 skrll if (ed == NULL)
538 1.14 skrll return EIO;
539 1.2 ichiro
540 1.2 ichiro if (UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
541 1.2 ichiro /* issue ENDPOINT_HALT request */
542 1.2 ichiro req.bmRequestType = UT_WRITE_ENDPOINT;
543 1.2 ichiro req.bRequest = UR_CLEAR_FEATURE;
544 1.2 ichiro USETW(req.wValue, UF_ENDPOINT_HALT);
545 1.2 ichiro USETW(req.wIndex, ed->bEndpointAddress);
546 1.2 ichiro USETW(req.wLength, 0);
547 1.2 ichiro err = usbd_do_request(sc->sc_udev, &req, 0);
548 1.2 ichiro if (err) {
549 1.14 skrll DPRINTF(("%s: ENDPOINT_HALT to EP:%d fail\n",
550 1.2 ichiro __func__, ed->bEndpointAddress));
551 1.14 skrll return EIO;
552 1.2 ichiro }
553 1.2 ichiro
554 1.2 ichiro }
555 1.2 ichiro } /* end of Endpoint loop */
556 1.2 ichiro
557 1.14 skrll return 0;
558 1.2 ichiro }
559 1.2 ichiro
560 1.17 mrg static usbd_status
561 1.14 skrll uhmodem_regwrite(struct usbd_device *dev, uint8_t *data, size_t len)
562 1.2 ichiro {
563 1.2 ichiro usb_device_request_t req;
564 1.2 ichiro usbd_status err;
565 1.2 ichiro
566 1.2 ichiro req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
567 1.2 ichiro req.bRequest = UHMODEM_REGWRITE;
568 1.2 ichiro USETW(req.wValue, 0x0000);
569 1.2 ichiro USETW(req.wIndex, 0x0000);
570 1.2 ichiro USETW(req.wLength, len);
571 1.2 ichiro err = usbd_do_request(dev, &req, data);
572 1.14 skrll if (err)
573 1.2 ichiro return err;
574 1.2 ichiro
575 1.2 ichiro return 0;
576 1.2 ichiro }
577 1.2 ichiro
578 1.17 mrg static usbd_status
579 1.14 skrll uhmodem_regread(struct usbd_device *dev, uint8_t *data, size_t len)
580 1.2 ichiro {
581 1.2 ichiro usb_device_request_t req;
582 1.2 ichiro usbd_status err;
583 1.2 ichiro
584 1.2 ichiro req.bmRequestType = UT_READ_CLASS_INTERFACE;
585 1.2 ichiro req.bRequest = UHMODEM_REGREAD;
586 1.2 ichiro USETW(req.wValue, 0x0000);
587 1.2 ichiro USETW(req.wIndex, 0x0000);
588 1.2 ichiro USETW(req.wLength, len);
589 1.2 ichiro err = usbd_do_request(dev, &req, data);
590 1.2 ichiro
591 1.2 ichiro if (err)
592 1.2 ichiro return err;
593 1.2 ichiro
594 1.2 ichiro return 0;
595 1.2 ichiro }
596 1.2 ichiro
597 1.2 ichiro #if 0
598 1.17 mrg static usbd_status
599 1.14 skrll uhmodem_regsetup(struct usbd_device *dev, uint16_t cmd)
600 1.1 ichiro {
601 1.1 ichiro usb_device_request_t req;
602 1.1 ichiro usbd_status err;
603 1.1 ichiro
604 1.2 ichiro req.bmRequestType = UT_READ_CLASS_INTERFACE;
605 1.2 ichiro req.bRequest = UHMODEM_SETUP;
606 1.2 ichiro USETW(req.wValue, cmd);
607 1.2 ichiro USETW(req.wIndex, 0x0000);
608 1.1 ichiro USETW(req.wLength, 0);
609 1.1 ichiro err = usbd_do_request(dev, &req, 0);
610 1.2 ichiro
611 1.2 ichiro if (err)
612 1.2 ichiro return err;
613 1.2 ichiro
614 1.2 ichiro return 0;
615 1.2 ichiro }
616 1.2 ichiro #endif
617 1.2 ichiro
618 1.17 mrg static usbd_status
619 1.14 skrll a2502_init(struct usbd_device *dev)
620 1.2 ichiro {
621 1.2 ichiro uint8_t data[8];
622 1.2 ichiro static uint8_t init_cmd[] = {0x00, 0xE1, 0x00, 0x00, 0x00, 0x00, 0x08};
623 1.2 ichiro #ifdef UHMODEM_DEBUG
624 1.2 ichiro int i;
625 1.2 ichiro #endif
626 1.2 ichiro if (uhmodem_regread(dev, data, 7)) {
627 1.2 ichiro DPRINTF(("%s: read fail\n", __func__));
628 1.2 ichiro return EIO;
629 1.1 ichiro }
630 1.2 ichiro #ifdef UHMODEM_DEBUG
631 1.2 ichiro printf("%s: readdata: ", __func__);
632 1.2 ichiro for (i = 0; i < 7; i++)
633 1.2 ichiro printf("0x%x ", data[i]);
634 1.2 ichiro #endif
635 1.2 ichiro if (uhmodem_regwrite(dev, init_cmd, sizeof(init_cmd)) ) {
636 1.2 ichiro DPRINTF(("%s: write fail\n", __func__));
637 1.2 ichiro return EIO;
638 1.1 ichiro }
639 1.1 ichiro
640 1.14 skrll if (uhmodem_regread(dev, data, 7)) {
641 1.2 ichiro DPRINTF(("%s: read fail\n", __func__));
642 1.2 ichiro return EIO;
643 1.2 ichiro }
644 1.2 ichiro #ifdef UHMODEM_DEBUG
645 1.2 ichiro printf("%s: readdata: ", __func__);
646 1.2 ichiro printf(" => ");
647 1.2 ichiro for (i = 0; i < 7; i++)
648 1.2 ichiro printf("0x%x ", data[i]);
649 1.2 ichiro printf("\n");
650 1.2 ichiro #endif
651 1.2 ichiro return 0;
652 1.1 ichiro }
653 1.1 ichiro
654 1.2 ichiro
655 1.1 ichiro #if 0
656 1.14 skrll /*
657 1.1 ichiro * Windows device driver send these sequens of USB requests.
658 1.1 ichiro * However currently I can't understand what the messege is,
659 1.1 ichiro * disable this code when I get more information about it.
660 1.14 skrll */
661 1.17 mrg static usbd_status
662 1.14 skrll e220_init(struct usbd_device *dev)
663 1.1 ichiro {
664 1.1 ichiro uint8_t data[8];
665 1.1 ichiro usb_device_request_t req;
666 1.1 ichiro int i;
667 1.1 ichiro
668 1.2 ichiro /* vendor specific unknown request */
669 1.1 ichiro req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
670 1.1 ichiro req.bRequest = 0x02;
671 1.1 ichiro USETW(req.wValue, 0x0001);
672 1.1 ichiro USETW(req.wIndex, 0x0000);
673 1.1 ichiro USETW(req.wLength, 2);
674 1.1 ichiro data[0] = 0x0;
675 1.1 ichiro data[1] = 0x0;
676 1.2 ichiro if (usbd_do_request(dev, &req, data))
677 1.1 ichiro goto error;
678 1.1 ichiro
679 1.1 ichiro /* vendor specific unknown sequence */
680 1.14 skrll if(uhmodem_regsetup(dev, 0x1))
681 1.1 ichiro goto error;
682 1.1 ichiro
683 1.2 ichiro if (uhmodem_regread(dev, data, 7))
684 1.1 ichiro goto error;
685 1.1 ichiro
686 1.1 ichiro data[1] = 0x8;
687 1.1 ichiro data[2] = 0x7;
688 1.2 ichiro if (uhmodem_regwrite(dev, data, sizeof(data)) )
689 1.1 ichiro goto error;
690 1.1 ichiro
691 1.2 ichiro if (uhmodem_regread(dev, data, 7))
692 1.1 ichiro goto error;
693 1.2 ichiro /* XXX should verify the read data ? */
694 1.1 ichiro
695 1.2 ichiro if (uhmodem_regsetup(dev, 0x3))
696 1.1 ichiro goto error;
697 1.1 ichiro
698 1.14 skrll return 0;
699 1.1 ichiro error:
700 1.2 ichiro DPRINTF(("%s: E220 init request fail\n", __func__));
701 1.14 skrll return EIO;
702 1.1 ichiro }
703 1.1 ichiro #endif
704 1.1 ichiro
705