usb_subr.c revision 1.182 1 1.182 mrg /* $NetBSD: usb_subr.c,v 1.182 2012/06/10 06:15:54 mrg Exp $ */
2 1.56 augustss /* $FreeBSD: src/sys/dev/usb/usb_subr.c,v 1.18 1999/11/17 22:33:47 n_hibma Exp $ */
3 1.1 augustss
4 1.1 augustss /*
5 1.121 mycroft * Copyright (c) 1998, 2004 The NetBSD Foundation, Inc.
6 1.1 augustss * All rights reserved.
7 1.1 augustss *
8 1.9 augustss * This code is derived from software contributed to The NetBSD Foundation
9 1.76 augustss * by Lennart Augustsson (lennart (at) augustsson.net) at
10 1.9 augustss * Carlstedt Research & Technology.
11 1.1 augustss *
12 1.1 augustss * Redistribution and use in source and binary forms, with or without
13 1.1 augustss * modification, are permitted provided that the following conditions
14 1.1 augustss * are met:
15 1.1 augustss * 1. Redistributions of source code must retain the above copyright
16 1.1 augustss * notice, this list of conditions and the following disclaimer.
17 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 augustss * notice, this list of conditions and the following disclaimer in the
19 1.1 augustss * documentation and/or other materials provided with the distribution.
20 1.1 augustss *
21 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
32 1.1 augustss */
33 1.91 lukem
34 1.91 lukem #include <sys/cdefs.h>
35 1.182 mrg __KERNEL_RCSID(0, "$NetBSD: usb_subr.c,v 1.182 2012/06/10 06:15:54 mrg Exp $");
36 1.104 martin
37 1.140 pavel #include "opt_compat_netbsd.h"
38 1.104 martin #include "opt_usbverbose.h"
39 1.181 martin #include "opt_usb.h"
40 1.1 augustss
41 1.1 augustss #include <sys/param.h>
42 1.1 augustss #include <sys/systm.h>
43 1.1 augustss #include <sys/kernel.h>
44 1.1 augustss #include <sys/malloc.h>
45 1.1 augustss #include <sys/device.h>
46 1.56 augustss #include <sys/select.h>
47 1.1 augustss #include <sys/proc.h>
48 1.46 augustss
49 1.149 ad #include <sys/bus.h>
50 1.169 pgoyette #include <sys/module.h>
51 1.1 augustss
52 1.1 augustss #include <dev/usb/usb.h>
53 1.1 augustss
54 1.1 augustss #include <dev/usb/usbdi.h>
55 1.1 augustss #include <dev/usb/usbdi_util.h>
56 1.1 augustss #include <dev/usb/usbdivar.h>
57 1.1 augustss #include <dev/usb/usbdevs.h>
58 1.1 augustss #include <dev/usb/usb_quirks.h>
59 1.169 pgoyette #include <dev/usb/usb_verbose.h>
60 1.1 augustss
61 1.158 drochner #include "locators.h"
62 1.158 drochner
63 1.1 augustss #ifdef USB_DEBUG
64 1.177 dyoung #define DPRINTF(x) if (usbdebug) printf x
65 1.177 dyoung #define DPRINTFN(n,x) if (usbdebug>(n)) printf x
66 1.1 augustss extern int usbdebug;
67 1.1 augustss #else
68 1.1 augustss #define DPRINTF(x)
69 1.1 augustss #define DPRINTFN(n,x)
70 1.1 augustss #endif
71 1.1 augustss
72 1.178 tsutsui MALLOC_DEFINE(M_USB, "USB", "USB misc. memory");
73 1.178 tsutsui MALLOC_DEFINE(M_USBDEV, "USB device", "USB device driver");
74 1.178 tsutsui MALLOC_DEFINE(M_USBHC, "USB HC", "USB host controller");
75 1.178 tsutsui
76 1.82 augustss Static usbd_status usbd_set_config(usbd_device_handle, int);
77 1.124 augustss Static void usbd_devinfo(usbd_device_handle, int, char *, size_t);
78 1.175 christos Static void usbd_devinfo_vp(usbd_device_handle, char *, size_t, char *, size_t,
79 1.175 christos int, int);
80 1.175 christos Static int usbd_getnewaddr(usbd_bus_handle);
81 1.118 drochner Static int usbd_print(void *, const char *);
82 1.144 drochner Static int usbd_ifprint(void *, const char *);
83 1.175 christos Static void usbd_free_iface_data(usbd_device_handle, int);
84 1.78 augustss Static void usbd_kill_pipe(usbd_pipe_handle);
85 1.155 drochner usbd_status usbd_attach_roothub(device_t, usbd_device_handle);
86 1.175 christos Static usbd_status usbd_probe_and_attach(device_t, usbd_device_handle, int,
87 1.175 christos int);
88 1.1 augustss
89 1.69 augustss Static u_int32_t usb_cookie_no = 0;
90 1.27 augustss
91 1.84 jdolecek Static const char * const usbd_error_strs[] = {
92 1.12 augustss "NORMAL_COMPLETION",
93 1.12 augustss "IN_PROGRESS",
94 1.12 augustss "PENDING_REQUESTS",
95 1.12 augustss "NOT_STARTED",
96 1.12 augustss "INVAL",
97 1.12 augustss "NOMEM",
98 1.12 augustss "CANCELLED",
99 1.12 augustss "BAD_ADDRESS",
100 1.12 augustss "IN_USE",
101 1.12 augustss "NO_ADDR",
102 1.12 augustss "SET_ADDR_FAILED",
103 1.12 augustss "NO_POWER",
104 1.12 augustss "TOO_DEEP",
105 1.12 augustss "IOERROR",
106 1.12 augustss "NOT_CONFIGURED",
107 1.12 augustss "TIMEOUT",
108 1.12 augustss "SHORT_XFER",
109 1.12 augustss "STALLED",
110 1.33 augustss "INTERRUPTED",
111 1.12 augustss "XXX",
112 1.12 augustss };
113 1.1 augustss
114 1.171 pgoyette void usb_load_verbose(void);
115 1.171 pgoyette
116 1.175 christos void get_usb_vendor_stub(char *, size_t, usb_vendor_id_t);
117 1.175 christos void get_usb_product_stub(char *, size_t, usb_vendor_id_t, usb_product_id_t);
118 1.171 pgoyette
119 1.175 christos void (*get_usb_vendor)(char *, size_t, usb_vendor_id_t) = get_usb_vendor_stub;
120 1.175 christos void (*get_usb_product)(char *, size_t, usb_vendor_id_t, usb_product_id_t) =
121 1.171 pgoyette get_usb_product_stub;
122 1.171 pgoyette
123 1.171 pgoyette int usb_verbose_loaded = 0;
124 1.171 pgoyette
125 1.171 pgoyette /*
126 1.171 pgoyette * Load the usbverbose module
127 1.171 pgoyette */
128 1.171 pgoyette void usb_load_verbose(void)
129 1.171 pgoyette {
130 1.176 pgoyette if (usb_verbose_loaded == 0)
131 1.173 pgoyette module_autoload("usbverbose", MODULE_CLASS_MISC);
132 1.171 pgoyette }
133 1.169 pgoyette
134 1.175 christos void get_usb_vendor_stub(char *v, size_t l, usb_vendor_id_t v_id)
135 1.169 pgoyette {
136 1.171 pgoyette usb_load_verbose();
137 1.171 pgoyette if (usb_verbose_loaded)
138 1.175 christos get_usb_vendor(v, l, v_id);
139 1.169 pgoyette }
140 1.169 pgoyette
141 1.175 christos void get_usb_product_stub(char *p, size_t l, usb_vendor_id_t v_id,
142 1.175 christos usb_product_id_t p_id)
143 1.169 pgoyette {
144 1.171 pgoyette usb_load_verbose();
145 1.171 pgoyette if (usb_verbose_loaded)
146 1.175 christos get_usb_product(p, l, v_id, p_id);
147 1.169 pgoyette }
148 1.169 pgoyette
149 1.42 thorpej const char *
150 1.78 augustss usbd_errstr(usbd_status err)
151 1.39 augustss {
152 1.39 augustss static char buffer[5];
153 1.39 augustss
154 1.42 thorpej if (err < USBD_ERROR_MAX) {
155 1.39 augustss return usbd_error_strs[err];
156 1.39 augustss } else {
157 1.39 augustss snprintf(buffer, sizeof buffer, "%d", err);
158 1.39 augustss return buffer;
159 1.39 augustss }
160 1.39 augustss }
161 1.39 augustss
162 1.13 augustss usbd_status
163 1.78 augustss usbd_get_string_desc(usbd_device_handle dev, int sindex, int langid,
164 1.114 mycroft usb_string_descriptor_t *sdesc, int *sizep)
165 1.13 augustss {
166 1.13 augustss usb_device_request_t req;
167 1.116 mycroft usbd_status err;
168 1.116 mycroft int actlen;
169 1.13 augustss
170 1.13 augustss req.bmRequestType = UT_READ_DEVICE;
171 1.13 augustss req.bRequest = UR_GET_DESCRIPTOR;
172 1.13 augustss USETW2(req.wValue, UDESC_STRING, sindex);
173 1.13 augustss USETW(req.wIndex, langid);
174 1.146 christos USETW(req.wLength, 2); /* only size byte first */
175 1.116 mycroft err = usbd_do_request_flags(dev, &req, sdesc, USBD_SHORT_XFER_OK,
176 1.116 mycroft &actlen, USBD_DEFAULT_TIMEOUT);
177 1.116 mycroft if (err)
178 1.116 mycroft return (err);
179 1.116 mycroft
180 1.146 christos if (actlen < 2)
181 1.146 christos return (USBD_SHORT_XFER);
182 1.146 christos
183 1.146 christos USETW(req.wLength, sdesc->bLength); /* the whole string */
184 1.146 christos err = usbd_do_request_flags(dev, &req, sdesc, USBD_SHORT_XFER_OK,
185 1.146 christos &actlen, USBD_DEFAULT_TIMEOUT);
186 1.146 christos if (err)
187 1.146 christos return (err);
188 1.146 christos
189 1.116 mycroft if (actlen != sdesc->bLength) {
190 1.116 mycroft DPRINTFN(-1, ("usbd_get_string_desc: expected %d, got %d\n",
191 1.116 mycroft sdesc->bLength, actlen));
192 1.116 mycroft }
193 1.116 mycroft
194 1.116 mycroft *sizep = actlen;
195 1.116 mycroft return (USBD_NORMAL_COMPLETION);
196 1.13 augustss }
197 1.13 augustss
198 1.128 enami static void
199 1.128 enami usbd_trim_spaces(char *p)
200 1.83 augustss {
201 1.128 enami char *q, *e;
202 1.83 augustss
203 1.128 enami q = e = p;
204 1.128 enami while (*q == ' ') /* skip leading spaces */
205 1.85 augustss q++;
206 1.128 enami while ((*p = *q++)) /* copy string */
207 1.128 enami if (*p++ != ' ') /* remember last non-space */
208 1.128 enami e = p;
209 1.128 enami *e = '\0'; /* kill trailing spaces */
210 1.83 augustss }
211 1.83 augustss
212 1.123 augustss Static void
213 1.175 christos usbd_devinfo_vp(usbd_device_handle dev, char *v, size_t vl, char *p,
214 1.175 christos size_t pl, int usedev, int useencoded)
215 1.1 augustss {
216 1.1 augustss usb_device_descriptor_t *udd = &dev->ddesc;
217 1.175 christos if (dev == NULL)
218 1.175 christos return;
219 1.1 augustss
220 1.128 enami v[0] = p[0] = '\0';
221 1.52 augustss
222 1.82 augustss if (usedev) {
223 1.139 pavel if (usbd_get_string0(dev, udd->iManufacturer, v, useencoded) ==
224 1.128 enami USBD_NORMAL_COMPLETION)
225 1.128 enami usbd_trim_spaces(v);
226 1.139 pavel if (usbd_get_string0(dev, udd->iProduct, p, useencoded) ==
227 1.128 enami USBD_NORMAL_COMPLETION)
228 1.128 enami usbd_trim_spaces(p);
229 1.82 augustss }
230 1.128 enami if (v[0] == '\0')
231 1.175 christos get_usb_vendor(v, vl, UGETW(udd->idVendor));
232 1.128 enami if (p[0] == '\0')
233 1.175 christos get_usb_product(p, pl, UGETW(udd->idVendor),
234 1.175 christos UGETW(udd->idProduct));
235 1.169 pgoyette
236 1.128 enami if (v[0] == '\0')
237 1.175 christos snprintf(v, vl, "vendor 0x%04x", UGETW(udd->idVendor));
238 1.128 enami if (p[0] == '\0')
239 1.175 christos snprintf(p, pl, "product 0x%04x", UGETW(udd->idProduct));
240 1.1 augustss }
241 1.1 augustss
242 1.1 augustss int
243 1.113 itojun usbd_printBCD(char *cp, size_t l, int bcd)
244 1.1 augustss {
245 1.175 christos return snprintf(cp, l, "%x.%02x", bcd >> 8, bcd & 0xff);
246 1.1 augustss }
247 1.1 augustss
248 1.124 augustss Static void
249 1.113 itojun usbd_devinfo(usbd_device_handle dev, int showclass, char *cp, size_t l)
250 1.1 augustss {
251 1.1 augustss usb_device_descriptor_t *udd = &dev->ddesc;
252 1.133 christos char *vendor, *product;
253 1.1 augustss int bcdDevice, bcdUSB;
254 1.113 itojun char *ep;
255 1.113 itojun
256 1.133 christos vendor = malloc(USB_MAX_ENCODED_STRING_LEN * 2, M_USB, M_NOWAIT);
257 1.133 christos if (vendor == NULL) {
258 1.133 christos *cp = '\0';
259 1.133 christos return;
260 1.133 christos }
261 1.133 christos product = &vendor[USB_MAX_ENCODED_STRING_LEN];
262 1.133 christos
263 1.113 itojun ep = cp + l;
264 1.1 augustss
265 1.175 christos usbd_devinfo_vp(dev, vendor, USB_MAX_ENCODED_STRING_LEN,
266 1.175 christos product, USB_MAX_ENCODED_STRING_LEN, 1, 1);
267 1.113 itojun cp += snprintf(cp, ep - cp, "%s %s", vendor, product);
268 1.1 augustss if (showclass)
269 1.113 itojun cp += snprintf(cp, ep - cp, ", class %d/%d",
270 1.113 itojun udd->bDeviceClass, udd->bDeviceSubClass);
271 1.1 augustss bcdUSB = UGETW(udd->bcdUSB);
272 1.1 augustss bcdDevice = UGETW(udd->bcdDevice);
273 1.113 itojun cp += snprintf(cp, ep - cp, ", rev ");
274 1.113 itojun cp += usbd_printBCD(cp, ep - cp, bcdUSB);
275 1.1 augustss *cp++ = '/';
276 1.113 itojun cp += usbd_printBCD(cp, ep - cp, bcdDevice);
277 1.113 itojun cp += snprintf(cp, ep - cp, ", addr %d", dev->address);
278 1.10 augustss *cp = 0;
279 1.133 christos free(vendor, M_USB);
280 1.1 augustss }
281 1.1 augustss
282 1.124 augustss char *
283 1.124 augustss usbd_devinfo_alloc(usbd_device_handle dev, int showclass)
284 1.124 augustss {
285 1.124 augustss char *devinfop;
286 1.124 augustss
287 1.124 augustss devinfop = malloc(DEVINFOSIZE, M_TEMP, M_WAITOK);
288 1.124 augustss usbd_devinfo(dev, showclass, devinfop, DEVINFOSIZE);
289 1.124 augustss return devinfop;
290 1.124 augustss }
291 1.124 augustss
292 1.124 augustss void
293 1.124 augustss usbd_devinfo_free(char *devinfop)
294 1.124 augustss {
295 1.124 augustss free(devinfop, M_TEMP);
296 1.124 augustss }
297 1.124 augustss
298 1.1 augustss /* Delay for a certain number of ms */
299 1.1 augustss void
300 1.182 mrg usb_delay_ms_locked(usbd_bus_handle bus, u_int ms, kmutex_t *lock)
301 1.1 augustss {
302 1.1 augustss /* Wait at least two clock ticks so we know the time has passed. */
303 1.64 augustss if (bus->use_polling || cold)
304 1.1 augustss delay((ms+1) * 1000);
305 1.1 augustss else
306 1.182 mrg kpause("usbdly", false, (ms*hz+999)/1000 + 1, lock);
307 1.182 mrg }
308 1.182 mrg
309 1.182 mrg void
310 1.182 mrg usb_delay_ms(usbd_bus_handle bus, u_int ms)
311 1.182 mrg {
312 1.182 mrg usb_delay_ms_locked(bus, ms, NULL);
313 1.182 mrg }
314 1.182 mrg
315 1.182 mrg /* Delay given a device handle. */
316 1.182 mrg void
317 1.182 mrg usbd_delay_ms_locked(usbd_device_handle dev, u_int ms, kmutex_t *lock)
318 1.182 mrg {
319 1.182 mrg usb_delay_ms_locked(dev->bus, ms, lock);
320 1.1 augustss }
321 1.1 augustss
322 1.23 augustss /* Delay given a device handle. */
323 1.23 augustss void
324 1.78 augustss usbd_delay_ms(usbd_device_handle dev, u_int ms)
325 1.23 augustss {
326 1.182 mrg usb_delay_ms_locked(dev->bus, ms, NULL);
327 1.23 augustss }
328 1.23 augustss
329 1.1 augustss usbd_status
330 1.78 augustss usbd_reset_port(usbd_device_handle dev, int port, usb_port_status_t *ps)
331 1.1 augustss {
332 1.1 augustss usb_device_request_t req;
333 1.53 augustss usbd_status err;
334 1.1 augustss int n;
335 1.99 augustss
336 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_OTHER;
337 1.1 augustss req.bRequest = UR_SET_FEATURE;
338 1.1 augustss USETW(req.wValue, UHF_PORT_RESET);
339 1.1 augustss USETW(req.wIndex, port);
340 1.1 augustss USETW(req.wLength, 0);
341 1.53 augustss err = usbd_do_request(dev, &req, 0);
342 1.39 augustss DPRINTFN(1,("usbd_reset_port: port %d reset done, error=%s\n",
343 1.53 augustss port, usbd_errstr(err)));
344 1.53 augustss if (err)
345 1.53 augustss return (err);
346 1.1 augustss n = 10;
347 1.1 augustss do {
348 1.1 augustss /* Wait for device to recover from reset. */
349 1.23 augustss usbd_delay_ms(dev, USB_PORT_RESET_DELAY);
350 1.53 augustss err = usbd_get_port_status(dev, port, ps);
351 1.53 augustss if (err) {
352 1.53 augustss DPRINTF(("usbd_reset_port: get status failed %d\n",
353 1.53 augustss err));
354 1.53 augustss return (err);
355 1.1 augustss }
356 1.92 augustss /* If the device disappeared, just give up. */
357 1.92 augustss if (!(UGETW(ps->wPortStatus) & UPS_CURRENT_CONNECT_STATUS))
358 1.92 augustss return (USBD_NORMAL_COMPLETION);
359 1.1 augustss } while ((UGETW(ps->wPortChange) & UPS_C_PORT_RESET) == 0 && --n > 0);
360 1.73 augustss if (n == 0)
361 1.73 augustss return (USBD_TIMEOUT);
362 1.53 augustss err = usbd_clear_port_feature(dev, port, UHF_C_PORT_RESET);
363 1.1 augustss #ifdef USB_DEBUG
364 1.53 augustss if (err)
365 1.53 augustss DPRINTF(("usbd_reset_port: clear port feature failed %d\n",
366 1.53 augustss err));
367 1.1 augustss #endif
368 1.18 augustss
369 1.18 augustss /* Wait for the device to recover from reset. */
370 1.23 augustss usbd_delay_ms(dev, USB_PORT_RESET_RECOVERY);
371 1.53 augustss return (err);
372 1.1 augustss }
373 1.1 augustss
374 1.12 augustss usb_interface_descriptor_t *
375 1.78 augustss usbd_find_idesc(usb_config_descriptor_t *cd, int ifaceidx, int altidx)
376 1.12 augustss {
377 1.12 augustss char *p = (char *)cd;
378 1.12 augustss char *end = p + UGETW(cd->wTotalLength);
379 1.12 augustss usb_interface_descriptor_t *d;
380 1.19 augustss int curidx, lastidx, curaidx = 0;
381 1.12 augustss
382 1.19 augustss for (curidx = lastidx = -1; p < end; ) {
383 1.12 augustss d = (usb_interface_descriptor_t *)p;
384 1.18 augustss DPRINTFN(4,("usbd_find_idesc: idx=%d(%d) altidx=%d(%d) len=%d "
385 1.99 augustss "type=%d\n",
386 1.18 augustss ifaceidx, curidx, altidx, curaidx,
387 1.18 augustss d->bLength, d->bDescriptorType));
388 1.12 augustss if (d->bLength == 0) /* bad descriptor */
389 1.12 augustss break;
390 1.12 augustss p += d->bLength;
391 1.12 augustss if (p <= end && d->bDescriptorType == UDESC_INTERFACE) {
392 1.19 augustss if (d->bInterfaceNumber != lastidx) {
393 1.19 augustss lastidx = d->bInterfaceNumber;
394 1.12 augustss curidx++;
395 1.12 augustss curaidx = 0;
396 1.12 augustss } else
397 1.12 augustss curaidx++;
398 1.12 augustss if (ifaceidx == curidx && altidx == curaidx)
399 1.12 augustss return (d);
400 1.12 augustss }
401 1.12 augustss }
402 1.58 augustss return (NULL);
403 1.12 augustss }
404 1.12 augustss
405 1.12 augustss usb_endpoint_descriptor_t *
406 1.99 augustss usbd_find_edesc(usb_config_descriptor_t *cd, int ifaceidx, int altidx,
407 1.78 augustss int endptidx)
408 1.12 augustss {
409 1.12 augustss char *p = (char *)cd;
410 1.12 augustss char *end = p + UGETW(cd->wTotalLength);
411 1.12 augustss usb_interface_descriptor_t *d;
412 1.12 augustss usb_endpoint_descriptor_t *e;
413 1.12 augustss int curidx;
414 1.12 augustss
415 1.12 augustss d = usbd_find_idesc(cd, ifaceidx, altidx);
416 1.53 augustss if (d == NULL)
417 1.58 augustss return (NULL);
418 1.12 augustss if (endptidx >= d->bNumEndpoints) /* quick exit */
419 1.58 augustss return (NULL);
420 1.12 augustss
421 1.12 augustss curidx = -1;
422 1.12 augustss for (p = (char *)d + d->bLength; p < end; ) {
423 1.12 augustss e = (usb_endpoint_descriptor_t *)p;
424 1.12 augustss if (e->bLength == 0) /* bad descriptor */
425 1.12 augustss break;
426 1.12 augustss p += e->bLength;
427 1.12 augustss if (p <= end && e->bDescriptorType == UDESC_INTERFACE)
428 1.58 augustss return (NULL);
429 1.12 augustss if (p <= end && e->bDescriptorType == UDESC_ENDPOINT) {
430 1.12 augustss curidx++;
431 1.12 augustss if (curidx == endptidx)
432 1.12 augustss return (e);
433 1.12 augustss }
434 1.1 augustss }
435 1.58 augustss return (NULL);
436 1.1 augustss }
437 1.1 augustss
438 1.1 augustss usbd_status
439 1.78 augustss usbd_fill_iface_data(usbd_device_handle dev, int ifaceidx, int altidx)
440 1.1 augustss {
441 1.12 augustss usbd_interface_handle ifc = &dev->ifaces[ifaceidx];
442 1.77 augustss usb_interface_descriptor_t *idesc;
443 1.1 augustss char *p, *end;
444 1.1 augustss int endpt, nendpt;
445 1.1 augustss
446 1.18 augustss DPRINTFN(4,("usbd_fill_iface_data: ifaceidx=%d altidx=%d\n",
447 1.14 drochner ifaceidx, altidx));
448 1.77 augustss idesc = usbd_find_idesc(dev->cdesc, ifaceidx, altidx);
449 1.77 augustss if (idesc == NULL)
450 1.77 augustss return (USBD_INVAL);
451 1.1 augustss ifc->device = dev;
452 1.77 augustss ifc->idesc = idesc;
453 1.13 augustss ifc->index = ifaceidx;
454 1.13 augustss ifc->altindex = altidx;
455 1.1 augustss nendpt = ifc->idesc->bNumEndpoints;
456 1.59 augustss DPRINTFN(4,("usbd_fill_iface_data: found idesc nendpt=%d\n", nendpt));
457 1.1 augustss if (nendpt != 0) {
458 1.1 augustss ifc->endpoints = malloc(nendpt * sizeof(struct usbd_endpoint),
459 1.1 augustss M_USB, M_NOWAIT);
460 1.58 augustss if (ifc->endpoints == NULL)
461 1.1 augustss return (USBD_NOMEM);
462 1.1 augustss } else
463 1.58 augustss ifc->endpoints = NULL;
464 1.58 augustss ifc->priv = NULL;
465 1.1 augustss p = (char *)ifc->idesc + ifc->idesc->bLength;
466 1.1 augustss end = (char *)dev->cdesc + UGETW(dev->cdesc->wTotalLength);
467 1.19 augustss #define ed ((usb_endpoint_descriptor_t *)p)
468 1.1 augustss for (endpt = 0; endpt < nendpt; endpt++) {
469 1.1 augustss DPRINTFN(10,("usbd_fill_iface_data: endpt=%d\n", endpt));
470 1.1 augustss for (; p < end; p += ed->bLength) {
471 1.14 drochner DPRINTFN(10,("usbd_fill_iface_data: p=%p end=%p "
472 1.14 drochner "len=%d type=%d\n",
473 1.1 augustss p, end, ed->bLength, ed->bDescriptorType));
474 1.24 augustss if (p + ed->bLength <= end && ed->bLength != 0 &&
475 1.1 augustss ed->bDescriptorType == UDESC_ENDPOINT)
476 1.24 augustss goto found;
477 1.59 augustss if (ed->bLength == 0 ||
478 1.59 augustss ed->bDescriptorType == UDESC_INTERFACE)
479 1.1 augustss break;
480 1.1 augustss }
481 1.24 augustss /* passed end, or bad desc */
482 1.95 augustss printf("usbd_fill_iface_data: bad descriptor(s): %s\n",
483 1.95 augustss ed->bLength == 0 ? "0 length" :
484 1.95 augustss ed->bDescriptorType == UDESC_INTERFACE ? "iface desc":
485 1.95 augustss "out of data");
486 1.24 augustss goto bad;
487 1.24 augustss found:
488 1.1 augustss ifc->endpoints[endpt].edesc = ed;
489 1.95 augustss if (dev->speed == USB_SPEED_HIGH) {
490 1.95 augustss u_int mps;
491 1.95 augustss /* Control and bulk endpoints have max packet limits. */
492 1.95 augustss switch (UE_GET_XFERTYPE(ed->bmAttributes)) {
493 1.95 augustss case UE_CONTROL:
494 1.95 augustss mps = USB_2_MAX_CTRL_PACKET;
495 1.95 augustss goto check;
496 1.95 augustss case UE_BULK:
497 1.95 augustss mps = USB_2_MAX_BULK_PACKET;
498 1.95 augustss check:
499 1.95 augustss if (UGETW(ed->wMaxPacketSize) != mps) {
500 1.95 augustss USETW(ed->wMaxPacketSize, mps);
501 1.95 augustss #ifdef DIAGNOSTIC
502 1.95 augustss printf("usbd_fill_iface_data: bad max "
503 1.95 augustss "packet size\n");
504 1.95 augustss #endif
505 1.95 augustss }
506 1.95 augustss break;
507 1.95 augustss default:
508 1.95 augustss break;
509 1.95 augustss }
510 1.95 augustss }
511 1.1 augustss ifc->endpoints[endpt].refcnt = 0;
512 1.179 drochner ifc->endpoints[endpt].datatoggle = 0;
513 1.24 augustss p += ed->bLength;
514 1.1 augustss }
515 1.19 augustss #undef ed
516 1.1 augustss LIST_INIT(&ifc->pipes);
517 1.1 augustss return (USBD_NORMAL_COMPLETION);
518 1.24 augustss
519 1.1 augustss bad:
520 1.77 augustss if (ifc->endpoints != NULL) {
521 1.59 augustss free(ifc->endpoints, M_USB);
522 1.77 augustss ifc->endpoints = NULL;
523 1.77 augustss }
524 1.24 augustss return (USBD_INVAL);
525 1.1 augustss }
526 1.1 augustss
527 1.1 augustss void
528 1.78 augustss usbd_free_iface_data(usbd_device_handle dev, int ifcno)
529 1.1 augustss {
530 1.1 augustss usbd_interface_handle ifc = &dev->ifaces[ifcno];
531 1.1 augustss if (ifc->endpoints)
532 1.1 augustss free(ifc->endpoints, M_USB);
533 1.1 augustss }
534 1.1 augustss
535 1.69 augustss Static usbd_status
536 1.78 augustss usbd_set_config(usbd_device_handle dev, int conf)
537 1.7 augustss {
538 1.7 augustss usb_device_request_t req;
539 1.7 augustss
540 1.7 augustss req.bmRequestType = UT_WRITE_DEVICE;
541 1.7 augustss req.bRequest = UR_SET_CONFIG;
542 1.7 augustss USETW(req.wValue, conf);
543 1.7 augustss USETW(req.wIndex, 0);
544 1.7 augustss USETW(req.wLength, 0);
545 1.7 augustss return (usbd_do_request(dev, &req, 0));
546 1.7 augustss }
547 1.7 augustss
548 1.1 augustss usbd_status
549 1.78 augustss usbd_set_config_no(usbd_device_handle dev, int no, int msg)
550 1.1 augustss {
551 1.12 augustss int index;
552 1.12 augustss usb_config_descriptor_t cd;
553 1.53 augustss usbd_status err;
554 1.12 augustss
555 1.75 augustss if (no == USB_UNCONFIG_NO)
556 1.75 augustss return (usbd_set_config_index(dev, USB_UNCONFIG_INDEX, msg));
557 1.75 augustss
558 1.12 augustss DPRINTFN(5,("usbd_set_config_no: %d\n", no));
559 1.12 augustss /* Figure out what config index to use. */
560 1.12 augustss for (index = 0; index < dev->ddesc.bNumConfigurations; index++) {
561 1.53 augustss err = usbd_get_config_desc(dev, index, &cd);
562 1.53 augustss if (err)
563 1.53 augustss return (err);
564 1.12 augustss if (cd.bConfigurationValue == no)
565 1.12 augustss return (usbd_set_config_index(dev, index, msg));
566 1.12 augustss }
567 1.12 augustss return (USBD_INVAL);
568 1.12 augustss }
569 1.12 augustss
570 1.12 augustss usbd_status
571 1.78 augustss usbd_set_config_index(usbd_device_handle dev, int index, int msg)
572 1.12 augustss {
573 1.1 augustss usb_config_descriptor_t cd, *cdp;
574 1.53 augustss usbd_status err;
575 1.103 augustss int i, ifcidx, nifc, len, selfpowered, power;
576 1.1 augustss
577 1.12 augustss DPRINTFN(5,("usbd_set_config_index: dev=%p index=%d\n", dev, index));
578 1.1 augustss
579 1.145 drochner if (index >= dev->ddesc.bNumConfigurations &&
580 1.161 drochner index != USB_UNCONFIG_INDEX) {
581 1.145 drochner /* panic? */
582 1.145 drochner printf("usbd_set_config_index: illegal index\n");
583 1.145 drochner return (USBD_INVAL);
584 1.145 drochner }
585 1.145 drochner
586 1.1 augustss /* XXX check that all interfaces are idle */
587 1.75 augustss if (dev->config != USB_UNCONFIG_NO) {
588 1.12 augustss DPRINTF(("usbd_set_config_index: free old config\n"));
589 1.1 augustss /* Free all configuration data structures. */
590 1.1 augustss nifc = dev->cdesc->bNumInterface;
591 1.12 augustss for (ifcidx = 0; ifcidx < nifc; ifcidx++)
592 1.12 augustss usbd_free_iface_data(dev, ifcidx);
593 1.1 augustss free(dev->ifaces, M_USB);
594 1.1 augustss free(dev->cdesc, M_USB);
595 1.57 augustss dev->ifaces = NULL;
596 1.57 augustss dev->cdesc = NULL;
597 1.75 augustss dev->config = USB_UNCONFIG_NO;
598 1.75 augustss }
599 1.75 augustss
600 1.75 augustss if (index == USB_UNCONFIG_INDEX) {
601 1.75 augustss /* We are unconfiguring the device, so leave unallocated. */
602 1.75 augustss DPRINTF(("usbd_set_config_index: set config 0\n"));
603 1.75 augustss err = usbd_set_config(dev, USB_UNCONFIG_NO);
604 1.136 christos if (err) {
605 1.75 augustss DPRINTF(("usbd_set_config_index: setting config=0 "
606 1.75 augustss "failed, error=%s\n", usbd_errstr(err)));
607 1.136 christos }
608 1.75 augustss return (err);
609 1.1 augustss }
610 1.1 augustss
611 1.74 augustss /* Get the short descriptor. */
612 1.53 augustss err = usbd_get_config_desc(dev, index, &cd);
613 1.172 drochner if (err) {
614 1.172 drochner DPRINTF(("usbd_set_config_index: get_config_desc=%d\n", err));
615 1.53 augustss return (err);
616 1.172 drochner }
617 1.1 augustss len = UGETW(cd.wTotalLength);
618 1.1 augustss cdp = malloc(len, M_USB, M_NOWAIT);
619 1.53 augustss if (cdp == NULL)
620 1.1 augustss return (USBD_NOMEM);
621 1.103 augustss
622 1.103 augustss /* Get the full descriptor. Try a few times for slow devices. */
623 1.103 augustss for (i = 0; i < 3; i++) {
624 1.103 augustss err = usbd_get_desc(dev, UDESC_CONFIG, index, len, cdp);
625 1.103 augustss if (!err)
626 1.103 augustss break;
627 1.103 augustss usbd_delay_ms(dev, 200);
628 1.103 augustss }
629 1.172 drochner if (err) {
630 1.172 drochner DPRINTF(("usbd_set_config_index: get_desc=%d\n", err));
631 1.1 augustss goto bad;
632 1.172 drochner }
633 1.18 augustss if (cdp->bDescriptorType != UDESC_CONFIG) {
634 1.18 augustss DPRINTFN(-1,("usbd_set_config_index: bad desc %d\n",
635 1.18 augustss cdp->bDescriptorType));
636 1.53 augustss err = USBD_INVAL;
637 1.18 augustss goto bad;
638 1.18 augustss }
639 1.74 augustss
640 1.142 drochner /*
641 1.142 drochner * Figure out if the device is self or bus powered.
642 1.142 drochner */
643 1.142 drochner #if 0 /* XXX various devices don't report the power state correctly */
644 1.1 augustss selfpowered = 0;
645 1.141 drochner err = usbd_get_device_status(dev, &ds);
646 1.141 drochner if (!err && (UGETW(ds.wStatus) & UDS_SELF_POWERED))
647 1.141 drochner selfpowered = 1;
648 1.142 drochner #endif
649 1.142 drochner /*
650 1.142 drochner * Use the power state in the configuration we are going
651 1.142 drochner * to set. This doesn't necessarily reflect the actual
652 1.142 drochner * power state of the device; the driver can control this
653 1.142 drochner * by choosing the appropriate configuration.
654 1.142 drochner */
655 1.142 drochner selfpowered = !!(cdp->bmAttributes & UC_SELF_POWERED);
656 1.141 drochner
657 1.81 augustss DPRINTF(("usbd_set_config_index: (addr %d) cno=%d attr=0x%02x, "
658 1.81 augustss "selfpowered=%d, power=%d\n",
659 1.99 augustss cdp->bConfigurationValue, dev->address, cdp->bmAttributes,
660 1.33 augustss selfpowered, cdp->bMaxPower * 2));
661 1.74 augustss
662 1.74 augustss /* Check if we have enough power. */
663 1.142 drochner #if 0 /* this is a no-op, see above */
664 1.141 drochner if ((cdp->bmAttributes & UC_SELF_POWERED) && !selfpowered) {
665 1.141 drochner if (msg)
666 1.141 drochner printf("%s: device addr %d (config %d): "
667 1.141 drochner "can't set self powered configuration\n",
668 1.164 dyoung device_xname(dev->bus->bdev), dev->address,
669 1.141 drochner cdp->bConfigurationValue);
670 1.141 drochner err = USBD_NO_POWER;
671 1.141 drochner goto bad;
672 1.141 drochner }
673 1.142 drochner #endif
674 1.1 augustss #ifdef USB_DEBUG
675 1.53 augustss if (dev->powersrc == NULL) {
676 1.44 augustss DPRINTF(("usbd_set_config_index: No power source?\n"));
677 1.141 drochner err = USBD_IOERROR;
678 1.141 drochner goto bad;
679 1.1 augustss }
680 1.1 augustss #endif
681 1.1 augustss power = cdp->bMaxPower * 2;
682 1.1 augustss if (power > dev->powersrc->power) {
683 1.81 augustss DPRINTF(("power exceeded %d %d\n", power,dev->powersrc->power));
684 1.1 augustss /* XXX print nicer message. */
685 1.7 augustss if (msg)
686 1.18 augustss printf("%s: device addr %d (config %d) exceeds power "
687 1.18 augustss "budget, %d mA > %d mA\n",
688 1.151 drochner device_xname(dev->bus->usbctl), dev->address,
689 1.99 augustss cdp->bConfigurationValue,
690 1.7 augustss power, dev->powersrc->power);
691 1.53 augustss err = USBD_NO_POWER;
692 1.1 augustss goto bad;
693 1.1 augustss }
694 1.1 augustss dev->power = power;
695 1.1 augustss dev->self_powered = selfpowered;
696 1.1 augustss
697 1.74 augustss /* Set the actual configuration value. */
698 1.18 augustss DPRINTF(("usbd_set_config_index: set config %d\n",
699 1.18 augustss cdp->bConfigurationValue));
700 1.53 augustss err = usbd_set_config(dev, cdp->bConfigurationValue);
701 1.53 augustss if (err) {
702 1.14 drochner DPRINTF(("usbd_set_config_index: setting config=%d failed, "
703 1.39 augustss "error=%s\n",
704 1.53 augustss cdp->bConfigurationValue, usbd_errstr(err)));
705 1.1 augustss goto bad;
706 1.1 augustss }
707 1.74 augustss
708 1.74 augustss /* Allocate and fill interface data. */
709 1.1 augustss nifc = cdp->bNumInterface;
710 1.99 augustss dev->ifaces = malloc(nifc * sizeof(struct usbd_interface),
711 1.1 augustss M_USB, M_NOWAIT);
712 1.58 augustss if (dev->ifaces == NULL) {
713 1.53 augustss err = USBD_NOMEM;
714 1.1 augustss goto bad;
715 1.1 augustss }
716 1.12 augustss DPRINTFN(5,("usbd_set_config_index: dev=%p cdesc=%p\n", dev, cdp));
717 1.1 augustss dev->cdesc = cdp;
718 1.1 augustss dev->config = cdp->bConfigurationValue;
719 1.12 augustss for (ifcidx = 0; ifcidx < nifc; ifcidx++) {
720 1.53 augustss err = usbd_fill_iface_data(dev, ifcidx, 0);
721 1.53 augustss if (err) {
722 1.12 augustss while (--ifcidx >= 0)
723 1.12 augustss usbd_free_iface_data(dev, ifcidx);
724 1.1 augustss goto bad;
725 1.1 augustss }
726 1.1 augustss }
727 1.1 augustss
728 1.1 augustss return (USBD_NORMAL_COMPLETION);
729 1.1 augustss
730 1.1 augustss bad:
731 1.1 augustss free(cdp, M_USB);
732 1.53 augustss return (err);
733 1.1 augustss }
734 1.1 augustss
735 1.1 augustss /* XXX add function for alternate settings */
736 1.1 augustss
737 1.1 augustss usbd_status
738 1.78 augustss usbd_setup_pipe(usbd_device_handle dev, usbd_interface_handle iface,
739 1.78 augustss struct usbd_endpoint *ep, int ival, usbd_pipe_handle *pipe)
740 1.1 augustss {
741 1.1 augustss usbd_pipe_handle p;
742 1.53 augustss usbd_status err;
743 1.1 augustss
744 1.1 augustss DPRINTFN(1,("usbd_setup_pipe: dev=%p iface=%p ep=%p pipe=%p\n",
745 1.1 augustss dev, iface, ep, pipe));
746 1.1 augustss p = malloc(dev->bus->pipe_size, M_USB, M_NOWAIT);
747 1.53 augustss if (p == NULL)
748 1.1 augustss return (USBD_NOMEM);
749 1.1 augustss p->device = dev;
750 1.1 augustss p->iface = iface;
751 1.1 augustss p->endpoint = ep;
752 1.1 augustss ep->refcnt++;
753 1.1 augustss p->refcnt = 1;
754 1.53 augustss p->intrxfer = 0;
755 1.1 augustss p->running = 0;
756 1.70 augustss p->aborting = 0;
757 1.34 augustss p->repeat = 0;
758 1.63 augustss p->interval = ival;
759 1.1 augustss SIMPLEQ_INIT(&p->queue);
760 1.53 augustss err = dev->bus->methods->open_pipe(p);
761 1.53 augustss if (err) {
762 1.39 augustss DPRINTFN(-1,("usbd_setup_pipe: endpoint=0x%x failed, error="
763 1.39 augustss "%s\n",
764 1.53 augustss ep->edesc->bEndpointAddress, usbd_errstr(err)));
765 1.1 augustss free(p, M_USB);
766 1.53 augustss return (err);
767 1.1 augustss }
768 1.1 augustss *pipe = p;
769 1.1 augustss return (USBD_NORMAL_COMPLETION);
770 1.1 augustss }
771 1.1 augustss
772 1.1 augustss /* Abort the device control pipe. */
773 1.1 augustss void
774 1.78 augustss usbd_kill_pipe(usbd_pipe_handle pipe)
775 1.1 augustss {
776 1.182 mrg int s;
777 1.182 mrg
778 1.89 augustss usbd_abort_pipe(pipe);
779 1.182 mrg usbd_lock_pipe(pipe);
780 1.1 augustss pipe->methods->close(pipe);
781 1.182 mrg usbd_unlock_pipe(pipe);
782 1.1 augustss pipe->endpoint->refcnt--;
783 1.1 augustss free(pipe, M_USB);
784 1.1 augustss }
785 1.1 augustss
786 1.1 augustss int
787 1.78 augustss usbd_getnewaddr(usbd_bus_handle bus)
788 1.1 augustss {
789 1.18 augustss int addr;
790 1.1 augustss
791 1.18 augustss for (addr = 1; addr < USB_MAX_DEVICES; addr++)
792 1.18 augustss if (bus->devices[addr] == 0)
793 1.18 augustss return (addr);
794 1.1 augustss return (-1);
795 1.1 augustss }
796 1.1 augustss
797 1.155 drochner usbd_status
798 1.155 drochner usbd_attach_roothub(device_t parent, usbd_device_handle dev)
799 1.155 drochner {
800 1.155 drochner struct usb_attach_arg uaa;
801 1.155 drochner usb_device_descriptor_t *dd = &dev->ddesc;
802 1.155 drochner device_t dv;
803 1.155 drochner
804 1.155 drochner uaa.device = dev;
805 1.155 drochner uaa.usegeneric = 0;
806 1.155 drochner uaa.port = 0;
807 1.155 drochner uaa.vendor = UGETW(dd->idVendor);
808 1.155 drochner uaa.product = UGETW(dd->idProduct);
809 1.155 drochner uaa.release = UGETW(dd->bcdDevice);
810 1.155 drochner uaa.class = dd->bDeviceClass;
811 1.155 drochner uaa.subclass = dd->bDeviceSubClass;
812 1.155 drochner uaa.proto = dd->bDeviceProtocol;
813 1.155 drochner
814 1.156 drochner dv = config_found_ia(parent, "usbroothubif", &uaa, 0);
815 1.155 drochner if (dv) {
816 1.155 drochner dev->subdevs = malloc(sizeof dv, M_USB, M_NOWAIT);
817 1.155 drochner if (dev->subdevs == NULL)
818 1.155 drochner return (USBD_NOMEM);
819 1.155 drochner dev->subdevs[0] = dv;
820 1.155 drochner dev->subdevlen = 1;
821 1.155 drochner }
822 1.155 drochner return (USBD_NORMAL_COMPLETION);
823 1.155 drochner }
824 1.18 augustss
825 1.160 drochner static usbd_status
826 1.160 drochner usbd_attachwholedevice(device_t parent, usbd_device_handle dev, int port,
827 1.160 drochner int usegeneric)
828 1.18 augustss {
829 1.18 augustss struct usb_attach_arg uaa;
830 1.18 augustss usb_device_descriptor_t *dd = &dev->ddesc;
831 1.160 drochner device_t dv;
832 1.158 drochner int dlocs[USBDEVIFCF_NLOCS];
833 1.18 augustss
834 1.18 augustss uaa.device = dev;
835 1.160 drochner uaa.usegeneric = usegeneric;
836 1.18 augustss uaa.port = port;
837 1.32 augustss uaa.vendor = UGETW(dd->idVendor);
838 1.32 augustss uaa.product = UGETW(dd->idProduct);
839 1.32 augustss uaa.release = UGETW(dd->bcdDevice);
840 1.144 drochner uaa.class = dd->bDeviceClass;
841 1.144 drochner uaa.subclass = dd->bDeviceSubClass;
842 1.144 drochner uaa.proto = dd->bDeviceProtocol;
843 1.18 augustss
844 1.158 drochner dlocs[USBDEVIFCF_PORT] = uaa.port;
845 1.158 drochner dlocs[USBDEVIFCF_VENDOR] = uaa.vendor;
846 1.158 drochner dlocs[USBDEVIFCF_PRODUCT] = uaa.product;
847 1.158 drochner dlocs[USBDEVIFCF_RELEASE] = uaa.release;
848 1.158 drochner /* the rest is historical ballast */
849 1.158 drochner dlocs[USBDEVIFCF_CONFIGURATION] = -1;
850 1.158 drochner dlocs[USBDEVIFCF_INTERFACE] = -1;
851 1.158 drochner
852 1.158 drochner dv = config_found_sm_loc(parent, "usbdevif", dlocs, &uaa, usbd_print,
853 1.160 drochner config_stdsubmatch);
854 1.34 augustss if (dv) {
855 1.155 drochner dev->subdevs = malloc(sizeof dv, M_USB, M_NOWAIT);
856 1.57 augustss if (dev->subdevs == NULL)
857 1.34 augustss return (USBD_NOMEM);
858 1.34 augustss dev->subdevs[0] = dv;
859 1.155 drochner dev->subdevlen = 1;
860 1.160 drochner dev->nifaces_claimed = 1; /* XXX */
861 1.34 augustss }
862 1.160 drochner return (USBD_NORMAL_COMPLETION);
863 1.160 drochner }
864 1.18 augustss
865 1.160 drochner static usbd_status
866 1.162 kent usbd_attachinterfaces(device_t parent, usbd_device_handle dev,
867 1.162 kent int port, const int *locators)
868 1.160 drochner {
869 1.160 drochner struct usbif_attach_arg uiaa;
870 1.162 kent int ilocs[USBIFIFCF_NLOCS];
871 1.160 drochner usb_device_descriptor_t *dd = &dev->ddesc;
872 1.160 drochner int nifaces;
873 1.160 drochner usbd_interface_handle *ifaces;
874 1.162 kent int i, j, loc;
875 1.160 drochner device_t dv;
876 1.160 drochner
877 1.160 drochner nifaces = dev->cdesc->bNumInterface;
878 1.160 drochner ifaces = malloc(nifaces * sizeof(*ifaces), M_USB, M_NOWAIT|M_ZERO);
879 1.160 drochner if (!ifaces)
880 1.160 drochner return (USBD_NOMEM);
881 1.160 drochner for (i = 0; i < nifaces; i++)
882 1.160 drochner if (!dev->subdevs[i])
883 1.160 drochner ifaces[i] = &dev->ifaces[i];
884 1.18 augustss
885 1.144 drochner uiaa.device = dev;
886 1.144 drochner uiaa.port = port;
887 1.144 drochner uiaa.vendor = UGETW(dd->idVendor);
888 1.144 drochner uiaa.product = UGETW(dd->idProduct);
889 1.144 drochner uiaa.release = UGETW(dd->bcdDevice);
890 1.160 drochner uiaa.configno = dev->cdesc->bConfigurationValue;
891 1.160 drochner uiaa.ifaces = ifaces;
892 1.160 drochner uiaa.nifaces = nifaces;
893 1.158 drochner ilocs[USBIFIFCF_PORT] = uiaa.port;
894 1.158 drochner ilocs[USBIFIFCF_VENDOR] = uiaa.vendor;
895 1.158 drochner ilocs[USBIFIFCF_PRODUCT] = uiaa.product;
896 1.158 drochner ilocs[USBIFIFCF_RELEASE] = uiaa.release;
897 1.160 drochner ilocs[USBIFIFCF_CONFIGURATION] = uiaa.configno;
898 1.160 drochner
899 1.160 drochner for (i = 0; i < nifaces; i++) {
900 1.160 drochner if (!ifaces[i])
901 1.160 drochner continue; /* interface already claimed */
902 1.160 drochner uiaa.iface = ifaces[i];
903 1.160 drochner uiaa.class = ifaces[i]->idesc->bInterfaceClass;
904 1.160 drochner uiaa.subclass = ifaces[i]->idesc->bInterfaceSubClass;
905 1.160 drochner uiaa.proto = ifaces[i]->idesc->bInterfaceProtocol;
906 1.160 drochner uiaa.ifaceno = ifaces[i]->idesc->bInterfaceNumber;
907 1.160 drochner ilocs[USBIFIFCF_INTERFACE] = uiaa.ifaceno;
908 1.162 kent if (locators != NULL) {
909 1.162 kent loc = locators[USBIFIFCF_CONFIGURATION];
910 1.162 kent if (loc != USBIFIFCF_CONFIGURATION_DEFAULT &&
911 1.162 kent loc != uiaa.configno)
912 1.162 kent continue;
913 1.162 kent loc = locators[USBIFIFCF_INTERFACE];
914 1.162 kent if (loc != USBIFIFCF_INTERFACE && loc != uiaa.ifaceno)
915 1.162 kent continue;
916 1.162 kent }
917 1.160 drochner dv = config_found_sm_loc(parent, "usbifif", ilocs, &uiaa,
918 1.160 drochner usbd_ifprint, config_stdsubmatch);
919 1.160 drochner if (!dv)
920 1.160 drochner continue;
921 1.160 drochner ifaces[i] = 0; /* claim */
922 1.160 drochner /* account for ifaces claimed by the driver behind our back */
923 1.160 drochner for (j = 0; j < nifaces; j++) {
924 1.160 drochner if (!ifaces[j] && !dev->subdevs[j]) {
925 1.160 drochner dev->subdevs[j] = dv;
926 1.160 drochner dev->nifaces_claimed++;
927 1.160 drochner }
928 1.160 drochner }
929 1.160 drochner }
930 1.160 drochner
931 1.160 drochner free(ifaces, M_USB);
932 1.160 drochner return (USBD_NORMAL_COMPLETION);
933 1.160 drochner }
934 1.160 drochner
935 1.160 drochner usbd_status
936 1.164 dyoung usbd_probe_and_attach(device_t parent, usbd_device_handle dev,
937 1.164 dyoung int port, int addr)
938 1.160 drochner {
939 1.160 drochner usb_device_descriptor_t *dd = &dev->ddesc;
940 1.160 drochner int confi, nifaces;
941 1.160 drochner usbd_status err;
942 1.160 drochner
943 1.160 drochner /* First try with device specific drivers. */
944 1.160 drochner DPRINTF(("usbd_probe_and_attach: trying device specific drivers\n"));
945 1.160 drochner err = usbd_attachwholedevice(parent, dev, port, 0);
946 1.160 drochner if (dev->nifaces_claimed || err)
947 1.160 drochner return (err);
948 1.160 drochner DPRINTF(("usbd_probe_and_attach: no device specific driver found\n"));
949 1.158 drochner
950 1.60 augustss DPRINTF(("usbd_probe_and_attach: looping over %d configurations\n",
951 1.60 augustss dd->bNumConfigurations));
952 1.18 augustss for (confi = 0; confi < dd->bNumConfigurations; confi++) {
953 1.18 augustss DPRINTFN(1,("usbd_probe_and_attach: trying config idx=%d\n",
954 1.18 augustss confi));
955 1.53 augustss err = usbd_set_config_index(dev, confi, 1);
956 1.53 augustss if (err) {
957 1.18 augustss #ifdef USB_DEBUG
958 1.18 augustss DPRINTF(("%s: port %d, set config at addr %d failed, "
959 1.164 dyoung "error=%s\n", device_xname(parent), port,
960 1.164 dyoung addr, usbd_errstr(err)));
961 1.18 augustss #else
962 1.18 augustss printf("%s: port %d, set config at addr %d failed\n",
963 1.164 dyoung device_xname(parent), port, addr);
964 1.18 augustss #endif
965 1.162 kent return (err);
966 1.18 augustss }
967 1.20 augustss nifaces = dev->cdesc->bNumInterface;
968 1.160 drochner dev->subdevs = malloc(nifaces * sizeof(device_t), M_USB,
969 1.155 drochner M_NOWAIT|M_ZERO);
970 1.160 drochner if (dev->subdevs == NULL)
971 1.34 augustss return (USBD_NOMEM);
972 1.155 drochner dev->subdevlen = nifaces;
973 1.52 augustss
974 1.162 kent err = usbd_attachinterfaces(parent, dev, port, NULL);
975 1.160 drochner
976 1.160 drochner if (!dev->nifaces_claimed) {
977 1.160 drochner free(dev->subdevs, M_USB);
978 1.160 drochner dev->subdevs = 0;
979 1.160 drochner dev->subdevlen = 0;
980 1.18 augustss }
981 1.160 drochner if (dev->nifaces_claimed || err)
982 1.160 drochner return (err);
983 1.18 augustss }
984 1.21 augustss /* No interfaces were attached in any of the configurations. */
985 1.34 augustss
986 1.34 augustss if (dd->bNumConfigurations > 1) /* don't change if only 1 config */
987 1.18 augustss usbd_set_config_index(dev, 0, 0);
988 1.18 augustss
989 1.18 augustss DPRINTF(("usbd_probe_and_attach: no interface drivers found\n"));
990 1.18 augustss
991 1.18 augustss /* Finally try the generic driver. */
992 1.160 drochner err = usbd_attachwholedevice(parent, dev, port, 1);
993 1.18 augustss
994 1.99 augustss /*
995 1.18 augustss * The generic attach failed, but leave the device as it is.
996 1.18 augustss * We just did not find any drivers, that's all. The device is
997 1.18 augustss * fully operational and not harming anyone.
998 1.18 augustss */
999 1.18 augustss DPRINTF(("usbd_probe_and_attach: generic attach failed\n"));
1000 1.162 kent return (USBD_NORMAL_COMPLETION);
1001 1.18 augustss }
1002 1.18 augustss
1003 1.162 kent /**
1004 1.162 kent * Called from uhub_rescan(). usbd_new_device() for the target dev must be
1005 1.162 kent * called before calling this.
1006 1.162 kent */
1007 1.162 kent usbd_status
1008 1.164 dyoung usbd_reattach_device(device_t parent, usbd_device_handle dev,
1009 1.164 dyoung int port, const int *locators)
1010 1.162 kent {
1011 1.162 kent int i, loc;
1012 1.162 kent
1013 1.162 kent if (locators != NULL) {
1014 1.162 kent loc = locators[USBIFIFCF_PORT];
1015 1.162 kent if (loc != USBIFIFCF_PORT_DEFAULT && loc != port)
1016 1.162 kent return USBD_NORMAL_COMPLETION;
1017 1.162 kent loc = locators[USBIFIFCF_VENDOR];
1018 1.162 kent if (loc != USBIFIFCF_VENDOR_DEFAULT &&
1019 1.162 kent loc != UGETW(dev->ddesc.idVendor))
1020 1.162 kent return USBD_NORMAL_COMPLETION;
1021 1.162 kent loc = locators[USBIFIFCF_PRODUCT];
1022 1.162 kent if (loc != USBIFIFCF_PRODUCT_DEFAULT &&
1023 1.162 kent loc != UGETW(dev->ddesc.idProduct))
1024 1.162 kent return USBD_NORMAL_COMPLETION;
1025 1.162 kent loc = locators[USBIFIFCF_RELEASE];
1026 1.162 kent if (loc != USBIFIFCF_RELEASE_DEFAULT &&
1027 1.162 kent loc != UGETW(dev->ddesc.bcdDevice))
1028 1.162 kent return USBD_NORMAL_COMPLETION;
1029 1.162 kent }
1030 1.162 kent if (dev->subdevlen == 0) {
1031 1.162 kent /* XXX: check USBIFIFCF_CONFIGURATION and
1032 1.162 kent * USBIFIFCF_INTERFACE too */
1033 1.162 kent return usbd_probe_and_attach(parent, dev, port, dev->address);
1034 1.162 kent } else if (dev->subdevlen != dev->cdesc->bNumInterface) {
1035 1.162 kent /* device-specific or generic driver is already attached. */
1036 1.162 kent return USBD_NORMAL_COMPLETION;
1037 1.162 kent }
1038 1.162 kent /* Does the device have unconfigured interfaces? */
1039 1.162 kent for (i = 0; i < dev->subdevlen; i++) {
1040 1.162 kent if (dev->subdevs[i] == NULL) {
1041 1.162 kent break;
1042 1.162 kent }
1043 1.162 kent }
1044 1.162 kent if (i >= dev->subdevlen)
1045 1.162 kent return USBD_NORMAL_COMPLETION;
1046 1.162 kent return usbd_attachinterfaces(parent, dev, port, locators);
1047 1.162 kent }
1048 1.18 augustss
1049 1.1 augustss /*
1050 1.172 drochner * Get the first 8 bytes of the device descriptor.
1051 1.172 drochner * Do as Windows does: try to read 64 bytes -- there are devices which
1052 1.172 drochner * recognize the initial descriptor fetch (before the control endpoint's
1053 1.172 drochner * MaxPacketSize is known by the host) by exactly this length.
1054 1.172 drochner */
1055 1.172 drochner static usbd_status
1056 1.172 drochner usbd_get_initial_ddesc(usbd_device_handle dev, usb_device_descriptor_t *desc)
1057 1.172 drochner {
1058 1.172 drochner usb_device_request_t req;
1059 1.172 drochner char buf[64];
1060 1.172 drochner int res, actlen;
1061 1.172 drochner
1062 1.172 drochner req.bmRequestType = UT_READ_DEVICE;
1063 1.172 drochner req.bRequest = UR_GET_DESCRIPTOR;
1064 1.172 drochner USETW2(req.wValue, UDESC_DEVICE, 0);
1065 1.172 drochner USETW(req.wIndex, 0);
1066 1.172 drochner USETW(req.wLength, 64);
1067 1.172 drochner res = usbd_do_request_flags(dev, &req, buf, USBD_SHORT_XFER_OK,
1068 1.172 drochner &actlen, USBD_DEFAULT_TIMEOUT);
1069 1.172 drochner if (res)
1070 1.172 drochner return res;
1071 1.172 drochner if (actlen < 8)
1072 1.172 drochner return USBD_SHORT_XFER;
1073 1.172 drochner memcpy(desc, buf, 8);
1074 1.172 drochner return USBD_NORMAL_COMPLETION;
1075 1.172 drochner }
1076 1.172 drochner
1077 1.172 drochner /*
1078 1.1 augustss * Called when a new device has been put in the powered state,
1079 1.1 augustss * but not yet in the addressed state.
1080 1.1 augustss * Get initial descriptor, set the address, get full descriptor,
1081 1.1 augustss * and attach a driver.
1082 1.1 augustss */
1083 1.1 augustss usbd_status
1084 1.164 dyoung usbd_new_device(device_t parent, usbd_bus_handle bus, int depth,
1085 1.164 dyoung int speed, int port, struct usbd_port *up)
1086 1.1 augustss {
1087 1.120 augustss usbd_device_handle dev, adev;
1088 1.94 augustss struct usbd_device *hub;
1089 1.18 augustss usb_device_descriptor_t *dd;
1090 1.107 augustss usb_port_status_t ps;
1091 1.53 augustss usbd_status err;
1092 1.1 augustss int addr;
1093 1.18 augustss int i;
1094 1.120 augustss int p;
1095 1.1 augustss
1096 1.94 augustss DPRINTF(("usbd_new_device bus=%p port=%d depth=%d speed=%d\n",
1097 1.94 augustss bus, port, depth, speed));
1098 1.1 augustss addr = usbd_getnewaddr(bus);
1099 1.1 augustss if (addr < 0) {
1100 1.99 augustss printf("%s: No free USB addresses, new device ignored.\n",
1101 1.151 drochner device_xname(bus->usbctl));
1102 1.1 augustss return (USBD_NO_ADDR);
1103 1.1 augustss }
1104 1.1 augustss
1105 1.97 tsutsui dev = malloc(sizeof *dev, M_USB, M_NOWAIT|M_ZERO);
1106 1.53 augustss if (dev == NULL)
1107 1.1 augustss return (USBD_NOMEM);
1108 1.1 augustss
1109 1.1 augustss dev->bus = bus;
1110 1.1 augustss
1111 1.1 augustss /* Set up default endpoint handle. */
1112 1.1 augustss dev->def_ep.edesc = &dev->def_ep_desc;
1113 1.1 augustss
1114 1.1 augustss /* Set up default endpoint descriptor. */
1115 1.1 augustss dev->def_ep_desc.bLength = USB_ENDPOINT_DESCRIPTOR_SIZE;
1116 1.1 augustss dev->def_ep_desc.bDescriptorType = UDESC_ENDPOINT;
1117 1.1 augustss dev->def_ep_desc.bEndpointAddress = USB_CONTROL_ENDPOINT;
1118 1.1 augustss dev->def_ep_desc.bmAttributes = UE_CONTROL;
1119 1.172 drochner /*
1120 1.172 drochner * temporary, will be fixed after first descriptor fetch
1121 1.172 drochner * (which uses 64 bytes so it shouldn't be less),
1122 1.172 drochner * highspeed devices must support 64 byte packets anyway
1123 1.172 drochner */
1124 1.172 drochner USETW(dev->def_ep_desc.wMaxPacketSize, 64);
1125 1.1 augustss dev->def_ep_desc.bInterval = 0;
1126 1.1 augustss
1127 1.179 drochner /* doesn't matter, just don't let it uninitialized */
1128 1.179 drochner dev->def_ep.datatoggle = 0;
1129 1.179 drochner
1130 1.1 augustss dev->quirks = &usbd_no_quirk;
1131 1.1 augustss dev->address = USB_START_ADDR;
1132 1.4 augustss dev->ddesc.bMaxPacketSize = 0;
1133 1.1 augustss dev->depth = depth;
1134 1.1 augustss dev->powersrc = up;
1135 1.94 augustss dev->myhub = up->parent;
1136 1.120 augustss
1137 1.120 augustss up->device = dev;
1138 1.120 augustss
1139 1.120 augustss /* Locate port on upstream high speed hub */
1140 1.120 augustss for (adev = dev, hub = up->parent;
1141 1.94 augustss hub != NULL && hub->speed != USB_SPEED_HIGH;
1142 1.120 augustss adev = hub, hub = hub->myhub)
1143 1.94 augustss ;
1144 1.120 augustss if (hub) {
1145 1.120 augustss for (p = 0; p < hub->hub->hubdesc.bNbrPorts; p++) {
1146 1.120 augustss if (hub->hub->ports[p].device == adev) {
1147 1.120 augustss dev->myhsport = &hub->hub->ports[p];
1148 1.120 augustss goto found;
1149 1.120 augustss }
1150 1.120 augustss }
1151 1.120 augustss panic("usbd_new_device: cannot find HS port\n");
1152 1.120 augustss found:
1153 1.120 augustss DPRINTFN(1,("usbd_new_device: high speed port %d\n", p));
1154 1.120 augustss } else {
1155 1.120 augustss dev->myhsport = NULL;
1156 1.120 augustss }
1157 1.94 augustss dev->speed = speed;
1158 1.22 augustss dev->langid = USBD_NOLANG;
1159 1.50 augustss dev->cookie.cookie = ++usb_cookie_no;
1160 1.1 augustss
1161 1.67 soren /* Establish the default pipe. */
1162 1.63 augustss err = usbd_setup_pipe(dev, 0, &dev->def_ep, USBD_DEFAULT_INTERVAL,
1163 1.63 augustss &dev->default_pipe);
1164 1.53 augustss if (err) {
1165 1.18 augustss usbd_remove_device(dev, up);
1166 1.53 augustss return (err);
1167 1.18 augustss }
1168 1.1 augustss
1169 1.18 augustss dd = &dev->ddesc;
1170 1.6 augustss /* Try a few times in case the device is slow (i.e. outside specs.) */
1171 1.107 augustss for (i = 0; i < 10; i++) {
1172 1.6 augustss /* Get the first 8 bytes of the device descriptor. */
1173 1.172 drochner err = usbd_get_initial_ddesc(dev, dd);
1174 1.53 augustss if (!err)
1175 1.6 augustss break;
1176 1.23 augustss usbd_delay_ms(dev, 200);
1177 1.107 augustss if ((i & 3) == 3)
1178 1.107 augustss usbd_reset_port(up->parent, port, &ps);
1179 1.6 augustss }
1180 1.53 augustss if (err) {
1181 1.14 drochner DPRINTFN(-1, ("usbd_new_device: addr=%d, getting first desc "
1182 1.180 matt "failed: %d\n", addr, err));
1183 1.18 augustss usbd_remove_device(dev, up);
1184 1.53 augustss return (err);
1185 1.95 augustss }
1186 1.95 augustss
1187 1.174 drochner /* Windows resets the port here, do likewise */
1188 1.174 drochner if (up->parent)
1189 1.174 drochner usbd_reset_port(up->parent, port, &ps);
1190 1.174 drochner
1191 1.95 augustss if (speed == USB_SPEED_HIGH) {
1192 1.95 augustss /* Max packet size must be 64 (sec 5.5.3). */
1193 1.95 augustss if (dd->bMaxPacketSize != USB_2_MAX_CTRL_PACKET) {
1194 1.95 augustss #ifdef DIAGNOSTIC
1195 1.165 pooka printf("usbd_new_device: addr=%d bad max packet "
1196 1.165 pooka "size=%d. adjusting to %d.\n",
1197 1.165 pooka addr, dd->bMaxPacketSize, USB_2_MAX_CTRL_PACKET);
1198 1.95 augustss #endif
1199 1.95 augustss dd->bMaxPacketSize = USB_2_MAX_CTRL_PACKET;
1200 1.95 augustss }
1201 1.18 augustss }
1202 1.18 augustss
1203 1.39 augustss DPRINTF(("usbd_new_device: adding unit addr=%d, rev=%02x, class=%d, "
1204 1.99 augustss "subclass=%d, protocol=%d, maxpacket=%d, len=%d, speed=%d\n",
1205 1.39 augustss addr,UGETW(dd->bcdUSB), dd->bDeviceClass, dd->bDeviceSubClass,
1206 1.99 augustss dd->bDeviceProtocol, dd->bMaxPacketSize, dd->bLength,
1207 1.94 augustss dev->speed));
1208 1.39 augustss
1209 1.18 augustss if (dd->bDescriptorType != UDESC_DEVICE) {
1210 1.18 augustss /* Illegal device descriptor */
1211 1.18 augustss DPRINTFN(-1,("usbd_new_device: illegal descriptor %d\n",
1212 1.18 augustss dd->bDescriptorType));
1213 1.18 augustss usbd_remove_device(dev, up);
1214 1.18 augustss return (USBD_INVAL);
1215 1.1 augustss }
1216 1.1 augustss
1217 1.39 augustss if (dd->bLength < USB_DEVICE_DESCRIPTOR_SIZE) {
1218 1.39 augustss DPRINTFN(-1,("usbd_new_device: bad length %d\n", dd->bLength));
1219 1.39 augustss usbd_remove_device(dev, up);
1220 1.39 augustss return (USBD_INVAL);
1221 1.39 augustss }
1222 1.4 augustss
1223 1.18 augustss USETW(dev->def_ep_desc.wMaxPacketSize, dd->bMaxPacketSize);
1224 1.1 augustss
1225 1.159 jmcneill /* Set the address */
1226 1.159 jmcneill DPRINTFN(5, ("usbd_new_device: setting device address=%d\n", addr));
1227 1.159 jmcneill err = usbd_set_address(dev, addr);
1228 1.159 jmcneill if (err) {
1229 1.159 jmcneill DPRINTFN(-1, ("usbd_new_device: set address %d failed\n", addr));
1230 1.159 jmcneill err = USBD_SET_ADDR_FAILED;
1231 1.159 jmcneill usbd_remove_device(dev, up);
1232 1.159 jmcneill return err;
1233 1.159 jmcneill }
1234 1.159 jmcneill
1235 1.159 jmcneill /* Allow device time to set new address */
1236 1.159 jmcneill usbd_delay_ms(dev, USB_SET_ADDRESS_SETTLE);
1237 1.159 jmcneill dev->address = addr; /* new device address now */
1238 1.159 jmcneill bus->devices[addr] = dev;
1239 1.159 jmcneill
1240 1.168 matthias err = usbd_reload_device_desc(dev);
1241 1.168 matthias if (err) {
1242 1.168 matthias DPRINTFN(-1, ("usbd_new_device: addr=%d, getting full desc "
1243 1.168 matthias "failed\n", addr));
1244 1.168 matthias usbd_remove_device(dev, up);
1245 1.168 matthias return (err);
1246 1.168 matthias }
1247 1.168 matthias
1248 1.159 jmcneill /* Re-establish the default pipe with the new address. */
1249 1.159 jmcneill usbd_kill_pipe(dev->default_pipe);
1250 1.159 jmcneill err = usbd_setup_pipe(dev, 0, &dev->def_ep, USBD_DEFAULT_INTERVAL,
1251 1.159 jmcneill &dev->default_pipe);
1252 1.159 jmcneill if (err) {
1253 1.159 jmcneill DPRINTFN(-1, ("usbd_new_device: setup default pipe failed\n"));
1254 1.159 jmcneill usbd_remove_device(dev, up);
1255 1.159 jmcneill return err;
1256 1.159 jmcneill }
1257 1.159 jmcneill
1258 1.1 augustss /* Assume 100mA bus powered for now. Changed when configured. */
1259 1.1 augustss dev->power = USB_MIN_POWER;
1260 1.1 augustss dev->self_powered = 0;
1261 1.1 augustss
1262 1.99 augustss DPRINTF(("usbd_new_device: new dev (addr %d), dev=%p, parent=%p\n",
1263 1.1 augustss addr, dev, parent));
1264 1.99 augustss
1265 1.65 augustss usbd_add_dev_event(USB_EVENT_DEVICE_ATTACH, dev);
1266 1.1 augustss
1267 1.155 drochner if (port == 0) { /* root hub */
1268 1.155 drochner KASSERT(addr == 1);
1269 1.155 drochner usbd_attach_roothub(parent, dev);
1270 1.155 drochner return (USBD_NORMAL_COMPLETION);
1271 1.155 drochner }
1272 1.155 drochner
1273 1.53 augustss err = usbd_probe_and_attach(parent, dev, port, addr);
1274 1.53 augustss if (err) {
1275 1.18 augustss usbd_remove_device(dev, up);
1276 1.53 augustss return (err);
1277 1.164 dyoung }
1278 1.65 augustss
1279 1.164 dyoung return (USBD_NORMAL_COMPLETION);
1280 1.62 augustss }
1281 1.62 augustss
1282 1.62 augustss usbd_status
1283 1.78 augustss usbd_reload_device_desc(usbd_device_handle dev)
1284 1.62 augustss {
1285 1.62 augustss usbd_status err;
1286 1.62 augustss
1287 1.62 augustss /* Get the full device descriptor. */
1288 1.62 augustss err = usbd_get_device_desc(dev, &dev->ddesc);
1289 1.62 augustss if (err)
1290 1.62 augustss return (err);
1291 1.62 augustss
1292 1.62 augustss /* Figure out what's wrong with this device. */
1293 1.62 augustss dev->quirks = usbd_find_quirk(&dev->ddesc);
1294 1.62 augustss
1295 1.62 augustss return (USBD_NORMAL_COMPLETION);
1296 1.18 augustss }
1297 1.1 augustss
1298 1.18 augustss void
1299 1.78 augustss usbd_remove_device(usbd_device_handle dev, struct usbd_port *up)
1300 1.18 augustss {
1301 1.182 mrg
1302 1.18 augustss DPRINTF(("usbd_remove_device: %p\n", dev));
1303 1.99 augustss
1304 1.53 augustss if (dev->default_pipe != NULL)
1305 1.18 augustss usbd_kill_pipe(dev->default_pipe);
1306 1.120 augustss up->device = NULL;
1307 1.120 augustss dev->bus->devices[dev->address] = NULL;
1308 1.1 augustss
1309 1.1 augustss free(dev, M_USB);
1310 1.1 augustss }
1311 1.1 augustss
1312 1.1 augustss int
1313 1.78 augustss usbd_print(void *aux, const char *pnp)
1314 1.1 augustss {
1315 1.1 augustss struct usb_attach_arg *uaa = aux;
1316 1.1 augustss
1317 1.1 augustss DPRINTFN(15, ("usbd_print dev=%p\n", uaa->device));
1318 1.1 augustss if (pnp) {
1319 1.134 christos #define USB_DEVINFO 1024
1320 1.134 christos char *devinfo;
1321 1.1 augustss if (!uaa->usegeneric)
1322 1.1 augustss return (QUIET);
1323 1.134 christos devinfo = malloc(USB_DEVINFO, M_TEMP, M_WAITOK);
1324 1.134 christos usbd_devinfo(uaa->device, 1, devinfo, USB_DEVINFO);
1325 1.101 thorpej aprint_normal("%s, %s", devinfo, pnp);
1326 1.134 christos free(devinfo, M_TEMP);
1327 1.1 augustss }
1328 1.155 drochner aprint_normal(" port %d", uaa->port);
1329 1.144 drochner #if 0
1330 1.144 drochner /*
1331 1.144 drochner * It gets very crowded with these locators on the attach line.
1332 1.144 drochner * They are not really needed since they are printed in the clear
1333 1.144 drochner * by each driver.
1334 1.144 drochner */
1335 1.144 drochner if (uaa->vendor != UHUB_UNK_VENDOR)
1336 1.144 drochner aprint_normal(" vendor 0x%04x", uaa->vendor);
1337 1.144 drochner if (uaa->product != UHUB_UNK_PRODUCT)
1338 1.144 drochner aprint_normal(" product 0x%04x", uaa->product);
1339 1.144 drochner if (uaa->release != UHUB_UNK_RELEASE)
1340 1.144 drochner aprint_normal(" release 0x%04x", uaa->release);
1341 1.144 drochner #endif
1342 1.144 drochner return (UNCONF);
1343 1.144 drochner }
1344 1.144 drochner
1345 1.144 drochner int
1346 1.144 drochner usbd_ifprint(void *aux, const char *pnp)
1347 1.144 drochner {
1348 1.144 drochner struct usbif_attach_arg *uaa = aux;
1349 1.144 drochner
1350 1.144 drochner DPRINTFN(15, ("usbd_print dev=%p\n", uaa->device));
1351 1.144 drochner if (pnp)
1352 1.144 drochner return (QUIET);
1353 1.155 drochner aprint_normal(" port %d", uaa->port);
1354 1.156 drochner aprint_normal(" configuration %d", uaa->configno);
1355 1.156 drochner aprint_normal(" interface %d", uaa->ifaceno);
1356 1.32 augustss #if 0
1357 1.99 augustss /*
1358 1.32 augustss * It gets very crowded with these locators on the attach line.
1359 1.32 augustss * They are not really needed since they are printed in the clear
1360 1.32 augustss * by each driver.
1361 1.32 augustss */
1362 1.32 augustss if (uaa->vendor != UHUB_UNK_VENDOR)
1363 1.101 thorpej aprint_normal(" vendor 0x%04x", uaa->vendor);
1364 1.32 augustss if (uaa->product != UHUB_UNK_PRODUCT)
1365 1.101 thorpej aprint_normal(" product 0x%04x", uaa->product);
1366 1.32 augustss if (uaa->release != UHUB_UNK_RELEASE)
1367 1.101 thorpej aprint_normal(" release 0x%04x", uaa->release);
1368 1.32 augustss #endif
1369 1.1 augustss return (UNCONF);
1370 1.1 augustss }
1371 1.1 augustss
1372 1.13 augustss void
1373 1.82 augustss usbd_fill_deviceinfo(usbd_device_handle dev, struct usb_device_info *di,
1374 1.82 augustss int usedev)
1375 1.13 augustss {
1376 1.13 augustss struct usbd_port *p;
1377 1.155 drochner int i, j, err, s;
1378 1.13 augustss
1379 1.151 drochner di->udi_bus = device_unit(dev->bus->usbctl);
1380 1.98 christos di->udi_addr = dev->address;
1381 1.98 christos di->udi_cookie = dev->cookie;
1382 1.175 christos usbd_devinfo_vp(dev, di->udi_vendor, sizeof(di->udi_vendor),
1383 1.175 christos di->udi_product, sizeof(di->udi_product), usedev, 1);
1384 1.113 itojun usbd_printBCD(di->udi_release, sizeof(di->udi_release),
1385 1.113 itojun UGETW(dev->ddesc.bcdDevice));
1386 1.123 augustss di->udi_serial[0] = 0;
1387 1.123 augustss if (usedev)
1388 1.123 augustss (void)usbd_get_string(dev, dev->ddesc.iSerialNumber,
1389 1.123 augustss di->udi_serial);
1390 1.98 christos di->udi_vendorNo = UGETW(dev->ddesc.idVendor);
1391 1.98 christos di->udi_productNo = UGETW(dev->ddesc.idProduct);
1392 1.98 christos di->udi_releaseNo = UGETW(dev->ddesc.bcdDevice);
1393 1.98 christos di->udi_class = dev->ddesc.bDeviceClass;
1394 1.98 christos di->udi_subclass = dev->ddesc.bDeviceSubClass;
1395 1.98 christos di->udi_protocol = dev->ddesc.bDeviceProtocol;
1396 1.98 christos di->udi_config = dev->config;
1397 1.98 christos di->udi_power = dev->self_powered ? 0 : dev->power;
1398 1.98 christos di->udi_speed = dev->speed;
1399 1.65 augustss
1400 1.155 drochner if (dev->subdevlen > 0) {
1401 1.155 drochner for (i = 0, j = 0; i < dev->subdevlen &&
1402 1.155 drochner j < USB_MAX_DEVNAMES; i++) {
1403 1.155 drochner if (!dev->subdevs[i])
1404 1.155 drochner continue;
1405 1.164 dyoung strncpy(di->udi_devnames[j],
1406 1.164 dyoung device_xname(dev->subdevs[i]), USB_MAX_DEVNAMELEN);
1407 1.155 drochner di->udi_devnames[j][USB_MAX_DEVNAMELEN-1] = '\0';
1408 1.155 drochner j++;
1409 1.164 dyoung }
1410 1.164 dyoung } else {
1411 1.164 dyoung j = 0;
1412 1.164 dyoung }
1413 1.164 dyoung for (/* j is set */; j < USB_MAX_DEVNAMES; j++)
1414 1.164 dyoung di->udi_devnames[j][0] = 0; /* empty */
1415 1.65 augustss
1416 1.13 augustss if (dev->hub) {
1417 1.99 augustss for (i = 0;
1418 1.98 christos i < sizeof(di->udi_ports) / sizeof(di->udi_ports[0]) &&
1419 1.13 augustss i < dev->hub->hubdesc.bNbrPorts;
1420 1.13 augustss i++) {
1421 1.13 augustss p = &dev->hub->ports[i];
1422 1.13 augustss if (p->device)
1423 1.56 augustss err = p->device->address;
1424 1.13 augustss else {
1425 1.13 augustss s = UGETW(p->status.wPortStatus);
1426 1.13 augustss if (s & UPS_PORT_ENABLED)
1427 1.56 augustss err = USB_PORT_ENABLED;
1428 1.13 augustss else if (s & UPS_SUSPEND)
1429 1.56 augustss err = USB_PORT_SUSPENDED;
1430 1.13 augustss else if (s & UPS_PORT_POWER)
1431 1.56 augustss err = USB_PORT_POWERED;
1432 1.13 augustss else
1433 1.56 augustss err = USB_PORT_DISABLED;
1434 1.13 augustss }
1435 1.98 christos di->udi_ports[i] = err;
1436 1.13 augustss }
1437 1.98 christos di->udi_nports = dev->hub->hubdesc.bNbrPorts;
1438 1.13 augustss } else
1439 1.98 christos di->udi_nports = 0;
1440 1.34 augustss }
1441 1.34 augustss
1442 1.139 pavel #ifdef COMPAT_30
1443 1.139 pavel void
1444 1.139 pavel usbd_fill_deviceinfo_old(usbd_device_handle dev, struct usb_device_info_old *di,
1445 1.139 pavel int usedev)
1446 1.139 pavel {
1447 1.139 pavel struct usbd_port *p;
1448 1.155 drochner int i, j, err, s;
1449 1.139 pavel
1450 1.151 drochner di->udi_bus = device_unit(dev->bus->usbctl);
1451 1.139 pavel di->udi_addr = dev->address;
1452 1.139 pavel di->udi_cookie = dev->cookie;
1453 1.175 christos usbd_devinfo_vp(dev, di->udi_vendor, sizeof(di->udi_vendor),
1454 1.175 christos di->udi_product, sizeof(di->udi_product), usedev, 0);
1455 1.139 pavel usbd_printBCD(di->udi_release, sizeof(di->udi_release),
1456 1.139 pavel UGETW(dev->ddesc.bcdDevice));
1457 1.139 pavel di->udi_vendorNo = UGETW(dev->ddesc.idVendor);
1458 1.139 pavel di->udi_productNo = UGETW(dev->ddesc.idProduct);
1459 1.139 pavel di->udi_releaseNo = UGETW(dev->ddesc.bcdDevice);
1460 1.139 pavel di->udi_class = dev->ddesc.bDeviceClass;
1461 1.139 pavel di->udi_subclass = dev->ddesc.bDeviceSubClass;
1462 1.139 pavel di->udi_protocol = dev->ddesc.bDeviceProtocol;
1463 1.139 pavel di->udi_config = dev->config;
1464 1.139 pavel di->udi_power = dev->self_powered ? 0 : dev->power;
1465 1.139 pavel di->udi_speed = dev->speed;
1466 1.139 pavel
1467 1.155 drochner if (dev->subdevlen > 0) {
1468 1.155 drochner for (i = 0, j = 0; i < dev->subdevlen &&
1469 1.155 drochner j < USB_MAX_DEVNAMES; i++) {
1470 1.155 drochner if (!dev->subdevs[i])
1471 1.155 drochner continue;
1472 1.164 dyoung strncpy(di->udi_devnames[j],
1473 1.164 dyoung device_xname(dev->subdevs[i]), USB_MAX_DEVNAMELEN);
1474 1.155 drochner di->udi_devnames[j][USB_MAX_DEVNAMELEN-1] = '\0';
1475 1.155 drochner j++;
1476 1.139 pavel }
1477 1.139 pavel } else {
1478 1.155 drochner j = 0;
1479 1.139 pavel }
1480 1.155 drochner for (/* j is set */; j < USB_MAX_DEVNAMES; j++)
1481 1.155 drochner di->udi_devnames[j][0] = 0; /* empty */
1482 1.139 pavel
1483 1.139 pavel if (dev->hub) {
1484 1.139 pavel for (i = 0;
1485 1.139 pavel i < sizeof(di->udi_ports) / sizeof(di->udi_ports[0]) &&
1486 1.139 pavel i < dev->hub->hubdesc.bNbrPorts;
1487 1.139 pavel i++) {
1488 1.139 pavel p = &dev->hub->ports[i];
1489 1.139 pavel if (p->device)
1490 1.139 pavel err = p->device->address;
1491 1.139 pavel else {
1492 1.139 pavel s = UGETW(p->status.wPortStatus);
1493 1.139 pavel if (s & UPS_PORT_ENABLED)
1494 1.139 pavel err = USB_PORT_ENABLED;
1495 1.139 pavel else if (s & UPS_SUSPEND)
1496 1.139 pavel err = USB_PORT_SUSPENDED;
1497 1.139 pavel else if (s & UPS_PORT_POWER)
1498 1.139 pavel err = USB_PORT_POWERED;
1499 1.139 pavel else
1500 1.139 pavel err = USB_PORT_DISABLED;
1501 1.139 pavel }
1502 1.139 pavel di->udi_ports[i] = err;
1503 1.139 pavel }
1504 1.139 pavel di->udi_nports = dev->hub->hubdesc.bNbrPorts;
1505 1.139 pavel } else
1506 1.139 pavel di->udi_nports = 0;
1507 1.139 pavel }
1508 1.139 pavel #endif
1509 1.139 pavel
1510 1.139 pavel
1511 1.34 augustss void
1512 1.78 augustss usb_free_device(usbd_device_handle dev)
1513 1.34 augustss {
1514 1.34 augustss int ifcidx, nifc;
1515 1.34 augustss
1516 1.53 augustss if (dev->default_pipe != NULL)
1517 1.34 augustss usbd_kill_pipe(dev->default_pipe);
1518 1.53 augustss if (dev->ifaces != NULL) {
1519 1.34 augustss nifc = dev->cdesc->bNumInterface;
1520 1.34 augustss for (ifcidx = 0; ifcidx < nifc; ifcidx++)
1521 1.34 augustss usbd_free_iface_data(dev, ifcidx);
1522 1.34 augustss free(dev->ifaces, M_USB);
1523 1.34 augustss }
1524 1.53 augustss if (dev->cdesc != NULL)
1525 1.34 augustss free(dev->cdesc, M_USB);
1526 1.155 drochner if (dev->subdevlen > 0) {
1527 1.34 augustss free(dev->subdevs, M_USB);
1528 1.155 drochner dev->subdevlen = 0;
1529 1.155 drochner }
1530 1.34 augustss free(dev, M_USB);
1531 1.1 augustss }
1532 1.47 augustss
1533 1.47 augustss /*
1534 1.47 augustss * The general mechanism for detaching drivers works as follows: Each
1535 1.47 augustss * driver is responsible for maintaining a reference count on the
1536 1.47 augustss * number of outstanding references to its softc (e.g. from
1537 1.47 augustss * processing hanging in a read or write). The detach method of the
1538 1.47 augustss * driver decrements this counter and flags in the softc that the
1539 1.47 augustss * driver is dying and then wakes any sleepers. It then sleeps on the
1540 1.47 augustss * softc. Each place that can sleep must maintain the reference
1541 1.47 augustss * count. When the reference count drops to -1 (0 is the normal value
1542 1.47 augustss * of the reference count) the a wakeup on the softc is performed
1543 1.47 augustss * signaling to the detach waiter that all references are gone.
1544 1.47 augustss */
1545 1.47 augustss
1546 1.47 augustss /*
1547 1.47 augustss * Called from process context when we discover that a port has
1548 1.47 augustss * been disconnected.
1549 1.47 augustss */
1550 1.167 dyoung int
1551 1.167 dyoung usb_disconnect_port(struct usbd_port *up, device_t parent, int flags)
1552 1.47 augustss {
1553 1.47 augustss usbd_device_handle dev = up->device;
1554 1.167 dyoung device_t subdev;
1555 1.167 dyoung char subdevname[16];
1556 1.164 dyoung const char *hubname = device_xname(parent);
1557 1.167 dyoung int i, rc;
1558 1.47 augustss
1559 1.99 augustss DPRINTFN(3,("uhub_disconnect: up=%p dev=%p port=%d\n",
1560 1.47 augustss up, dev, up->portno));
1561 1.48 augustss
1562 1.167 dyoung if (dev == NULL) {
1563 1.48 augustss #ifdef DIAGNOSTIC
1564 1.48 augustss printf("usb_disconnect_port: no device\n");
1565 1.167 dyoung #endif
1566 1.167 dyoung return 0;
1567 1.48 augustss }
1568 1.47 augustss
1569 1.155 drochner if (dev->subdevlen > 0) {
1570 1.57 augustss DPRINTFN(3,("usb_disconnect_port: disconnect subdevs\n"));
1571 1.155 drochner for (i = 0; i < dev->subdevlen; i++) {
1572 1.167 dyoung if ((subdev = dev->subdevs[i]) == NULL)
1573 1.155 drochner continue;
1574 1.167 dyoung strlcpy(subdevname, device_xname(subdev),
1575 1.167 dyoung sizeof(subdevname));
1576 1.167 dyoung if ((rc = config_detach(subdev, flags)) != 0)
1577 1.167 dyoung return rc;
1578 1.167 dyoung printf("%s: at %s", subdevname, hubname);
1579 1.51 augustss if (up->portno != 0)
1580 1.51 augustss printf(" port %d", up->portno);
1581 1.51 augustss printf(" (addr %d) disconnected\n", dev->address);
1582 1.47 augustss }
1583 1.160 drochner KASSERT(!dev->nifaces_claimed);
1584 1.47 augustss }
1585 1.47 augustss
1586 1.65 augustss usbd_add_dev_event(USB_EVENT_DEVICE_DETACH, dev);
1587 1.57 augustss dev->bus->devices[dev->address] = NULL;
1588 1.57 augustss up->device = NULL;
1589 1.47 augustss usb_free_device(dev);
1590 1.167 dyoung return 0;
1591 1.47 augustss }
1592