usb_subr.c revision 1.263 1 1.262 mlelstv /* $NetBSD: usb_subr.c,v 1.263 2021/06/13 08:50:33 mlelstv 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.262 mlelstv __KERNEL_RCSID(0, "$NetBSD: usb_subr.c,v 1.263 2021/06/13 08:50:33 mlelstv Exp $");
36 1.104 martin
37 1.186 christos #ifdef _KERNEL_OPT
38 1.140 pavel #include "opt_compat_netbsd.h"
39 1.197 skrll #include "opt_usb.h"
40 1.104 martin #include "opt_usbverbose.h"
41 1.186 christos #endif
42 1.1 augustss
43 1.1 augustss #include <sys/param.h>
44 1.1 augustss #include <sys/systm.h>
45 1.1 augustss #include <sys/kernel.h>
46 1.208 skrll #include <sys/kmem.h>
47 1.1 augustss #include <sys/device.h>
48 1.56 augustss #include <sys/select.h>
49 1.1 augustss #include <sys/proc.h>
50 1.46 augustss
51 1.149 ad #include <sys/bus.h>
52 1.169 pgoyette #include <sys/module.h>
53 1.1 augustss
54 1.1 augustss #include <dev/usb/usb.h>
55 1.1 augustss
56 1.1 augustss #include <dev/usb/usbdi.h>
57 1.1 augustss #include <dev/usb/usbdi_util.h>
58 1.1 augustss #include <dev/usb/usbdivar.h>
59 1.1 augustss #include <dev/usb/usbdevs.h>
60 1.1 augustss #include <dev/usb/usb_quirks.h>
61 1.169 pgoyette #include <dev/usb/usb_verbose.h>
62 1.205 skrll #include <dev/usb/usbhist.h>
63 1.1 augustss
64 1.158 drochner #include "locators.h"
65 1.158 drochner
66 1.205 skrll #define DPRINTF(FMT,A,B,C,D) USBHIST_LOG(usbdebug,FMT,A,B,C,D)
67 1.205 skrll #define DPRINTFN(N,FMT,A,B,C,D) USBHIST_LOGN(usbdebug,N,FMT,A,B,C,D)
68 1.1 augustss
69 1.210 skrll Static void usbd_devinfo(struct usbd_device *, int, char *, size_t);
70 1.210 skrll Static int usbd_getnewaddr(struct usbd_bus *);
71 1.118 drochner Static int usbd_print(void *, const char *);
72 1.144 drochner Static int usbd_ifprint(void *, const char *);
73 1.210 skrll Static void usbd_free_iface_data(struct usbd_device *, int);
74 1.1 augustss
75 1.193 jakllsch uint32_t usb_cookie_no = 0;
76 1.27 augustss
77 1.84 jdolecek Static const char * const usbd_error_strs[] = {
78 1.12 augustss "NORMAL_COMPLETION",
79 1.12 augustss "IN_PROGRESS",
80 1.12 augustss "PENDING_REQUESTS",
81 1.12 augustss "NOT_STARTED",
82 1.12 augustss "INVAL",
83 1.12 augustss "NOMEM",
84 1.12 augustss "CANCELLED",
85 1.12 augustss "BAD_ADDRESS",
86 1.12 augustss "IN_USE",
87 1.12 augustss "NO_ADDR",
88 1.12 augustss "SET_ADDR_FAILED",
89 1.12 augustss "NO_POWER",
90 1.12 augustss "TOO_DEEP",
91 1.12 augustss "IOERROR",
92 1.12 augustss "NOT_CONFIGURED",
93 1.12 augustss "TIMEOUT",
94 1.12 augustss "SHORT_XFER",
95 1.12 augustss "STALLED",
96 1.33 augustss "INTERRUPTED",
97 1.12 augustss "XXX",
98 1.12 augustss };
99 1.1 augustss
100 1.198 christos DEV_VERBOSE_DEFINE(usb);
101 1.169 pgoyette
102 1.42 thorpej const char *
103 1.78 augustss usbd_errstr(usbd_status err)
104 1.39 augustss {
105 1.39 augustss static char buffer[5];
106 1.39 augustss
107 1.42 thorpej if (err < USBD_ERROR_MAX) {
108 1.39 augustss return usbd_error_strs[err];
109 1.39 augustss } else {
110 1.210 skrll snprintf(buffer, sizeof(buffer), "%d", err);
111 1.39 augustss return buffer;
112 1.39 augustss }
113 1.39 augustss }
114 1.39 augustss
115 1.128 enami static void
116 1.128 enami usbd_trim_spaces(char *p)
117 1.83 augustss {
118 1.128 enami char *q, *e;
119 1.83 augustss
120 1.128 enami q = e = p;
121 1.128 enami while (*q == ' ') /* skip leading spaces */
122 1.85 augustss q++;
123 1.128 enami while ((*p = *q++)) /* copy string */
124 1.128 enami if (*p++ != ' ') /* remember last non-space */
125 1.128 enami e = p;
126 1.128 enami *e = '\0'; /* kill trailing spaces */
127 1.83 augustss }
128 1.83 augustss
129 1.207 skrll static void
130 1.207 skrll usbd_get_device_string(struct usbd_device *ud, uByte index, char **buf)
131 1.207 skrll {
132 1.220 chs char *b;
133 1.220 chs usbd_status err;
134 1.220 chs
135 1.220 chs b = kmem_alloc(USB_MAX_ENCODED_STRING_LEN, KM_SLEEP);
136 1.220 chs err = usbd_get_string0(ud, index, b, true);
137 1.220 chs if (err != USBD_NORMAL_COMPLETION) {
138 1.220 chs kmem_free(b, USB_MAX_ENCODED_STRING_LEN);
139 1.220 chs b = NULL;
140 1.220 chs } else {
141 1.220 chs usbd_trim_spaces(b);
142 1.207 skrll }
143 1.220 chs
144 1.207 skrll *buf = b;
145 1.207 skrll }
146 1.207 skrll
147 1.207 skrll void
148 1.207 skrll usbd_get_device_strings(struct usbd_device *ud)
149 1.207 skrll {
150 1.210 skrll usb_device_descriptor_t *udd = &ud->ud_ddesc;
151 1.207 skrll
152 1.207 skrll usbd_get_device_string(ud, udd->iManufacturer, &ud->ud_vendor);
153 1.207 skrll usbd_get_device_string(ud, udd->iProduct, &ud->ud_product);
154 1.207 skrll usbd_get_device_string(ud, udd->iSerialNumber, &ud->ud_serial);
155 1.207 skrll }
156 1.207 skrll
157 1.207 skrll
158 1.229 pgoyette void
159 1.210 skrll usbd_devinfo_vp(struct usbd_device *dev, char *v, size_t vl, char *p,
160 1.175 christos size_t pl, int usedev, int useencoded)
161 1.1 augustss {
162 1.210 skrll usb_device_descriptor_t *udd = &dev->ud_ddesc;
163 1.175 christos if (dev == NULL)
164 1.175 christos return;
165 1.1 augustss
166 1.128 enami v[0] = p[0] = '\0';
167 1.52 augustss
168 1.82 augustss if (usedev) {
169 1.139 pavel if (usbd_get_string0(dev, udd->iManufacturer, v, useencoded) ==
170 1.128 enami USBD_NORMAL_COMPLETION)
171 1.128 enami usbd_trim_spaces(v);
172 1.139 pavel if (usbd_get_string0(dev, udd->iProduct, p, useencoded) ==
173 1.128 enami USBD_NORMAL_COMPLETION)
174 1.128 enami usbd_trim_spaces(p);
175 1.207 skrll } else {
176 1.207 skrll if (dev->ud_vendor) {
177 1.207 skrll strlcpy(v, dev->ud_vendor, vl);
178 1.207 skrll }
179 1.207 skrll if (dev->ud_product) {
180 1.207 skrll strlcpy(p, dev->ud_product, pl);
181 1.207 skrll }
182 1.82 augustss }
183 1.128 enami if (v[0] == '\0')
184 1.198 christos usb_findvendor(v, vl, UGETW(udd->idVendor));
185 1.128 enami if (p[0] == '\0')
186 1.198 christos usb_findproduct(p, pl, UGETW(udd->idVendor),
187 1.175 christos UGETW(udd->idProduct));
188 1.1 augustss }
189 1.1 augustss
190 1.1 augustss int
191 1.113 itojun usbd_printBCD(char *cp, size_t l, int bcd)
192 1.1 augustss {
193 1.175 christos return snprintf(cp, l, "%x.%02x", bcd >> 8, bcd & 0xff);
194 1.1 augustss }
195 1.1 augustss
196 1.124 augustss Static void
197 1.210 skrll usbd_devinfo(struct usbd_device *dev, int showclass, char *cp, size_t l)
198 1.1 augustss {
199 1.210 skrll usb_device_descriptor_t *udd = &dev->ud_ddesc;
200 1.133 christos char *vendor, *product;
201 1.1 augustss int bcdDevice, bcdUSB;
202 1.113 itojun char *ep;
203 1.113 itojun
204 1.210 skrll vendor = kmem_alloc(USB_MAX_ENCODED_STRING_LEN * 2, KM_SLEEP);
205 1.133 christos product = &vendor[USB_MAX_ENCODED_STRING_LEN];
206 1.133 christos
207 1.113 itojun ep = cp + l;
208 1.1 augustss
209 1.175 christos usbd_devinfo_vp(dev, vendor, USB_MAX_ENCODED_STRING_LEN,
210 1.207 skrll product, USB_MAX_ENCODED_STRING_LEN, 0, 1);
211 1.243 christos cp += snprintf(cp, ep - cp, "%s (0x%04x) %s (0x%04x)", vendor,
212 1.219 christos UGETW(udd->idVendor), product, UGETW(udd->idProduct));
213 1.1 augustss if (showclass)
214 1.113 itojun cp += snprintf(cp, ep - cp, ", class %d/%d",
215 1.113 itojun udd->bDeviceClass, udd->bDeviceSubClass);
216 1.1 augustss bcdUSB = UGETW(udd->bcdUSB);
217 1.1 augustss bcdDevice = UGETW(udd->bcdDevice);
218 1.113 itojun cp += snprintf(cp, ep - cp, ", rev ");
219 1.113 itojun cp += usbd_printBCD(cp, ep - cp, bcdUSB);
220 1.1 augustss *cp++ = '/';
221 1.113 itojun cp += usbd_printBCD(cp, ep - cp, bcdDevice);
222 1.210 skrll cp += snprintf(cp, ep - cp, ", addr %d", dev->ud_addr);
223 1.10 augustss *cp = 0;
224 1.210 skrll kmem_free(vendor, USB_MAX_ENCODED_STRING_LEN * 2);
225 1.1 augustss }
226 1.1 augustss
227 1.124 augustss char *
228 1.210 skrll usbd_devinfo_alloc(struct usbd_device *dev, int showclass)
229 1.124 augustss {
230 1.124 augustss char *devinfop;
231 1.124 augustss
232 1.210 skrll devinfop = kmem_alloc(DEVINFOSIZE, KM_SLEEP);
233 1.124 augustss usbd_devinfo(dev, showclass, devinfop, DEVINFOSIZE);
234 1.124 augustss return devinfop;
235 1.124 augustss }
236 1.124 augustss
237 1.124 augustss void
238 1.124 augustss usbd_devinfo_free(char *devinfop)
239 1.124 augustss {
240 1.210 skrll kmem_free(devinfop, DEVINFOSIZE);
241 1.124 augustss }
242 1.124 augustss
243 1.1 augustss /* Delay for a certain number of ms */
244 1.1 augustss void
245 1.210 skrll usb_delay_ms_locked(struct usbd_bus *bus, u_int ms, kmutex_t *lock)
246 1.1 augustss {
247 1.1 augustss /* Wait at least two clock ticks so we know the time has passed. */
248 1.210 skrll if (bus->ub_usepolling || cold)
249 1.1 augustss delay((ms+1) * 1000);
250 1.1 augustss else
251 1.182 mrg kpause("usbdly", false, (ms*hz+999)/1000 + 1, lock);
252 1.182 mrg }
253 1.182 mrg
254 1.182 mrg void
255 1.210 skrll usb_delay_ms(struct usbd_bus *bus, u_int ms)
256 1.182 mrg {
257 1.182 mrg usb_delay_ms_locked(bus, ms, NULL);
258 1.182 mrg }
259 1.182 mrg
260 1.182 mrg /* Delay given a device handle. */
261 1.182 mrg void
262 1.210 skrll usbd_delay_ms_locked(struct usbd_device *dev, u_int ms, kmutex_t *lock)
263 1.182 mrg {
264 1.210 skrll usb_delay_ms_locked(dev->ud_bus, ms, lock);
265 1.1 augustss }
266 1.1 augustss
267 1.23 augustss /* Delay given a device handle. */
268 1.23 augustss void
269 1.210 skrll usbd_delay_ms(struct usbd_device *dev, u_int ms)
270 1.23 augustss {
271 1.210 skrll usb_delay_ms_locked(dev->ud_bus, ms, NULL);
272 1.23 augustss }
273 1.23 augustss
274 1.1 augustss usbd_status
275 1.210 skrll usbd_reset_port(struct usbd_device *dev, int port, usb_port_status_t *ps)
276 1.1 augustss {
277 1.238 mrg USBHIST_FUNC(); USBHIST_CALLARGS(usbdebug, "port %jd", port, 0, 0, 0);
278 1.1 augustss usb_device_request_t req;
279 1.53 augustss usbd_status err;
280 1.1 augustss int n;
281 1.99 augustss
282 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_OTHER;
283 1.1 augustss req.bRequest = UR_SET_FEATURE;
284 1.1 augustss USETW(req.wValue, UHF_PORT_RESET);
285 1.1 augustss USETW(req.wIndex, port);
286 1.1 augustss USETW(req.wLength, 0);
287 1.53 augustss err = usbd_do_request(dev, &req, 0);
288 1.221 pgoyette DPRINTFN(1, "port %jd reset done, error=%jd", port, err, 0, 0);
289 1.53 augustss if (err)
290 1.210 skrll return err;
291 1.1 augustss n = 10;
292 1.1 augustss do {
293 1.1 augustss /* Wait for device to recover from reset. */
294 1.23 augustss usbd_delay_ms(dev, USB_PORT_RESET_DELAY);
295 1.53 augustss err = usbd_get_port_status(dev, port, ps);
296 1.53 augustss if (err) {
297 1.221 pgoyette DPRINTF("get status failed %jd", err, 0, 0, 0);
298 1.210 skrll return err;
299 1.1 augustss }
300 1.92 augustss /* If the device disappeared, just give up. */
301 1.92 augustss if (!(UGETW(ps->wPortStatus) & UPS_CURRENT_CONNECT_STATUS))
302 1.210 skrll return USBD_NORMAL_COMPLETION;
303 1.1 augustss } while ((UGETW(ps->wPortChange) & UPS_C_PORT_RESET) == 0 && --n > 0);
304 1.73 augustss if (n == 0)
305 1.210 skrll return USBD_TIMEOUT;
306 1.53 augustss err = usbd_clear_port_feature(dev, port, UHF_C_PORT_RESET);
307 1.1 augustss #ifdef USB_DEBUG
308 1.53 augustss if (err)
309 1.221 pgoyette DPRINTF("clear port feature failed %jd", err, 0, 0, 0);
310 1.1 augustss #endif
311 1.18 augustss
312 1.18 augustss /* Wait for the device to recover from reset. */
313 1.23 augustss usbd_delay_ms(dev, USB_PORT_RESET_RECOVERY);
314 1.210 skrll return err;
315 1.1 augustss }
316 1.1 augustss
317 1.12 augustss usb_interface_descriptor_t *
318 1.78 augustss usbd_find_idesc(usb_config_descriptor_t *cd, int ifaceidx, int altidx)
319 1.12 augustss {
320 1.238 mrg USBHIST_FUNC();
321 1.238 mrg USBHIST_CALLARGS(usbdebug, "iface/alt idx %jd/%jd",
322 1.238 mrg ifaceidx, altidx, 0, 0);
323 1.12 augustss char *p = (char *)cd;
324 1.12 augustss char *end = p + UGETW(cd->wTotalLength);
325 1.237 maxv usb_descriptor_t *desc;
326 1.237 maxv usb_interface_descriptor_t *idesc;
327 1.19 augustss int curidx, lastidx, curaidx = 0;
328 1.12 augustss
329 1.19 augustss for (curidx = lastidx = -1; p < end; ) {
330 1.237 maxv desc = (usb_descriptor_t *)p;
331 1.237 maxv
332 1.221 pgoyette DPRINTFN(4, "idx=%jd(%jd) altidx=%jd(%jd)", ifaceidx, curidx,
333 1.205 skrll altidx, curaidx);
334 1.237 maxv DPRINTFN(4, "len=%jd type=%jd", desc->bLength,
335 1.237 maxv desc->bDescriptorType, 0, 0);
336 1.237 maxv
337 1.237 maxv if (desc->bLength < USB_DESCRIPTOR_SIZE)
338 1.237 maxv break;
339 1.237 maxv p += desc->bLength;
340 1.237 maxv if (p > end)
341 1.237 maxv break;
342 1.237 maxv
343 1.237 maxv if (desc->bDescriptorType != UDESC_INTERFACE)
344 1.237 maxv continue;
345 1.237 maxv idesc = (usb_interface_descriptor_t *)desc;
346 1.237 maxv if (idesc->bLength < USB_INTERFACE_DESCRIPTOR_SIZE)
347 1.237 maxv break;
348 1.237 maxv
349 1.237 maxv if (idesc->bInterfaceNumber != lastidx) {
350 1.237 maxv lastidx = idesc->bInterfaceNumber;
351 1.237 maxv curidx++;
352 1.237 maxv curaidx = 0;
353 1.237 maxv } else {
354 1.237 maxv curaidx++;
355 1.12 augustss }
356 1.237 maxv if (ifaceidx == curidx && altidx == curaidx)
357 1.237 maxv return idesc;
358 1.12 augustss }
359 1.237 maxv
360 1.210 skrll return NULL;
361 1.12 augustss }
362 1.12 augustss
363 1.12 augustss usb_endpoint_descriptor_t *
364 1.99 augustss usbd_find_edesc(usb_config_descriptor_t *cd, int ifaceidx, int altidx,
365 1.78 augustss int endptidx)
366 1.12 augustss {
367 1.12 augustss char *p = (char *)cd;
368 1.12 augustss char *end = p + UGETW(cd->wTotalLength);
369 1.237 maxv usb_interface_descriptor_t *idesc;
370 1.237 maxv usb_endpoint_descriptor_t *edesc;
371 1.237 maxv usb_descriptor_t *desc;
372 1.12 augustss int curidx;
373 1.12 augustss
374 1.237 maxv idesc = usbd_find_idesc(cd, ifaceidx, altidx);
375 1.237 maxv if (idesc == NULL)
376 1.210 skrll return NULL;
377 1.237 maxv if (endptidx >= idesc->bNumEndpoints) /* quick exit */
378 1.210 skrll return NULL;
379 1.12 augustss
380 1.12 augustss curidx = -1;
381 1.237 maxv for (p = (char *)idesc + idesc->bLength; p < end; ) {
382 1.237 maxv desc = (usb_descriptor_t *)p;
383 1.237 maxv
384 1.237 maxv if (desc->bLength < USB_DESCRIPTOR_SIZE)
385 1.237 maxv break;
386 1.237 maxv p += desc->bLength;
387 1.237 maxv if (p > end)
388 1.237 maxv break;
389 1.237 maxv
390 1.237 maxv if (desc->bDescriptorType == UDESC_INTERFACE)
391 1.237 maxv break;
392 1.237 maxv if (desc->bDescriptorType != UDESC_ENDPOINT)
393 1.237 maxv continue;
394 1.237 maxv
395 1.237 maxv edesc = (usb_endpoint_descriptor_t *)desc;
396 1.237 maxv if (edesc->bLength < USB_ENDPOINT_DESCRIPTOR_SIZE)
397 1.237 maxv break;
398 1.237 maxv
399 1.237 maxv curidx++;
400 1.237 maxv if (curidx == endptidx)
401 1.237 maxv return edesc;
402 1.1 augustss }
403 1.210 skrll return NULL;
404 1.1 augustss }
405 1.1 augustss
406 1.256 riastrad static void
407 1.256 riastrad usbd_iface_init(struct usbd_device *dev, int ifaceidx)
408 1.256 riastrad {
409 1.256 riastrad struct usbd_interface *ifc = &dev->ud_ifaces[ifaceidx];
410 1.256 riastrad
411 1.256 riastrad memset(ifc, 0, sizeof(*ifc));
412 1.256 riastrad
413 1.256 riastrad ifc->ui_dev = dev;
414 1.256 riastrad ifc->ui_idesc = NULL;
415 1.256 riastrad ifc->ui_index = 0;
416 1.256 riastrad ifc->ui_altindex = 0;
417 1.256 riastrad ifc->ui_endpoints = NULL;
418 1.261 riastrad ifc->ui_busy = 0;
419 1.256 riastrad }
420 1.256 riastrad
421 1.256 riastrad static void
422 1.256 riastrad usbd_iface_fini(struct usbd_device *dev, int ifaceidx)
423 1.256 riastrad {
424 1.263 mlelstv struct usbd_interface *ifc = &dev->ud_ifaces[ifaceidx] __diagused;
425 1.256 riastrad
426 1.256 riastrad KASSERT(ifc->ui_dev == dev);
427 1.256 riastrad KASSERT(ifc->ui_idesc == NULL);
428 1.256 riastrad KASSERT(ifc->ui_index == 0);
429 1.256 riastrad KASSERT(ifc->ui_altindex == 0);
430 1.256 riastrad KASSERT(ifc->ui_endpoints == NULL);
431 1.261 riastrad KASSERTMSG(ifc->ui_busy == 0, "%"PRId64, ifc->ui_busy);
432 1.261 riastrad }
433 1.261 riastrad
434 1.261 riastrad /*
435 1.261 riastrad * usbd_iface_lock/locked/unlock, usbd_iface_piperef/pipeunref
436 1.261 riastrad *
437 1.261 riastrad * We lock the interface while we are setting it, and we acquire a
438 1.261 riastrad * reference to the interface for each pipe opened on it.
439 1.261 riastrad *
440 1.261 riastrad * Setting the interface while pipes are open is forbidden, and
441 1.261 riastrad * opening pipes while the interface is being set is forbidden.
442 1.261 riastrad */
443 1.261 riastrad
444 1.261 riastrad bool
445 1.261 riastrad usbd_iface_locked(struct usbd_interface *iface)
446 1.261 riastrad {
447 1.261 riastrad bool locked;
448 1.261 riastrad
449 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
450 1.261 riastrad locked = (iface->ui_busy == -1);
451 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
452 1.261 riastrad
453 1.261 riastrad return locked;
454 1.261 riastrad }
455 1.261 riastrad
456 1.261 riastrad static void
457 1.261 riastrad usbd_iface_exlock(struct usbd_interface *iface)
458 1.261 riastrad {
459 1.261 riastrad
460 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
461 1.261 riastrad KASSERTMSG(iface->ui_busy == 0, "interface is not idle,"
462 1.261 riastrad " busy=%"PRId64, iface->ui_busy);
463 1.261 riastrad iface->ui_busy = -1;
464 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
465 1.261 riastrad }
466 1.261 riastrad
467 1.261 riastrad usbd_status
468 1.261 riastrad usbd_iface_lock(struct usbd_interface *iface)
469 1.261 riastrad {
470 1.261 riastrad usbd_status err;
471 1.261 riastrad
472 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
473 1.261 riastrad KASSERTMSG(iface->ui_busy != -1, "interface is locked");
474 1.261 riastrad KASSERTMSG(iface->ui_busy >= 0, "%"PRId64, iface->ui_busy);
475 1.261 riastrad if (iface->ui_busy) {
476 1.261 riastrad err = USBD_IN_USE;
477 1.261 riastrad } else {
478 1.261 riastrad iface->ui_busy = -1;
479 1.261 riastrad err = 0;
480 1.261 riastrad }
481 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
482 1.261 riastrad
483 1.261 riastrad return err;
484 1.261 riastrad }
485 1.261 riastrad
486 1.261 riastrad void
487 1.261 riastrad usbd_iface_unlock(struct usbd_interface *iface)
488 1.261 riastrad {
489 1.261 riastrad
490 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
491 1.261 riastrad KASSERTMSG(iface->ui_busy == -1, "interface is not locked,"
492 1.261 riastrad " busy=%"PRId64, iface->ui_busy);
493 1.261 riastrad iface->ui_busy = 0;
494 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
495 1.261 riastrad }
496 1.261 riastrad
497 1.261 riastrad usbd_status
498 1.261 riastrad usbd_iface_piperef(struct usbd_interface *iface)
499 1.261 riastrad {
500 1.261 riastrad usbd_status err;
501 1.261 riastrad
502 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
503 1.261 riastrad KASSERTMSG(iface->ui_busy >= -1, "%"PRId64, iface->ui_busy);
504 1.261 riastrad if (iface->ui_busy == -1) {
505 1.261 riastrad err = USBD_IN_USE;
506 1.261 riastrad } else {
507 1.261 riastrad iface->ui_busy++;
508 1.261 riastrad err = 0;
509 1.261 riastrad }
510 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
511 1.261 riastrad
512 1.261 riastrad return err;
513 1.261 riastrad }
514 1.256 riastrad
515 1.261 riastrad void
516 1.261 riastrad usbd_iface_pipeunref(struct usbd_interface *iface)
517 1.261 riastrad {
518 1.261 riastrad
519 1.261 riastrad mutex_enter(iface->ui_dev->ud_bus->ub_lock);
520 1.261 riastrad KASSERTMSG(iface->ui_busy != -1, "interface is locked");
521 1.261 riastrad KASSERTMSG(iface->ui_busy != 0, "interface not in use");
522 1.261 riastrad KASSERTMSG(iface->ui_busy >= 1, "%"PRId64, iface->ui_busy);
523 1.261 riastrad iface->ui_busy--;
524 1.261 riastrad mutex_exit(iface->ui_dev->ud_bus->ub_lock);
525 1.256 riastrad }
526 1.256 riastrad
527 1.1 augustss usbd_status
528 1.210 skrll usbd_fill_iface_data(struct usbd_device *dev, int ifaceidx, int altidx)
529 1.1 augustss {
530 1.238 mrg USBHIST_FUNC();
531 1.238 mrg USBHIST_CALLARGS(usbdebug, "ifaceidx=%jd altidx=%jd",
532 1.238 mrg ifaceidx, altidx, 0, 0);
533 1.210 skrll struct usbd_interface *ifc = &dev->ud_ifaces[ifaceidx];
534 1.77 augustss usb_interface_descriptor_t *idesc;
535 1.259 riastrad struct usbd_endpoint *endpoints;
536 1.1 augustss char *p, *end;
537 1.1 augustss int endpt, nendpt;
538 1.1 augustss
539 1.256 riastrad KASSERT(ifc->ui_dev == dev);
540 1.261 riastrad KASSERT(usbd_iface_locked(ifc));
541 1.256 riastrad
542 1.210 skrll idesc = usbd_find_idesc(dev->ud_cdesc, ifaceidx, altidx);
543 1.77 augustss if (idesc == NULL)
544 1.210 skrll return USBD_INVAL;
545 1.259 riastrad
546 1.259 riastrad nendpt = idesc->bNumEndpoints;
547 1.221 pgoyette DPRINTFN(4, "found idesc nendpt=%jd", nendpt, 0, 0, 0);
548 1.1 augustss if (nendpt != 0) {
549 1.259 riastrad endpoints = kmem_alloc(nendpt * sizeof(struct usbd_endpoint),
550 1.259 riastrad KM_SLEEP);
551 1.1 augustss } else
552 1.259 riastrad endpoints = NULL;
553 1.259 riastrad
554 1.259 riastrad p = (char *)idesc + idesc->bLength;
555 1.210 skrll end = (char *)dev->ud_cdesc + UGETW(dev->ud_cdesc->wTotalLength);
556 1.19 augustss #define ed ((usb_endpoint_descriptor_t *)p)
557 1.1 augustss for (endpt = 0; endpt < nendpt; endpt++) {
558 1.221 pgoyette DPRINTFN(10, "endpt=%jd", endpt, 0, 0, 0);
559 1.1 augustss for (; p < end; p += ed->bLength) {
560 1.221 pgoyette DPRINTFN(10, "p=%#jx end=%#jx len=%jd type=%jd",
561 1.221 pgoyette (uintptr_t)p, (uintptr_t)end, ed->bLength,
562 1.221 pgoyette ed->bDescriptorType);
563 1.236 maxv if (p + ed->bLength <= end &&
564 1.236 maxv ed->bLength >= USB_ENDPOINT_DESCRIPTOR_SIZE &&
565 1.1 augustss ed->bDescriptorType == UDESC_ENDPOINT)
566 1.24 augustss goto found;
567 1.59 augustss if (ed->bLength == 0 ||
568 1.59 augustss ed->bDescriptorType == UDESC_INTERFACE)
569 1.1 augustss break;
570 1.1 augustss }
571 1.24 augustss /* passed end, or bad desc */
572 1.245 maxv if (p < end) {
573 1.245 maxv if (ed->bLength == 0) {
574 1.245 maxv printf("%s: bad descriptor: 0 length\n",
575 1.245 maxv __func__);
576 1.245 maxv } else {
577 1.245 maxv printf("%s: bad descriptor: iface desc\n",
578 1.245 maxv __func__);
579 1.245 maxv }
580 1.245 maxv } else {
581 1.245 maxv printf("%s: no desc found\n", __func__);
582 1.245 maxv }
583 1.24 augustss goto bad;
584 1.24 augustss found:
585 1.259 riastrad endpoints[endpt].ue_edesc = ed;
586 1.210 skrll if (dev->ud_speed == USB_SPEED_HIGH) {
587 1.95 augustss u_int mps;
588 1.95 augustss /* Control and bulk endpoints have max packet limits. */
589 1.95 augustss switch (UE_GET_XFERTYPE(ed->bmAttributes)) {
590 1.95 augustss case UE_CONTROL:
591 1.95 augustss mps = USB_2_MAX_CTRL_PACKET;
592 1.95 augustss goto check;
593 1.95 augustss case UE_BULK:
594 1.95 augustss mps = USB_2_MAX_BULK_PACKET;
595 1.95 augustss check:
596 1.95 augustss if (UGETW(ed->wMaxPacketSize) != mps) {
597 1.95 augustss USETW(ed->wMaxPacketSize, mps);
598 1.95 augustss #ifdef DIAGNOSTIC
599 1.95 augustss printf("usbd_fill_iface_data: bad max "
600 1.95 augustss "packet size\n");
601 1.95 augustss #endif
602 1.95 augustss }
603 1.95 augustss break;
604 1.95 augustss default:
605 1.95 augustss break;
606 1.95 augustss }
607 1.95 augustss }
608 1.259 riastrad endpoints[endpt].ue_refcnt = 0;
609 1.259 riastrad endpoints[endpt].ue_toggle = 0;
610 1.24 augustss p += ed->bLength;
611 1.1 augustss }
612 1.19 augustss #undef ed
613 1.259 riastrad
614 1.259 riastrad /* Success! Free the old endpoints and commit the changes. */
615 1.259 riastrad if (ifc->ui_endpoints) {
616 1.259 riastrad kmem_free(ifc->ui_endpoints, (sizeof(ifc->ui_endpoints[0]) *
617 1.259 riastrad ifc->ui_idesc->bNumEndpoints));
618 1.259 riastrad }
619 1.259 riastrad
620 1.259 riastrad ifc->ui_idesc = idesc;
621 1.259 riastrad ifc->ui_index = ifaceidx;
622 1.259 riastrad ifc->ui_altindex = altidx;
623 1.259 riastrad ifc->ui_endpoints = endpoints;
624 1.259 riastrad
625 1.210 skrll return USBD_NORMAL_COMPLETION;
626 1.24 augustss
627 1.1 augustss bad:
628 1.259 riastrad if (endpoints)
629 1.259 riastrad kmem_free(endpoints, nendpt * sizeof(struct usbd_endpoint));
630 1.210 skrll return USBD_INVAL;
631 1.1 augustss }
632 1.1 augustss
633 1.256 riastrad Static void
634 1.210 skrll usbd_free_iface_data(struct usbd_device *dev, int ifcno)
635 1.1 augustss {
636 1.210 skrll struct usbd_interface *ifc = &dev->ud_ifaces[ifcno];
637 1.256 riastrad
638 1.256 riastrad KASSERT(ifc->ui_dev == dev);
639 1.256 riastrad KASSERT(ifc->ui_idesc != NULL);
640 1.261 riastrad KASSERT(usbd_iface_locked(ifc));
641 1.256 riastrad
642 1.210 skrll if (ifc->ui_endpoints) {
643 1.210 skrll int nendpt = ifc->ui_idesc->bNumEndpoints;
644 1.210 skrll size_t sz = nendpt * sizeof(struct usbd_endpoint);
645 1.210 skrll kmem_free(ifc->ui_endpoints, sz);
646 1.246 jdolecek ifc->ui_endpoints = NULL;
647 1.210 skrll }
648 1.256 riastrad
649 1.256 riastrad ifc->ui_altindex = 0;
650 1.256 riastrad ifc->ui_index = 0;
651 1.256 riastrad ifc->ui_idesc = NULL;
652 1.1 augustss }
653 1.1 augustss
654 1.1 augustss usbd_status
655 1.210 skrll usbd_set_config_no(struct usbd_device *dev, int no, int msg)
656 1.1 augustss {
657 1.238 mrg USBHIST_FUNC(); USBHIST_CALLARGS(usbdebug, "%jd", no, 0, 0, 0);
658 1.12 augustss usb_config_descriptor_t cd;
659 1.53 augustss usbd_status err;
660 1.210 skrll int index;
661 1.205 skrll
662 1.75 augustss if (no == USB_UNCONFIG_NO)
663 1.210 skrll return usbd_set_config_index(dev, USB_UNCONFIG_INDEX, msg);
664 1.75 augustss
665 1.12 augustss /* Figure out what config index to use. */
666 1.210 skrll for (index = 0; index < dev->ud_ddesc.bNumConfigurations; index++) {
667 1.53 augustss err = usbd_get_config_desc(dev, index, &cd);
668 1.53 augustss if (err)
669 1.210 skrll return err;
670 1.12 augustss if (cd.bConfigurationValue == no)
671 1.210 skrll return usbd_set_config_index(dev, index, msg);
672 1.12 augustss }
673 1.210 skrll return USBD_INVAL;
674 1.12 augustss }
675 1.12 augustss
676 1.12 augustss usbd_status
677 1.210 skrll usbd_set_config_index(struct usbd_device *dev, int index, int msg)
678 1.12 augustss {
679 1.238 mrg USBHIST_FUNC();
680 1.238 mrg USBHIST_CALLARGS(usbdebug, "dev=%#jx index=%jd",
681 1.238 mrg (uintptr_t)dev, index, 0, 0);
682 1.1 augustss usb_config_descriptor_t cd, *cdp;
683 1.216 skrll usb_bos_descriptor_t *bdp = NULL;
684 1.53 augustss usbd_status err;
685 1.103 augustss int i, ifcidx, nifc, len, selfpowered, power;
686 1.1 augustss
687 1.1 augustss
688 1.210 skrll if (index >= dev->ud_ddesc.bNumConfigurations &&
689 1.161 drochner index != USB_UNCONFIG_INDEX) {
690 1.145 drochner /* panic? */
691 1.145 drochner printf("usbd_set_config_index: illegal index\n");
692 1.210 skrll return USBD_INVAL;
693 1.145 drochner }
694 1.145 drochner
695 1.1 augustss /* XXX check that all interfaces are idle */
696 1.210 skrll if (dev->ud_config != USB_UNCONFIG_NO) {
697 1.205 skrll DPRINTF("free old config", 0, 0, 0, 0);
698 1.1 augustss /* Free all configuration data structures. */
699 1.210 skrll nifc = dev->ud_cdesc->bNumInterface;
700 1.256 riastrad for (ifcidx = 0; ifcidx < nifc; ifcidx++) {
701 1.261 riastrad usbd_iface_exlock(&dev->ud_ifaces[ifcidx]);
702 1.12 augustss usbd_free_iface_data(dev, ifcidx);
703 1.261 riastrad usbd_iface_unlock(&dev->ud_ifaces[ifcidx]);
704 1.256 riastrad usbd_iface_fini(dev, ifcidx);
705 1.256 riastrad }
706 1.210 skrll kmem_free(dev->ud_ifaces, nifc * sizeof(struct usbd_interface));
707 1.210 skrll kmem_free(dev->ud_cdesc, UGETW(dev->ud_cdesc->wTotalLength));
708 1.210 skrll if (dev->ud_bdesc != NULL)
709 1.210 skrll kmem_free(dev->ud_bdesc,
710 1.210 skrll UGETW(dev->ud_bdesc->wTotalLength));
711 1.210 skrll dev->ud_ifaces = NULL;
712 1.210 skrll dev->ud_cdesc = NULL;
713 1.210 skrll dev->ud_bdesc = NULL;
714 1.210 skrll dev->ud_config = USB_UNCONFIG_NO;
715 1.75 augustss }
716 1.75 augustss
717 1.75 augustss if (index == USB_UNCONFIG_INDEX) {
718 1.75 augustss /* We are unconfiguring the device, so leave unallocated. */
719 1.205 skrll DPRINTF("set config 0", 0, 0, 0, 0);
720 1.75 augustss err = usbd_set_config(dev, USB_UNCONFIG_NO);
721 1.136 christos if (err) {
722 1.221 pgoyette DPRINTF("setting config=0 failed, err = %jd", err,
723 1.205 skrll 0, 0, 0);
724 1.136 christos }
725 1.210 skrll return err;
726 1.1 augustss }
727 1.1 augustss
728 1.74 augustss /* Get the short descriptor. */
729 1.53 augustss err = usbd_get_config_desc(dev, index, &cd);
730 1.172 drochner if (err) {
731 1.221 pgoyette DPRINTF("get_config_desc=%jd", err, 0, 0, 0);
732 1.210 skrll return err;
733 1.172 drochner }
734 1.1 augustss len = UGETW(cd.wTotalLength);
735 1.235 maxv if (len < USB_CONFIG_DESCRIPTOR_SIZE) {
736 1.222 khorben DPRINTF("empty short descriptor", 0, 0, 0, 0);
737 1.222 khorben return USBD_INVAL;
738 1.222 khorben }
739 1.210 skrll cdp = kmem_alloc(len, KM_SLEEP);
740 1.103 augustss
741 1.103 augustss /* Get the full descriptor. Try a few times for slow devices. */
742 1.103 augustss for (i = 0; i < 3; i++) {
743 1.103 augustss err = usbd_get_desc(dev, UDESC_CONFIG, index, len, cdp);
744 1.103 augustss if (!err)
745 1.103 augustss break;
746 1.103 augustss usbd_delay_ms(dev, 200);
747 1.103 augustss }
748 1.172 drochner if (err) {
749 1.221 pgoyette DPRINTF("get_desc=%jd", err, 0, 0, 0);
750 1.1 augustss goto bad;
751 1.172 drochner }
752 1.18 augustss if (cdp->bDescriptorType != UDESC_CONFIG) {
753 1.221 pgoyette DPRINTF("bad desc %jd", cdp->bDescriptorType, 0, 0, 0);
754 1.53 augustss err = USBD_INVAL;
755 1.18 augustss goto bad;
756 1.18 augustss }
757 1.235 maxv if (UGETW(cdp->wTotalLength) != UGETW(cd.wTotalLength)) {
758 1.235 maxv DPRINTF("bad len %jd", UGETW(cdp->wTotalLength), 0, 0, 0);
759 1.235 maxv err = USBD_INVAL;
760 1.235 maxv goto bad;
761 1.235 maxv }
762 1.74 augustss
763 1.210 skrll if (USB_IS_SS(dev->ud_speed)) {
764 1.216 skrll usb_bos_descriptor_t bd;
765 1.216 skrll
766 1.210 skrll /* get short bos desc */
767 1.210 skrll err = usbd_get_bos_desc(dev, index, &bd);
768 1.210 skrll if (!err) {
769 1.210 skrll int blen = UGETW(bd.wTotalLength);
770 1.235 maxv if (blen < USB_BOS_DESCRIPTOR_SIZE) {
771 1.222 khorben DPRINTF("empty bos descriptor", 0, 0, 0, 0);
772 1.222 khorben err = USBD_INVAL;
773 1.222 khorben goto bad;
774 1.222 khorben }
775 1.210 skrll bdp = kmem_alloc(blen, KM_SLEEP);
776 1.210 skrll
777 1.210 skrll /* Get the full desc */
778 1.210 skrll for (i = 0; i < 3; i++) {
779 1.210 skrll err = usbd_get_desc(dev, UDESC_BOS, index, blen,
780 1.210 skrll bdp);
781 1.210 skrll if (!err)
782 1.210 skrll break;
783 1.210 skrll usbd_delay_ms(dev, 200);
784 1.210 skrll }
785 1.236 maxv if (err || bdp->bDescriptorType != UDESC_BOS ||
786 1.236 maxv UGETW(bdp->wTotalLength) != UGETW(bd.wTotalLength)) {
787 1.221 pgoyette DPRINTF("error %jd or bad desc %jd", err,
788 1.210 skrll bdp->bDescriptorType, 0, 0);
789 1.210 skrll kmem_free(bdp, blen);
790 1.210 skrll bdp = NULL;
791 1.210 skrll }
792 1.210 skrll }
793 1.210 skrll }
794 1.210 skrll dev->ud_bdesc = bdp;
795 1.210 skrll
796 1.142 drochner /*
797 1.142 drochner * Figure out if the device is self or bus powered.
798 1.142 drochner */
799 1.142 drochner #if 0 /* XXX various devices don't report the power state correctly */
800 1.1 augustss selfpowered = 0;
801 1.141 drochner err = usbd_get_device_status(dev, &ds);
802 1.141 drochner if (!err && (UGETW(ds.wStatus) & UDS_SELF_POWERED))
803 1.141 drochner selfpowered = 1;
804 1.142 drochner #endif
805 1.142 drochner /*
806 1.142 drochner * Use the power state in the configuration we are going
807 1.142 drochner * to set. This doesn't necessarily reflect the actual
808 1.142 drochner * power state of the device; the driver can control this
809 1.142 drochner * by choosing the appropriate configuration.
810 1.142 drochner */
811 1.142 drochner selfpowered = !!(cdp->bmAttributes & UC_SELF_POWERED);
812 1.141 drochner
813 1.243 christos DPRINTF("addr %jd cno=%jd attr=0x%02jx, selfpowered=%jd",
814 1.210 skrll dev->ud_addr, cdp->bConfigurationValue, cdp->bmAttributes,
815 1.205 skrll selfpowered);
816 1.221 pgoyette DPRINTF("max power=%jd", cdp->bMaxPower * 2, 0, 0, 0);
817 1.74 augustss
818 1.74 augustss /* Check if we have enough power. */
819 1.142 drochner #if 0 /* this is a no-op, see above */
820 1.141 drochner if ((cdp->bmAttributes & UC_SELF_POWERED) && !selfpowered) {
821 1.141 drochner if (msg)
822 1.141 drochner printf("%s: device addr %d (config %d): "
823 1.141 drochner "can't set self powered configuration\n",
824 1.210 skrll device_xname(dev->ud_bus->bdev), dev->ud_addr,
825 1.141 drochner cdp->bConfigurationValue);
826 1.141 drochner err = USBD_NO_POWER;
827 1.141 drochner goto bad;
828 1.141 drochner }
829 1.142 drochner #endif
830 1.1 augustss #ifdef USB_DEBUG
831 1.210 skrll if (dev->ud_powersrc == NULL) {
832 1.205 skrll DPRINTF("No power source?", 0, 0, 0, 0);
833 1.141 drochner err = USBD_IOERROR;
834 1.141 drochner goto bad;
835 1.1 augustss }
836 1.1 augustss #endif
837 1.1 augustss power = cdp->bMaxPower * 2;
838 1.210 skrll if (power > dev->ud_powersrc->up_power) {
839 1.221 pgoyette DPRINTF("power exceeded %jd %jd", power,
840 1.221 pgoyette dev->ud_powersrc->up_power, 0, 0);
841 1.1 augustss /* XXX print nicer message. */
842 1.7 augustss if (msg)
843 1.18 augustss printf("%s: device addr %d (config %d) exceeds power "
844 1.18 augustss "budget, %d mA > %d mA\n",
845 1.210 skrll device_xname(dev->ud_bus->ub_usbctl), dev->ud_addr,
846 1.99 augustss cdp->bConfigurationValue,
847 1.210 skrll power, dev->ud_powersrc->up_power);
848 1.53 augustss err = USBD_NO_POWER;
849 1.1 augustss goto bad;
850 1.1 augustss }
851 1.210 skrll dev->ud_power = power;
852 1.210 skrll dev->ud_selfpowered = selfpowered;
853 1.1 augustss
854 1.74 augustss /* Set the actual configuration value. */
855 1.221 pgoyette DPRINTF("set config %jd", cdp->bConfigurationValue, 0, 0, 0);
856 1.53 augustss err = usbd_set_config(dev, cdp->bConfigurationValue);
857 1.53 augustss if (err) {
858 1.221 pgoyette DPRINTF("setting config=%jd failed, error=%jd",
859 1.205 skrll cdp->bConfigurationValue, err, 0, 0);
860 1.1 augustss goto bad;
861 1.1 augustss }
862 1.74 augustss
863 1.74 augustss /* Allocate and fill interface data. */
864 1.1 augustss nifc = cdp->bNumInterface;
865 1.222 khorben if (nifc == 0) {
866 1.222 khorben DPRINTF("no interfaces", 0, 0, 0, 0);
867 1.222 khorben err = USBD_INVAL;
868 1.222 khorben goto bad;
869 1.222 khorben }
870 1.210 skrll dev->ud_ifaces = kmem_alloc(nifc * sizeof(struct usbd_interface),
871 1.210 skrll KM_SLEEP);
872 1.221 pgoyette DPRINTFN(5, "dev=%#jx cdesc=%#jx", (uintptr_t)dev, (uintptr_t)cdp,
873 1.221 pgoyette 0, 0);
874 1.210 skrll dev->ud_cdesc = cdp;
875 1.210 skrll dev->ud_config = cdp->bConfigurationValue;
876 1.12 augustss for (ifcidx = 0; ifcidx < nifc; ifcidx++) {
877 1.256 riastrad usbd_iface_init(dev, ifcidx);
878 1.261 riastrad usbd_iface_exlock(&dev->ud_ifaces[ifcidx]);
879 1.53 augustss err = usbd_fill_iface_data(dev, ifcidx, 0);
880 1.261 riastrad usbd_iface_unlock(&dev->ud_ifaces[ifcidx]);
881 1.53 augustss if (err) {
882 1.256 riastrad while (--ifcidx >= 0) {
883 1.261 riastrad usbd_iface_exlock(&dev->ud_ifaces[ifcidx]);
884 1.12 augustss usbd_free_iface_data(dev, ifcidx);
885 1.261 riastrad usbd_iface_unlock(&dev->ud_ifaces[ifcidx]);
886 1.256 riastrad usbd_iface_fini(dev, ifcidx);
887 1.256 riastrad }
888 1.247 maxv kmem_free(dev->ud_ifaces,
889 1.247 maxv nifc * sizeof(struct usbd_interface));
890 1.247 maxv dev->ud_ifaces = NULL;
891 1.1 augustss goto bad;
892 1.1 augustss }
893 1.1 augustss }
894 1.1 augustss
895 1.210 skrll return USBD_NORMAL_COMPLETION;
896 1.1 augustss
897 1.247 maxv bad:
898 1.247 maxv /* XXX Use usbd_set_config() to reset the config? */
899 1.247 maxv /* XXX Should we forbid USB_UNCONFIG_NO from bConfigurationValue? */
900 1.247 maxv dev->ud_config = USB_UNCONFIG_NO;
901 1.210 skrll kmem_free(cdp, len);
902 1.247 maxv dev->ud_cdesc = NULL;
903 1.210 skrll if (bdp != NULL) {
904 1.210 skrll kmem_free(bdp, UGETW(bdp->wTotalLength));
905 1.210 skrll dev->ud_bdesc = NULL;
906 1.210 skrll }
907 1.210 skrll return err;
908 1.1 augustss }
909 1.1 augustss
910 1.1 augustss /* XXX add function for alternate settings */
911 1.1 augustss
912 1.1 augustss usbd_status
913 1.210 skrll usbd_setup_pipe(struct usbd_device *dev, struct usbd_interface *iface,
914 1.210 skrll struct usbd_endpoint *ep, int ival, struct usbd_pipe **pipe)
915 1.1 augustss {
916 1.188 jmcneill return usbd_setup_pipe_flags(dev, iface, ep, ival, pipe, 0);
917 1.188 jmcneill }
918 1.188 jmcneill
919 1.188 jmcneill usbd_status
920 1.210 skrll usbd_setup_pipe_flags(struct usbd_device *dev, struct usbd_interface *iface,
921 1.210 skrll struct usbd_endpoint *ep, int ival, struct usbd_pipe **pipe, uint8_t flags)
922 1.188 jmcneill {
923 1.238 mrg USBHIST_FUNC();
924 1.238 mrg USBHIST_CALLARGS(usbdebug, "dev=%#jx addr=%jd iface=%#jx ep=%#jx",
925 1.238 mrg (uintptr_t)dev, dev->ud_addr, (uintptr_t)iface, (uintptr_t)ep);
926 1.261 riastrad struct usbd_pipe *p = NULL;
927 1.261 riastrad bool ep_acquired = false;
928 1.53 augustss usbd_status err;
929 1.1 augustss
930 1.261 riastrad /* Block exclusive use of the endpoint by later pipes. */
931 1.255 riastrad err = usbd_endpoint_acquire(dev, ep, flags & USBD_EXCLUSIVE_USE);
932 1.255 riastrad if (err)
933 1.261 riastrad goto out;
934 1.261 riastrad ep_acquired = true;
935 1.255 riastrad
936 1.210 skrll p = kmem_alloc(dev->ud_bus->ub_pipesize, KM_SLEEP);
937 1.221 pgoyette DPRINTFN(1, "pipe=%#jx", (uintptr_t)p, 0, 0, 0);
938 1.210 skrll p->up_dev = dev;
939 1.210 skrll p->up_iface = iface;
940 1.210 skrll p->up_endpoint = ep;
941 1.210 skrll p->up_intrxfer = NULL;
942 1.210 skrll p->up_running = 0;
943 1.210 skrll p->up_aborting = 0;
944 1.210 skrll p->up_serialise = true;
945 1.210 skrll p->up_repeat = 0;
946 1.210 skrll p->up_interval = ival;
947 1.210 skrll p->up_flags = flags;
948 1.210 skrll SIMPLEQ_INIT(&p->up_queue);
949 1.257 riastrad
950 1.210 skrll err = dev->ud_bus->ub_methods->ubm_open(p);
951 1.53 augustss if (err) {
952 1.221 pgoyette DPRINTF("endpoint=%#jx failed, error=%jd",
953 1.221 pgoyette (uintptr_t)ep->ue_edesc->bEndpointAddress, err, 0, 0);
954 1.261 riastrad goto out;
955 1.1 augustss }
956 1.210 skrll
957 1.210 skrll KASSERT(p->up_methods->upm_start || p->up_serialise == false);
958 1.210 skrll
959 1.210 skrll usb_init_task(&p->up_async_task, usbd_clear_endpoint_stall_task, p,
960 1.188 jmcneill USB_TASKQ_MPSAFE);
961 1.221 pgoyette DPRINTFN(1, "pipe=%#jx", (uintptr_t)p, 0, 0, 0);
962 1.1 augustss *pipe = p;
963 1.261 riastrad p = NULL; /* handed off to caller */
964 1.261 riastrad ep_acquired = false; /* handed off to pipe */
965 1.261 riastrad err = USBD_NORMAL_COMPLETION;
966 1.261 riastrad
967 1.261 riastrad out: if (p)
968 1.261 riastrad kmem_free(p, dev->ud_bus->ub_pipesize);
969 1.261 riastrad if (ep_acquired)
970 1.261 riastrad usbd_endpoint_release(dev, ep);
971 1.261 riastrad return err;
972 1.1 augustss }
973 1.1 augustss
974 1.255 riastrad usbd_status
975 1.255 riastrad usbd_endpoint_acquire(struct usbd_device *dev, struct usbd_endpoint *ep,
976 1.255 riastrad int flags)
977 1.255 riastrad {
978 1.255 riastrad usbd_status err;
979 1.255 riastrad
980 1.255 riastrad mutex_enter(dev->ud_bus->ub_lock);
981 1.255 riastrad if (ep->ue_refcnt == INT_MAX) {
982 1.255 riastrad err = USBD_IN_USE; /* XXX rule out or switch to 64-bit */
983 1.255 riastrad } else if ((flags & USBD_EXCLUSIVE_USE) && ep->ue_refcnt) {
984 1.255 riastrad err = USBD_IN_USE;
985 1.255 riastrad } else {
986 1.255 riastrad ep->ue_refcnt++;
987 1.255 riastrad err = 0;
988 1.255 riastrad }
989 1.255 riastrad mutex_exit(dev->ud_bus->ub_lock);
990 1.255 riastrad
991 1.255 riastrad return err;
992 1.255 riastrad }
993 1.255 riastrad
994 1.255 riastrad void
995 1.255 riastrad usbd_endpoint_release(struct usbd_device *dev, struct usbd_endpoint *ep)
996 1.255 riastrad {
997 1.255 riastrad
998 1.255 riastrad mutex_enter(dev->ud_bus->ub_lock);
999 1.255 riastrad KASSERT(ep->ue_refcnt);
1000 1.255 riastrad ep->ue_refcnt--;
1001 1.255 riastrad mutex_exit(dev->ud_bus->ub_lock);
1002 1.255 riastrad }
1003 1.255 riastrad
1004 1.258 riastrad /* Abort and close the device control pipe. */
1005 1.1 augustss void
1006 1.210 skrll usbd_kill_pipe(struct usbd_pipe *pipe)
1007 1.1 augustss {
1008 1.258 riastrad
1009 1.89 augustss usbd_abort_pipe(pipe);
1010 1.258 riastrad usbd_close_pipe(pipe);
1011 1.1 augustss }
1012 1.1 augustss
1013 1.1 augustss int
1014 1.210 skrll usbd_getnewaddr(struct usbd_bus *bus)
1015 1.1 augustss {
1016 1.18 augustss int addr;
1017 1.1 augustss
1018 1.218 skrll for (addr = 1; addr < USB_MAX_DEVICES; addr++) {
1019 1.218 skrll size_t dindex = usb_addr2dindex(addr);
1020 1.218 skrll if (bus->ub_devices[dindex] == NULL)
1021 1.210 skrll return addr;
1022 1.218 skrll }
1023 1.210 skrll return -1;
1024 1.1 augustss }
1025 1.1 augustss
1026 1.155 drochner usbd_status
1027 1.210 skrll usbd_attach_roothub(device_t parent, struct usbd_device *dev)
1028 1.155 drochner {
1029 1.155 drochner struct usb_attach_arg uaa;
1030 1.210 skrll usb_device_descriptor_t *dd = &dev->ud_ddesc;
1031 1.155 drochner device_t dv;
1032 1.155 drochner
1033 1.210 skrll uaa.uaa_device = dev;
1034 1.210 skrll uaa.uaa_usegeneric = 0;
1035 1.210 skrll uaa.uaa_port = 0;
1036 1.210 skrll uaa.uaa_vendor = UGETW(dd->idVendor);
1037 1.210 skrll uaa.uaa_product = UGETW(dd->idProduct);
1038 1.210 skrll uaa.uaa_release = UGETW(dd->bcdDevice);
1039 1.210 skrll uaa.uaa_class = dd->bDeviceClass;
1040 1.210 skrll uaa.uaa_subclass = dd->bDeviceSubClass;
1041 1.210 skrll uaa.uaa_proto = dd->bDeviceProtocol;
1042 1.155 drochner
1043 1.224 mlelstv KERNEL_LOCK(1, curlwp);
1044 1.250 thorpej dv = config_found(parent, &uaa, NULL,
1045 1.250 thorpej CFARG_IATTR, "usbroothubif",
1046 1.250 thorpej CFARG_EOL);
1047 1.224 mlelstv KERNEL_UNLOCK_ONE(curlwp);
1048 1.155 drochner if (dv) {
1049 1.210 skrll dev->ud_subdevs = kmem_alloc(sizeof(dv), KM_SLEEP);
1050 1.210 skrll dev->ud_subdevs[0] = dv;
1051 1.210 skrll dev->ud_subdevlen = 1;
1052 1.155 drochner }
1053 1.210 skrll return USBD_NORMAL_COMPLETION;
1054 1.155 drochner }
1055 1.18 augustss
1056 1.204 joerg static void
1057 1.249 mlelstv usbd_properties(device_t dv, struct usbd_device *dev)
1058 1.204 joerg {
1059 1.249 mlelstv usb_device_descriptor_t *dd = &dev->ud_ddesc;
1060 1.249 mlelstv prop_dictionary_t dict = device_properties(dv);
1061 1.249 mlelstv int class, subclass, release, proto, vendor, product;
1062 1.249 mlelstv
1063 1.249 mlelstv class = dd->bDeviceClass;
1064 1.249 mlelstv subclass = dd->bDeviceSubClass;
1065 1.249 mlelstv release = UGETW(dd->bcdDevice);
1066 1.249 mlelstv proto = dd->bDeviceProtocol;
1067 1.249 mlelstv vendor = UGETW(dd->idVendor);
1068 1.249 mlelstv product = UGETW(dd->idProduct);
1069 1.249 mlelstv
1070 1.263 mlelstv prop_dictionary_set_uint8(dict, "class", class);
1071 1.263 mlelstv prop_dictionary_set_uint8(dict, "subclass", subclass);
1072 1.249 mlelstv prop_dictionary_set_uint16(dict, "release", release);
1073 1.263 mlelstv prop_dictionary_set_uint8(dict, "proto", proto);
1074 1.263 mlelstv prop_dictionary_set_uint16(dict, "vendor-id", vendor);
1075 1.263 mlelstv prop_dictionary_set_uint16(dict, "product-id", product);
1076 1.249 mlelstv
1077 1.249 mlelstv if (dev->ud_vendor) {
1078 1.249 mlelstv prop_dictionary_set_string(dict,
1079 1.249 mlelstv "vendor-string", dev->ud_vendor);
1080 1.249 mlelstv }
1081 1.249 mlelstv if (dev->ud_product) {
1082 1.249 mlelstv prop_dictionary_set_string(dict,
1083 1.249 mlelstv "product-string", dev->ud_product);
1084 1.249 mlelstv }
1085 1.207 skrll if (dev->ud_serial) {
1086 1.249 mlelstv prop_dictionary_set_string(dict,
1087 1.207 skrll "serialnumber", dev->ud_serial);
1088 1.204 joerg }
1089 1.204 joerg }
1090 1.204 joerg
1091 1.160 drochner static usbd_status
1092 1.210 skrll usbd_attachwholedevice(device_t parent, struct usbd_device *dev, int port,
1093 1.160 drochner int usegeneric)
1094 1.18 augustss {
1095 1.18 augustss struct usb_attach_arg uaa;
1096 1.210 skrll usb_device_descriptor_t *dd = &dev->ud_ddesc;
1097 1.160 drochner device_t dv;
1098 1.158 drochner int dlocs[USBDEVIFCF_NLOCS];
1099 1.18 augustss
1100 1.210 skrll uaa.uaa_device = dev;
1101 1.210 skrll uaa.uaa_usegeneric = usegeneric;
1102 1.210 skrll uaa.uaa_port = port;
1103 1.210 skrll uaa.uaa_vendor = UGETW(dd->idVendor);
1104 1.210 skrll uaa.uaa_product = UGETW(dd->idProduct);
1105 1.210 skrll uaa.uaa_release = UGETW(dd->bcdDevice);
1106 1.210 skrll uaa.uaa_class = dd->bDeviceClass;
1107 1.210 skrll uaa.uaa_subclass = dd->bDeviceSubClass;
1108 1.210 skrll uaa.uaa_proto = dd->bDeviceProtocol;
1109 1.210 skrll
1110 1.210 skrll dlocs[USBDEVIFCF_PORT] = uaa.uaa_port;
1111 1.210 skrll dlocs[USBDEVIFCF_VENDOR] = uaa.uaa_vendor;
1112 1.210 skrll dlocs[USBDEVIFCF_PRODUCT] = uaa.uaa_product;
1113 1.210 skrll dlocs[USBDEVIFCF_RELEASE] = uaa.uaa_release;
1114 1.158 drochner /* the rest is historical ballast */
1115 1.158 drochner dlocs[USBDEVIFCF_CONFIGURATION] = -1;
1116 1.158 drochner dlocs[USBDEVIFCF_INTERFACE] = -1;
1117 1.158 drochner
1118 1.224 mlelstv KERNEL_LOCK(1, curlwp);
1119 1.227 mrg config_pending_incr(parent);
1120 1.250 thorpej dv = config_found(parent, &uaa, usbd_print,
1121 1.250 thorpej CFARG_SUBMATCH, config_stdsubmatch,
1122 1.250 thorpej CFARG_IATTR, "usbdevif",
1123 1.250 thorpej CFARG_LOCATORS, dlocs,
1124 1.250 thorpej CFARG_EOL);
1125 1.224 mlelstv KERNEL_UNLOCK_ONE(curlwp);
1126 1.34 augustss if (dv) {
1127 1.210 skrll dev->ud_subdevs = kmem_alloc(sizeof(dv), KM_SLEEP);
1128 1.210 skrll dev->ud_subdevs[0] = dv;
1129 1.210 skrll dev->ud_subdevlen = 1;
1130 1.210 skrll dev->ud_nifaces_claimed = 1; /* XXX */
1131 1.249 mlelstv usbd_properties(dv, dev);
1132 1.34 augustss }
1133 1.227 mrg config_pending_decr(parent);
1134 1.210 skrll return USBD_NORMAL_COMPLETION;
1135 1.160 drochner }
1136 1.18 augustss
1137 1.160 drochner static usbd_status
1138 1.210 skrll usbd_attachinterfaces(device_t parent, struct usbd_device *dev,
1139 1.162 kent int port, const int *locators)
1140 1.160 drochner {
1141 1.210 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
1142 1.160 drochner struct usbif_attach_arg uiaa;
1143 1.162 kent int ilocs[USBIFIFCF_NLOCS];
1144 1.210 skrll usb_device_descriptor_t *dd = &dev->ud_ddesc;
1145 1.160 drochner int nifaces;
1146 1.210 skrll struct usbd_interface **ifaces;
1147 1.162 kent int i, j, loc;
1148 1.160 drochner device_t dv;
1149 1.160 drochner
1150 1.253 riastrad /* Needed for access to dev->ud_subdevs. */
1151 1.253 riastrad KASSERT(KERNEL_LOCKED_P());
1152 1.253 riastrad
1153 1.210 skrll nifaces = dev->ud_cdesc->bNumInterface;
1154 1.210 skrll ifaces = kmem_zalloc(nifaces * sizeof(*ifaces), KM_SLEEP);
1155 1.200 skrll for (i = 0; i < nifaces; i++) {
1156 1.210 skrll if (!dev->ud_subdevs[i]) {
1157 1.210 skrll ifaces[i] = &dev->ud_ifaces[i];
1158 1.200 skrll }
1159 1.221 pgoyette DPRINTF("interface %jd %#jx", i, (uintptr_t)ifaces[i], 0, 0);
1160 1.200 skrll }
1161 1.18 augustss
1162 1.210 skrll
1163 1.210 skrll uiaa.uiaa_device = dev;
1164 1.210 skrll uiaa.uiaa_port = port;
1165 1.210 skrll uiaa.uiaa_vendor = UGETW(dd->idVendor);
1166 1.210 skrll uiaa.uiaa_product = UGETW(dd->idProduct);
1167 1.210 skrll uiaa.uiaa_release = UGETW(dd->bcdDevice);
1168 1.210 skrll uiaa.uiaa_configno = dev->ud_cdesc->bConfigurationValue;
1169 1.210 skrll uiaa.uiaa_ifaces = ifaces;
1170 1.210 skrll uiaa.uiaa_nifaces = nifaces;
1171 1.210 skrll ilocs[USBIFIFCF_PORT] = uiaa.uiaa_port;
1172 1.210 skrll ilocs[USBIFIFCF_VENDOR] = uiaa.uiaa_vendor;
1173 1.210 skrll ilocs[USBIFIFCF_PRODUCT] = uiaa.uiaa_product;
1174 1.210 skrll ilocs[USBIFIFCF_RELEASE] = uiaa.uiaa_release;
1175 1.210 skrll ilocs[USBIFIFCF_CONFIGURATION] = uiaa.uiaa_configno;
1176 1.160 drochner
1177 1.160 drochner for (i = 0; i < nifaces; i++) {
1178 1.200 skrll if (!ifaces[i]) {
1179 1.221 pgoyette DPRINTF("interface %jd claimed", i, 0, 0, 0);
1180 1.160 drochner continue; /* interface already claimed */
1181 1.200 skrll }
1182 1.210 skrll uiaa.uiaa_iface = ifaces[i];
1183 1.210 skrll uiaa.uiaa_class = ifaces[i]->ui_idesc->bInterfaceClass;
1184 1.210 skrll uiaa.uiaa_subclass = ifaces[i]->ui_idesc->bInterfaceSubClass;
1185 1.210 skrll uiaa.uiaa_proto = ifaces[i]->ui_idesc->bInterfaceProtocol;
1186 1.210 skrll uiaa.uiaa_ifaceno = ifaces[i]->ui_idesc->bInterfaceNumber;
1187 1.200 skrll
1188 1.221 pgoyette DPRINTF("searching for interface %jd...", i, 0, 0, 0);
1189 1.221 pgoyette DPRINTF("class %jx subclass %jx proto %jx ifaceno %jd",
1190 1.210 skrll uiaa.uiaa_class, uiaa.uiaa_subclass, uiaa.uiaa_proto,
1191 1.210 skrll uiaa.uiaa_ifaceno);
1192 1.210 skrll ilocs[USBIFIFCF_INTERFACE] = uiaa.uiaa_ifaceno;
1193 1.162 kent if (locators != NULL) {
1194 1.162 kent loc = locators[USBIFIFCF_CONFIGURATION];
1195 1.162 kent if (loc != USBIFIFCF_CONFIGURATION_DEFAULT &&
1196 1.210 skrll loc != uiaa.uiaa_configno)
1197 1.162 kent continue;
1198 1.162 kent loc = locators[USBIFIFCF_INTERFACE];
1199 1.202 skrll if (loc != USBIFIFCF_INTERFACE_DEFAULT &&
1200 1.210 skrll loc != uiaa.uiaa_ifaceno)
1201 1.162 kent continue;
1202 1.162 kent }
1203 1.224 mlelstv KERNEL_LOCK(1, curlwp);
1204 1.250 thorpej dv = config_found(parent, &uiaa, usbd_ifprint,
1205 1.250 thorpej CFARG_SUBMATCH, config_stdsubmatch,
1206 1.250 thorpej CFARG_IATTR, "usbifif",
1207 1.250 thorpej CFARG_LOCATORS, ilocs,
1208 1.250 thorpej CFARG_EOL);
1209 1.224 mlelstv KERNEL_UNLOCK_ONE(curlwp);
1210 1.160 drochner if (!dv)
1211 1.160 drochner continue;
1212 1.204 joerg
1213 1.249 mlelstv usbd_properties(dv, dev);
1214 1.204 joerg
1215 1.201 skrll /* claim */
1216 1.201 skrll ifaces[i] = NULL;
1217 1.160 drochner /* account for ifaces claimed by the driver behind our back */
1218 1.160 drochner for (j = 0; j < nifaces; j++) {
1219 1.210 skrll
1220 1.210 skrll if (!ifaces[j] && !dev->ud_subdevs[j]) {
1221 1.221 pgoyette DPRINTF("interface %jd claimed behind our back",
1222 1.210 skrll j, 0, 0, 0);
1223 1.210 skrll dev->ud_subdevs[j] = dv;
1224 1.210 skrll dev->ud_nifaces_claimed++;
1225 1.160 drochner }
1226 1.160 drochner }
1227 1.160 drochner }
1228 1.160 drochner
1229 1.210 skrll kmem_free(ifaces, nifaces * sizeof(*ifaces));
1230 1.210 skrll return USBD_NORMAL_COMPLETION;
1231 1.160 drochner }
1232 1.160 drochner
1233 1.160 drochner usbd_status
1234 1.210 skrll usbd_probe_and_attach(device_t parent, struct usbd_device *dev,
1235 1.164 dyoung int port, int addr)
1236 1.160 drochner {
1237 1.238 mrg USBHIST_FUNC();
1238 1.238 mrg USBHIST_CALLARGS(usbdebug, "trying device specific drivers", 0, 0, 0, 0);
1239 1.210 skrll usb_device_descriptor_t *dd = &dev->ud_ddesc;
1240 1.160 drochner int confi, nifaces;
1241 1.160 drochner usbd_status err;
1242 1.160 drochner
1243 1.253 riastrad KASSERT(KERNEL_LOCKED_P());
1244 1.253 riastrad
1245 1.160 drochner /* First try with device specific drivers. */
1246 1.160 drochner err = usbd_attachwholedevice(parent, dev, port, 0);
1247 1.210 skrll if (dev->ud_nifaces_claimed || err)
1248 1.210 skrll return err;
1249 1.205 skrll DPRINTF("no device specific driver found", 0, 0, 0, 0);
1250 1.158 drochner
1251 1.221 pgoyette DPRINTF("looping over %jd configurations", dd->bNumConfigurations,
1252 1.205 skrll 0, 0, 0);
1253 1.18 augustss for (confi = 0; confi < dd->bNumConfigurations; confi++) {
1254 1.221 pgoyette DPRINTFN(1, "trying config idx=%jd", confi, 0, 0, 0);
1255 1.53 augustss err = usbd_set_config_index(dev, confi, 1);
1256 1.53 augustss if (err) {
1257 1.221 pgoyette DPRINTF("port %jd, set config at addr %jd failed, "
1258 1.244 christos "error=%jd", port, addr, err, 0);
1259 1.18 augustss printf("%s: port %d, set config at addr %d failed\n",
1260 1.164 dyoung device_xname(parent), port, addr);
1261 1.210 skrll return err;
1262 1.18 augustss }
1263 1.210 skrll nifaces = dev->ud_cdesc->bNumInterface;
1264 1.210 skrll dev->ud_subdevs = kmem_zalloc(nifaces * sizeof(device_t),
1265 1.210 skrll KM_SLEEP);
1266 1.210 skrll dev->ud_subdevlen = nifaces;
1267 1.52 augustss
1268 1.162 kent err = usbd_attachinterfaces(parent, dev, port, NULL);
1269 1.160 drochner
1270 1.252 riastrad if (dev->ud_subdevs && dev->ud_nifaces_claimed == 0) {
1271 1.210 skrll kmem_free(dev->ud_subdevs,
1272 1.210 skrll dev->ud_subdevlen * sizeof(device_t));
1273 1.210 skrll dev->ud_subdevs = 0;
1274 1.210 skrll dev->ud_subdevlen = 0;
1275 1.18 augustss }
1276 1.210 skrll if (dev->ud_nifaces_claimed || err)
1277 1.210 skrll return err;
1278 1.18 augustss }
1279 1.21 augustss /* No interfaces were attached in any of the configurations. */
1280 1.34 augustss
1281 1.34 augustss if (dd->bNumConfigurations > 1) /* don't change if only 1 config */
1282 1.18 augustss usbd_set_config_index(dev, 0, 0);
1283 1.18 augustss
1284 1.205 skrll DPRINTF("no interface drivers found", 0, 0, 0, 0);
1285 1.18 augustss
1286 1.18 augustss /* Finally try the generic driver. */
1287 1.160 drochner err = usbd_attachwholedevice(parent, dev, port, 1);
1288 1.18 augustss
1289 1.99 augustss /*
1290 1.18 augustss * The generic attach failed, but leave the device as it is.
1291 1.18 augustss * We just did not find any drivers, that's all. The device is
1292 1.18 augustss * fully operational and not harming anyone.
1293 1.18 augustss */
1294 1.205 skrll DPRINTF("generic attach failed", 0, 0, 0, 0);
1295 1.210 skrll
1296 1.210 skrll return USBD_NORMAL_COMPLETION;
1297 1.18 augustss }
1298 1.18 augustss
1299 1.162 kent /**
1300 1.162 kent * Called from uhub_rescan(). usbd_new_device() for the target dev must be
1301 1.162 kent * called before calling this.
1302 1.162 kent */
1303 1.162 kent usbd_status
1304 1.210 skrll usbd_reattach_device(device_t parent, struct usbd_device *dev,
1305 1.164 dyoung int port, const int *locators)
1306 1.162 kent {
1307 1.162 kent int i, loc;
1308 1.162 kent
1309 1.254 riastrad USBHIST_FUNC();
1310 1.254 riastrad USBHIST_CALLARGS(usbdebug, "uhub%jd port=%jd",
1311 1.254 riastrad device_unit(parent), port, 0, 0);
1312 1.254 riastrad
1313 1.253 riastrad KASSERT(KERNEL_LOCKED_P());
1314 1.253 riastrad
1315 1.162 kent if (locators != NULL) {
1316 1.162 kent loc = locators[USBIFIFCF_PORT];
1317 1.162 kent if (loc != USBIFIFCF_PORT_DEFAULT && loc != port)
1318 1.162 kent return USBD_NORMAL_COMPLETION;
1319 1.162 kent loc = locators[USBIFIFCF_VENDOR];
1320 1.162 kent if (loc != USBIFIFCF_VENDOR_DEFAULT &&
1321 1.210 skrll loc != UGETW(dev->ud_ddesc.idVendor))
1322 1.162 kent return USBD_NORMAL_COMPLETION;
1323 1.162 kent loc = locators[USBIFIFCF_PRODUCT];
1324 1.162 kent if (loc != USBIFIFCF_PRODUCT_DEFAULT &&
1325 1.210 skrll loc != UGETW(dev->ud_ddesc.idProduct))
1326 1.162 kent return USBD_NORMAL_COMPLETION;
1327 1.162 kent loc = locators[USBIFIFCF_RELEASE];
1328 1.162 kent if (loc != USBIFIFCF_RELEASE_DEFAULT &&
1329 1.210 skrll loc != UGETW(dev->ud_ddesc.bcdDevice))
1330 1.162 kent return USBD_NORMAL_COMPLETION;
1331 1.162 kent }
1332 1.210 skrll if (dev->ud_subdevlen == 0) {
1333 1.162 kent /* XXX: check USBIFIFCF_CONFIGURATION and
1334 1.162 kent * USBIFIFCF_INTERFACE too */
1335 1.210 skrll return usbd_probe_and_attach(parent, dev, port, dev->ud_addr);
1336 1.210 skrll } else if (dev->ud_subdevlen != dev->ud_cdesc->bNumInterface) {
1337 1.162 kent /* device-specific or generic driver is already attached. */
1338 1.162 kent return USBD_NORMAL_COMPLETION;
1339 1.162 kent }
1340 1.162 kent /* Does the device have unconfigured interfaces? */
1341 1.210 skrll for (i = 0; i < dev->ud_subdevlen; i++) {
1342 1.210 skrll if (dev->ud_subdevs[i] == NULL) {
1343 1.162 kent break;
1344 1.162 kent }
1345 1.162 kent }
1346 1.210 skrll if (i >= dev->ud_subdevlen)
1347 1.162 kent return USBD_NORMAL_COMPLETION;
1348 1.162 kent return usbd_attachinterfaces(parent, dev, port, locators);
1349 1.162 kent }
1350 1.18 augustss
1351 1.1 augustss /*
1352 1.1 augustss * Called when a new device has been put in the powered state,
1353 1.1 augustss * but not yet in the addressed state.
1354 1.1 augustss * Get initial descriptor, set the address, get full descriptor,
1355 1.1 augustss * and attach a driver.
1356 1.1 augustss */
1357 1.1 augustss usbd_status
1358 1.218 skrll usbd_new_device(device_t parent, struct usbd_bus *bus, int depth, int speed,
1359 1.218 skrll int port, struct usbd_port *up)
1360 1.1 augustss {
1361 1.238 mrg USBHIST_FUNC();
1362 1.238 mrg USBHIST_CALLARGS(usbdebug, "bus=%#jx port=%jd depth=%jd speed=%jd",
1363 1.238 mrg (uintptr_t)bus, port, depth, speed);
1364 1.210 skrll struct usbd_device *dev, *adev;
1365 1.94 augustss struct usbd_device *hub;
1366 1.18 augustss usb_device_descriptor_t *dd;
1367 1.107 augustss usb_port_status_t ps;
1368 1.53 augustss usbd_status err;
1369 1.1 augustss int addr;
1370 1.18 augustss int i;
1371 1.120 augustss int p;
1372 1.1 augustss
1373 1.253 riastrad KASSERT(KERNEL_LOCKED_P());
1374 1.253 riastrad
1375 1.210 skrll if (bus->ub_methods->ubm_newdev != NULL)
1376 1.210 skrll return (bus->ub_methods->ubm_newdev)(parent, bus, depth, speed,
1377 1.193 jakllsch port, up);
1378 1.193 jakllsch
1379 1.1 augustss addr = usbd_getnewaddr(bus);
1380 1.1 augustss if (addr < 0) {
1381 1.99 augustss printf("%s: No free USB addresses, new device ignored.\n",
1382 1.210 skrll device_xname(bus->ub_usbctl));
1383 1.210 skrll return USBD_NO_ADDR;
1384 1.1 augustss }
1385 1.1 augustss
1386 1.210 skrll dev = kmem_zalloc(sizeof(*dev), KM_SLEEP);
1387 1.210 skrll dev->ud_bus = bus;
1388 1.1 augustss
1389 1.1 augustss /* Set up default endpoint handle. */
1390 1.210 skrll dev->ud_ep0.ue_edesc = &dev->ud_ep0desc;
1391 1.1 augustss
1392 1.1 augustss /* Set up default endpoint descriptor. */
1393 1.210 skrll dev->ud_ep0desc.bLength = USB_ENDPOINT_DESCRIPTOR_SIZE;
1394 1.210 skrll dev->ud_ep0desc.bDescriptorType = UDESC_ENDPOINT;
1395 1.210 skrll dev->ud_ep0desc.bEndpointAddress = USB_CONTROL_ENDPOINT;
1396 1.210 skrll dev->ud_ep0desc.bmAttributes = UE_CONTROL;
1397 1.172 drochner /*
1398 1.172 drochner * temporary, will be fixed after first descriptor fetch
1399 1.172 drochner * (which uses 64 bytes so it shouldn't be less),
1400 1.172 drochner * highspeed devices must support 64 byte packets anyway
1401 1.172 drochner */
1402 1.190 skrll if (speed == USB_SPEED_HIGH || speed == USB_SPEED_FULL)
1403 1.210 skrll USETW(dev->ud_ep0desc.wMaxPacketSize, 64);
1404 1.190 skrll else
1405 1.210 skrll USETW(dev->ud_ep0desc.wMaxPacketSize, USB_MAX_IPACKET);
1406 1.190 skrll
1407 1.210 skrll dev->ud_ep0desc.bInterval = 0;
1408 1.1 augustss
1409 1.203 skrll /* doesn't matter, just don't leave it uninitialized */
1410 1.210 skrll dev->ud_ep0.ue_toggle = 0;
1411 1.179 drochner
1412 1.210 skrll dev->ud_quirks = &usbd_no_quirk;
1413 1.210 skrll dev->ud_addr = USB_START_ADDR;
1414 1.210 skrll dev->ud_ddesc.bMaxPacketSize = 0;
1415 1.210 skrll dev->ud_depth = depth;
1416 1.210 skrll dev->ud_powersrc = up;
1417 1.210 skrll dev->ud_myhub = up->up_parent;
1418 1.120 augustss
1419 1.210 skrll up->up_dev = dev;
1420 1.120 augustss
1421 1.120 augustss /* Locate port on upstream high speed hub */
1422 1.210 skrll for (adev = dev, hub = up->up_parent;
1423 1.210 skrll hub != NULL && hub->ud_speed != USB_SPEED_HIGH;
1424 1.210 skrll adev = hub, hub = hub->ud_myhub)
1425 1.94 augustss ;
1426 1.120 augustss if (hub) {
1427 1.228 manu for (p = 1; p <= hub->ud_hub->uh_hubdesc.bNbrPorts; p++) {
1428 1.228 manu if (hub->ud_hub->uh_ports[p - 1].up_dev == adev) {
1429 1.228 manu dev->ud_myhsport =
1430 1.228 manu &hub->ud_hub->uh_ports[p - 1];
1431 1.120 augustss goto found;
1432 1.120 augustss }
1433 1.120 augustss }
1434 1.199 skrll panic("usbd_new_device: cannot find HS port");
1435 1.120 augustss found:
1436 1.221 pgoyette DPRINTFN(1, "high speed port %jd", p, 0, 0, 0);
1437 1.120 augustss } else {
1438 1.210 skrll dev->ud_myhsport = NULL;
1439 1.120 augustss }
1440 1.210 skrll dev->ud_speed = speed;
1441 1.210 skrll dev->ud_langid = USBD_NOLANG;
1442 1.210 skrll dev->ud_cookie.cookie = ++usb_cookie_no;
1443 1.1 augustss
1444 1.67 soren /* Establish the default pipe. */
1445 1.210 skrll err = usbd_setup_pipe_flags(dev, 0, &dev->ud_ep0, USBD_DEFAULT_INTERVAL,
1446 1.218 skrll &dev->ud_pipe0, USBD_MPSAFE);
1447 1.53 augustss if (err) {
1448 1.18 augustss usbd_remove_device(dev, up);
1449 1.210 skrll return err;
1450 1.18 augustss }
1451 1.1 augustss
1452 1.210 skrll dd = &dev->ud_ddesc;
1453 1.6 augustss /* Try a few times in case the device is slow (i.e. outside specs.) */
1454 1.107 augustss for (i = 0; i < 10; i++) {
1455 1.6 augustss /* Get the first 8 bytes of the device descriptor. */
1456 1.172 drochner err = usbd_get_initial_ddesc(dev, dd);
1457 1.53 augustss if (!err)
1458 1.6 augustss break;
1459 1.218 skrll /*
1460 1.218 skrll * The root hub can never fail to give the initial descriptor,
1461 1.218 skrll * but assert it just in case.
1462 1.218 skrll */
1463 1.218 skrll KASSERT(up->up_parent);
1464 1.23 augustss usbd_delay_ms(dev, 200);
1465 1.107 augustss if ((i & 3) == 3)
1466 1.210 skrll usbd_reset_port(up->up_parent, port, &ps);
1467 1.6 augustss }
1468 1.53 augustss if (err) {
1469 1.221 pgoyette DPRINTF("addr=%jd, getting first desc failed: %jd", addr, err,
1470 1.205 skrll 0, 0);
1471 1.18 augustss usbd_remove_device(dev, up);
1472 1.210 skrll return err;
1473 1.95 augustss }
1474 1.95 augustss
1475 1.174 drochner /* Windows resets the port here, do likewise */
1476 1.210 skrll if (up->up_parent)
1477 1.210 skrll usbd_reset_port(up->up_parent, port, &ps);
1478 1.174 drochner
1479 1.95 augustss if (speed == USB_SPEED_HIGH) {
1480 1.95 augustss /* Max packet size must be 64 (sec 5.5.3). */
1481 1.95 augustss if (dd->bMaxPacketSize != USB_2_MAX_CTRL_PACKET) {
1482 1.95 augustss #ifdef DIAGNOSTIC
1483 1.165 pooka printf("usbd_new_device: addr=%d bad max packet "
1484 1.165 pooka "size=%d. adjusting to %d.\n",
1485 1.165 pooka addr, dd->bMaxPacketSize, USB_2_MAX_CTRL_PACKET);
1486 1.95 augustss #endif
1487 1.95 augustss dd->bMaxPacketSize = USB_2_MAX_CTRL_PACKET;
1488 1.95 augustss }
1489 1.18 augustss }
1490 1.18 augustss
1491 1.221 pgoyette DPRINTF("adding unit addr=%jd, rev=%02jx, class=%jd, subclass=%jd",
1492 1.221 pgoyette addr, UGETW(dd->bcdUSB), dd->bDeviceClass, dd->bDeviceSubClass);
1493 1.221 pgoyette DPRINTF("protocol=%jd, maxpacket=%jd, len=%jd, speed=%jd",
1494 1.210 skrll dd->bDeviceProtocol, dd->bMaxPacketSize, dd->bLength, dev->ud_speed);
1495 1.39 augustss
1496 1.18 augustss if (dd->bDescriptorType != UDESC_DEVICE) {
1497 1.18 augustss /* Illegal device descriptor */
1498 1.221 pgoyette DPRINTF("illegal descriptor %jd", dd->bDescriptorType, 0, 0, 0);
1499 1.18 augustss usbd_remove_device(dev, up);
1500 1.210 skrll return USBD_INVAL;
1501 1.1 augustss }
1502 1.1 augustss
1503 1.39 augustss if (dd->bLength < USB_DEVICE_DESCRIPTOR_SIZE) {
1504 1.221 pgoyette DPRINTF("bad length %jd", dd->bLength, 0, 0, 0);
1505 1.39 augustss usbd_remove_device(dev, up);
1506 1.210 skrll return USBD_INVAL;
1507 1.39 augustss }
1508 1.4 augustss
1509 1.210 skrll USETW(dev->ud_ep0desc.wMaxPacketSize, dd->bMaxPacketSize);
1510 1.1 augustss
1511 1.196 skrll /* Re-establish the default pipe with the new MPS. */
1512 1.210 skrll usbd_kill_pipe(dev->ud_pipe0);
1513 1.240 maxv dev->ud_pipe0 = NULL;
1514 1.210 skrll err = usbd_setup_pipe_flags(dev, 0, &dev->ud_ep0, USBD_DEFAULT_INTERVAL,
1515 1.210 skrll &dev->ud_pipe0, USBD_MPSAFE);
1516 1.196 skrll if (err) {
1517 1.221 pgoyette DPRINTF("setup default pipe failed err %jd", err, 0, 0, 0);
1518 1.196 skrll usbd_remove_device(dev, up);
1519 1.196 skrll return err;
1520 1.196 skrll }
1521 1.196 skrll
1522 1.159 jmcneill /* Set the address */
1523 1.221 pgoyette DPRINTFN(5, "setting device address=%jd", addr, 0, 0, 0);
1524 1.159 jmcneill err = usbd_set_address(dev, addr);
1525 1.159 jmcneill if (err) {
1526 1.221 pgoyette DPRINTF("set address %jd failed, err = %jd", addr, err, 0, 0);
1527 1.159 jmcneill err = USBD_SET_ADDR_FAILED;
1528 1.159 jmcneill usbd_remove_device(dev, up);
1529 1.159 jmcneill return err;
1530 1.159 jmcneill }
1531 1.159 jmcneill
1532 1.159 jmcneill /* Allow device time to set new address */
1533 1.159 jmcneill usbd_delay_ms(dev, USB_SET_ADDRESS_SETTLE);
1534 1.210 skrll dev->ud_addr = addr; /* new device address now */
1535 1.218 skrll bus->ub_devices[usb_addr2dindex(addr)] = dev;
1536 1.159 jmcneill
1537 1.159 jmcneill /* Re-establish the default pipe with the new address. */
1538 1.210 skrll usbd_kill_pipe(dev->ud_pipe0);
1539 1.240 maxv dev->ud_pipe0 = NULL;
1540 1.210 skrll err = usbd_setup_pipe_flags(dev, 0, &dev->ud_ep0, USBD_DEFAULT_INTERVAL,
1541 1.210 skrll &dev->ud_pipe0, USBD_MPSAFE);
1542 1.159 jmcneill if (err) {
1543 1.221 pgoyette DPRINTF("setup default pipe failed, err = %jd", err, 0, 0, 0);
1544 1.159 jmcneill usbd_remove_device(dev, up);
1545 1.159 jmcneill return err;
1546 1.159 jmcneill }
1547 1.159 jmcneill
1548 1.192 skrll err = usbd_reload_device_desc(dev);
1549 1.192 skrll if (err) {
1550 1.221 pgoyette DPRINTF("addr=%jd, getting full desc failed, err = %jd", addr,
1551 1.205 skrll err, 0, 0);
1552 1.192 skrll usbd_remove_device(dev, up);
1553 1.210 skrll return err;
1554 1.192 skrll }
1555 1.192 skrll
1556 1.1 augustss /* Assume 100mA bus powered for now. Changed when configured. */
1557 1.210 skrll dev->ud_power = USB_MIN_POWER;
1558 1.210 skrll dev->ud_selfpowered = 0;
1559 1.1 augustss
1560 1.221 pgoyette DPRINTF("new dev (addr %jd), dev=%#jx, parent=%#jx",
1561 1.221 pgoyette addr, (uintptr_t)dev, (uintptr_t)parent, 0);
1562 1.99 augustss
1563 1.207 skrll usbd_get_device_strings(dev);
1564 1.207 skrll
1565 1.65 augustss usbd_add_dev_event(USB_EVENT_DEVICE_ATTACH, dev);
1566 1.1 augustss
1567 1.155 drochner if (port == 0) { /* root hub */
1568 1.155 drochner KASSERT(addr == 1);
1569 1.155 drochner usbd_attach_roothub(parent, dev);
1570 1.210 skrll return USBD_NORMAL_COMPLETION;
1571 1.155 drochner }
1572 1.155 drochner
1573 1.53 augustss err = usbd_probe_and_attach(parent, dev, port, addr);
1574 1.53 augustss if (err) {
1575 1.18 augustss usbd_remove_device(dev, up);
1576 1.210 skrll return err;
1577 1.164 dyoung }
1578 1.65 augustss
1579 1.210 skrll return USBD_NORMAL_COMPLETION;
1580 1.62 augustss }
1581 1.62 augustss
1582 1.62 augustss usbd_status
1583 1.210 skrll usbd_reload_device_desc(struct usbd_device *dev)
1584 1.62 augustss {
1585 1.210 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
1586 1.210 skrll usb_device_descriptor_t *udd = &dev->ud_ddesc;
1587 1.62 augustss usbd_status err;
1588 1.62 augustss
1589 1.62 augustss /* Get the full device descriptor. */
1590 1.210 skrll err = usbd_get_device_desc(dev, udd);
1591 1.62 augustss if (err)
1592 1.210 skrll return err;
1593 1.240 maxv if (udd->bDescriptorType != UDESC_DEVICE)
1594 1.240 maxv return USBD_INVAL;
1595 1.240 maxv if (udd->bLength < USB_DEVICE_DESCRIPTOR_SIZE)
1596 1.240 maxv return USBD_INVAL;
1597 1.210 skrll
1598 1.221 pgoyette DPRINTFN(15, "bLength %5ju", udd->bLength, 0, 0, 0);
1599 1.221 pgoyette DPRINTFN(15, "bDescriptorType %5ju", udd->bDescriptorType, 0, 0, 0);
1600 1.221 pgoyette DPRINTFN(15, "bcdUSB %2jx.%02jx", udd->bcdUSB[1],
1601 1.210 skrll udd->bcdUSB[0], 0, 0);
1602 1.221 pgoyette DPRINTFN(15, "bDeviceClass %5ju", udd->bDeviceClass, 0, 0, 0);
1603 1.221 pgoyette DPRINTFN(15, "bDeviceSubClass %5ju", udd->bDeviceSubClass, 0, 0, 0);
1604 1.221 pgoyette DPRINTFN(15, "bDeviceProtocol %5ju", udd->bDeviceProtocol, 0, 0, 0);
1605 1.221 pgoyette DPRINTFN(15, "bMaxPacketSize0 %5ju", udd->bMaxPacketSize, 0, 0, 0);
1606 1.243 christos DPRINTFN(15, "idVendor 0x%02jx 0x%02jx",
1607 1.221 pgoyette udd->idVendor[0],
1608 1.221 pgoyette udd->idVendor[1], 0, 0);
1609 1.243 christos DPRINTFN(15, "idProduct 0x%02jx 0x%02jx",
1610 1.221 pgoyette udd->idProduct[0],
1611 1.221 pgoyette udd->idProduct[1], 0, 0);
1612 1.221 pgoyette DPRINTFN(15, "bcdDevice %2jx.%02jx", udd->bcdDevice[1],
1613 1.210 skrll udd->bcdDevice[0], 0, 0);
1614 1.221 pgoyette DPRINTFN(15, "iManufacturer %5ju", udd->iManufacturer, 0, 0, 0);
1615 1.221 pgoyette DPRINTFN(15, "iProduct %5ju", udd->iProduct, 0, 0, 0);
1616 1.221 pgoyette DPRINTFN(15, "iSerial %5ju", udd->iSerialNumber, 0, 0, 0);
1617 1.221 pgoyette DPRINTFN(15, "bNumConfigurations %5ju", udd->bNumConfigurations, 0, 0,
1618 1.210 skrll 0);
1619 1.62 augustss
1620 1.62 augustss /* Figure out what's wrong with this device. */
1621 1.210 skrll dev->ud_quirks = usbd_find_quirk(udd);
1622 1.62 augustss
1623 1.210 skrll return USBD_NORMAL_COMPLETION;
1624 1.18 augustss }
1625 1.1 augustss
1626 1.18 augustss void
1627 1.210 skrll usbd_remove_device(struct usbd_device *dev, struct usbd_port *up)
1628 1.18 augustss {
1629 1.182 mrg
1630 1.238 mrg USBHIST_FUNC();
1631 1.238 mrg USBHIST_CALLARGS(usbdebug, "dev %#jx up %#jx",
1632 1.238 mrg (uintptr_t)dev, (uintptr_t)up, 0, 0);
1633 1.99 augustss
1634 1.210 skrll if (dev->ud_pipe0 != NULL)
1635 1.210 skrll usbd_kill_pipe(dev->ud_pipe0);
1636 1.210 skrll up->up_dev = NULL;
1637 1.218 skrll dev->ud_bus->ub_devices[usb_addr2dindex(dev->ud_addr)] = NULL;
1638 1.1 augustss
1639 1.241 maxv if (dev->ud_vendor != NULL) {
1640 1.241 maxv kmem_free(dev->ud_vendor, USB_MAX_ENCODED_STRING_LEN);
1641 1.241 maxv }
1642 1.241 maxv if (dev->ud_product != NULL) {
1643 1.241 maxv kmem_free(dev->ud_product, USB_MAX_ENCODED_STRING_LEN);
1644 1.241 maxv }
1645 1.241 maxv if (dev->ud_serial != NULL) {
1646 1.241 maxv kmem_free(dev->ud_serial, USB_MAX_ENCODED_STRING_LEN);
1647 1.241 maxv }
1648 1.210 skrll kmem_free(dev, sizeof(*dev));
1649 1.1 augustss }
1650 1.1 augustss
1651 1.1 augustss int
1652 1.78 augustss usbd_print(void *aux, const char *pnp)
1653 1.1 augustss {
1654 1.1 augustss struct usb_attach_arg *uaa = aux;
1655 1.1 augustss
1656 1.1 augustss if (pnp) {
1657 1.134 christos #define USB_DEVINFO 1024
1658 1.134 christos char *devinfo;
1659 1.210 skrll if (!uaa->uaa_usegeneric)
1660 1.210 skrll return QUIET;
1661 1.210 skrll devinfo = kmem_alloc(USB_DEVINFO, KM_SLEEP);
1662 1.210 skrll usbd_devinfo(uaa->uaa_device, 1, devinfo, USB_DEVINFO);
1663 1.101 thorpej aprint_normal("%s, %s", devinfo, pnp);
1664 1.210 skrll kmem_free(devinfo, USB_DEVINFO);
1665 1.1 augustss }
1666 1.210 skrll aprint_normal(" port %d", uaa->uaa_port);
1667 1.144 drochner #if 0
1668 1.144 drochner /*
1669 1.144 drochner * It gets very crowded with these locators on the attach line.
1670 1.144 drochner * They are not really needed since they are printed in the clear
1671 1.144 drochner * by each driver.
1672 1.144 drochner */
1673 1.210 skrll if (uaa->uaa_vendor != UHUB_UNK_VENDOR)
1674 1.243 christos aprint_normal(" vendor 0x%04x", uaa->uaa_vendor);
1675 1.210 skrll if (uaa->uaa_product != UHUB_UNK_PRODUCT)
1676 1.243 christos aprint_normal(" product 0x%04x", uaa->uaa_product);
1677 1.210 skrll if (uaa->uaa_release != UHUB_UNK_RELEASE)
1678 1.243 christos aprint_normal(" release 0x%04x", uaa->uaa_release);
1679 1.144 drochner #endif
1680 1.210 skrll return UNCONF;
1681 1.144 drochner }
1682 1.144 drochner
1683 1.144 drochner int
1684 1.144 drochner usbd_ifprint(void *aux, const char *pnp)
1685 1.144 drochner {
1686 1.210 skrll struct usbif_attach_arg *uiaa = aux;
1687 1.144 drochner
1688 1.144 drochner if (pnp)
1689 1.210 skrll return QUIET;
1690 1.210 skrll aprint_normal(" port %d", uiaa->uiaa_port);
1691 1.210 skrll aprint_normal(" configuration %d", uiaa->uiaa_configno);
1692 1.210 skrll aprint_normal(" interface %d", uiaa->uiaa_ifaceno);
1693 1.32 augustss #if 0
1694 1.99 augustss /*
1695 1.32 augustss * It gets very crowded with these locators on the attach line.
1696 1.32 augustss * They are not really needed since they are printed in the clear
1697 1.32 augustss * by each driver.
1698 1.32 augustss */
1699 1.210 skrll if (uaa->uaa_vendor != UHUB_UNK_VENDOR)
1700 1.243 christos aprint_normal(" vendor 0x%04x", uaa->uaa_vendor);
1701 1.210 skrll if (uaa->uaa_product != UHUB_UNK_PRODUCT)
1702 1.243 christos aprint_normal(" product 0x%04x", uaa->uaa_product);
1703 1.210 skrll if (uaa->uaa_release != UHUB_UNK_RELEASE)
1704 1.243 christos aprint_normal(" release 0x%04x", uaa->uaa_release);
1705 1.32 augustss #endif
1706 1.210 skrll return UNCONF;
1707 1.1 augustss }
1708 1.1 augustss
1709 1.13 augustss void
1710 1.210 skrll usbd_fill_deviceinfo(struct usbd_device *dev, struct usb_device_info *di,
1711 1.82 augustss int usedev)
1712 1.13 augustss {
1713 1.13 augustss struct usbd_port *p;
1714 1.214 skrll int i, j, err;
1715 1.13 augustss
1716 1.210 skrll di->udi_bus = device_unit(dev->ud_bus->ub_usbctl);
1717 1.210 skrll di->udi_addr = dev->ud_addr;
1718 1.210 skrll di->udi_cookie = dev->ud_cookie;
1719 1.175 christos usbd_devinfo_vp(dev, di->udi_vendor, sizeof(di->udi_vendor),
1720 1.175 christos di->udi_product, sizeof(di->udi_product), usedev, 1);
1721 1.113 itojun usbd_printBCD(di->udi_release, sizeof(di->udi_release),
1722 1.210 skrll UGETW(dev->ud_ddesc.bcdDevice));
1723 1.207 skrll if (usedev) {
1724 1.207 skrll usbd_status uerr = usbd_get_string(dev,
1725 1.210 skrll dev->ud_ddesc.iSerialNumber, di->udi_serial);
1726 1.207 skrll if (uerr != USBD_NORMAL_COMPLETION) {
1727 1.207 skrll di->udi_serial[0] = '\0';
1728 1.207 skrll } else {
1729 1.207 skrll usbd_trim_spaces(di->udi_serial);
1730 1.207 skrll }
1731 1.207 skrll } else {
1732 1.207 skrll di->udi_serial[0] = '\0';
1733 1.207 skrll if (dev->ud_serial) {
1734 1.207 skrll strlcpy(di->udi_serial, dev->ud_serial,
1735 1.207 skrll sizeof(di->udi_serial));
1736 1.207 skrll }
1737 1.207 skrll }
1738 1.65 augustss
1739 1.210 skrll di->udi_vendorNo = UGETW(dev->ud_ddesc.idVendor);
1740 1.210 skrll di->udi_productNo = UGETW(dev->ud_ddesc.idProduct);
1741 1.210 skrll di->udi_releaseNo = UGETW(dev->ud_ddesc.bcdDevice);
1742 1.210 skrll di->udi_class = dev->ud_ddesc.bDeviceClass;
1743 1.210 skrll di->udi_subclass = dev->ud_ddesc.bDeviceSubClass;
1744 1.210 skrll di->udi_protocol = dev->ud_ddesc.bDeviceProtocol;
1745 1.210 skrll di->udi_config = dev->ud_config;
1746 1.210 skrll di->udi_power = dev->ud_selfpowered ? 0 : dev->ud_power;
1747 1.210 skrll di->udi_speed = dev->ud_speed;
1748 1.210 skrll
1749 1.210 skrll if (dev->ud_subdevlen > 0) {
1750 1.210 skrll for (i = 0, j = 0; i < dev->ud_subdevlen &&
1751 1.155 drochner j < USB_MAX_DEVNAMES; i++) {
1752 1.210 skrll if (!dev->ud_subdevs[i])
1753 1.155 drochner continue;
1754 1.164 dyoung strncpy(di->udi_devnames[j],
1755 1.210 skrll device_xname(dev->ud_subdevs[i]), USB_MAX_DEVNAMELEN);
1756 1.155 drochner di->udi_devnames[j][USB_MAX_DEVNAMELEN-1] = '\0';
1757 1.155 drochner j++;
1758 1.164 dyoung }
1759 1.164 dyoung } else {
1760 1.164 dyoung j = 0;
1761 1.164 dyoung }
1762 1.164 dyoung for (/* j is set */; j < USB_MAX_DEVNAMES; j++)
1763 1.164 dyoung di->udi_devnames[j][0] = 0; /* empty */
1764 1.65 augustss
1765 1.213 skrll if (!dev->ud_hub) {
1766 1.213 skrll di->udi_nports = 0;
1767 1.213 skrll return;
1768 1.213 skrll }
1769 1.213 skrll
1770 1.215 skrll const int nports = dev->ud_hub->uh_hubdesc.bNbrPorts;
1771 1.228 manu for (i = 1; i <= __arraycount(di->udi_ports) && i <= nports; i++) {
1772 1.228 manu p = &dev->ud_hub->uh_ports[i - 1];
1773 1.213 skrll if (p->up_dev)
1774 1.213 skrll err = p->up_dev->ud_addr;
1775 1.213 skrll else {
1776 1.218 skrll const int s = UGETW(p->up_status.wPortStatus);
1777 1.218 skrll const bool sshub_p = USB_IS_SS(dev->ud_speed);
1778 1.213 skrll if (s & UPS_PORT_ENABLED)
1779 1.213 skrll err = USB_PORT_ENABLED;
1780 1.213 skrll else if (s & UPS_SUSPEND)
1781 1.213 skrll err = USB_PORT_SUSPENDED;
1782 1.213 skrll /*
1783 1.213 skrll * Note: UPS_PORT_POWER_SS is available only
1784 1.213 skrll * on 3.x, and UPS_PORT_POWER is available
1785 1.213 skrll * only on 2.0 or 1.1.
1786 1.213 skrll */
1787 1.218 skrll else if (sshub_p && (s & UPS_PORT_POWER_SS))
1788 1.213 skrll err = USB_PORT_POWERED;
1789 1.218 skrll else if (!sshub_p && (s & UPS_PORT_POWER))
1790 1.213 skrll err = USB_PORT_POWERED;
1791 1.213 skrll else
1792 1.213 skrll err = USB_PORT_DISABLED;
1793 1.13 augustss }
1794 1.228 manu di->udi_ports[i - 1] = err;
1795 1.213 skrll }
1796 1.215 skrll di->udi_nports = nports;
1797 1.34 augustss }
1798 1.34 augustss
1799 1.34 augustss void
1800 1.210 skrll usb_free_device(struct usbd_device *dev)
1801 1.34 augustss {
1802 1.34 augustss int ifcidx, nifc;
1803 1.34 augustss
1804 1.210 skrll if (dev->ud_pipe0 != NULL)
1805 1.210 skrll usbd_kill_pipe(dev->ud_pipe0);
1806 1.210 skrll if (dev->ud_ifaces != NULL) {
1807 1.210 skrll nifc = dev->ud_cdesc->bNumInterface;
1808 1.256 riastrad for (ifcidx = 0; ifcidx < nifc; ifcidx++) {
1809 1.261 riastrad usbd_iface_exlock(&dev->ud_ifaces[ifcidx]);
1810 1.34 augustss usbd_free_iface_data(dev, ifcidx);
1811 1.261 riastrad usbd_iface_unlock(&dev->ud_ifaces[ifcidx]);
1812 1.256 riastrad usbd_iface_fini(dev, ifcidx);
1813 1.256 riastrad }
1814 1.210 skrll kmem_free(dev->ud_ifaces,
1815 1.210 skrll nifc * sizeof(struct usbd_interface));
1816 1.34 augustss }
1817 1.210 skrll if (dev->ud_cdesc != NULL)
1818 1.210 skrll kmem_free(dev->ud_cdesc, UGETW(dev->ud_cdesc->wTotalLength));
1819 1.210 skrll if (dev->ud_bdesc != NULL)
1820 1.210 skrll kmem_free(dev->ud_bdesc, UGETW(dev->ud_bdesc->wTotalLength));
1821 1.210 skrll if (dev->ud_subdevlen > 0) {
1822 1.210 skrll kmem_free(dev->ud_subdevs,
1823 1.210 skrll dev->ud_subdevlen * sizeof(device_t));
1824 1.210 skrll dev->ud_subdevlen = 0;
1825 1.155 drochner }
1826 1.207 skrll if (dev->ud_vendor) {
1827 1.207 skrll kmem_free(dev->ud_vendor, USB_MAX_ENCODED_STRING_LEN);
1828 1.207 skrll }
1829 1.207 skrll if (dev->ud_product) {
1830 1.207 skrll kmem_free(dev->ud_product, USB_MAX_ENCODED_STRING_LEN);
1831 1.207 skrll }
1832 1.207 skrll if (dev->ud_serial) {
1833 1.207 skrll kmem_free(dev->ud_serial, USB_MAX_ENCODED_STRING_LEN);
1834 1.207 skrll }
1835 1.210 skrll kmem_free(dev, sizeof(*dev));
1836 1.1 augustss }
1837 1.47 augustss
1838 1.47 augustss /*
1839 1.47 augustss * The general mechanism for detaching drivers works as follows: Each
1840 1.47 augustss * driver is responsible for maintaining a reference count on the
1841 1.47 augustss * number of outstanding references to its softc (e.g. from
1842 1.47 augustss * processing hanging in a read or write). The detach method of the
1843 1.47 augustss * driver decrements this counter and flags in the softc that the
1844 1.47 augustss * driver is dying and then wakes any sleepers. It then sleeps on the
1845 1.47 augustss * softc. Each place that can sleep must maintain the reference
1846 1.47 augustss * count. When the reference count drops to -1 (0 is the normal value
1847 1.223 khorben * of the reference count) then a wakeup on the softc is performed
1848 1.47 augustss * signaling to the detach waiter that all references are gone.
1849 1.47 augustss */
1850 1.47 augustss
1851 1.47 augustss /*
1852 1.47 augustss * Called from process context when we discover that a port has
1853 1.47 augustss * been disconnected.
1854 1.47 augustss */
1855 1.167 dyoung int
1856 1.167 dyoung usb_disconnect_port(struct usbd_port *up, device_t parent, int flags)
1857 1.47 augustss {
1858 1.210 skrll struct usbd_device *dev = up->up_dev;
1859 1.167 dyoung device_t subdev;
1860 1.167 dyoung char subdevname[16];
1861 1.164 dyoung const char *hubname = device_xname(parent);
1862 1.167 dyoung int i, rc;
1863 1.47 augustss
1864 1.238 mrg USBHIST_FUNC();
1865 1.238 mrg USBHIST_CALLARGS(usbdebug, "up=%#jx dev=%#jx port=%jd",
1866 1.238 mrg (uintptr_t)up, (uintptr_t)dev, up->up_portno, 0);
1867 1.48 augustss
1868 1.167 dyoung if (dev == NULL) {
1869 1.167 dyoung return 0;
1870 1.48 augustss }
1871 1.47 augustss
1872 1.210 skrll if (dev->ud_subdevlen > 0) {
1873 1.205 skrll DPRINTFN(3, "disconnect subdevs", 0, 0, 0, 0);
1874 1.210 skrll for (i = 0; i < dev->ud_subdevlen; i++) {
1875 1.210 skrll if ((subdev = dev->ud_subdevs[i]) == NULL)
1876 1.155 drochner continue;
1877 1.167 dyoung strlcpy(subdevname, device_xname(subdev),
1878 1.167 dyoung sizeof(subdevname));
1879 1.224 mlelstv KERNEL_LOCK(1, curlwp);
1880 1.224 mlelstv rc = config_detach(subdev, flags);
1881 1.224 mlelstv KERNEL_UNLOCK_ONE(curlwp);
1882 1.224 mlelstv if (rc != 0)
1883 1.167 dyoung return rc;
1884 1.167 dyoung printf("%s: at %s", subdevname, hubname);
1885 1.210 skrll if (up->up_portno != 0)
1886 1.210 skrll printf(" port %d", up->up_portno);
1887 1.210 skrll printf(" (addr %d) disconnected\n", dev->ud_addr);
1888 1.47 augustss }
1889 1.210 skrll KASSERT(!dev->ud_nifaces_claimed);
1890 1.47 augustss }
1891 1.47 augustss
1892 1.218 skrll mutex_enter(dev->ud_bus->ub_lock);
1893 1.218 skrll dev->ud_bus->ub_devices[usb_addr2dindex(dev->ud_addr)] = NULL;
1894 1.218 skrll up->up_dev = NULL;
1895 1.218 skrll mutex_exit(dev->ud_bus->ub_lock);
1896 1.218 skrll
1897 1.65 augustss usbd_add_dev_event(USB_EVENT_DEVICE_DETACH, dev);
1898 1.218 skrll
1899 1.47 augustss usb_free_device(dev);
1900 1.218 skrll
1901 1.167 dyoung return 0;
1902 1.47 augustss }
1903