xref: /netbsd-src/sys/dev/usb/xhci.c (revision e6c7e151de239c49d2e38720a061ed9d1fa99309)
1 /*	$NetBSD: xhci.c,v 1.123 2020/04/02 11:37:23 skrll Exp $	*/
2 
3 /*
4  * Copyright (c) 2013 Jonathan A. Kollasch
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
17  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
18  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
19  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
20  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
21  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
22  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
23  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
24  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
25  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
26  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27  */
28 
29 /*
30  * USB rev 2.0 and rev 3.1 specification
31  *  http://www.usb.org/developers/docs/
32  * xHCI rev 1.1 specification
33  *  http://www.intel.com/technology/usb/spec.htm
34  */
35 
36 #include <sys/cdefs.h>
37 __KERNEL_RCSID(0, "$NetBSD: xhci.c,v 1.123 2020/04/02 11:37:23 skrll Exp $");
38 
39 #ifdef _KERNEL_OPT
40 #include "opt_usb.h"
41 #endif
42 
43 #include <sys/param.h>
44 #include <sys/systm.h>
45 #include <sys/kernel.h>
46 #include <sys/kmem.h>
47 #include <sys/device.h>
48 #include <sys/select.h>
49 #include <sys/proc.h>
50 #include <sys/queue.h>
51 #include <sys/mutex.h>
52 #include <sys/condvar.h>
53 #include <sys/bus.h>
54 #include <sys/cpu.h>
55 #include <sys/sysctl.h>
56 
57 #include <machine/endian.h>
58 
59 #include <dev/usb/usb.h>
60 #include <dev/usb/usbdi.h>
61 #include <dev/usb/usbdivar.h>
62 #include <dev/usb/usbdi_util.h>
63 #include <dev/usb/usbhist.h>
64 #include <dev/usb/usb_mem.h>
65 #include <dev/usb/usb_quirks.h>
66 
67 #include <dev/usb/xhcireg.h>
68 #include <dev/usb/xhcivar.h>
69 #include <dev/usb/usbroothub.h>
70 
71 
72 #ifdef USB_DEBUG
73 #ifndef XHCI_DEBUG
74 #define xhcidebug 0
75 #else /* !XHCI_DEBUG */
76 #define HEXDUMP(a, b, c) \
77     do { \
78 	    if (xhcidebug > 0) \
79 		    hexdump(printf, a, b, c); \
80     } while (/*CONSTCOND*/0)
81 static int xhcidebug = 0;
82 
83 SYSCTL_SETUP(sysctl_hw_xhci_setup, "sysctl hw.xhci setup")
84 {
85 	int err;
86 	const struct sysctlnode *rnode;
87 	const struct sysctlnode *cnode;
88 
89 	err = sysctl_createv(clog, 0, NULL, &rnode,
90 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "xhci",
91 	    SYSCTL_DESCR("xhci global controls"),
92 	    NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
93 
94 	if (err)
95 		goto fail;
96 
97 	/* control debugging printfs */
98 	err = sysctl_createv(clog, 0, &rnode, &cnode,
99 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
100 	    "debug", SYSCTL_DESCR("Enable debugging output"),
101 	    NULL, 0, &xhcidebug, sizeof(xhcidebug), CTL_CREATE, CTL_EOL);
102 	if (err)
103 		goto fail;
104 
105 	return;
106 fail:
107 	aprint_error("%s: sysctl_createv failed (err = %d)\n", __func__, err);
108 }
109 
110 #endif /* !XHCI_DEBUG */
111 #endif /* USB_DEBUG */
112 
113 #ifndef HEXDUMP
114 #define HEXDUMP(a, b, c)
115 #endif
116 
117 #define DPRINTF(FMT,A,B,C,D)	USBHIST_LOG(xhcidebug,FMT,A,B,C,D)
118 #define DPRINTFN(N,FMT,A,B,C,D)	USBHIST_LOGN(xhcidebug,N,FMT,A,B,C,D)
119 #define XHCIHIST_FUNC()		USBHIST_FUNC()
120 #define XHCIHIST_CALLED(name)	USBHIST_CALLED(xhcidebug)
121 #define XHCIHIST_CALLARGS(FMT,A,B,C,D) \
122 				USBHIST_CALLARGS(xhcidebug,FMT,A,B,C,D)
123 
124 #define XHCI_DCI_SLOT 0
125 #define XHCI_DCI_EP_CONTROL 1
126 
127 #define XHCI_ICI_INPUT_CONTROL 0
128 
129 struct xhci_pipe {
130 	struct usbd_pipe xp_pipe;
131 	struct usb_task xp_async_task;
132 };
133 
134 #define XHCI_COMMAND_RING_TRBS 256
135 #define XHCI_EVENT_RING_TRBS 256
136 #define XHCI_EVENT_RING_SEGMENTS 1
137 #define XHCI_TRB_3_ED_BIT XHCI_TRB_3_ISP_BIT
138 
139 static usbd_status xhci_open(struct usbd_pipe *);
140 static void xhci_close_pipe(struct usbd_pipe *);
141 static int xhci_intr1(struct xhci_softc * const);
142 static void xhci_softintr(void *);
143 static void xhci_poll(struct usbd_bus *);
144 static struct usbd_xfer *xhci_allocx(struct usbd_bus *, unsigned int);
145 static void xhci_freex(struct usbd_bus *, struct usbd_xfer *);
146 static void xhci_abortx(struct usbd_xfer *);
147 static bool xhci_dying(struct usbd_bus *);
148 static void xhci_get_lock(struct usbd_bus *, kmutex_t **);
149 static usbd_status xhci_new_device(device_t, struct usbd_bus *, int, int, int,
150     struct usbd_port *);
151 static int xhci_roothub_ctrl(struct usbd_bus *, usb_device_request_t *,
152     void *, int);
153 
154 static usbd_status xhci_configure_endpoint(struct usbd_pipe *);
155 //static usbd_status xhci_unconfigure_endpoint(struct usbd_pipe *);
156 static usbd_status xhci_reset_endpoint(struct usbd_pipe *);
157 static usbd_status xhci_stop_endpoint(struct usbd_pipe *);
158 
159 static void xhci_host_dequeue(struct xhci_ring * const);
160 static usbd_status xhci_set_dequeue(struct usbd_pipe *);
161 
162 static usbd_status xhci_do_command(struct xhci_softc * const,
163     struct xhci_soft_trb * const, int);
164 static usbd_status xhci_do_command_locked(struct xhci_softc * const,
165     struct xhci_soft_trb * const, int);
166 static usbd_status xhci_init_slot(struct usbd_device *, uint32_t);
167 static void xhci_free_slot(struct xhci_softc *, struct xhci_slot *);
168 static usbd_status xhci_set_address(struct usbd_device *, uint32_t, bool);
169 static usbd_status xhci_enable_slot(struct xhci_softc * const,
170     uint8_t * const);
171 static usbd_status xhci_disable_slot(struct xhci_softc * const, uint8_t);
172 static usbd_status xhci_address_device(struct xhci_softc * const,
173     uint64_t, uint8_t, bool);
174 static void xhci_set_dcba(struct xhci_softc * const, uint64_t, int);
175 static usbd_status xhci_update_ep0_mps(struct xhci_softc * const,
176     struct xhci_slot * const, u_int);
177 static usbd_status xhci_ring_init(struct xhci_softc * const,
178     struct xhci_ring **, size_t, size_t);
179 static void xhci_ring_free(struct xhci_softc * const,
180     struct xhci_ring ** const);
181 
182 static void xhci_setup_ctx(struct usbd_pipe *);
183 static void xhci_setup_route(struct usbd_pipe *, uint32_t *);
184 static void xhci_setup_tthub(struct usbd_pipe *, uint32_t *);
185 static void xhci_setup_maxburst(struct usbd_pipe *, uint32_t *);
186 static uint32_t xhci_bival2ival(uint32_t, uint32_t);
187 
188 static void xhci_noop(struct usbd_pipe *);
189 
190 static usbd_status xhci_root_intr_transfer(struct usbd_xfer *);
191 static usbd_status xhci_root_intr_start(struct usbd_xfer *);
192 static void xhci_root_intr_abort(struct usbd_xfer *);
193 static void xhci_root_intr_close(struct usbd_pipe *);
194 static void xhci_root_intr_done(struct usbd_xfer *);
195 
196 static usbd_status xhci_device_ctrl_transfer(struct usbd_xfer *);
197 static usbd_status xhci_device_ctrl_start(struct usbd_xfer *);
198 static void xhci_device_ctrl_abort(struct usbd_xfer *);
199 static void xhci_device_ctrl_close(struct usbd_pipe *);
200 static void xhci_device_ctrl_done(struct usbd_xfer *);
201 
202 static usbd_status xhci_device_intr_transfer(struct usbd_xfer *);
203 static usbd_status xhci_device_intr_start(struct usbd_xfer *);
204 static void xhci_device_intr_abort(struct usbd_xfer *);
205 static void xhci_device_intr_close(struct usbd_pipe *);
206 static void xhci_device_intr_done(struct usbd_xfer *);
207 
208 static usbd_status xhci_device_bulk_transfer(struct usbd_xfer *);
209 static usbd_status xhci_device_bulk_start(struct usbd_xfer *);
210 static void xhci_device_bulk_abort(struct usbd_xfer *);
211 static void xhci_device_bulk_close(struct usbd_pipe *);
212 static void xhci_device_bulk_done(struct usbd_xfer *);
213 
214 static const struct usbd_bus_methods xhci_bus_methods = {
215 	.ubm_open = xhci_open,
216 	.ubm_softint = xhci_softintr,
217 	.ubm_dopoll = xhci_poll,
218 	.ubm_allocx = xhci_allocx,
219 	.ubm_freex = xhci_freex,
220 	.ubm_abortx = xhci_abortx,
221 	.ubm_dying = xhci_dying,
222 	.ubm_getlock = xhci_get_lock,
223 	.ubm_newdev = xhci_new_device,
224 	.ubm_rhctrl = xhci_roothub_ctrl,
225 };
226 
227 static const struct usbd_pipe_methods xhci_root_intr_methods = {
228 	.upm_transfer = xhci_root_intr_transfer,
229 	.upm_start = xhci_root_intr_start,
230 	.upm_abort = xhci_root_intr_abort,
231 	.upm_close = xhci_root_intr_close,
232 	.upm_cleartoggle = xhci_noop,
233 	.upm_done = xhci_root_intr_done,
234 };
235 
236 
237 static const struct usbd_pipe_methods xhci_device_ctrl_methods = {
238 	.upm_transfer = xhci_device_ctrl_transfer,
239 	.upm_start = xhci_device_ctrl_start,
240 	.upm_abort = xhci_device_ctrl_abort,
241 	.upm_close = xhci_device_ctrl_close,
242 	.upm_cleartoggle = xhci_noop,
243 	.upm_done = xhci_device_ctrl_done,
244 };
245 
246 static const struct usbd_pipe_methods xhci_device_isoc_methods = {
247 	.upm_cleartoggle = xhci_noop,
248 };
249 
250 static const struct usbd_pipe_methods xhci_device_bulk_methods = {
251 	.upm_transfer = xhci_device_bulk_transfer,
252 	.upm_start = xhci_device_bulk_start,
253 	.upm_abort = xhci_device_bulk_abort,
254 	.upm_close = xhci_device_bulk_close,
255 	.upm_cleartoggle = xhci_noop,
256 	.upm_done = xhci_device_bulk_done,
257 };
258 
259 static const struct usbd_pipe_methods xhci_device_intr_methods = {
260 	.upm_transfer = xhci_device_intr_transfer,
261 	.upm_start = xhci_device_intr_start,
262 	.upm_abort = xhci_device_intr_abort,
263 	.upm_close = xhci_device_intr_close,
264 	.upm_cleartoggle = xhci_noop,
265 	.upm_done = xhci_device_intr_done,
266 };
267 
268 static inline uint32_t
269 xhci_read_1(const struct xhci_softc * const sc, bus_size_t offset)
270 {
271 	return bus_space_read_1(sc->sc_iot, sc->sc_ioh, offset);
272 }
273 
274 static inline uint32_t
275 xhci_read_4(const struct xhci_softc * const sc, bus_size_t offset)
276 {
277 	return bus_space_read_4(sc->sc_iot, sc->sc_ioh, offset);
278 }
279 
280 static inline void
281 xhci_write_1(const struct xhci_softc * const sc, bus_size_t offset,
282     uint32_t value)
283 {
284 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, offset, value);
285 }
286 
287 #if 0 /* unused */
288 static inline void
289 xhci_write_4(const struct xhci_softc * const sc, bus_size_t offset,
290     uint32_t value)
291 {
292 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, offset, value);
293 }
294 #endif /* unused */
295 
296 static inline uint32_t
297 xhci_cap_read_4(const struct xhci_softc * const sc, bus_size_t offset)
298 {
299 	return bus_space_read_4(sc->sc_iot, sc->sc_cbh, offset);
300 }
301 
302 static inline uint32_t
303 xhci_op_read_4(const struct xhci_softc * const sc, bus_size_t offset)
304 {
305 	return bus_space_read_4(sc->sc_iot, sc->sc_obh, offset);
306 }
307 
308 static inline void
309 xhci_op_write_4(const struct xhci_softc * const sc, bus_size_t offset,
310     uint32_t value)
311 {
312 	bus_space_write_4(sc->sc_iot, sc->sc_obh, offset, value);
313 }
314 
315 static inline uint64_t
316 xhci_op_read_8(const struct xhci_softc * const sc, bus_size_t offset)
317 {
318 	uint64_t value;
319 
320 	if (sc->sc_ac64) {
321 #ifdef XHCI_USE_BUS_SPACE_8
322 		value = bus_space_read_8(sc->sc_iot, sc->sc_obh, offset);
323 #else
324 		value = bus_space_read_4(sc->sc_iot, sc->sc_obh, offset);
325 		value |= (uint64_t)bus_space_read_4(sc->sc_iot, sc->sc_obh,
326 		    offset + 4) << 32;
327 #endif
328 	} else {
329 		value = bus_space_read_4(sc->sc_iot, sc->sc_obh, offset);
330 	}
331 
332 	return value;
333 }
334 
335 static inline void
336 xhci_op_write_8(const struct xhci_softc * const sc, bus_size_t offset,
337     uint64_t value)
338 {
339 	if (sc->sc_ac64) {
340 #ifdef XHCI_USE_BUS_SPACE_8
341 		bus_space_write_8(sc->sc_iot, sc->sc_obh, offset, value);
342 #else
343 		bus_space_write_4(sc->sc_iot, sc->sc_obh, offset + 0,
344 		    (value >> 0) & 0xffffffff);
345 		bus_space_write_4(sc->sc_iot, sc->sc_obh, offset + 4,
346 		    (value >> 32) & 0xffffffff);
347 #endif
348 	} else {
349 		bus_space_write_4(sc->sc_iot, sc->sc_obh, offset, value);
350 	}
351 }
352 
353 static inline void
354 xhci_op_barrier(const struct xhci_softc * const sc, bus_size_t offset,
355     bus_size_t len, int flags)
356 {
357 	bus_space_barrier(sc->sc_iot, sc->sc_obh, offset, len, flags);
358 }
359 
360 static inline uint32_t
361 xhci_rt_read_4(const struct xhci_softc * const sc, bus_size_t offset)
362 {
363 	return bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset);
364 }
365 
366 static inline void
367 xhci_rt_write_4(const struct xhci_softc * const sc, bus_size_t offset,
368     uint32_t value)
369 {
370 	bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset, value);
371 }
372 
373 #if 0 /* unused */
374 static inline uint64_t
375 xhci_rt_read_8(const struct xhci_softc * const sc, bus_size_t offset)
376 {
377 	uint64_t value;
378 
379 	if (sc->sc_ac64) {
380 #ifdef XHCI_USE_BUS_SPACE_8
381 		value = bus_space_read_8(sc->sc_iot, sc->sc_rbh, offset);
382 #else
383 		value = bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset);
384 		value |= (uint64_t)bus_space_read_4(sc->sc_iot, sc->sc_rbh,
385 		    offset + 4) << 32;
386 #endif
387 	} else {
388 		value = bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset);
389 	}
390 
391 	return value;
392 }
393 #endif /* unused */
394 
395 static inline void
396 xhci_rt_write_8(const struct xhci_softc * const sc, bus_size_t offset,
397     uint64_t value)
398 {
399 	if (sc->sc_ac64) {
400 #ifdef XHCI_USE_BUS_SPACE_8
401 		bus_space_write_8(sc->sc_iot, sc->sc_rbh, offset, value);
402 #else
403 		bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset + 0,
404 		    (value >> 0) & 0xffffffff);
405 		bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset + 4,
406 		    (value >> 32) & 0xffffffff);
407 #endif
408 	} else {
409 		bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset, value);
410 	}
411 }
412 
413 #if 0 /* unused */
414 static inline uint32_t
415 xhci_db_read_4(const struct xhci_softc * const sc, bus_size_t offset)
416 {
417 	return bus_space_read_4(sc->sc_iot, sc->sc_dbh, offset);
418 }
419 #endif /* unused */
420 
421 static inline void
422 xhci_db_write_4(const struct xhci_softc * const sc, bus_size_t offset,
423     uint32_t value)
424 {
425 	bus_space_write_4(sc->sc_iot, sc->sc_dbh, offset, value);
426 }
427 
428 /* --- */
429 
430 static inline uint8_t
431 xhci_ep_get_type(usb_endpoint_descriptor_t * const ed)
432 {
433 	u_int eptype = 0;
434 
435 	switch (UE_GET_XFERTYPE(ed->bmAttributes)) {
436 	case UE_CONTROL:
437 		eptype = 0x0;
438 		break;
439 	case UE_ISOCHRONOUS:
440 		eptype = 0x1;
441 		break;
442 	case UE_BULK:
443 		eptype = 0x2;
444 		break;
445 	case UE_INTERRUPT:
446 		eptype = 0x3;
447 		break;
448 	}
449 
450 	if ((UE_GET_XFERTYPE(ed->bmAttributes) == UE_CONTROL) ||
451 	    (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN))
452 		return eptype | 0x4;
453 	else
454 		return eptype;
455 }
456 
457 static u_int
458 xhci_ep_get_dci(usb_endpoint_descriptor_t * const ed)
459 {
460 	/* xHCI 1.0 section 4.5.1 */
461 	u_int epaddr = UE_GET_ADDR(ed->bEndpointAddress);
462 	u_int in = 0;
463 
464 	if ((UE_GET_XFERTYPE(ed->bmAttributes) == UE_CONTROL) ||
465 	    (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN))
466 		in = 1;
467 
468 	return epaddr * 2 + in;
469 }
470 
471 static inline u_int
472 xhci_dci_to_ici(const u_int i)
473 {
474 	return i + 1;
475 }
476 
477 static inline void *
478 xhci_slot_get_dcv(struct xhci_softc * const sc, struct xhci_slot * const xs,
479     const u_int dci)
480 {
481 	return KERNADDR(&xs->xs_dc_dma, sc->sc_ctxsz * dci);
482 }
483 
484 #if 0 /* unused */
485 static inline bus_addr_t
486 xhci_slot_get_dcp(struct xhci_softc * const sc, struct xhci_slot * const xs,
487     const u_int dci)
488 {
489 	return DMAADDR(&xs->xs_dc_dma, sc->sc_ctxsz * dci);
490 }
491 #endif /* unused */
492 
493 static inline void *
494 xhci_slot_get_icv(struct xhci_softc * const sc, struct xhci_slot * const xs,
495     const u_int ici)
496 {
497 	return KERNADDR(&xs->xs_ic_dma, sc->sc_ctxsz * ici);
498 }
499 
500 static inline bus_addr_t
501 xhci_slot_get_icp(struct xhci_softc * const sc, struct xhci_slot * const xs,
502     const u_int ici)
503 {
504 	return DMAADDR(&xs->xs_ic_dma, sc->sc_ctxsz * ici);
505 }
506 
507 static inline struct xhci_trb *
508 xhci_ring_trbv(struct xhci_ring * const xr, u_int idx)
509 {
510 	return KERNADDR(&xr->xr_dma, XHCI_TRB_SIZE * idx);
511 }
512 
513 static inline bus_addr_t
514 xhci_ring_trbp(struct xhci_ring * const xr, u_int idx)
515 {
516 	return DMAADDR(&xr->xr_dma, XHCI_TRB_SIZE * idx);
517 }
518 
519 static inline void
520 xhci_soft_trb_put(struct xhci_soft_trb * const trb,
521     uint64_t parameter, uint32_t status, uint32_t control)
522 {
523 	trb->trb_0 = parameter;
524 	trb->trb_2 = status;
525 	trb->trb_3 = control;
526 }
527 
528 static inline void
529 xhci_trb_put(struct xhci_trb * const trb, uint64_t parameter, uint32_t status,
530     uint32_t control)
531 {
532 	trb->trb_0 = htole64(parameter);
533 	trb->trb_2 = htole32(status);
534 	trb->trb_3 = htole32(control);
535 }
536 
537 static int
538 xhci_trb_get_idx(struct xhci_ring *xr, uint64_t trb_0, int *idx)
539 {
540 	/* base address of TRBs */
541 	bus_addr_t trbp = xhci_ring_trbp(xr, 0);
542 
543 	/* trb_0 range sanity check */
544 	if (trb_0 == 0 || trb_0 < trbp ||
545 	    (trb_0 - trbp) % sizeof(struct xhci_trb) != 0 ||
546 	    (trb_0 - trbp) / sizeof(struct xhci_trb) >= xr->xr_ntrb) {
547 		return 1;
548 	}
549 	*idx = (trb_0 - trbp) / sizeof(struct xhci_trb);
550 	return 0;
551 }
552 
553 static unsigned int
554 xhci_get_epstate(struct xhci_softc * const sc, struct xhci_slot * const xs,
555     u_int dci)
556 {
557 	uint32_t *cp;
558 
559 	usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD);
560 	cp = xhci_slot_get_dcv(sc, xs, dci);
561 	return XHCI_EPCTX_0_EPSTATE_GET(le32toh(cp[0]));
562 }
563 
564 static inline unsigned int
565 xhci_ctlrport2bus(struct xhci_softc * const sc, unsigned int ctlrport)
566 {
567 	const unsigned int port = ctlrport - 1;
568 	const uint8_t bit = __BIT(port % NBBY);
569 
570 	return __SHIFTOUT(sc->sc_ctlrportbus[port / NBBY], bit);
571 }
572 
573 /*
574  * Return the roothub port for a controller port.  Both are 1..n.
575  */
576 static inline unsigned int
577 xhci_ctlrport2rhport(struct xhci_softc * const sc, unsigned int ctrlport)
578 {
579 
580 	return sc->sc_ctlrportmap[ctrlport - 1];
581 }
582 
583 /*
584  * Return the controller port for a bus roothub port.  Both are 1..n.
585  */
586 static inline unsigned int
587 xhci_rhport2ctlrport(struct xhci_softc * const sc, unsigned int bn,
588     unsigned int rhport)
589 {
590 
591 	return sc->sc_rhportmap[bn][rhport - 1];
592 }
593 
594 /* --- */
595 
596 void
597 xhci_childdet(device_t self, device_t child)
598 {
599 	struct xhci_softc * const sc = device_private(self);
600 
601 	KASSERT((sc->sc_child == child) || (sc->sc_child2 == child));
602 	if (child == sc->sc_child2)
603 		sc->sc_child2 = NULL;
604 	else if (child == sc->sc_child)
605 		sc->sc_child = NULL;
606 }
607 
608 int
609 xhci_detach(struct xhci_softc *sc, int flags)
610 {
611 	int rv = 0;
612 
613 	if (sc->sc_child2 != NULL) {
614 		rv = config_detach(sc->sc_child2, flags);
615 		if (rv != 0)
616 			return rv;
617 		KASSERT(sc->sc_child2 == NULL);
618 	}
619 
620 	if (sc->sc_child != NULL) {
621 		rv = config_detach(sc->sc_child, flags);
622 		if (rv != 0)
623 			return rv;
624 		KASSERT(sc->sc_child == NULL);
625 	}
626 
627 	/* XXX unconfigure/free slots */
628 
629 	/* verify: */
630 	xhci_rt_write_4(sc, XHCI_IMAN(0), 0);
631 	xhci_op_write_4(sc, XHCI_USBCMD, 0);
632 	/* do we need to wait for stop? */
633 
634 	xhci_op_write_8(sc, XHCI_CRCR, 0);
635 	xhci_ring_free(sc, &sc->sc_cr);
636 	cv_destroy(&sc->sc_command_cv);
637 	cv_destroy(&sc->sc_cmdbusy_cv);
638 
639 	xhci_rt_write_4(sc, XHCI_ERSTSZ(0), 0);
640 	xhci_rt_write_8(sc, XHCI_ERSTBA(0), 0);
641 	xhci_rt_write_8(sc, XHCI_ERDP(0), 0|XHCI_ERDP_LO_BUSY);
642 	xhci_ring_free(sc, &sc->sc_er);
643 
644 	usb_freemem(&sc->sc_bus, &sc->sc_eventst_dma);
645 
646 	xhci_op_write_8(sc, XHCI_DCBAAP, 0);
647 	usb_freemem(&sc->sc_bus, &sc->sc_dcbaa_dma);
648 
649 	kmem_free(sc->sc_slots, sizeof(*sc->sc_slots) * sc->sc_maxslots);
650 
651 	kmem_free(sc->sc_ctlrportbus,
652 	    howmany(sc->sc_maxports * sizeof(uint8_t), NBBY));
653 	kmem_free(sc->sc_ctlrportmap, sc->sc_maxports * sizeof(int));
654 
655 	for (size_t j = 0; j < __arraycount(sc->sc_rhportmap); j++) {
656 		kmem_free(sc->sc_rhportmap[j], sc->sc_maxports * sizeof(int));
657 	}
658 
659 	mutex_destroy(&sc->sc_lock);
660 	mutex_destroy(&sc->sc_intr_lock);
661 
662 	pool_cache_destroy(sc->sc_xferpool);
663 
664 	return rv;
665 }
666 
667 int
668 xhci_activate(device_t self, enum devact act)
669 {
670 	struct xhci_softc * const sc = device_private(self);
671 
672 	switch (act) {
673 	case DVACT_DEACTIVATE:
674 		sc->sc_dying = true;
675 		return 0;
676 	default:
677 		return EOPNOTSUPP;
678 	}
679 }
680 
681 bool
682 xhci_suspend(device_t dv, const pmf_qual_t *qual)
683 {
684 	return false;
685 }
686 
687 bool
688 xhci_resume(device_t dv, const pmf_qual_t *qual)
689 {
690 	return false;
691 }
692 
693 bool
694 xhci_shutdown(device_t self, int flags)
695 {
696 	return false;
697 }
698 
699 static int
700 xhci_hc_reset(struct xhci_softc * const sc)
701 {
702 	uint32_t usbcmd, usbsts;
703 	int i;
704 
705 	/* Check controller not ready */
706 	for (i = 0; i < XHCI_WAIT_CNR; i++) {
707 		usbsts = xhci_op_read_4(sc, XHCI_USBSTS);
708 		if ((usbsts & XHCI_STS_CNR) == 0)
709 			break;
710 		usb_delay_ms(&sc->sc_bus, 1);
711 	}
712 	if (i >= XHCI_WAIT_CNR) {
713 		aprint_error_dev(sc->sc_dev, "controller not ready timeout\n");
714 		return EIO;
715 	}
716 
717 	/* Halt controller */
718 	usbcmd = 0;
719 	xhci_op_write_4(sc, XHCI_USBCMD, usbcmd);
720 	usb_delay_ms(&sc->sc_bus, 1);
721 
722 	/* Reset controller */
723 	usbcmd = XHCI_CMD_HCRST;
724 	xhci_op_write_4(sc, XHCI_USBCMD, usbcmd);
725 	for (i = 0; i < XHCI_WAIT_HCRST; i++) {
726 		/*
727 		 * Wait 1ms first. Existing Intel xHCI requies 1ms delay to
728 		 * prevent system hang (Errata).
729 		 */
730 		usb_delay_ms(&sc->sc_bus, 1);
731 		usbcmd = xhci_op_read_4(sc, XHCI_USBCMD);
732 		if ((usbcmd & XHCI_CMD_HCRST) == 0)
733 			break;
734 	}
735 	if (i >= XHCI_WAIT_HCRST) {
736 		aprint_error_dev(sc->sc_dev, "host controller reset timeout\n");
737 		return EIO;
738 	}
739 
740 	/* Check controller not ready */
741 	for (i = 0; i < XHCI_WAIT_CNR; i++) {
742 		usbsts = xhci_op_read_4(sc, XHCI_USBSTS);
743 		if ((usbsts & XHCI_STS_CNR) == 0)
744 			break;
745 		usb_delay_ms(&sc->sc_bus, 1);
746 	}
747 	if (i >= XHCI_WAIT_CNR) {
748 		aprint_error_dev(sc->sc_dev,
749 		    "controller not ready timeout after reset\n");
750 		return EIO;
751 	}
752 
753 	return 0;
754 }
755 
756 
757 /* 7.2 xHCI Support Protocol Capability */
758 static void
759 xhci_id_protocols(struct xhci_softc *sc, bus_size_t ecp)
760 {
761 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
762 
763 	/* XXX Cache this lot */
764 
765 	const uint32_t w0 = xhci_read_4(sc, ecp);
766 	const uint32_t w4 = xhci_read_4(sc, ecp + 4);
767 	const uint32_t w8 = xhci_read_4(sc, ecp + 8);
768 	const uint32_t wc = xhci_read_4(sc, ecp + 0xc);
769 
770 	aprint_debug_dev(sc->sc_dev,
771 	    " SP: 0x%08x 0x%08x 0x%08x 0x%08x\n", w0, w4, w8, wc);
772 
773 	if (w4 != XHCI_XECP_USBID)
774 		return;
775 
776 	const int major = XHCI_XECP_SP_W0_MAJOR(w0);
777 	const int minor = XHCI_XECP_SP_W0_MINOR(w0);
778 	const uint8_t cpo = XHCI_XECP_SP_W8_CPO(w8);
779 	const uint8_t cpc = XHCI_XECP_SP_W8_CPC(w8);
780 
781 	const uint16_t mm = __SHIFTOUT(w0, __BITS(31, 16));
782 	switch (mm) {
783 	case 0x0200:
784 	case 0x0300:
785 	case 0x0301:
786 	case 0x0310:
787 		aprint_debug_dev(sc->sc_dev, " %s ports %d - %d\n",
788 		    major == 3 ? "ss" : "hs", cpo, cpo + cpc -1);
789 		break;
790 	default:
791 		aprint_error_dev(sc->sc_dev, " unknown major/minor (%d/%d)\n",
792 		    major, minor);
793 		return;
794 	}
795 
796 	const size_t bus = (major == 3) ? 0 : 1;
797 
798 	/* Index arrays with 0..n-1 where ports are numbered 1..n */
799 	for (size_t cp = cpo - 1; cp < cpo + cpc - 1; cp++) {
800 		if (sc->sc_ctlrportmap[cp] != 0) {
801 			aprint_error_dev(sc->sc_dev, "controller port %zu "
802 			    "already assigned", cp);
803 			continue;
804 		}
805 
806 		sc->sc_ctlrportbus[cp / NBBY] |=
807 		    bus == 0 ? 0 : __BIT(cp % NBBY);
808 
809 		const size_t rhp = sc->sc_rhportcount[bus]++;
810 
811 		KASSERTMSG(sc->sc_rhportmap[bus][rhp] == 0,
812 		    "bus %zu rhp %zu is %d", bus, rhp,
813 		    sc->sc_rhportmap[bus][rhp]);
814 
815 		sc->sc_rhportmap[bus][rhp] = cp + 1;
816 		sc->sc_ctlrportmap[cp] = rhp + 1;
817 	}
818 }
819 
820 /* Process extended capabilities */
821 static void
822 xhci_ecp(struct xhci_softc *sc, uint32_t hcc)
823 {
824 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
825 
826 	bus_size_t ecp = XHCI_HCC_XECP(hcc) * 4;
827 	while (ecp != 0) {
828 		uint32_t ecr = xhci_read_4(sc, ecp);
829 		aprint_debug_dev(sc->sc_dev, "ECR: 0x%08x\n", ecr);
830 		switch (XHCI_XECP_ID(ecr)) {
831 		case XHCI_ID_PROTOCOLS: {
832 			xhci_id_protocols(sc, ecp);
833 			break;
834 		}
835 		case XHCI_ID_USB_LEGACY: {
836 			uint8_t bios_sem;
837 
838 			/* Take host controller ownership from BIOS */
839 			bios_sem = xhci_read_1(sc, ecp + XHCI_XECP_BIOS_SEM);
840 			if (bios_sem) {
841 				/* sets xHCI to be owned by OS */
842 				xhci_write_1(sc, ecp + XHCI_XECP_OS_SEM, 1);
843 				aprint_debug_dev(sc->sc_dev,
844 				    "waiting for BIOS to give up control\n");
845 				for (int i = 0; i < 5000; i++) {
846 					bios_sem = xhci_read_1(sc, ecp +
847 					    XHCI_XECP_BIOS_SEM);
848 					if (bios_sem == 0)
849 						break;
850 					DELAY(1000);
851 				}
852 				if (bios_sem) {
853 					aprint_error_dev(sc->sc_dev,
854 					    "timed out waiting for BIOS\n");
855 				}
856 			}
857 			break;
858 		}
859 		default:
860 			break;
861 		}
862 		ecr = xhci_read_4(sc, ecp);
863 		if (XHCI_XECP_NEXT(ecr) == 0) {
864 			ecp = 0;
865 		} else {
866 			ecp += XHCI_XECP_NEXT(ecr) * 4;
867 		}
868 	}
869 }
870 
871 #define XHCI_HCCPREV1_BITS	\
872 	"\177\020"	/* New bitmask */			\
873 	"f\020\020XECP\0"					\
874 	"f\014\4MAXPSA\0"					\
875 	"b\013CFC\0"						\
876 	"b\012SEC\0"						\
877 	"b\011SBD\0"						\
878 	"b\010FSE\0"						\
879 	"b\7NSS\0"						\
880 	"b\6LTC\0"						\
881 	"b\5LHRC\0"						\
882 	"b\4PIND\0"						\
883 	"b\3PPC\0"						\
884 	"b\2CZC\0"						\
885 	"b\1BNC\0"						\
886 	"b\0AC64\0"						\
887 	"\0"
888 #define XHCI_HCCV1_x_BITS	\
889 	"\177\020"	/* New bitmask */			\
890 	"f\020\020XECP\0"					\
891 	"f\014\4MAXPSA\0"					\
892 	"b\013CFC\0"						\
893 	"b\012SEC\0"						\
894 	"b\011SPC\0"						\
895 	"b\010PAE\0"						\
896 	"b\7NSS\0"						\
897 	"b\6LTC\0"						\
898 	"b\5LHRC\0"						\
899 	"b\4PIND\0"						\
900 	"b\3PPC\0"						\
901 	"b\2CSZ\0"						\
902 	"b\1BNC\0"						\
903 	"b\0AC64\0"						\
904 	"\0"
905 
906 #define XHCI_HCC2_BITS	\
907 	"\177\020"	/* New bitmask */			\
908 	"b\7ETC_TSC\0"						\
909 	"b\6ETC\0"						\
910 	"b\5CIC\0"						\
911 	"b\4LEC\0"						\
912 	"b\3CTC\0"						\
913 	"b\2FSC\0"						\
914 	"b\1CMC\0"						\
915 	"b\0U3C\0"						\
916 	"\0"
917 
918 void
919 xhci_start(struct xhci_softc *sc)
920 {
921 	xhci_rt_write_4(sc, XHCI_IMAN(0), XHCI_IMAN_INTR_ENA);
922 	if ((sc->sc_quirks & XHCI_QUIRK_INTEL) != 0)
923 		/* Intel xhci needs interrupt rate moderated. */
924 		xhci_rt_write_4(sc, XHCI_IMOD(0), XHCI_IMOD_DEFAULT_LP);
925 	else
926 		xhci_rt_write_4(sc, XHCI_IMOD(0), 0);
927 	aprint_debug_dev(sc->sc_dev, "current IMOD %u\n",
928 	    xhci_rt_read_4(sc, XHCI_IMOD(0)));
929 
930 	/* Go! */
931 	xhci_op_write_4(sc, XHCI_USBCMD, XHCI_CMD_INTE|XHCI_CMD_RS);
932 	aprint_debug_dev(sc->sc_dev, "USBCMD 0x%08"PRIx32"\n",
933 	    xhci_op_read_4(sc, XHCI_USBCMD));
934 }
935 
936 int
937 xhci_init(struct xhci_softc *sc)
938 {
939 	bus_size_t bsz;
940 	uint32_t cap, hcs1, hcs2, hcs3, hcc, dboff, rtsoff, hcc2;
941 	uint32_t pagesize, config;
942 	int i = 0;
943 	uint16_t hciversion;
944 	uint8_t caplength;
945 
946 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
947 
948 	/* Set up the bus struct for the usb 3 and usb 2 buses */
949 	sc->sc_bus.ub_methods = &xhci_bus_methods;
950 	sc->sc_bus.ub_pipesize = sizeof(struct xhci_pipe);
951 	sc->sc_bus.ub_usedma = true;
952 	sc->sc_bus.ub_hcpriv = sc;
953 
954 	sc->sc_bus2.ub_methods = &xhci_bus_methods;
955 	sc->sc_bus2.ub_pipesize = sizeof(struct xhci_pipe);
956 	sc->sc_bus2.ub_revision = USBREV_2_0;
957 	sc->sc_bus2.ub_usedma = true;
958 	sc->sc_bus2.ub_hcpriv = sc;
959 	sc->sc_bus2.ub_dmatag = sc->sc_bus.ub_dmatag;
960 
961 	cap = xhci_read_4(sc, XHCI_CAPLENGTH);
962 	caplength = XHCI_CAP_CAPLENGTH(cap);
963 	hciversion = XHCI_CAP_HCIVERSION(cap);
964 
965 	if (hciversion < XHCI_HCIVERSION_0_96 ||
966 	    hciversion >= 0x0200) {
967 		aprint_normal_dev(sc->sc_dev,
968 		    "xHCI version %x.%x not known to be supported\n",
969 		    (hciversion >> 8) & 0xff, (hciversion >> 0) & 0xff);
970 	} else {
971 		aprint_verbose_dev(sc->sc_dev, "xHCI version %x.%x\n",
972 		    (hciversion >> 8) & 0xff, (hciversion >> 0) & 0xff);
973 	}
974 
975 	if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, 0, caplength,
976 	    &sc->sc_cbh) != 0) {
977 		aprint_error_dev(sc->sc_dev, "capability subregion failure\n");
978 		return ENOMEM;
979 	}
980 
981 	hcs1 = xhci_cap_read_4(sc, XHCI_HCSPARAMS1);
982 	sc->sc_maxslots = XHCI_HCS1_MAXSLOTS(hcs1);
983 	sc->sc_maxintrs = XHCI_HCS1_MAXINTRS(hcs1);
984 	sc->sc_maxports = XHCI_HCS1_MAXPORTS(hcs1);
985 	hcs2 = xhci_cap_read_4(sc, XHCI_HCSPARAMS2);
986 	hcs3 = xhci_cap_read_4(sc, XHCI_HCSPARAMS3);
987 	aprint_debug_dev(sc->sc_dev,
988 	    "hcs1=%"PRIx32" hcs2=%"PRIx32" hcs3=%"PRIx32"\n", hcs1, hcs2, hcs3);
989 
990 	hcc = xhci_cap_read_4(sc, XHCI_HCCPARAMS);
991 	sc->sc_ac64 = XHCI_HCC_AC64(hcc);
992 	sc->sc_ctxsz = XHCI_HCC_CSZ(hcc) ? 64 : 32;
993 
994 	char sbuf[128];
995 	if (hciversion < XHCI_HCIVERSION_1_0)
996 		snprintb(sbuf, sizeof(sbuf), XHCI_HCCPREV1_BITS, hcc);
997 	else
998 		snprintb(sbuf, sizeof(sbuf), XHCI_HCCV1_x_BITS, hcc);
999 	aprint_debug_dev(sc->sc_dev, "hcc=%s\n", sbuf);
1000 	aprint_debug_dev(sc->sc_dev, "xECP %x\n", XHCI_HCC_XECP(hcc) * 4);
1001 	if (hciversion >= XHCI_HCIVERSION_1_1) {
1002 		hcc2 = xhci_cap_read_4(sc, XHCI_HCCPARAMS2);
1003 		snprintb(sbuf, sizeof(sbuf), XHCI_HCC2_BITS, hcc2);
1004 		aprint_debug_dev(sc->sc_dev, "hcc2=%s\n", sbuf);
1005 	}
1006 
1007 	/* default all ports to bus 0, i.e. usb 3 */
1008 	sc->sc_ctlrportbus = kmem_zalloc(
1009 	    howmany(sc->sc_maxports * sizeof(uint8_t), NBBY), KM_SLEEP);
1010 	sc->sc_ctlrportmap = kmem_zalloc(sc->sc_maxports * sizeof(int), KM_SLEEP);
1011 
1012 	/* controller port to bus roothub port map */
1013 	for (size_t j = 0; j < __arraycount(sc->sc_rhportmap); j++) {
1014 		sc->sc_rhportmap[j] = kmem_zalloc(sc->sc_maxports * sizeof(int), KM_SLEEP);
1015 	}
1016 
1017 	/*
1018 	 * Process all Extended Capabilities
1019 	 */
1020 	xhci_ecp(sc, hcc);
1021 
1022 	bsz = XHCI_PORTSC(sc->sc_maxports);
1023 	if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, caplength, bsz,
1024 	    &sc->sc_obh) != 0) {
1025 		aprint_error_dev(sc->sc_dev, "operational subregion failure\n");
1026 		return ENOMEM;
1027 	}
1028 
1029 	dboff = xhci_cap_read_4(sc, XHCI_DBOFF);
1030 	if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, dboff,
1031 	    sc->sc_maxslots * 4, &sc->sc_dbh) != 0) {
1032 		aprint_error_dev(sc->sc_dev, "doorbell subregion failure\n");
1033 		return ENOMEM;
1034 	}
1035 
1036 	rtsoff = xhci_cap_read_4(sc, XHCI_RTSOFF);
1037 	if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, rtsoff,
1038 	    sc->sc_maxintrs * 0x20, &sc->sc_rbh) != 0) {
1039 		aprint_error_dev(sc->sc_dev, "runtime subregion failure\n");
1040 		return ENOMEM;
1041 	}
1042 
1043 	int rv;
1044 	rv = xhci_hc_reset(sc);
1045 	if (rv != 0) {
1046 		return rv;
1047 	}
1048 
1049 	if (sc->sc_vendor_init)
1050 		sc->sc_vendor_init(sc);
1051 
1052 	pagesize = xhci_op_read_4(sc, XHCI_PAGESIZE);
1053 	aprint_debug_dev(sc->sc_dev, "PAGESIZE 0x%08x\n", pagesize);
1054 	pagesize = ffs(pagesize);
1055 	if (pagesize == 0) {
1056 		aprint_error_dev(sc->sc_dev, "pagesize is 0\n");
1057 		return EIO;
1058 	}
1059 	sc->sc_pgsz = 1 << (12 + (pagesize - 1));
1060 	aprint_debug_dev(sc->sc_dev, "sc_pgsz 0x%08x\n", (uint32_t)sc->sc_pgsz);
1061 	aprint_debug_dev(sc->sc_dev, "sc_maxslots 0x%08x\n",
1062 	    (uint32_t)sc->sc_maxslots);
1063 	aprint_debug_dev(sc->sc_dev, "sc_maxports %d\n", sc->sc_maxports);
1064 
1065 	usbd_status err;
1066 
1067 	sc->sc_maxspbuf = XHCI_HCS2_MAXSPBUF(hcs2);
1068 	aprint_debug_dev(sc->sc_dev, "sc_maxspbuf %d\n", sc->sc_maxspbuf);
1069 	if (sc->sc_maxspbuf != 0) {
1070 		err = usb_allocmem(&sc->sc_bus,
1071 		    sizeof(uint64_t) * sc->sc_maxspbuf, sizeof(uint64_t),
1072 		    &sc->sc_spbufarray_dma);
1073 		if (err) {
1074 			aprint_error_dev(sc->sc_dev,
1075 			    "spbufarray init fail, err %d\n", err);
1076 			return ENOMEM;
1077 		}
1078 
1079 		sc->sc_spbuf_dma = kmem_zalloc(sizeof(*sc->sc_spbuf_dma) *
1080 		    sc->sc_maxspbuf, KM_SLEEP);
1081 		uint64_t *spbufarray = KERNADDR(&sc->sc_spbufarray_dma, 0);
1082 		for (i = 0; i < sc->sc_maxspbuf; i++) {
1083 			usb_dma_t * const dma = &sc->sc_spbuf_dma[i];
1084 			/* allocate contexts */
1085 			err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz,
1086 			    sc->sc_pgsz, dma);
1087 			if (err) {
1088 				aprint_error_dev(sc->sc_dev,
1089 				    "spbufarray_dma init fail, err %d\n", err);
1090 				rv = ENOMEM;
1091 				goto bad1;
1092 			}
1093 			spbufarray[i] = htole64(DMAADDR(dma, 0));
1094 			usb_syncmem(dma, 0, sc->sc_pgsz,
1095 			    BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE);
1096 		}
1097 
1098 		usb_syncmem(&sc->sc_spbufarray_dma, 0,
1099 		    sizeof(uint64_t) * sc->sc_maxspbuf, BUS_DMASYNC_PREWRITE);
1100 	}
1101 
1102 	config = xhci_op_read_4(sc, XHCI_CONFIG);
1103 	config &= ~0xFF;
1104 	config |= sc->sc_maxslots & 0xFF;
1105 	xhci_op_write_4(sc, XHCI_CONFIG, config);
1106 
1107 	err = xhci_ring_init(sc, &sc->sc_cr, XHCI_COMMAND_RING_TRBS,
1108 	    XHCI_COMMAND_RING_SEGMENTS_ALIGN);
1109 	if (err) {
1110 		aprint_error_dev(sc->sc_dev, "command ring init fail, err %d\n",
1111 		    err);
1112 		rv = ENOMEM;
1113 		goto bad1;
1114 	}
1115 
1116 	err = xhci_ring_init(sc, &sc->sc_er, XHCI_EVENT_RING_TRBS,
1117 	    XHCI_EVENT_RING_SEGMENTS_ALIGN);
1118 	if (err) {
1119 		aprint_error_dev(sc->sc_dev, "event ring init fail, err %d\n",
1120 		    err);
1121 		rv = ENOMEM;
1122 		goto bad2;
1123 	}
1124 
1125 	usb_dma_t *dma;
1126 	size_t size;
1127 	size_t align;
1128 
1129 	dma = &sc->sc_eventst_dma;
1130 	size = roundup2(XHCI_EVENT_RING_SEGMENTS * XHCI_ERSTE_SIZE,
1131 	    XHCI_EVENT_RING_SEGMENT_TABLE_ALIGN);
1132 	KASSERTMSG(size <= (512 * 1024), "eventst size %zu too large", size);
1133 	align = XHCI_EVENT_RING_SEGMENT_TABLE_ALIGN;
1134 	err = usb_allocmem(&sc->sc_bus, size, align, dma);
1135 	if (err) {
1136 		aprint_error_dev(sc->sc_dev, "eventst init fail, err %d\n",
1137 		    err);
1138 		rv = ENOMEM;
1139 		goto bad3;
1140 	}
1141 
1142 	memset(KERNADDR(dma, 0), 0, size);
1143 	usb_syncmem(dma, 0, size, BUS_DMASYNC_PREWRITE);
1144 	aprint_debug_dev(sc->sc_dev, "eventst: 0x%016jx %p %zx\n",
1145 	    (uintmax_t)DMAADDR(&sc->sc_eventst_dma, 0),
1146 	    KERNADDR(&sc->sc_eventst_dma, 0),
1147 	    sc->sc_eventst_dma.udma_block->size);
1148 
1149 	dma = &sc->sc_dcbaa_dma;
1150 	size = (1 + sc->sc_maxslots) * sizeof(uint64_t);
1151 	KASSERTMSG(size <= 2048, "dcbaa size %zu too large", size);
1152 	align = XHCI_DEVICE_CONTEXT_BASE_ADDRESS_ARRAY_ALIGN;
1153 	err = usb_allocmem(&sc->sc_bus, size, align, dma);
1154 	if (err) {
1155 		aprint_error_dev(sc->sc_dev, "dcbaa init fail, err %d\n", err);
1156 		rv = ENOMEM;
1157 		goto bad4;
1158 	}
1159 	aprint_debug_dev(sc->sc_dev, "dcbaa: 0x%016jx %p %zx\n",
1160 	    (uintmax_t)DMAADDR(&sc->sc_dcbaa_dma, 0),
1161 	    KERNADDR(&sc->sc_dcbaa_dma, 0),
1162 	    sc->sc_dcbaa_dma.udma_block->size);
1163 
1164 	memset(KERNADDR(dma, 0), 0, size);
1165 	if (sc->sc_maxspbuf != 0) {
1166 		/*
1167 		 * DCBA entry 0 hold the scratchbuf array pointer.
1168 		 */
1169 		*(uint64_t *)KERNADDR(dma, 0) =
1170 		    htole64(DMAADDR(&sc->sc_spbufarray_dma, 0));
1171 	}
1172 	usb_syncmem(dma, 0, size, BUS_DMASYNC_PREWRITE);
1173 
1174 	sc->sc_slots = kmem_zalloc(sizeof(*sc->sc_slots) * sc->sc_maxslots,
1175 	    KM_SLEEP);
1176 	if (sc->sc_slots == NULL) {
1177 		aprint_error_dev(sc->sc_dev, "slots init fail, err %d\n", err);
1178 		rv = ENOMEM;
1179 		goto bad;
1180 	}
1181 
1182 	sc->sc_xferpool = pool_cache_init(sizeof(struct xhci_xfer), 0, 0, 0,
1183 	    "xhcixfer", NULL, IPL_USB, NULL, NULL, NULL);
1184 	if (sc->sc_xferpool == NULL) {
1185 		aprint_error_dev(sc->sc_dev, "pool_cache init fail, err %d\n",
1186 		    err);
1187 		rv = ENOMEM;
1188 		goto bad;
1189 	}
1190 
1191 	cv_init(&sc->sc_command_cv, "xhcicmd");
1192 	cv_init(&sc->sc_cmdbusy_cv, "xhcicmdq");
1193 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
1194 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_USB);
1195 
1196 	struct xhci_erste *erst;
1197 	erst = KERNADDR(&sc->sc_eventst_dma, 0);
1198 	erst[0].erste_0 = htole64(xhci_ring_trbp(sc->sc_er, 0));
1199 	erst[0].erste_2 = htole32(sc->sc_er->xr_ntrb);
1200 	erst[0].erste_3 = htole32(0);
1201 	usb_syncmem(&sc->sc_eventst_dma, 0,
1202 	    XHCI_ERSTE_SIZE * XHCI_EVENT_RING_SEGMENTS, BUS_DMASYNC_PREWRITE);
1203 
1204 	xhci_rt_write_4(sc, XHCI_ERSTSZ(0), XHCI_EVENT_RING_SEGMENTS);
1205 	xhci_rt_write_8(sc, XHCI_ERSTBA(0), DMAADDR(&sc->sc_eventst_dma, 0));
1206 	xhci_rt_write_8(sc, XHCI_ERDP(0), xhci_ring_trbp(sc->sc_er, 0) |
1207 	    XHCI_ERDP_LO_BUSY);
1208 
1209 	xhci_op_write_8(sc, XHCI_DCBAAP, DMAADDR(&sc->sc_dcbaa_dma, 0));
1210 	xhci_op_write_8(sc, XHCI_CRCR, xhci_ring_trbp(sc->sc_cr, 0) |
1211 	    sc->sc_cr->xr_cs);
1212 
1213 	xhci_op_barrier(sc, 0, 4, BUS_SPACE_BARRIER_WRITE);
1214 
1215 	HEXDUMP("eventst", KERNADDR(&sc->sc_eventst_dma, 0),
1216 	    XHCI_ERSTE_SIZE * XHCI_EVENT_RING_SEGMENTS);
1217 
1218 	if ((sc->sc_quirks & XHCI_DEFERRED_START) == 0)
1219 		xhci_start(sc);
1220 
1221 	return 0;
1222 
1223  bad:
1224 	if (sc->sc_xferpool) {
1225 		pool_cache_destroy(sc->sc_xferpool);
1226 		sc->sc_xferpool = NULL;
1227 	}
1228 
1229 	if (sc->sc_slots) {
1230 		kmem_free(sc->sc_slots, sizeof(*sc->sc_slots) *
1231 		    sc->sc_maxslots);
1232 		sc->sc_slots = NULL;
1233 	}
1234 
1235 	usb_freemem(&sc->sc_bus, &sc->sc_dcbaa_dma);
1236  bad4:
1237 	usb_freemem(&sc->sc_bus, &sc->sc_eventst_dma);
1238  bad3:
1239 	xhci_ring_free(sc, &sc->sc_er);
1240  bad2:
1241 	xhci_ring_free(sc, &sc->sc_cr);
1242 	i = sc->sc_maxspbuf;
1243  bad1:
1244 	for (int j = 0; j < i; j++)
1245 		usb_freemem(&sc->sc_bus, &sc->sc_spbuf_dma[j]);
1246 	usb_freemem(&sc->sc_bus, &sc->sc_spbufarray_dma);
1247 
1248 	return rv;
1249 }
1250 
1251 static inline bool
1252 xhci_polling_p(struct xhci_softc * const sc)
1253 {
1254 	return sc->sc_bus.ub_usepolling || sc->sc_bus2.ub_usepolling;
1255 }
1256 
1257 int
1258 xhci_intr(void *v)
1259 {
1260 	struct xhci_softc * const sc = v;
1261 	int ret = 0;
1262 
1263 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
1264 
1265 	if (sc == NULL)
1266 		return 0;
1267 
1268 	mutex_spin_enter(&sc->sc_intr_lock);
1269 
1270 	if (sc->sc_dying || !device_has_power(sc->sc_dev))
1271 		goto done;
1272 
1273 	/* If we get an interrupt while polling, then just ignore it. */
1274 	if (xhci_polling_p(sc)) {
1275 #ifdef DIAGNOSTIC
1276 		DPRINTFN(16, "ignored interrupt while polling", 0, 0, 0, 0);
1277 #endif
1278 		goto done;
1279 	}
1280 
1281 	ret = xhci_intr1(sc);
1282 	if (ret) {
1283 		KASSERT(sc->sc_child || sc->sc_child2);
1284 
1285 		/*
1286 		 * One of child busses could be already detached. It doesn't
1287 		 * matter on which of the two the softintr is scheduled.
1288 		 */
1289 		if (sc->sc_child)
1290 			usb_schedsoftintr(&sc->sc_bus);
1291 		else
1292 			usb_schedsoftintr(&sc->sc_bus2);
1293 	}
1294 done:
1295 	mutex_spin_exit(&sc->sc_intr_lock);
1296 	return ret;
1297 }
1298 
1299 int
1300 xhci_intr1(struct xhci_softc * const sc)
1301 {
1302 	uint32_t usbsts;
1303 	uint32_t iman;
1304 
1305 	XHCIHIST_FUNC();
1306 
1307 	usbsts = xhci_op_read_4(sc, XHCI_USBSTS);
1308 	XHCIHIST_CALLARGS("USBSTS 0x%08jx", usbsts, 0, 0, 0);
1309 	if ((usbsts & (XHCI_STS_HSE | XHCI_STS_EINT | XHCI_STS_PCD |
1310 	    XHCI_STS_HCE)) == 0) {
1311 		DPRINTFN(16, "ignored intr not for %jd",
1312 		    device_unit(sc->sc_dev), 0, 0, 0);
1313 		return 0;
1314 	}
1315 
1316 	/*
1317 	 * Clear EINT and other transient flags, to not misenterpret
1318 	 * next shared interrupt. Also, to avoid race, EINT must be cleared
1319 	 * before XHCI_IMAN_INTR_PEND is cleared.
1320 	 */
1321 	xhci_op_write_4(sc, XHCI_USBSTS, usbsts & XHCI_STS_RSVDP0);
1322 
1323 #ifdef XHCI_DEBUG
1324 	usbsts = xhci_op_read_4(sc, XHCI_USBSTS);
1325 	DPRINTFN(16, "USBSTS 0x%08jx", usbsts, 0, 0, 0);
1326 #endif
1327 
1328 	iman = xhci_rt_read_4(sc, XHCI_IMAN(0));
1329 	DPRINTFN(16, "IMAN0 0x%08jx", iman, 0, 0, 0);
1330 	iman |= XHCI_IMAN_INTR_PEND;
1331 	xhci_rt_write_4(sc, XHCI_IMAN(0), iman);
1332 
1333 #ifdef XHCI_DEBUG
1334 	iman = xhci_rt_read_4(sc, XHCI_IMAN(0));
1335 	DPRINTFN(16, "IMAN0 0x%08jx", iman, 0, 0, 0);
1336 	usbsts = xhci_op_read_4(sc, XHCI_USBSTS);
1337 	DPRINTFN(16, "USBSTS 0x%08jx", usbsts, 0, 0, 0);
1338 #endif
1339 
1340 	return 1;
1341 }
1342 
1343 /*
1344  * 3 port speed types used in USB stack
1345  *
1346  * usbdi speed
1347  *	definition: USB_SPEED_* in usb.h
1348  *	They are used in struct usbd_device in USB stack.
1349  *	ioctl interface uses these values too.
1350  * port_status speed
1351  *	definition: UPS_*_SPEED in usb.h
1352  *	They are used in usb_port_status_t and valid only for USB 2.0.
1353  *	Speed value is always 0 for Super Speed or more, and dwExtPortStatus
1354  *	of usb_port_status_ext_t indicates port speed.
1355  *	Note that some 3.0 values overlap with 2.0 values.
1356  *	(e.g. 0x200 means UPS_POER_POWER_SS in SS and
1357  *	            means UPS_LOW_SPEED in HS.)
1358  *	port status returned from hub also uses these values.
1359  *	On NetBSD UPS_OTHER_SPEED indicates port speed is super speed
1360  *	or more.
1361  * xspeed:
1362  *	definition: Protocol Speed ID (PSI) (xHCI 1.1 7.2.1)
1363  *	They are used in only slot context and PORTSC reg of xhci.
1364  *	The difference between usbdi speed and xspeed is
1365  *	that FS and LS values are swapped.
1366  */
1367 
1368 /* convert usbdi speed to xspeed */
1369 static int
1370 xhci_speed2xspeed(int speed)
1371 {
1372 	switch (speed) {
1373 	case USB_SPEED_LOW:	return 2;
1374 	case USB_SPEED_FULL:	return 1;
1375 	default:		return speed;
1376 	}
1377 }
1378 
1379 #if 0
1380 /* convert xspeed to usbdi speed */
1381 static int
1382 xhci_xspeed2speed(int xspeed)
1383 {
1384 	switch (xspeed) {
1385 	case 1: return USB_SPEED_FULL;
1386 	case 2: return USB_SPEED_LOW;
1387 	default: return xspeed;
1388 	}
1389 }
1390 #endif
1391 
1392 /* convert xspeed to port status speed */
1393 static int
1394 xhci_xspeed2psspeed(int xspeed)
1395 {
1396 	switch (xspeed) {
1397 	case 0: return 0;
1398 	case 1: return UPS_FULL_SPEED;
1399 	case 2: return UPS_LOW_SPEED;
1400 	case 3: return UPS_HIGH_SPEED;
1401 	default: return UPS_OTHER_SPEED;
1402 	}
1403 }
1404 
1405 /*
1406  * Construct input contexts and issue TRB to open pipe.
1407  */
1408 static usbd_status
1409 xhci_configure_endpoint(struct usbd_pipe *pipe)
1410 {
1411 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1412 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1413 #ifdef USB_DEBUG
1414 	const u_int dci = xhci_ep_get_dci(pipe->up_endpoint->ue_edesc);
1415 #endif
1416 	struct xhci_soft_trb trb;
1417 	usbd_status err;
1418 
1419 	XHCIHIST_FUNC();
1420 	XHCIHIST_CALLARGS("slot %ju dci %ju epaddr 0x%02jx attr 0x%02jx",
1421 	    xs->xs_idx, dci, pipe->up_endpoint->ue_edesc->bEndpointAddress,
1422 	    pipe->up_endpoint->ue_edesc->bmAttributes);
1423 
1424 	/* XXX ensure input context is available? */
1425 
1426 	memset(xhci_slot_get_icv(sc, xs, 0), 0, sc->sc_pgsz);
1427 
1428 	/* set up context */
1429 	xhci_setup_ctx(pipe);
1430 
1431 	HEXDUMP("input control context", xhci_slot_get_icv(sc, xs, 0),
1432 	    sc->sc_ctxsz * 1);
1433 	HEXDUMP("input endpoint context", xhci_slot_get_icv(sc, xs,
1434 	    xhci_dci_to_ici(dci)), sc->sc_ctxsz * 1);
1435 
1436 	trb.trb_0 = xhci_slot_get_icp(sc, xs, 0);
1437 	trb.trb_2 = 0;
1438 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
1439 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_CONFIGURE_EP);
1440 
1441 	err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT);
1442 
1443 	usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD);
1444 	HEXDUMP("output context", xhci_slot_get_dcv(sc, xs, dci),
1445 	    sc->sc_ctxsz * 1);
1446 
1447 	return err;
1448 }
1449 
1450 #if 0
1451 static usbd_status
1452 xhci_unconfigure_endpoint(struct usbd_pipe *pipe)
1453 {
1454 #ifdef USB_DEBUG
1455 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1456 #endif
1457 
1458 	XHCIHIST_FUNC();
1459 	XHCIHIST_CALLARGS("slot %ju", xs->xs_idx, 0, 0, 0);
1460 
1461 	return USBD_NORMAL_COMPLETION;
1462 }
1463 #endif
1464 
1465 /* 4.6.8, 6.4.3.7 */
1466 static usbd_status
1467 xhci_reset_endpoint_locked(struct usbd_pipe *pipe)
1468 {
1469 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1470 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1471 	const u_int dci = xhci_ep_get_dci(pipe->up_endpoint->ue_edesc);
1472 	struct xhci_soft_trb trb;
1473 	usbd_status err;
1474 
1475 	XHCIHIST_FUNC();
1476 	XHCIHIST_CALLARGS("slot %ju dci %ju", xs->xs_idx, dci, 0, 0);
1477 
1478 	KASSERT(mutex_owned(&sc->sc_lock));
1479 
1480 	trb.trb_0 = 0;
1481 	trb.trb_2 = 0;
1482 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
1483 	    XHCI_TRB_3_EP_SET(dci) |
1484 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_RESET_EP);
1485 
1486 	err = xhci_do_command_locked(sc, &trb, USBD_DEFAULT_TIMEOUT);
1487 
1488 	return err;
1489 }
1490 
1491 static usbd_status
1492 xhci_reset_endpoint(struct usbd_pipe *pipe)
1493 {
1494 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1495 
1496 	mutex_enter(&sc->sc_lock);
1497 	usbd_status ret = xhci_reset_endpoint_locked(pipe);
1498 	mutex_exit(&sc->sc_lock);
1499 
1500 	return ret;
1501 }
1502 
1503 /*
1504  * 4.6.9, 6.4.3.8
1505  * Stop execution of TDs on xfer ring.
1506  * Should be called with sc_lock held.
1507  */
1508 static usbd_status
1509 xhci_stop_endpoint(struct usbd_pipe *pipe)
1510 {
1511 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1512 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1513 	struct xhci_soft_trb trb;
1514 	usbd_status err;
1515 	const u_int dci = xhci_ep_get_dci(pipe->up_endpoint->ue_edesc);
1516 
1517 	XHCIHIST_FUNC();
1518 	XHCIHIST_CALLARGS("slot %ju dci %ju", xs->xs_idx, dci, 0, 0);
1519 
1520 	KASSERT(mutex_owned(&sc->sc_lock));
1521 
1522 	trb.trb_0 = 0;
1523 	trb.trb_2 = 0;
1524 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
1525 	    XHCI_TRB_3_EP_SET(dci) |
1526 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_STOP_EP);
1527 
1528 	err = xhci_do_command_locked(sc, &trb, USBD_DEFAULT_TIMEOUT);
1529 
1530 	return err;
1531 }
1532 
1533 /*
1534  * Set TR Dequeue Pointer.
1535  * xHCI 1.1  4.6.10  6.4.3.9
1536  * Purge all of the TRBs on ring and reinitialize ring.
1537  * Set TR dequeue Pointr to 0 and Cycle State to 1.
1538  * EPSTATE of endpoint must be ERROR or STOPPED, otherwise CONTEXT_STATE
1539  * error will be generated.
1540  */
1541 static usbd_status
1542 xhci_set_dequeue_locked(struct usbd_pipe *pipe)
1543 {
1544 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1545 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1546 	const u_int dci = xhci_ep_get_dci(pipe->up_endpoint->ue_edesc);
1547 	struct xhci_ring * const xr = xs->xs_xr[dci];
1548 	struct xhci_soft_trb trb;
1549 	usbd_status err;
1550 
1551 	XHCIHIST_FUNC();
1552 	XHCIHIST_CALLARGS("slot %ju dci %ju", xs->xs_idx, dci, 0, 0);
1553 
1554 	KASSERT(mutex_owned(&sc->sc_lock));
1555 	KASSERT(xr != NULL);
1556 
1557 	xhci_host_dequeue(xr);
1558 
1559 	/* set DCS */
1560 	trb.trb_0 = xhci_ring_trbp(xr, 0) | 1; /* XXX */
1561 	trb.trb_2 = 0;
1562 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
1563 	    XHCI_TRB_3_EP_SET(dci) |
1564 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_SET_TR_DEQUEUE);
1565 
1566 	err = xhci_do_command_locked(sc, &trb, USBD_DEFAULT_TIMEOUT);
1567 
1568 	return err;
1569 }
1570 
1571 static usbd_status
1572 xhci_set_dequeue(struct usbd_pipe *pipe)
1573 {
1574 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1575 
1576 	mutex_enter(&sc->sc_lock);
1577 	usbd_status ret = xhci_set_dequeue_locked(pipe);
1578 	mutex_exit(&sc->sc_lock);
1579 
1580 	return ret;
1581 }
1582 
1583 /*
1584  * Open new pipe: called from usbd_setup_pipe_flags.
1585  * Fills methods of pipe.
1586  * If pipe is not for ep0, calls configure_endpoint.
1587  */
1588 static usbd_status
1589 xhci_open(struct usbd_pipe *pipe)
1590 {
1591 	struct usbd_device * const dev = pipe->up_dev;
1592 	struct xhci_softc * const sc = XHCI_BUS2SC(dev->ud_bus);
1593 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1594 	usb_endpoint_descriptor_t * const ed = pipe->up_endpoint->ue_edesc;
1595 	const u_int dci = xhci_ep_get_dci(ed);
1596 	const uint8_t xfertype = UE_GET_XFERTYPE(ed->bmAttributes);
1597 	usbd_status err;
1598 
1599 	XHCIHIST_FUNC();
1600 	XHCIHIST_CALLARGS("addr %jd depth %jd port %jd speed %jd", dev->ud_addr,
1601 	    dev->ud_depth, dev->ud_powersrc->up_portno, dev->ud_speed);
1602 	DPRINTFN(1, " dci %ju type 0x%02jx epaddr 0x%02jx attr 0x%02jx",
1603 	    xhci_ep_get_dci(ed), ed->bDescriptorType, ed->bEndpointAddress,
1604 	    ed->bmAttributes);
1605 	DPRINTFN(1, " mps %ju ival %ju", UGETW(ed->wMaxPacketSize),
1606 	    ed->bInterval, 0, 0);
1607 
1608 	if (sc->sc_dying)
1609 		return USBD_IOERROR;
1610 
1611 	/* Root Hub */
1612 	if (dev->ud_depth == 0 && dev->ud_powersrc->up_portno == 0) {
1613 		switch (ed->bEndpointAddress) {
1614 		case USB_CONTROL_ENDPOINT:
1615 			pipe->up_methods = &roothub_ctrl_methods;
1616 			break;
1617 		case UE_DIR_IN | USBROOTHUB_INTR_ENDPT:
1618 			pipe->up_methods = &xhci_root_intr_methods;
1619 			break;
1620 		default:
1621 			pipe->up_methods = NULL;
1622 			DPRINTFN(0, "bad bEndpointAddress 0x%02jx",
1623 			    ed->bEndpointAddress, 0, 0, 0);
1624 			return USBD_INVAL;
1625 		}
1626 		return USBD_NORMAL_COMPLETION;
1627 	}
1628 
1629 	switch (xfertype) {
1630 	case UE_CONTROL:
1631 		pipe->up_methods = &xhci_device_ctrl_methods;
1632 		break;
1633 	case UE_ISOCHRONOUS:
1634 		pipe->up_methods = &xhci_device_isoc_methods;
1635 		return USBD_INVAL;
1636 		break;
1637 	case UE_BULK:
1638 		pipe->up_methods = &xhci_device_bulk_methods;
1639 		break;
1640 	case UE_INTERRUPT:
1641 		pipe->up_methods = &xhci_device_intr_methods;
1642 		break;
1643 	default:
1644 		return USBD_IOERROR;
1645 		break;
1646 	}
1647 
1648 	KASSERT(xs != NULL);
1649 	KASSERT(xs->xs_xr[dci] == NULL);
1650 
1651 	/* allocate transfer ring */
1652 	err = xhci_ring_init(sc, &xs->xs_xr[dci], XHCI_TRANSFER_RING_TRBS,
1653 	    XHCI_TRB_ALIGN);
1654 	if (err) {
1655 		DPRINTFN(1, "ring alloc failed %jd", err, 0, 0, 0);
1656 		return err;
1657 	}
1658 
1659 	if (ed->bEndpointAddress != USB_CONTROL_ENDPOINT)
1660 		return xhci_configure_endpoint(pipe);
1661 
1662 	return USBD_NORMAL_COMPLETION;
1663 }
1664 
1665 /*
1666  * Closes pipe, called from usbd_kill_pipe via close methods.
1667  * If the endpoint to be closed is ep0, disable_slot.
1668  * Should be called with sc_lock held.
1669  */
1670 static void
1671 xhci_close_pipe(struct usbd_pipe *pipe)
1672 {
1673 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
1674 	struct xhci_slot * const xs = pipe->up_dev->ud_hcpriv;
1675 	usb_endpoint_descriptor_t * const ed = pipe->up_endpoint->ue_edesc;
1676 	const u_int dci = xhci_ep_get_dci(ed);
1677 	struct xhci_soft_trb trb;
1678 	uint32_t *cp;
1679 
1680 	XHCIHIST_FUNC();
1681 
1682 	if (sc->sc_dying)
1683 		return;
1684 
1685 	/* xs is uninitialized before xhci_init_slot */
1686 	if (xs == NULL || xs->xs_idx == 0)
1687 		return;
1688 
1689 	XHCIHIST_CALLARGS("pipe %#jx slot %ju dci %ju",
1690 	    (uintptr_t)pipe, xs->xs_idx, dci, 0);
1691 
1692 	KASSERTMSG(!cpu_intr_p() && !cpu_softintr_p(), "called from intr ctx");
1693 	KASSERT(mutex_owned(&sc->sc_lock));
1694 
1695 	if (pipe->up_dev->ud_depth == 0)
1696 		return;
1697 
1698 	if (dci == XHCI_DCI_EP_CONTROL) {
1699 		DPRINTFN(4, "closing ep0", 0, 0, 0, 0);
1700 		/* This frees all rings */
1701 		xhci_disable_slot(sc, xs->xs_idx);
1702 		return;
1703 	}
1704 
1705 	if (xhci_get_epstate(sc, xs, dci) != XHCI_EPSTATE_STOPPED)
1706 		(void)xhci_stop_endpoint(pipe);
1707 
1708 	/*
1709 	 * set appropriate bit to be dropped.
1710 	 * don't set DC bit to 1, otherwise all endpoints
1711 	 * would be deconfigured.
1712 	 */
1713 	cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL);
1714 	cp[0] = htole32(XHCI_INCTX_0_DROP_MASK(dci));
1715 	cp[1] = htole32(0);
1716 
1717 	/* XXX should be most significant one, not dci? */
1718 	cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_SLOT));
1719 	cp[0] = htole32(XHCI_SCTX_0_CTX_NUM_SET(dci));
1720 
1721 	/* configure ep context performs an implicit dequeue */
1722 	xhci_host_dequeue(xs->xs_xr[dci]);
1723 
1724 	/* sync input contexts before they are read from memory */
1725 	usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE);
1726 
1727 	trb.trb_0 = xhci_slot_get_icp(sc, xs, 0);
1728 	trb.trb_2 = 0;
1729 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
1730 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_CONFIGURE_EP);
1731 
1732 	(void)xhci_do_command_locked(sc, &trb, USBD_DEFAULT_TIMEOUT);
1733 	usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD);
1734 
1735 	xhci_ring_free(sc, &xs->xs_xr[dci]);
1736 }
1737 
1738 /*
1739  * Abort transfer.
1740  * Should be called with sc_lock held.
1741  */
1742 static void
1743 xhci_abortx(struct usbd_xfer *xfer)
1744 {
1745 	XHCIHIST_FUNC();
1746 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
1747 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
1748 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
1749 
1750 	XHCIHIST_CALLARGS("xfer %#jx pipe %#jx",
1751 	    (uintptr_t)xfer, (uintptr_t)xfer->ux_pipe, 0, 0);
1752 
1753 	KASSERT(mutex_owned(&sc->sc_lock));
1754 	ASSERT_SLEEPABLE();
1755 
1756 	KASSERTMSG((xfer->ux_status == USBD_CANCELLED ||
1757 		xfer->ux_status == USBD_TIMEOUT),
1758 	    "bad abort status: %d", xfer->ux_status);
1759 
1760 	/*
1761 	 * If we're dying, skip the hardware action and just notify the
1762 	 * software that we're done.
1763 	 */
1764 	if (sc->sc_dying) {
1765 		DPRINTFN(4, "xfer %#jx dying %ju", (uintptr_t)xfer,
1766 		    xfer->ux_status, 0, 0);
1767 		goto dying;
1768 	}
1769 
1770 	/*
1771 	 * HC Step 1: Stop execution of TD on the ring.
1772 	 */
1773 	switch (xhci_get_epstate(sc, xs, dci)) {
1774 	case XHCI_EPSTATE_HALTED:
1775 		(void)xhci_reset_endpoint_locked(xfer->ux_pipe);
1776 		break;
1777 	case XHCI_EPSTATE_STOPPED:
1778 		break;
1779 	default:
1780 		(void)xhci_stop_endpoint(xfer->ux_pipe);
1781 		break;
1782 	}
1783 #ifdef DIAGNOSTIC
1784 	uint32_t epst = xhci_get_epstate(sc, xs, dci);
1785 	if (epst != XHCI_EPSTATE_STOPPED)
1786 		DPRINTFN(4, "dci %ju not stopped %ju", dci, epst, 0, 0);
1787 #endif
1788 
1789 	/*
1790 	 * HC Step 2: Remove any vestiges of the xfer from the ring.
1791 	 */
1792 	xhci_set_dequeue_locked(xfer->ux_pipe);
1793 
1794 	/*
1795 	 * Final Step: Notify completion to waiting xfers.
1796 	 */
1797 dying:
1798 	usb_transfer_complete(xfer);
1799 	DPRINTFN(14, "end", 0, 0, 0, 0);
1800 
1801 	KASSERT(mutex_owned(&sc->sc_lock));
1802 }
1803 
1804 static void
1805 xhci_host_dequeue(struct xhci_ring * const xr)
1806 {
1807 	/* When dequeueing the controller, update our struct copy too */
1808 	memset(xr->xr_trb, 0, xr->xr_ntrb * XHCI_TRB_SIZE);
1809 	usb_syncmem(&xr->xr_dma, 0, xr->xr_ntrb * XHCI_TRB_SIZE,
1810 	    BUS_DMASYNC_PREWRITE);
1811 	memset(xr->xr_cookies, 0, xr->xr_ntrb * sizeof(*xr->xr_cookies));
1812 
1813 	xr->xr_ep = 0;
1814 	xr->xr_cs = 1;
1815 }
1816 
1817 /*
1818  * Recover STALLed endpoint.
1819  * xHCI 1.1 sect 4.10.2.1
1820  * Issue RESET_EP to recover halt condition and SET_TR_DEQUEUE to remove
1821  * all transfers on transfer ring.
1822  * These are done in thread context asynchronously.
1823  */
1824 static void
1825 xhci_clear_endpoint_stall_async_task(void *cookie)
1826 {
1827 	struct usbd_xfer * const xfer = cookie;
1828 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
1829 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
1830 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
1831 	struct xhci_ring * const tr = xs->xs_xr[dci];
1832 
1833 	XHCIHIST_FUNC();
1834 	XHCIHIST_CALLARGS("xfer %#jx slot %ju dci %ju", (uintptr_t)xfer, xs->xs_idx,
1835 	    dci, 0);
1836 
1837 	/*
1838 	 * XXXMRG: Stall task can run after slot is disabled when yanked.
1839 	 * This hack notices that the xs has been memset() in
1840 	 * xhci_disable_slot() and returns.  Both xhci_reset_endpoint()
1841 	 * and xhci_set_dequeue() rely upon a valid ring setup for correct
1842 	 * operation, and the latter will fault, as would
1843 	 * usb_transfer_complete() if it got that far.
1844 	 */
1845 	if (xs->xs_idx == 0) {
1846 		DPRINTFN(4, "ends xs_idx is 0", 0, 0, 0, 0);
1847 		return;
1848 	}
1849 
1850 	KASSERT(tr != NULL);
1851 
1852 	xhci_reset_endpoint(xfer->ux_pipe);
1853 	xhci_set_dequeue(xfer->ux_pipe);
1854 
1855 	mutex_enter(&sc->sc_lock);
1856 	tr->is_halted = false;
1857 	usb_transfer_complete(xfer);
1858 	mutex_exit(&sc->sc_lock);
1859 	DPRINTFN(4, "ends", 0, 0, 0, 0);
1860 }
1861 
1862 static usbd_status
1863 xhci_clear_endpoint_stall_async(struct usbd_xfer *xfer)
1864 {
1865 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
1866 	struct xhci_pipe * const xp = (struct xhci_pipe *)xfer->ux_pipe;
1867 
1868 	XHCIHIST_FUNC();
1869 	XHCIHIST_CALLARGS("xfer %#jx", (uintptr_t)xfer, 0, 0, 0);
1870 
1871 	if (sc->sc_dying) {
1872 		return USBD_IOERROR;
1873 	}
1874 
1875 	usb_init_task(&xp->xp_async_task,
1876 	    xhci_clear_endpoint_stall_async_task, xfer, USB_TASKQ_MPSAFE);
1877 	usb_add_task(xfer->ux_pipe->up_dev, &xp->xp_async_task, USB_TASKQ_HC);
1878 	DPRINTFN(4, "ends", 0, 0, 0, 0);
1879 
1880 	return USBD_NORMAL_COMPLETION;
1881 }
1882 
1883 /* Process roothub port status/change events and notify to uhub_intr. */
1884 static void
1885 xhci_rhpsc(struct xhci_softc * const sc, u_int ctlrport)
1886 {
1887 	XHCIHIST_FUNC();
1888 	XHCIHIST_CALLARGS("xhci%jd: port %ju status change",
1889 	   device_unit(sc->sc_dev), ctlrport, 0, 0);
1890 
1891 	if (ctlrport > sc->sc_maxports)
1892 		return;
1893 
1894 	const size_t bn = xhci_ctlrport2bus(sc, ctlrport);
1895 	const size_t rhp = xhci_ctlrport2rhport(sc, ctlrport);
1896 	struct usbd_xfer * const xfer = sc->sc_intrxfer[bn];
1897 
1898 	DPRINTFN(4, "xhci%jd: bus %jd bp %ju xfer %#jx status change",
1899 	    device_unit(sc->sc_dev), bn, rhp, (uintptr_t)xfer);
1900 
1901 	if (xfer == NULL)
1902 		return;
1903 	KASSERT(xfer->ux_status == USBD_IN_PROGRESS);
1904 
1905 	uint8_t *p = xfer->ux_buf;
1906 	memset(p, 0, xfer->ux_length);
1907 	p[rhp / NBBY] |= 1 << (rhp % NBBY);
1908 	xfer->ux_actlen = xfer->ux_length;
1909 	xfer->ux_status = USBD_NORMAL_COMPLETION;
1910 	usb_transfer_complete(xfer);
1911 }
1912 
1913 /* Process Transfer Events */
1914 static void
1915 xhci_event_transfer(struct xhci_softc * const sc,
1916     const struct xhci_trb * const trb)
1917 {
1918 	uint64_t trb_0;
1919 	uint32_t trb_2, trb_3;
1920 	uint8_t trbcode;
1921 	u_int slot, dci;
1922 	struct xhci_slot *xs;
1923 	struct xhci_ring *xr;
1924 	struct xhci_xfer *xx;
1925 	struct usbd_xfer *xfer;
1926 	usbd_status err;
1927 
1928 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
1929 
1930 	trb_0 = le64toh(trb->trb_0);
1931 	trb_2 = le32toh(trb->trb_2);
1932 	trb_3 = le32toh(trb->trb_3);
1933 	trbcode = XHCI_TRB_2_ERROR_GET(trb_2);
1934 	slot = XHCI_TRB_3_SLOT_GET(trb_3);
1935 	dci = XHCI_TRB_3_EP_GET(trb_3);
1936 	xs = &sc->sc_slots[slot];
1937 	xr = xs->xs_xr[dci];
1938 
1939 	/* sanity check */
1940 	KASSERT(xr != NULL);
1941 	KASSERTMSG(xs->xs_idx != 0 && xs->xs_idx <= sc->sc_maxslots,
1942 	    "invalid xs_idx %u slot %u", xs->xs_idx, slot);
1943 
1944 	int idx = 0;
1945 	if ((trb_3 & XHCI_TRB_3_ED_BIT) == 0) {
1946 		if (xhci_trb_get_idx(xr, trb_0, &idx)) {
1947 			DPRINTFN(0, "invalid trb_0 %#jx", trb_0, 0, 0, 0);
1948 			return;
1949 		}
1950 		xx = xr->xr_cookies[idx];
1951 
1952 		/* clear cookie of consumed TRB */
1953 		xr->xr_cookies[idx] = NULL;
1954 
1955 		/*
1956 		 * xx is NULL if pipe is opened but xfer is not started.
1957 		 * It happens when stopping idle pipe.
1958 		 */
1959 		if (xx == NULL || trbcode == XHCI_TRB_ERROR_LENGTH) {
1960 			DPRINTFN(1, "Ignore #%ju: cookie %#jx cc %ju dci %ju",
1961 			    idx, (uintptr_t)xx, trbcode, dci);
1962 			DPRINTFN(1, " orig TRB %#jx type %ju", trb_0,
1963 			    XHCI_TRB_3_TYPE_GET(le32toh(xr->xr_trb[idx].trb_3)),
1964 			    0, 0);
1965 			return;
1966 		}
1967 	} else {
1968 		/* When ED != 0, trb_0 is virtual addr of struct xhci_xfer. */
1969 		xx = (void *)(uintptr_t)(trb_0 & ~0x3);
1970 	}
1971 	/* XXX this may not happen */
1972 	if (xx == NULL) {
1973 		DPRINTFN(1, "xfer done: xx is NULL", 0, 0, 0, 0);
1974 		return;
1975 	}
1976 	xfer = &xx->xx_xfer;
1977 	/* XXX this may happen when detaching */
1978 	if (xfer == NULL) {
1979 		DPRINTFN(1, "xx(%#jx)->xx_xfer is NULL trb_0 %#jx",
1980 		    (uintptr_t)xx, trb_0, 0, 0);
1981 		return;
1982 	}
1983 	DPRINTFN(14, "xfer %#jx", (uintptr_t)xfer, 0, 0, 0);
1984 	/* XXX I dunno why this happens */
1985 	KASSERTMSG(xfer->ux_pipe != NULL, "xfer(%p)->ux_pipe is NULL", xfer);
1986 
1987 	if (!xfer->ux_pipe->up_repeat &&
1988 	    SIMPLEQ_EMPTY(&xfer->ux_pipe->up_queue)) {
1989 		DPRINTFN(1, "xfer(%#jx)->pipe not queued", (uintptr_t)xfer,
1990 		    0, 0, 0);
1991 		return;
1992 	}
1993 
1994 	/*
1995 	 * Try to claim this xfer for completion.  If it has already
1996 	 * completed or aborted, drop it on the floor.
1997 	 */
1998 	if (!usbd_xfer_trycomplete(xfer))
1999 		return;
2000 
2001 	/* 4.11.5.2 Event Data TRB */
2002 	if ((trb_3 & XHCI_TRB_3_ED_BIT) != 0) {
2003 		DPRINTFN(14, "transfer Event Data: 0x%016jx 0x%08jx"
2004 		    " %02jx", trb_0, XHCI_TRB_2_REM_GET(trb_2), trbcode, 0);
2005 		if ((trb_0 & 0x3) == 0x3) {
2006 			xfer->ux_actlen = XHCI_TRB_2_REM_GET(trb_2);
2007 		}
2008 	}
2009 
2010 	switch (trbcode) {
2011 	case XHCI_TRB_ERROR_SHORT_PKT:
2012 	case XHCI_TRB_ERROR_SUCCESS:
2013 		/*
2014 		 * A ctrl transfer can generate two events if it has a Data
2015 		 * stage.  A short data stage can be OK and should not
2016 		 * complete the transfer as the status stage needs to be
2017 		 * performed.
2018 		 *
2019 		 * Note: Data and Status stage events point at same xfer.
2020 		 * ux_actlen and ux_dmabuf will be passed to
2021 		 * usb_transfer_complete after the Status stage event.
2022 		 *
2023 		 * It can be distingished which stage generates the event:
2024 		 * + by checking least 3 bits of trb_0 if ED==1.
2025 		 *   (see xhci_device_ctrl_start).
2026 		 * + by checking the type of original TRB if ED==0.
2027 		 *
2028 		 * In addition, intr, bulk, and isoc transfer currently
2029 		 * consists of single TD, so the "skip" is not needed.
2030 		 * ctrl xfer uses EVENT_DATA, and others do not.
2031 		 * Thus driver can switch the flow by checking ED bit.
2032 		 */
2033 		if ((trb_3 & XHCI_TRB_3_ED_BIT) == 0) {
2034 			if (xfer->ux_actlen == 0)
2035 				xfer->ux_actlen = xfer->ux_length -
2036 				    XHCI_TRB_2_REM_GET(trb_2);
2037 			if (XHCI_TRB_3_TYPE_GET(le32toh(xr->xr_trb[idx].trb_3))
2038 			    == XHCI_TRB_TYPE_DATA_STAGE) {
2039 				return;
2040 			}
2041 		} else if ((trb_0 & 0x3) == 0x3) {
2042 			return;
2043 		}
2044 		err = USBD_NORMAL_COMPLETION;
2045 		break;
2046 	case XHCI_TRB_ERROR_STOPPED:
2047 	case XHCI_TRB_ERROR_LENGTH:
2048 	case XHCI_TRB_ERROR_STOPPED_SHORT:
2049 		err = USBD_IOERROR;
2050 		break;
2051 	case XHCI_TRB_ERROR_STALL:
2052 	case XHCI_TRB_ERROR_BABBLE:
2053 		DPRINTFN(1, "ERR %ju slot %ju dci %ju", trbcode, slot, dci, 0);
2054 		xr->is_halted = true;
2055 		/*
2056 		 * Stalled endpoints can be recoverd by issuing
2057 		 * command TRB TYPE_RESET_EP on xHCI instead of
2058 		 * issuing request CLEAR_FEATURE UF_ENDPOINT_HALT
2059 		 * on the endpoint. However, this function may be
2060 		 * called from softint context (e.g. from umass),
2061 		 * in that case driver gets KASSERT in cv_timedwait
2062 		 * in xhci_do_command.
2063 		 * To avoid this, this runs reset_endpoint and
2064 		 * usb_transfer_complete in usb task thread
2065 		 * asynchronously (and then umass issues clear
2066 		 * UF_ENDPOINT_HALT).
2067 		 */
2068 
2069 		/* Override the status.  */
2070 		xfer->ux_status = USBD_STALLED;
2071 
2072 		xhci_clear_endpoint_stall_async(xfer);
2073 		return;
2074 	default:
2075 		DPRINTFN(1, "ERR %ju slot %ju dci %ju", trbcode, slot, dci, 0);
2076 		err = USBD_IOERROR;
2077 		break;
2078 	}
2079 
2080 	/* Set the status.  */
2081 	xfer->ux_status = err;
2082 
2083 	if ((trb_3 & XHCI_TRB_3_ED_BIT) == 0 ||
2084 	    (trb_0 & 0x3) == 0x0) {
2085 		usb_transfer_complete(xfer);
2086 	}
2087 }
2088 
2089 /* Process Command complete events */
2090 static void
2091 xhci_event_cmd(struct xhci_softc * const sc, const struct xhci_trb * const trb)
2092 {
2093 	uint64_t trb_0;
2094 	uint32_t trb_2, trb_3;
2095 
2096 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2097 
2098 	KASSERT(mutex_owned(&sc->sc_lock));
2099 
2100 	trb_0 = le64toh(trb->trb_0);
2101 	trb_2 = le32toh(trb->trb_2);
2102 	trb_3 = le32toh(trb->trb_3);
2103 
2104 	if (trb_0 == sc->sc_command_addr) {
2105 		sc->sc_resultpending = false;
2106 
2107 		sc->sc_result_trb.trb_0 = trb_0;
2108 		sc->sc_result_trb.trb_2 = trb_2;
2109 		sc->sc_result_trb.trb_3 = trb_3;
2110 		if (XHCI_TRB_2_ERROR_GET(trb_2) !=
2111 		    XHCI_TRB_ERROR_SUCCESS) {
2112 			DPRINTFN(1, "command completion "
2113 			    "failure: 0x%016jx 0x%08jx 0x%08jx",
2114 			    trb_0, trb_2, trb_3, 0);
2115 		}
2116 		cv_signal(&sc->sc_command_cv);
2117 	} else {
2118 		DPRINTFN(1, "spurious event: %#jx 0x%016jx "
2119 		    "0x%08jx 0x%08jx", (uintptr_t)trb, trb_0, trb_2, trb_3);
2120 	}
2121 }
2122 
2123 /*
2124  * Process events.
2125  * called from xhci_softintr
2126  */
2127 static void
2128 xhci_handle_event(struct xhci_softc * const sc,
2129     const struct xhci_trb * const trb)
2130 {
2131 	uint64_t trb_0;
2132 	uint32_t trb_2, trb_3;
2133 
2134 	XHCIHIST_FUNC();
2135 
2136 	trb_0 = le64toh(trb->trb_0);
2137 	trb_2 = le32toh(trb->trb_2);
2138 	trb_3 = le32toh(trb->trb_3);
2139 
2140 	XHCIHIST_CALLARGS("event: %#jx 0x%016jx 0x%08jx 0x%08jx",
2141 	    (uintptr_t)trb, trb_0, trb_2, trb_3);
2142 
2143 	/*
2144 	 * 4.11.3.1, 6.4.2.1
2145 	 * TRB Pointer is invalid for these completion codes.
2146 	 */
2147 	switch (XHCI_TRB_2_ERROR_GET(trb_2)) {
2148 	case XHCI_TRB_ERROR_RING_UNDERRUN:
2149 	case XHCI_TRB_ERROR_RING_OVERRUN:
2150 	case XHCI_TRB_ERROR_VF_RING_FULL:
2151 		return;
2152 	default:
2153 		if (trb_0 == 0) {
2154 			return;
2155 		}
2156 		break;
2157 	}
2158 
2159 	switch (XHCI_TRB_3_TYPE_GET(trb_3)) {
2160 	case XHCI_TRB_EVENT_TRANSFER:
2161 		xhci_event_transfer(sc, trb);
2162 		break;
2163 	case XHCI_TRB_EVENT_CMD_COMPLETE:
2164 		xhci_event_cmd(sc, trb);
2165 		break;
2166 	case XHCI_TRB_EVENT_PORT_STS_CHANGE:
2167 		xhci_rhpsc(sc, (uint32_t)((trb_0 >> 24) & 0xff));
2168 		break;
2169 	default:
2170 		break;
2171 	}
2172 }
2173 
2174 static void
2175 xhci_softintr(void *v)
2176 {
2177 	struct usbd_bus * const bus = v;
2178 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2179 	struct xhci_ring * const er = sc->sc_er;
2180 	struct xhci_trb *trb;
2181 	int i, j, k;
2182 
2183 	XHCIHIST_FUNC();
2184 
2185 	KASSERT(xhci_polling_p(sc) || mutex_owned(&sc->sc_lock));
2186 
2187 	i = er->xr_ep;
2188 	j = er->xr_cs;
2189 
2190 	XHCIHIST_CALLARGS("er: xr_ep %jd xr_cs %jd", i, j, 0, 0);
2191 
2192 	while (1) {
2193 		usb_syncmem(&er->xr_dma, XHCI_TRB_SIZE * i, XHCI_TRB_SIZE,
2194 		    BUS_DMASYNC_POSTREAD);
2195 		trb = &er->xr_trb[i];
2196 		k = (le32toh(trb->trb_3) & XHCI_TRB_3_CYCLE_BIT) ? 1 : 0;
2197 
2198 		if (j != k)
2199 			break;
2200 
2201 		xhci_handle_event(sc, trb);
2202 
2203 		i++;
2204 		if (i == er->xr_ntrb) {
2205 			i = 0;
2206 			j ^= 1;
2207 		}
2208 	}
2209 
2210 	er->xr_ep = i;
2211 	er->xr_cs = j;
2212 
2213 	xhci_rt_write_8(sc, XHCI_ERDP(0), xhci_ring_trbp(er, er->xr_ep) |
2214 	    XHCI_ERDP_LO_BUSY);
2215 
2216 	DPRINTFN(16, "ends", 0, 0, 0, 0);
2217 
2218 	return;
2219 }
2220 
2221 static void
2222 xhci_poll(struct usbd_bus *bus)
2223 {
2224 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2225 
2226 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2227 
2228 	mutex_enter(&sc->sc_intr_lock);
2229 	int ret = xhci_intr1(sc);
2230 	if (ret) {
2231 		xhci_softintr(bus);
2232 	}
2233 	mutex_exit(&sc->sc_intr_lock);
2234 
2235 	return;
2236 }
2237 
2238 static struct usbd_xfer *
2239 xhci_allocx(struct usbd_bus *bus, unsigned int nframes)
2240 {
2241 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2242 	struct usbd_xfer *xfer;
2243 
2244 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2245 
2246 	xfer = pool_cache_get(sc->sc_xferpool, PR_WAITOK);
2247 	if (xfer != NULL) {
2248 		memset(xfer, 0, sizeof(struct xhci_xfer));
2249 #ifdef DIAGNOSTIC
2250 		xfer->ux_state = XFER_BUSY;
2251 #endif
2252 	}
2253 
2254 	return xfer;
2255 }
2256 
2257 static void
2258 xhci_freex(struct usbd_bus *bus, struct usbd_xfer *xfer)
2259 {
2260 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2261 
2262 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2263 
2264 #ifdef DIAGNOSTIC
2265 	if (xfer->ux_state != XFER_BUSY &&
2266 	    xfer->ux_status != USBD_NOT_STARTED) {
2267 		DPRINTFN(0, "xfer=%#jx not busy, 0x%08jx",
2268 		    (uintptr_t)xfer, xfer->ux_state, 0, 0);
2269 	}
2270 	xfer->ux_state = XFER_FREE;
2271 #endif
2272 	pool_cache_put(sc->sc_xferpool, xfer);
2273 }
2274 
2275 static bool
2276 xhci_dying(struct usbd_bus *bus)
2277 {
2278 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2279 
2280 	return sc->sc_dying;
2281 }
2282 
2283 static void
2284 xhci_get_lock(struct usbd_bus *bus, kmutex_t **lock)
2285 {
2286 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2287 
2288 	*lock = &sc->sc_lock;
2289 }
2290 
2291 extern uint32_t usb_cookie_no;
2292 
2293 /*
2294  * xHCI 4.3
2295  * Called when uhub_explore finds a new device (via usbd_new_device).
2296  * Port initialization and speed detection (4.3.1) are already done in uhub.c.
2297  * This function does:
2298  *   Allocate and construct dev structure of default endpoint (ep0).
2299  *   Allocate and open pipe of ep0.
2300  *   Enable slot and initialize slot context.
2301  *   Set Address.
2302  *   Read initial device descriptor.
2303  *   Determine initial MaxPacketSize (mps) by speed.
2304  *   Read full device descriptor.
2305  *   Register this device.
2306  * Finally state of device transitions ADDRESSED.
2307  */
2308 static usbd_status
2309 xhci_new_device(device_t parent, struct usbd_bus *bus, int depth,
2310     int speed, int port, struct usbd_port *up)
2311 {
2312 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
2313 	struct usbd_device *dev;
2314 	usbd_status err;
2315 	usb_device_descriptor_t *dd;
2316 	struct xhci_slot *xs;
2317 	uint32_t *cp;
2318 
2319 	XHCIHIST_FUNC();
2320 	XHCIHIST_CALLARGS("port %ju depth %ju speed %ju up %#jx",
2321 	    port, depth, speed, (uintptr_t)up);
2322 
2323 	dev = kmem_zalloc(sizeof(*dev), KM_SLEEP);
2324 	dev->ud_bus = bus;
2325 	dev->ud_quirks = &usbd_no_quirk;
2326 	dev->ud_addr = 0;
2327 	dev->ud_ddesc.bMaxPacketSize = 0;
2328 	dev->ud_depth = depth;
2329 	dev->ud_powersrc = up;
2330 	dev->ud_myhub = up->up_parent;
2331 	dev->ud_speed = speed;
2332 	dev->ud_langid = USBD_NOLANG;
2333 	dev->ud_cookie.cookie = ++usb_cookie_no;
2334 
2335 	/* Set up default endpoint handle. */
2336 	dev->ud_ep0.ue_edesc = &dev->ud_ep0desc;
2337 	/* doesn't matter, just don't let it uninitialized */
2338 	dev->ud_ep0.ue_toggle = 0;
2339 
2340 	/* Set up default endpoint descriptor. */
2341 	dev->ud_ep0desc.bLength = USB_ENDPOINT_DESCRIPTOR_SIZE;
2342 	dev->ud_ep0desc.bDescriptorType = UDESC_ENDPOINT;
2343 	dev->ud_ep0desc.bEndpointAddress = USB_CONTROL_ENDPOINT;
2344 	dev->ud_ep0desc.bmAttributes = UE_CONTROL;
2345 	dev->ud_ep0desc.bInterval = 0;
2346 
2347 	/* 4.3,  4.8.2.1 */
2348 	switch (speed) {
2349 	case USB_SPEED_SUPER:
2350 	case USB_SPEED_SUPER_PLUS:
2351 		USETW(dev->ud_ep0desc.wMaxPacketSize, USB_3_MAX_CTRL_PACKET);
2352 		break;
2353 	case USB_SPEED_FULL:
2354 		/* XXX using 64 as initial mps of ep0 in FS */
2355 	case USB_SPEED_HIGH:
2356 		USETW(dev->ud_ep0desc.wMaxPacketSize, USB_2_MAX_CTRL_PACKET);
2357 		break;
2358 	case USB_SPEED_LOW:
2359 	default:
2360 		USETW(dev->ud_ep0desc.wMaxPacketSize, USB_MAX_IPACKET);
2361 		break;
2362 	}
2363 
2364 	up->up_dev = dev;
2365 
2366 	dd = &dev->ud_ddesc;
2367 
2368 	if (depth == 0 && port == 0) {
2369 		KASSERT(bus->ub_devices[USB_ROOTHUB_INDEX] == NULL);
2370 		bus->ub_devices[USB_ROOTHUB_INDEX] = dev;
2371 
2372 		/* Establish the default pipe. */
2373 		err = usbd_setup_pipe(dev, 0, &dev->ud_ep0,
2374 		    USBD_DEFAULT_INTERVAL, &dev->ud_pipe0);
2375 		if (err) {
2376 			DPRINTFN(1, "setup default pipe failed %jd", err,0,0,0);
2377 			goto bad;
2378 		}
2379 		err = usbd_get_initial_ddesc(dev, dd);
2380 		if (err) {
2381 			DPRINTFN(1, "get_initial_ddesc %ju", err, 0, 0, 0);
2382 			goto bad;
2383 		}
2384 	} else {
2385 		uint8_t slot = 0;
2386 
2387 		/* 4.3.2 */
2388 		err = xhci_enable_slot(sc, &slot);
2389 		if (err) {
2390 			DPRINTFN(1, "enable slot %ju", err, 0, 0, 0);
2391 			goto bad;
2392 		}
2393 
2394 		xs = &sc->sc_slots[slot];
2395 		dev->ud_hcpriv = xs;
2396 
2397 		/* 4.3.3 initialize slot structure */
2398 		err = xhci_init_slot(dev, slot);
2399 		if (err) {
2400 			DPRINTFN(1, "init slot %ju", err, 0, 0, 0);
2401 			dev->ud_hcpriv = NULL;
2402 			/*
2403 			 * We have to disable_slot here because
2404 			 * xs->xs_idx == 0 when xhci_init_slot fails,
2405 			 * in that case usbd_remove_dev won't work.
2406 			 */
2407 			mutex_enter(&sc->sc_lock);
2408 			xhci_disable_slot(sc, slot);
2409 			mutex_exit(&sc->sc_lock);
2410 			goto bad;
2411 		}
2412 
2413 		/*
2414 		 * We have to establish the default pipe _after_ slot
2415 		 * structure has been prepared.
2416 		 */
2417 		err = usbd_setup_pipe(dev, 0, &dev->ud_ep0,
2418 		    USBD_DEFAULT_INTERVAL, &dev->ud_pipe0);
2419 		if (err) {
2420 			DPRINTFN(1, "setup default pipe failed %jd", err, 0, 0,
2421 			    0);
2422 			goto bad;
2423 		}
2424 
2425 		/* 4.3.4 Address Assignment */
2426 		err = xhci_set_address(dev, slot, false);
2427 		if (err) {
2428 			DPRINTFN(1, "failed! to set address: %ju", err, 0, 0, 0);
2429 			goto bad;
2430 		}
2431 
2432 		/* Allow device time to set new address */
2433 		usbd_delay_ms(dev, USB_SET_ADDRESS_SETTLE);
2434 
2435 		usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD);
2436 		cp = xhci_slot_get_dcv(sc, xs, XHCI_DCI_SLOT);
2437 		HEXDUMP("slot context", cp, sc->sc_ctxsz);
2438 		uint8_t addr = XHCI_SCTX_3_DEV_ADDR_GET(le32toh(cp[3]));
2439 		DPRINTFN(4, "device address %ju", addr, 0, 0, 0);
2440 		/*
2441 		 * XXX ensure we know when the hardware does something
2442 		 * we can't yet cope with
2443 		 */
2444 		KASSERTMSG(addr >= 1 && addr <= 127, "addr %d", addr);
2445 		dev->ud_addr = addr;
2446 
2447 		KASSERTMSG(bus->ub_devices[usb_addr2dindex(dev->ud_addr)] == NULL,
2448 		    "addr %d already allocated", dev->ud_addr);
2449 		/*
2450 		 * The root hub is given its own slot
2451 		 */
2452 		bus->ub_devices[usb_addr2dindex(dev->ud_addr)] = dev;
2453 
2454 		err = usbd_get_initial_ddesc(dev, dd);
2455 		if (err) {
2456 			DPRINTFN(1, "get_initial_ddesc %ju", err, 0, 0, 0);
2457 			goto bad;
2458 		}
2459 
2460 		/* 4.8.2.1 */
2461 		if (USB_IS_SS(speed)) {
2462 			if (dd->bMaxPacketSize != 9) {
2463 				printf("%s: invalid mps 2^%u for SS ep0,"
2464 				    " using 512\n",
2465 				    device_xname(sc->sc_dev),
2466 				    dd->bMaxPacketSize);
2467 				dd->bMaxPacketSize = 9;
2468 			}
2469 			USETW(dev->ud_ep0desc.wMaxPacketSize,
2470 			    (1 << dd->bMaxPacketSize));
2471 		} else
2472 			USETW(dev->ud_ep0desc.wMaxPacketSize,
2473 			    dd->bMaxPacketSize);
2474 		DPRINTFN(4, "bMaxPacketSize %ju", dd->bMaxPacketSize, 0, 0, 0);
2475 		err = xhci_update_ep0_mps(sc, xs,
2476 		    UGETW(dev->ud_ep0desc.wMaxPacketSize));
2477 		if (err) {
2478 			DPRINTFN(1, "update mps of ep0 %ju", err, 0, 0, 0);
2479 			goto bad;
2480 		}
2481 	}
2482 
2483 	err = usbd_reload_device_desc(dev);
2484 	if (err) {
2485 		DPRINTFN(1, "reload desc %ju", err, 0, 0, 0);
2486 		goto bad;
2487 	}
2488 
2489 	DPRINTFN(1, "adding unit addr=%jd, rev=%02jx,",
2490 		dev->ud_addr, UGETW(dd->bcdUSB), 0, 0);
2491 	DPRINTFN(1, " class=%jd, subclass=%jd, protocol=%jd,",
2492 		dd->bDeviceClass, dd->bDeviceSubClass,
2493 		dd->bDeviceProtocol, 0);
2494 	DPRINTFN(1, " mps=%jd, len=%jd, noconf=%jd, speed=%jd",
2495 		dd->bMaxPacketSize, dd->bLength, dd->bNumConfigurations,
2496 		dev->ud_speed);
2497 
2498 	usbd_get_device_strings(dev);
2499 
2500 	usbd_add_dev_event(USB_EVENT_DEVICE_ATTACH, dev);
2501 
2502 	if (depth == 0 && port == 0) {
2503 		usbd_attach_roothub(parent, dev);
2504 		DPRINTFN(1, "root hub %#jx", (uintptr_t)dev, 0, 0, 0);
2505 		return USBD_NORMAL_COMPLETION;
2506 	}
2507 
2508 	err = usbd_probe_and_attach(parent, dev, port, dev->ud_addr);
2509  bad:
2510 	if (err != USBD_NORMAL_COMPLETION) {
2511 		usbd_remove_device(dev, up);
2512 	}
2513 
2514 	return err;
2515 }
2516 
2517 static usbd_status
2518 xhci_ring_init(struct xhci_softc * const sc, struct xhci_ring **xrp,
2519     size_t ntrb, size_t align)
2520 {
2521 	usbd_status err;
2522 	size_t size = ntrb * XHCI_TRB_SIZE;
2523 	struct xhci_ring *xr;
2524 
2525 	XHCIHIST_FUNC();
2526 	XHCIHIST_CALLARGS("xr %#jx ntrb %#jx align %#jx",
2527 	    (uintptr_t)*xrp, ntrb, align, 0);
2528 
2529 	xr = kmem_zalloc(sizeof(struct xhci_ring), KM_SLEEP);
2530 	DPRINTFN(1, "ring %#jx", (uintptr_t)xr, 0, 0, 0);
2531 
2532 	err = usb_allocmem(&sc->sc_bus, size, align, &xr->xr_dma);
2533 	if (err) {
2534 		kmem_free(xr, sizeof(struct xhci_ring));
2535 		DPRINTFN(1, "alloc xr_dma failed %jd", err, 0, 0, 0);
2536 		return err;
2537 	}
2538 	mutex_init(&xr->xr_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
2539 	xr->xr_cookies = kmem_zalloc(sizeof(*xr->xr_cookies) * ntrb, KM_SLEEP);
2540 	xr->xr_trb = xhci_ring_trbv(xr, 0);
2541 	xr->xr_ntrb = ntrb;
2542 	xr->is_halted = false;
2543 	xhci_host_dequeue(xr);
2544 	*xrp = xr;
2545 
2546 	return USBD_NORMAL_COMPLETION;
2547 }
2548 
2549 static void
2550 xhci_ring_free(struct xhci_softc * const sc, struct xhci_ring ** const xr)
2551 {
2552 	if (*xr == NULL)
2553 		return;
2554 
2555 	usb_freemem(&sc->sc_bus, &(*xr)->xr_dma);
2556 	mutex_destroy(&(*xr)->xr_lock);
2557 	kmem_free((*xr)->xr_cookies,
2558 	    sizeof(*(*xr)->xr_cookies) * (*xr)->xr_ntrb);
2559 	kmem_free(*xr, sizeof(struct xhci_ring));
2560 	*xr = NULL;
2561 }
2562 
2563 static void
2564 xhci_ring_put(struct xhci_softc * const sc, struct xhci_ring * const xr,
2565     void *cookie, struct xhci_soft_trb * const trbs, size_t ntrbs)
2566 {
2567 	size_t i;
2568 	u_int ri;
2569 	u_int cs;
2570 	uint64_t parameter;
2571 	uint32_t status;
2572 	uint32_t control;
2573 
2574 	XHCIHIST_FUNC();
2575 	XHCIHIST_CALLARGS("%#jx xr_ep %#jx xr_cs %ju",
2576 	    (uintptr_t)xr, xr->xr_ep, xr->xr_cs, 0);
2577 
2578 	KASSERTMSG(ntrbs <= XHCI_XFER_NTRB, "ntrbs %zu", ntrbs);
2579 	for (i = 0; i < ntrbs; i++) {
2580 		DPRINTFN(12, "xr %#jx trbs %#jx num %ju", (uintptr_t)xr,
2581 		    (uintptr_t)trbs, i, 0);
2582 		DPRINTFN(12, " 0x%016jx 0x%08jx 0x%08jx",
2583 		    trbs[i].trb_0, trbs[i].trb_2, trbs[i].trb_3, 0);
2584 		KASSERTMSG(XHCI_TRB_3_TYPE_GET(trbs[i].trb_3) !=
2585 		    XHCI_TRB_TYPE_LINK, "trbs[%zu].trb3 %#x", i, trbs[i].trb_3);
2586 	}
2587 
2588 	ri = xr->xr_ep;
2589 	cs = xr->xr_cs;
2590 
2591 	/*
2592 	 * Although the xhci hardware can do scatter/gather dma from
2593 	 * arbitrary sized buffers, there is a non-obvious restriction
2594 	 * that a LINK trb is only allowed at the end of a burst of
2595 	 * transfers - which might be 16kB.
2596 	 * Arbitrary aligned LINK trb definitely fail on Ivy bridge.
2597 	 * The simple solution is not to allow a LINK trb in the middle
2598 	 * of anything - as here.
2599 	 * XXX: (dsl) There are xhci controllers out there (eg some made by
2600 	 * ASMedia) that seem to lock up if they process a LINK trb but
2601 	 * cannot process the linked-to trb yet.
2602 	 * The code should write the 'cycle' bit on the link trb AFTER
2603 	 * adding the other trb.
2604 	 */
2605 	u_int firstep = xr->xr_ep;
2606 	u_int firstcs = xr->xr_cs;
2607 
2608 	for (i = 0; i < ntrbs; ) {
2609 		u_int oldri = ri;
2610 		u_int oldcs = cs;
2611 
2612 		if (ri >= (xr->xr_ntrb - 1)) {
2613 			/* Put Link TD at the end of ring */
2614 			parameter = xhci_ring_trbp(xr, 0);
2615 			status = 0;
2616 			control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_LINK) |
2617 			    XHCI_TRB_3_TC_BIT;
2618 			xr->xr_cookies[ri] = NULL;
2619 			xr->xr_ep = 0;
2620 			xr->xr_cs ^= 1;
2621 			ri = xr->xr_ep;
2622 			cs = xr->xr_cs;
2623 		} else {
2624 			parameter = trbs[i].trb_0;
2625 			status = trbs[i].trb_2;
2626 			control = trbs[i].trb_3;
2627 
2628 			xr->xr_cookies[ri] = cookie;
2629 			ri++;
2630 			i++;
2631 		}
2632 		/*
2633 		 * If this is a first TRB, mark it invalid to prevent
2634 		 * xHC from running it immediately.
2635 		 */
2636 		if (oldri == firstep) {
2637 			if (oldcs) {
2638 				control &= ~XHCI_TRB_3_CYCLE_BIT;
2639 			} else {
2640 				control |= XHCI_TRB_3_CYCLE_BIT;
2641 			}
2642 		} else {
2643 			if (oldcs) {
2644 				control |= XHCI_TRB_3_CYCLE_BIT;
2645 			} else {
2646 				control &= ~XHCI_TRB_3_CYCLE_BIT;
2647 			}
2648 		}
2649 		xhci_trb_put(&xr->xr_trb[oldri], parameter, status, control);
2650 		usb_syncmem(&xr->xr_dma, XHCI_TRB_SIZE * oldri,
2651 		    XHCI_TRB_SIZE * 1, BUS_DMASYNC_PREWRITE);
2652 	}
2653 
2654 	/* Now invert cycle bit of first TRB */
2655 	if (firstcs) {
2656 		xr->xr_trb[firstep].trb_3 |= htole32(XHCI_TRB_3_CYCLE_BIT);
2657 	} else {
2658 		xr->xr_trb[firstep].trb_3 &= ~htole32(XHCI_TRB_3_CYCLE_BIT);
2659 	}
2660 	usb_syncmem(&xr->xr_dma, XHCI_TRB_SIZE * firstep,
2661 	    XHCI_TRB_SIZE * 1, BUS_DMASYNC_PREWRITE);
2662 
2663 	xr->xr_ep = ri;
2664 	xr->xr_cs = cs;
2665 
2666 	DPRINTFN(12, "%#jx xr_ep %#jx xr_cs %ju", (uintptr_t)xr, xr->xr_ep,
2667 	    xr->xr_cs, 0);
2668 }
2669 
2670 /*
2671  * Stop execution commands, purge all commands on command ring, and
2672  * rewind dequeue pointer.
2673  */
2674 static void
2675 xhci_abort_command(struct xhci_softc *sc)
2676 {
2677 	struct xhci_ring * const cr = sc->sc_cr;
2678 	uint64_t crcr;
2679 	int i;
2680 
2681 	XHCIHIST_FUNC();
2682 	XHCIHIST_CALLARGS("command %#jx timeout, aborting",
2683 	    sc->sc_command_addr, 0, 0, 0);
2684 
2685 	mutex_enter(&cr->xr_lock);
2686 
2687 	/* 4.6.1.2 Aborting a Command */
2688 	crcr = xhci_op_read_8(sc, XHCI_CRCR);
2689 	xhci_op_write_8(sc, XHCI_CRCR, crcr | XHCI_CRCR_LO_CA);
2690 
2691 	for (i = 0; i < 500; i++) {
2692 		crcr = xhci_op_read_8(sc, XHCI_CRCR);
2693 		if ((crcr & XHCI_CRCR_LO_CRR) == 0)
2694 			break;
2695 		usb_delay_ms(&sc->sc_bus, 1);
2696 	}
2697 	if ((crcr & XHCI_CRCR_LO_CRR) != 0) {
2698 		DPRINTFN(1, "Command Abort timeout", 0, 0, 0, 0);
2699 		/* reset HC here? */
2700 	}
2701 
2702 	/* reset command ring dequeue pointer */
2703 	cr->xr_ep = 0;
2704 	cr->xr_cs = 1;
2705 	xhci_op_write_8(sc, XHCI_CRCR, xhci_ring_trbp(cr, 0) | cr->xr_cs);
2706 
2707 	mutex_exit(&cr->xr_lock);
2708 }
2709 
2710 /*
2711  * Put a command on command ring, ring bell, set timer, and cv_timedwait.
2712  * Command completion is notified by cv_signal from xhci_event_cmd()
2713  * (called from xhci_softint), or timed-out.
2714  * The completion code is copied to sc->sc_result_trb in xhci_event_cmd(),
2715  * then do_command examines it.
2716  */
2717 static usbd_status
2718 xhci_do_command_locked(struct xhci_softc * const sc,
2719     struct xhci_soft_trb * const trb, int timeout)
2720 {
2721 	struct xhci_ring * const cr = sc->sc_cr;
2722 	usbd_status err;
2723 
2724 	XHCIHIST_FUNC();
2725 	XHCIHIST_CALLARGS("input: 0x%016jx 0x%08jx 0x%08jx",
2726 	    trb->trb_0, trb->trb_2, trb->trb_3, 0);
2727 
2728 	KASSERTMSG(!cpu_intr_p() && !cpu_softintr_p(), "called from intr ctx");
2729 	KASSERT(mutex_owned(&sc->sc_lock));
2730 
2731 	while (sc->sc_command_addr != 0)
2732 		cv_wait(&sc->sc_cmdbusy_cv, &sc->sc_lock);
2733 
2734 	/*
2735 	 * If enqueue pointer points at last of ring, it's Link TRB,
2736 	 * command TRB will be stored in 0th TRB.
2737 	 */
2738 	if (cr->xr_ep == cr->xr_ntrb - 1)
2739 		sc->sc_command_addr = xhci_ring_trbp(cr, 0);
2740 	else
2741 		sc->sc_command_addr = xhci_ring_trbp(cr, cr->xr_ep);
2742 
2743 	sc->sc_resultpending = true;
2744 
2745 	mutex_enter(&cr->xr_lock);
2746 	xhci_ring_put(sc, cr, NULL, trb, 1);
2747 	mutex_exit(&cr->xr_lock);
2748 
2749 	xhci_db_write_4(sc, XHCI_DOORBELL(0), 0);
2750 
2751 	while (sc->sc_resultpending) {
2752 		if (cv_timedwait(&sc->sc_command_cv, &sc->sc_lock,
2753 		    MAX(1, mstohz(timeout))) == EWOULDBLOCK) {
2754 			xhci_abort_command(sc);
2755 			err = USBD_TIMEOUT;
2756 			goto timedout;
2757 		}
2758 	}
2759 
2760 	trb->trb_0 = sc->sc_result_trb.trb_0;
2761 	trb->trb_2 = sc->sc_result_trb.trb_2;
2762 	trb->trb_3 = sc->sc_result_trb.trb_3;
2763 
2764 	DPRINTFN(12, "output: 0x%016jx 0x%08jx 0x%08jx",
2765 	    trb->trb_0, trb->trb_2, trb->trb_3, 0);
2766 
2767 	switch (XHCI_TRB_2_ERROR_GET(trb->trb_2)) {
2768 	case XHCI_TRB_ERROR_SUCCESS:
2769 		err = USBD_NORMAL_COMPLETION;
2770 		break;
2771 	default:
2772 	case 192 ... 223:
2773 		DPRINTFN(5, "error %#jx",
2774 		    XHCI_TRB_2_ERROR_GET(trb->trb_2), 0, 0, 0);
2775 		err = USBD_IOERROR;
2776 		break;
2777 	case 224 ... 255:
2778 		err = USBD_NORMAL_COMPLETION;
2779 		break;
2780 	}
2781 
2782 timedout:
2783 	sc->sc_resultpending = false;
2784 	sc->sc_command_addr = 0;
2785 	cv_broadcast(&sc->sc_cmdbusy_cv);
2786 
2787 	return err;
2788 }
2789 
2790 static usbd_status
2791 xhci_do_command(struct xhci_softc * const sc, struct xhci_soft_trb * const trb,
2792     int timeout)
2793 {
2794 
2795 	mutex_enter(&sc->sc_lock);
2796 	usbd_status ret = xhci_do_command_locked(sc, trb, timeout);
2797 	mutex_exit(&sc->sc_lock);
2798 
2799 	return ret;
2800 }
2801 
2802 static usbd_status
2803 xhci_enable_slot(struct xhci_softc * const sc, uint8_t * const slotp)
2804 {
2805 	struct xhci_soft_trb trb;
2806 	usbd_status err;
2807 
2808 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2809 
2810 	trb.trb_0 = 0;
2811 	trb.trb_2 = 0;
2812 	trb.trb_3 = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_ENABLE_SLOT);
2813 
2814 	err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT);
2815 	if (err != USBD_NORMAL_COMPLETION) {
2816 		return err;
2817 	}
2818 
2819 	*slotp = XHCI_TRB_3_SLOT_GET(trb.trb_3);
2820 
2821 	return err;
2822 }
2823 
2824 /*
2825  * xHCI 4.6.4
2826  * Deallocate ring and device/input context DMA buffers, and disable_slot.
2827  * All endpoints in the slot should be stopped.
2828  * Should be called with sc_lock held.
2829  */
2830 static usbd_status
2831 xhci_disable_slot(struct xhci_softc * const sc, uint8_t slot)
2832 {
2833 	struct xhci_soft_trb trb;
2834 	struct xhci_slot *xs;
2835 	usbd_status err;
2836 
2837 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
2838 
2839 	if (sc->sc_dying)
2840 		return USBD_IOERROR;
2841 
2842 	trb.trb_0 = 0;
2843 	trb.trb_2 = 0;
2844 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(slot) |
2845 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_DISABLE_SLOT);
2846 
2847 	err = xhci_do_command_locked(sc, &trb, USBD_DEFAULT_TIMEOUT);
2848 
2849 	if (!err) {
2850 		xs = &sc->sc_slots[slot];
2851 		if (xs->xs_idx != 0) {
2852 			xhci_free_slot(sc, xs);
2853 			xhci_set_dcba(sc, 0, slot);
2854 			memset(xs, 0, sizeof(*xs));
2855 		}
2856 	}
2857 
2858 	return err;
2859 }
2860 
2861 /*
2862  * Set address of device and transition slot state from ENABLED to ADDRESSED
2863  * if Block Setaddress Request (BSR) is false.
2864  * If BSR==true, transition slot state from ENABLED to DEFAULT.
2865  * see xHCI 1.1  4.5.3, 3.3.4
2866  * Should be called without sc_lock held.
2867  */
2868 static usbd_status
2869 xhci_address_device(struct xhci_softc * const sc,
2870     uint64_t icp, uint8_t slot_id, bool bsr)
2871 {
2872 	struct xhci_soft_trb trb;
2873 	usbd_status err;
2874 
2875 	XHCIHIST_FUNC();
2876 	if (bsr) {
2877 		XHCIHIST_CALLARGS("icp %#jx slot %#jx with bsr",
2878 		    icp, slot_id, 0, 0);
2879 	} else {
2880 		XHCIHIST_CALLARGS("icp %#jx slot %#jx nobsr",
2881 		    icp, slot_id, 0, 0);
2882 	}
2883 
2884 	trb.trb_0 = icp;
2885 	trb.trb_2 = 0;
2886 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(slot_id) |
2887 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_ADDRESS_DEVICE) |
2888 	    (bsr ? XHCI_TRB_3_BSR_BIT : 0);
2889 
2890 	err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT);
2891 
2892 	if (XHCI_TRB_2_ERROR_GET(trb.trb_2) == XHCI_TRB_ERROR_NO_SLOTS)
2893 		err = USBD_NO_ADDR;
2894 
2895 	return err;
2896 }
2897 
2898 static usbd_status
2899 xhci_update_ep0_mps(struct xhci_softc * const sc,
2900     struct xhci_slot * const xs, u_int mps)
2901 {
2902 	struct xhci_soft_trb trb;
2903 	usbd_status err;
2904 	uint32_t * cp;
2905 
2906 	XHCIHIST_FUNC();
2907 	XHCIHIST_CALLARGS("slot %ju mps %ju", xs->xs_idx, mps, 0, 0);
2908 
2909 	cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL);
2910 	cp[0] = htole32(0);
2911 	cp[1] = htole32(XHCI_INCTX_1_ADD_MASK(XHCI_DCI_EP_CONTROL));
2912 
2913 	cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_EP_CONTROL));
2914 	cp[1] = htole32(XHCI_EPCTX_1_MAXP_SIZE_SET(mps));
2915 
2916 	/* sync input contexts before they are read from memory */
2917 	usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE);
2918 	HEXDUMP("input context", xhci_slot_get_icv(sc, xs, 0),
2919 	    sc->sc_ctxsz * 4);
2920 
2921 	trb.trb_0 = xhci_slot_get_icp(sc, xs, 0);
2922 	trb.trb_2 = 0;
2923 	trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) |
2924 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_EVALUATE_CTX);
2925 
2926 	err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT);
2927 	return err;
2928 }
2929 
2930 static void
2931 xhci_set_dcba(struct xhci_softc * const sc, uint64_t dcba, int si)
2932 {
2933 	uint64_t * const dcbaa = KERNADDR(&sc->sc_dcbaa_dma, 0);
2934 
2935 	XHCIHIST_FUNC();
2936 	XHCIHIST_CALLARGS("dcbaa %#jx dc 0x%016jx slot %jd",
2937 	    (uintptr_t)&dcbaa[si], dcba, si, 0);
2938 
2939 	dcbaa[si] = htole64(dcba);
2940 	usb_syncmem(&sc->sc_dcbaa_dma, si * sizeof(uint64_t), sizeof(uint64_t),
2941 	    BUS_DMASYNC_PREWRITE);
2942 }
2943 
2944 /*
2945  * Allocate device and input context DMA buffer, and
2946  * TRB DMA buffer for each endpoint.
2947  */
2948 static usbd_status
2949 xhci_init_slot(struct usbd_device *dev, uint32_t slot)
2950 {
2951 	struct xhci_softc * const sc = XHCI_BUS2SC(dev->ud_bus);
2952 	struct xhci_slot *xs;
2953 	usbd_status err;
2954 
2955 	XHCIHIST_FUNC();
2956 	XHCIHIST_CALLARGS("slot %ju", slot, 0, 0, 0);
2957 
2958 	xs = &sc->sc_slots[slot];
2959 
2960 	/* allocate contexts */
2961 	err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz, sc->sc_pgsz,
2962 	    &xs->xs_dc_dma);
2963 	if (err) {
2964 		DPRINTFN(1, "failed to allocmem output device context %jd",
2965 		    err, 0, 0, 0);
2966 		return err;
2967 	}
2968 	memset(KERNADDR(&xs->xs_dc_dma, 0), 0, sc->sc_pgsz);
2969 
2970 	err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz, sc->sc_pgsz,
2971 	    &xs->xs_ic_dma);
2972 	if (err) {
2973 		DPRINTFN(1, "failed to allocmem input device context %jd",
2974 		    err, 0, 0, 0);
2975 		goto bad1;
2976 	}
2977 	memset(KERNADDR(&xs->xs_ic_dma, 0), 0, sc->sc_pgsz);
2978 
2979 	memset(&xs->xs_xr[0], 0, sizeof(xs->xs_xr));
2980 	xs->xs_idx = slot;
2981 
2982 	return USBD_NORMAL_COMPLETION;
2983 
2984  bad1:
2985 	usb_freemem(&sc->sc_bus, &xs->xs_dc_dma);
2986 	xs->xs_idx = 0;
2987 	return err;
2988 }
2989 
2990 static void
2991 xhci_free_slot(struct xhci_softc *sc, struct xhci_slot *xs)
2992 {
2993 	u_int dci;
2994 
2995 	XHCIHIST_FUNC();
2996 	XHCIHIST_CALLARGS("slot %ju", xs->xs_idx, 0, 0, 0);
2997 
2998 	/* deallocate all allocated rings in the slot */
2999 	for (dci = XHCI_DCI_SLOT; dci <= XHCI_MAX_DCI; dci++) {
3000 		if (xs->xs_xr[dci] != NULL)
3001 			xhci_ring_free(sc, &xs->xs_xr[dci]);
3002 	}
3003 	usb_freemem(&sc->sc_bus, &xs->xs_ic_dma);
3004 	usb_freemem(&sc->sc_bus, &xs->xs_dc_dma);
3005 	xs->xs_idx = 0;
3006 }
3007 
3008 /*
3009  * Setup slot context, set Device Context Base Address, and issue
3010  * Set Address Device command.
3011  */
3012 static usbd_status
3013 xhci_set_address(struct usbd_device *dev, uint32_t slot, bool bsr)
3014 {
3015 	struct xhci_softc * const sc = XHCI_BUS2SC(dev->ud_bus);
3016 	struct xhci_slot *xs;
3017 	usbd_status err;
3018 
3019 	XHCIHIST_FUNC();
3020 	XHCIHIST_CALLARGS("slot %ju bsr %ju", slot, bsr, 0, 0);
3021 
3022 	xs = &sc->sc_slots[slot];
3023 
3024 	xhci_setup_ctx(dev->ud_pipe0);
3025 
3026 	HEXDUMP("input context", xhci_slot_get_icv(sc, xs, 0),
3027 	    sc->sc_ctxsz * 3);
3028 
3029 	xhci_set_dcba(sc, DMAADDR(&xs->xs_dc_dma, 0), slot);
3030 
3031 	err = xhci_address_device(sc, xhci_slot_get_icp(sc, xs, 0), slot, bsr);
3032 
3033 	usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD);
3034 	HEXDUMP("output context", xhci_slot_get_dcv(sc, xs, 0),
3035 	    sc->sc_ctxsz * 2);
3036 
3037 	return err;
3038 }
3039 
3040 /*
3041  * 4.8.2, 6.2.3.2
3042  * construct slot/endpoint context parameters and do syncmem
3043  */
3044 static void
3045 xhci_setup_ctx(struct usbd_pipe *pipe)
3046 {
3047 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
3048 	struct usbd_device *dev = pipe->up_dev;
3049 	struct xhci_slot * const xs = dev->ud_hcpriv;
3050 	usb_endpoint_descriptor_t * const ed = pipe->up_endpoint->ue_edesc;
3051 	const u_int dci = xhci_ep_get_dci(ed);
3052 	const uint8_t xfertype = UE_GET_XFERTYPE(ed->bmAttributes);
3053 	uint32_t *cp;
3054 	uint16_t mps = UGETW(ed->wMaxPacketSize);
3055 	uint8_t speed = dev->ud_speed;
3056 	uint8_t ival = ed->bInterval;
3057 
3058 	XHCIHIST_FUNC();
3059 	XHCIHIST_CALLARGS("pipe %#jx: slot %ju dci %ju speed %ju",
3060 	    (uintptr_t)pipe, xs->xs_idx, dci, speed);
3061 
3062 	/* set up initial input control context */
3063 	cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL);
3064 	cp[0] = htole32(0);
3065 	cp[1] = htole32(XHCI_INCTX_1_ADD_MASK(dci));
3066 	cp[1] |= htole32(XHCI_INCTX_1_ADD_MASK(XHCI_DCI_SLOT));
3067 	cp[7] = htole32(0);
3068 
3069 	/* set up input slot context */
3070 	cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_SLOT));
3071 	cp[0] =
3072 	    XHCI_SCTX_0_CTX_NUM_SET(dci) |
3073 	    XHCI_SCTX_0_SPEED_SET(xhci_speed2xspeed(speed));
3074 	cp[1] = 0;
3075 	cp[2] = XHCI_SCTX_2_IRQ_TARGET_SET(0);
3076 	cp[3] = 0;
3077 	xhci_setup_route(pipe, cp);
3078 	xhci_setup_tthub(pipe, cp);
3079 
3080 	cp[0] = htole32(cp[0]);
3081 	cp[1] = htole32(cp[1]);
3082 	cp[2] = htole32(cp[2]);
3083 	cp[3] = htole32(cp[3]);
3084 
3085 	/* set up input endpoint context */
3086 	cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(dci));
3087 	cp[0] =
3088 	    XHCI_EPCTX_0_EPSTATE_SET(0) |
3089 	    XHCI_EPCTX_0_MULT_SET(0) |
3090 	    XHCI_EPCTX_0_MAXP_STREAMS_SET(0) |
3091 	    XHCI_EPCTX_0_LSA_SET(0) |
3092 	    XHCI_EPCTX_0_MAX_ESIT_PAYLOAD_HI_SET(0);
3093 	cp[1] =
3094 	    XHCI_EPCTX_1_EPTYPE_SET(xhci_ep_get_type(ed)) |
3095 	    XHCI_EPCTX_1_HID_SET(0) |
3096 	    XHCI_EPCTX_1_MAXB_SET(0);
3097 
3098 	if (xfertype != UE_ISOCHRONOUS)
3099 		cp[1] |= XHCI_EPCTX_1_CERR_SET(3);
3100 
3101 	if (xfertype == UE_CONTROL)
3102 		cp[4] = XHCI_EPCTX_4_AVG_TRB_LEN_SET(8); /* 6.2.3 */
3103 	else if (USB_IS_SS(speed))
3104 		cp[4] = XHCI_EPCTX_4_AVG_TRB_LEN_SET(mps);
3105 	else
3106 		cp[4] = XHCI_EPCTX_4_AVG_TRB_LEN_SET(UE_GET_SIZE(mps));
3107 
3108 	xhci_setup_maxburst(pipe, cp);
3109 
3110 	switch (xfertype) {
3111 	case UE_CONTROL:
3112 		break;
3113 	case UE_BULK:
3114 		/* XXX Set MaxPStreams, HID, and LSA if streams enabled */
3115 		break;
3116 	case UE_INTERRUPT:
3117 		if (pipe->up_interval != USBD_DEFAULT_INTERVAL)
3118 			ival = pipe->up_interval;
3119 
3120 		ival = xhci_bival2ival(ival, speed);
3121 		cp[0] |= XHCI_EPCTX_0_IVAL_SET(ival);
3122 		break;
3123 	case UE_ISOCHRONOUS:
3124 		if (pipe->up_interval != USBD_DEFAULT_INTERVAL)
3125 			ival = pipe->up_interval;
3126 
3127 		/* xHCI 6.2.3.6 Table 65, USB 2.0 9.6.6 */
3128 		if (speed == USB_SPEED_FULL)
3129 			ival += 3; /* 1ms -> 125us */
3130 		ival--;
3131 		cp[0] |= XHCI_EPCTX_0_IVAL_SET(ival);
3132 		break;
3133 	default:
3134 		break;
3135 	}
3136 	DPRINTFN(4, "setting ival %ju MaxBurst %#jx",
3137 	    XHCI_EPCTX_0_IVAL_GET(cp[0]), XHCI_EPCTX_1_MAXB_GET(cp[1]), 0, 0);
3138 
3139 	/* rewind TR dequeue pointer in xHC */
3140 	/* can't use xhci_ep_get_dci() yet? */
3141 	*(uint64_t *)(&cp[2]) = htole64(
3142 	    xhci_ring_trbp(xs->xs_xr[dci], 0) |
3143 	    XHCI_EPCTX_2_DCS_SET(1));
3144 
3145 	cp[0] = htole32(cp[0]);
3146 	cp[1] = htole32(cp[1]);
3147 	cp[4] = htole32(cp[4]);
3148 
3149 	/* rewind TR dequeue pointer in driver */
3150 	struct xhci_ring *xr = xs->xs_xr[dci];
3151 	mutex_enter(&xr->xr_lock);
3152 	xhci_host_dequeue(xr);
3153 	mutex_exit(&xr->xr_lock);
3154 
3155 	/* sync input contexts before they are read from memory */
3156 	usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE);
3157 }
3158 
3159 /*
3160  * Setup route string and roothub port of given device for slot context
3161  */
3162 static void
3163 xhci_setup_route(struct usbd_pipe *pipe, uint32_t *cp)
3164 {
3165 	struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
3166 	struct usbd_device *dev = pipe->up_dev;
3167 	struct usbd_port *up = dev->ud_powersrc;
3168 	struct usbd_device *hub;
3169 	struct usbd_device *adev;
3170 	uint8_t rhport = 0;
3171 	uint32_t route = 0;
3172 
3173 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3174 
3175 	/* Locate root hub port and Determine route string */
3176 	/* 4.3.3 route string does not include roothub port */
3177 	for (hub = dev; hub != NULL; hub = hub->ud_myhub) {
3178 		uint32_t dep;
3179 
3180 		DPRINTFN(4, "hub %#jx depth %jd upport %#jx upportno %jd",
3181 		    (uintptr_t)hub, hub->ud_depth, (uintptr_t)hub->ud_powersrc,
3182 		    hub->ud_powersrc ? (uintptr_t)hub->ud_powersrc->up_portno :
3183 			 -1);
3184 
3185 		if (hub->ud_powersrc == NULL)
3186 			break;
3187 		dep = hub->ud_depth;
3188 		if (dep == 0)
3189 			break;
3190 		rhport = hub->ud_powersrc->up_portno;
3191 		if (dep > USB_HUB_MAX_DEPTH)
3192 			continue;
3193 
3194 		route |=
3195 		    (rhport > UHD_SS_NPORTS_MAX ? UHD_SS_NPORTS_MAX : rhport)
3196 		    << ((dep - 1) * 4);
3197 	}
3198 	route = route >> 4;
3199 	size_t bn = hub == sc->sc_bus.ub_roothub ? 0 : 1;
3200 
3201 	/* Locate port on upstream high speed hub */
3202 	for (adev = dev, hub = up->up_parent;
3203 	     hub != NULL && hub->ud_speed != USB_SPEED_HIGH;
3204 	     adev = hub, hub = hub->ud_myhub)
3205 		;
3206 	if (hub) {
3207 		int p;
3208 		for (p = 1; p <= hub->ud_hub->uh_hubdesc.bNbrPorts; p++) {
3209 			if (hub->ud_hub->uh_ports[p - 1].up_dev == adev) {
3210 				dev->ud_myhsport = &hub->ud_hub->uh_ports[p - 1];
3211 				goto found;
3212 			}
3213 		}
3214 		panic("%s: cannot find HS port", __func__);
3215 	found:
3216 		DPRINTFN(4, "high speed port %jd", p, 0, 0, 0);
3217 	} else {
3218 		dev->ud_myhsport = NULL;
3219 	}
3220 
3221 	const size_t ctlrport = xhci_rhport2ctlrport(sc, bn, rhport);
3222 
3223 	DPRINTFN(4, "rhport %ju ctlrport %ju Route %05jx hub %#jx", rhport,
3224 	    ctlrport, route, (uintptr_t)hub);
3225 
3226 	cp[0] |= XHCI_SCTX_0_ROUTE_SET(route);
3227 	cp[1] |= XHCI_SCTX_1_RH_PORT_SET(ctlrport);
3228 }
3229 
3230 /*
3231  * Setup whether device is hub, whether device uses MTT, and
3232  * TT informations if it uses MTT.
3233  */
3234 static void
3235 xhci_setup_tthub(struct usbd_pipe *pipe, uint32_t *cp)
3236 {
3237 	struct usbd_device *dev = pipe->up_dev;
3238 	struct usbd_port *myhsport = dev->ud_myhsport;
3239 	usb_device_descriptor_t * const dd = &dev->ud_ddesc;
3240 	uint32_t speed = dev->ud_speed;
3241 	uint8_t rhaddr = dev->ud_bus->ub_rhaddr;
3242 	uint8_t tthubslot, ttportnum;
3243 	bool ishub;
3244 	bool usemtt;
3245 
3246 	XHCIHIST_FUNC();
3247 
3248 	/*
3249 	 * 6.2.2, Table 57-60, 6.2.2.1, 6.2.2.2
3250 	 * tthubslot:
3251 	 *   This is the slot ID of parent HS hub
3252 	 *   if LS/FS device is connected && connected through HS hub.
3253 	 *   This is 0 if device is not LS/FS device ||
3254 	 *   parent hub is not HS hub ||
3255 	 *   attached to root hub.
3256 	 * ttportnum:
3257 	 *   This is the downstream facing port of parent HS hub
3258 	 *   if LS/FS device is connected.
3259 	 *   This is 0 if device is not LS/FS device ||
3260 	 *   parent hub is not HS hub ||
3261 	 *   attached to root hub.
3262 	 */
3263 	if (myhsport &&
3264 	    myhsport->up_parent->ud_addr != rhaddr &&
3265 	    (speed == USB_SPEED_LOW || speed == USB_SPEED_FULL)) {
3266 		ttportnum = myhsport->up_portno;
3267 		tthubslot = myhsport->up_parent->ud_addr;
3268 	} else {
3269 		ttportnum = 0;
3270 		tthubslot = 0;
3271 	}
3272 	XHCIHIST_CALLARGS("myhsport %#jx ttportnum=%jd tthubslot=%jd",
3273 	    (uintptr_t)myhsport, ttportnum, tthubslot, 0);
3274 
3275 	/* ishub is valid after reading UDESC_DEVICE */
3276 	ishub = (dd->bDeviceClass == UDCLASS_HUB);
3277 
3278 	/* dev->ud_hub is valid after reading UDESC_HUB */
3279 	if (ishub && dev->ud_hub) {
3280 		usb_hub_descriptor_t *hd = &dev->ud_hub->uh_hubdesc;
3281 		uint8_t ttt =
3282 		    __SHIFTOUT(UGETW(hd->wHubCharacteristics), UHD_TT_THINK);
3283 
3284 		cp[1] |= XHCI_SCTX_1_NUM_PORTS_SET(hd->bNbrPorts);
3285 		cp[2] |= XHCI_SCTX_2_TT_THINK_TIME_SET(ttt);
3286 		DPRINTFN(4, "nports=%jd ttt=%jd", hd->bNbrPorts, ttt, 0, 0);
3287 	}
3288 
3289 #define IS_MTTHUB(dd) \
3290      ((dd)->bDeviceProtocol == UDPROTO_HSHUBMTT)
3291 
3292 	/*
3293 	 * MTT flag is set if
3294 	 * 1. this is HS hub && MTTs are supported and enabled;  or
3295 	 * 2. this is LS or FS device && there is a parent HS hub where MTTs
3296 	 *    are supported and enabled.
3297 	 *
3298 	 * XXX enabled is not tested yet
3299 	 */
3300 	if (ishub && speed == USB_SPEED_HIGH && IS_MTTHUB(dd))
3301 		usemtt = true;
3302 	else if ((speed == USB_SPEED_LOW || speed == USB_SPEED_FULL) &&
3303 	    myhsport &&
3304 	    myhsport->up_parent->ud_addr != rhaddr &&
3305 	    IS_MTTHUB(&myhsport->up_parent->ud_ddesc))
3306 		usemtt = true;
3307 	else
3308 		usemtt = false;
3309 	DPRINTFN(4, "class %ju proto %ju ishub %jd usemtt %jd",
3310 	    dd->bDeviceClass, dd->bDeviceProtocol, ishub, usemtt);
3311 
3312 #undef IS_MTTHUB
3313 
3314 	cp[0] |=
3315 	    XHCI_SCTX_0_HUB_SET(ishub ? 1 : 0) |
3316 	    XHCI_SCTX_0_MTT_SET(usemtt ? 1 : 0);
3317 	cp[2] |=
3318 	    XHCI_SCTX_2_TT_HUB_SID_SET(tthubslot) |
3319 	    XHCI_SCTX_2_TT_PORT_NUM_SET(ttportnum);
3320 }
3321 
3322 /* set up params for periodic endpoint */
3323 static void
3324 xhci_setup_maxburst(struct usbd_pipe *pipe, uint32_t *cp)
3325 {
3326 	struct usbd_device *dev = pipe->up_dev;
3327 	usb_endpoint_descriptor_t * const ed = pipe->up_endpoint->ue_edesc;
3328 	const uint8_t xfertype = UE_GET_XFERTYPE(ed->bmAttributes);
3329 	usbd_desc_iter_t iter;
3330 	const usb_cdc_descriptor_t *cdcd;
3331 	uint32_t maxb = 0;
3332 	uint16_t mps = UGETW(ed->wMaxPacketSize);
3333 	uint8_t speed = dev->ud_speed;
3334 	uint8_t ep;
3335 
3336 	/* config desc is NULL when opening ep0 */
3337 	if (dev == NULL || dev->ud_cdesc == NULL)
3338 		goto no_cdcd;
3339 	cdcd = (const usb_cdc_descriptor_t *)usb_find_desc(dev,
3340 	    UDESC_INTERFACE, USBD_CDCSUBTYPE_ANY);
3341 	if (cdcd == NULL)
3342 		goto no_cdcd;
3343 	usb_desc_iter_init(dev, &iter);
3344 	iter.cur = (const void *)cdcd;
3345 
3346 	/* find endpoint_ss_comp desc for ep of this pipe */
3347 	for (ep = 0;;) {
3348 		cdcd = (const usb_cdc_descriptor_t *)usb_desc_iter_next(&iter);
3349 		if (cdcd == NULL)
3350 			break;
3351 		if (ep == 0 && cdcd->bDescriptorType == UDESC_ENDPOINT) {
3352 			ep = ((const usb_endpoint_descriptor_t *)cdcd)->
3353 			    bEndpointAddress;
3354 			if (UE_GET_ADDR(ep) ==
3355 			    UE_GET_ADDR(ed->bEndpointAddress)) {
3356 				cdcd = (const usb_cdc_descriptor_t *)
3357 				    usb_desc_iter_next(&iter);
3358 				break;
3359 			}
3360 			ep = 0;
3361 		}
3362 	}
3363 	if (cdcd != NULL && cdcd->bDescriptorType == UDESC_ENDPOINT_SS_COMP) {
3364 		const usb_endpoint_ss_comp_descriptor_t * esscd =
3365 		    (const usb_endpoint_ss_comp_descriptor_t *)cdcd;
3366 		maxb = esscd->bMaxBurst;
3367 	}
3368 
3369  no_cdcd:
3370 	/* 6.2.3.4,  4.8.2.4 */
3371 	if (USB_IS_SS(speed)) {
3372 		/* USB 3.1  9.6.6 */
3373 		cp[1] |= XHCI_EPCTX_1_MAXP_SIZE_SET(mps);
3374 		/* USB 3.1  9.6.7 */
3375 		cp[1] |= XHCI_EPCTX_1_MAXB_SET(maxb);
3376 #ifdef notyet
3377 		if (xfertype == UE_ISOCHRONOUS) {
3378 		}
3379 		if (XHCI_HCC2_LEC(sc->sc_hcc2) != 0) {
3380 			/* use ESIT */
3381 			cp[4] |= XHCI_EPCTX_4_MAX_ESIT_PAYLOAD_SET(x);
3382 			cp[0] |= XHCI_EPCTX_0_MAX_ESIT_PAYLOAD_HI_SET(x);
3383 
3384 			/* XXX if LEC = 1, set ESIT instead */
3385 			cp[0] |= XHCI_EPCTX_0_MULT_SET(0);
3386 		} else {
3387 			/* use ival */
3388 		}
3389 #endif
3390 	} else {
3391 		/* USB 2.0  9.6.6 */
3392 		cp[1] |= XHCI_EPCTX_1_MAXP_SIZE_SET(UE_GET_SIZE(mps));
3393 
3394 		/* 6.2.3.4 */
3395 		if (speed == USB_SPEED_HIGH &&
3396 		   (xfertype == UE_ISOCHRONOUS || xfertype == UE_INTERRUPT)) {
3397 			maxb = UE_GET_TRANS(mps);
3398 		} else {
3399 			/* LS/FS or HS CTRL or HS BULK */
3400 			maxb = 0;
3401 		}
3402 		cp[1] |= XHCI_EPCTX_1_MAXB_SET(maxb);
3403 	}
3404 }
3405 
3406 /*
3407  * Convert endpoint bInterval value to endpoint context interval value
3408  * for Interrupt pipe.
3409  * xHCI 6.2.3.6 Table 65, USB 2.0 9.6.6
3410  */
3411 static uint32_t
3412 xhci_bival2ival(uint32_t ival, uint32_t speed)
3413 {
3414 	if (speed == USB_SPEED_LOW || speed == USB_SPEED_FULL) {
3415 		int i;
3416 
3417 		/*
3418 		 * round ival down to "the nearest base 2 multiple of
3419 		 * bInterval * 8".
3420 		 * bInterval is at most 255 as its type is uByte.
3421 		 * 255(ms) = 2040(x 125us) < 2^11, so start with 10.
3422 		 */
3423 		for (i = 10; i > 0; i--) {
3424 			if ((ival * 8) >= (1 << i))
3425 				break;
3426 		}
3427 		ival = i;
3428 	} else {
3429 		/* Interval = bInterval-1 for SS/HS */
3430 		ival--;
3431 	}
3432 
3433 	return ival;
3434 }
3435 
3436 /* ----- */
3437 
3438 static void
3439 xhci_noop(struct usbd_pipe *pipe)
3440 {
3441 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3442 }
3443 
3444 /*
3445  * Process root hub request.
3446  */
3447 static int
3448 xhci_roothub_ctrl(struct usbd_bus *bus, usb_device_request_t *req,
3449     void *buf, int buflen)
3450 {
3451 	struct xhci_softc * const sc = XHCI_BUS2SC(bus);
3452 	usb_port_status_t ps;
3453 	int l, totlen = 0;
3454 	uint16_t len, value, index;
3455 	int port, i;
3456 	uint32_t v;
3457 
3458 	XHCIHIST_FUNC();
3459 
3460 	if (sc->sc_dying)
3461 		return -1;
3462 
3463 	size_t bn = bus == &sc->sc_bus ? 0 : 1;
3464 
3465 	len = UGETW(req->wLength);
3466 	value = UGETW(req->wValue);
3467 	index = UGETW(req->wIndex);
3468 
3469 	XHCIHIST_CALLARGS("rhreq: %04jx %04jx %04jx %04jx",
3470 	    req->bmRequestType | (req->bRequest << 8), value, index, len);
3471 
3472 #define C(x,y) ((x) | ((y) << 8))
3473 	switch (C(req->bRequest, req->bmRequestType)) {
3474 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
3475 		DPRINTFN(8, "getdesc: wValue=0x%04jx", value, 0, 0, 0);
3476 		if (len == 0)
3477 			break;
3478 		switch (value) {
3479 #define sd ((usb_string_descriptor_t *)buf)
3480 		case C(2, UDESC_STRING):
3481 			/* Product */
3482 			totlen = usb_makestrdesc(sd, len, "xHCI root hub");
3483 			break;
3484 #undef sd
3485 		default:
3486 			/* default from usbroothub */
3487 			return buflen;
3488 		}
3489 		break;
3490 
3491 	/* Hub requests */
3492 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
3493 		break;
3494 	/* Clear Port Feature request */
3495 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER): {
3496 		const size_t cp = xhci_rhport2ctlrport(sc, bn, index);
3497 
3498 		DPRINTFN(4, "UR_CLEAR_PORT_FEAT bp=%jd feat=%jd bus=%jd cp=%jd",
3499 		    index, value, bn, cp);
3500 		if (index < 1 || index > sc->sc_rhportcount[bn]) {
3501 			return -1;
3502 		}
3503 		port = XHCI_PORTSC(cp);
3504 		v = xhci_op_read_4(sc, port);
3505 		DPRINTFN(4, "portsc=0x%08jx", v, 0, 0, 0);
3506 		v &= ~XHCI_PS_CLEAR;
3507 		switch (value) {
3508 		case UHF_PORT_ENABLE:
3509 			xhci_op_write_4(sc, port, v & ~XHCI_PS_PED);
3510 			break;
3511 		case UHF_PORT_SUSPEND:
3512 			return -1;
3513 		case UHF_PORT_POWER:
3514 			break;
3515 		case UHF_PORT_TEST:
3516 		case UHF_PORT_INDICATOR:
3517 			return -1;
3518 		case UHF_C_PORT_CONNECTION:
3519 			xhci_op_write_4(sc, port, v | XHCI_PS_CSC);
3520 			break;
3521 		case UHF_C_PORT_ENABLE:
3522 		case UHF_C_PORT_SUSPEND:
3523 		case UHF_C_PORT_OVER_CURRENT:
3524 			return -1;
3525 		case UHF_C_BH_PORT_RESET:
3526 			xhci_op_write_4(sc, port, v | XHCI_PS_WRC);
3527 			break;
3528 		case UHF_C_PORT_RESET:
3529 			xhci_op_write_4(sc, port, v | XHCI_PS_PRC);
3530 			break;
3531 		case UHF_C_PORT_LINK_STATE:
3532 			xhci_op_write_4(sc, port, v | XHCI_PS_PLC);
3533 			break;
3534 		case UHF_C_PORT_CONFIG_ERROR:
3535 			xhci_op_write_4(sc, port, v | XHCI_PS_CEC);
3536 			break;
3537 		default:
3538 			return -1;
3539 		}
3540 		break;
3541 	}
3542 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
3543 		if (len == 0)
3544 			break;
3545 		if ((value & 0xff) != 0) {
3546 			return -1;
3547 		}
3548 		usb_hub_descriptor_t hubd;
3549 
3550 		totlen = uimin(buflen, sizeof(hubd));
3551 		memcpy(&hubd, buf, totlen);
3552 		hubd.bNbrPorts = sc->sc_rhportcount[bn];
3553 		USETW(hubd.wHubCharacteristics, UHD_PWR_NO_SWITCH);
3554 		hubd.bPwrOn2PwrGood = 200;
3555 		for (i = 0, l = sc->sc_rhportcount[bn]; l > 0; i++, l -= 8) {
3556 			/* XXX can't find out? */
3557 			hubd.DeviceRemovable[i++] = 0;
3558 		}
3559 		hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i;
3560 		totlen = uimin(totlen, hubd.bDescLength);
3561 		memcpy(buf, &hubd, totlen);
3562 		break;
3563 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
3564 		if (len != 4) {
3565 			return -1;
3566 		}
3567 		memset(buf, 0, len); /* ? XXX */
3568 		totlen = len;
3569 		break;
3570 	/* Get Port Status request */
3571 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER): {
3572 		const size_t cp = xhci_rhport2ctlrport(sc, bn, index);
3573 
3574 		DPRINTFN(8, "get port status bn=%jd i=%jd cp=%ju",
3575 		    bn, index, cp, 0);
3576 		if (index < 1 || index > sc->sc_rhportcount[bn]) {
3577 			DPRINTFN(5, "bad get port status: index=%jd bn=%jd "
3578 				    "portcount=%jd",
3579 			    index, bn, sc->sc_rhportcount[bn], 0);
3580 			return -1;
3581 		}
3582 		if (len != 4) {
3583 			DPRINTFN(5, "bad get port status: len %jd != 4",
3584 			    len, 0, 0, 0);
3585 			return -1;
3586 		}
3587 		v = xhci_op_read_4(sc, XHCI_PORTSC(cp));
3588 		DPRINTFN(4, "getrhportsc %jd 0x%08jx", cp, v, 0, 0);
3589 		i = xhci_xspeed2psspeed(XHCI_PS_SPEED_GET(v));
3590 		if (v & XHCI_PS_CCS)	i |= UPS_CURRENT_CONNECT_STATUS;
3591 		if (v & XHCI_PS_PED)	i |= UPS_PORT_ENABLED;
3592 		if (v & XHCI_PS_OCA)	i |= UPS_OVERCURRENT_INDICATOR;
3593 		//if (v & XHCI_PS_SUSP)	i |= UPS_SUSPEND;
3594 		if (v & XHCI_PS_PR)	i |= UPS_RESET;
3595 		if (v & XHCI_PS_PP) {
3596 			if (i & UPS_OTHER_SPEED)
3597 					i |= UPS_PORT_POWER_SS;
3598 			else
3599 					i |= UPS_PORT_POWER;
3600 		}
3601 		if (i & UPS_OTHER_SPEED)
3602 			i |= UPS_PORT_LS_SET(XHCI_PS_PLS_GET(v));
3603 		if (sc->sc_vendor_port_status)
3604 			i = sc->sc_vendor_port_status(sc, v, i);
3605 		USETW(ps.wPortStatus, i);
3606 		i = 0;
3607 		if (v & XHCI_PS_CSC)    i |= UPS_C_CONNECT_STATUS;
3608 		if (v & XHCI_PS_PEC)    i |= UPS_C_PORT_ENABLED;
3609 		if (v & XHCI_PS_OCC)    i |= UPS_C_OVERCURRENT_INDICATOR;
3610 		if (v & XHCI_PS_PRC)	i |= UPS_C_PORT_RESET;
3611 		if (v & XHCI_PS_WRC)	i |= UPS_C_BH_PORT_RESET;
3612 		if (v & XHCI_PS_PLC)	i |= UPS_C_PORT_LINK_STATE;
3613 		if (v & XHCI_PS_CEC)	i |= UPS_C_PORT_CONFIG_ERROR;
3614 		USETW(ps.wPortChange, i);
3615 		totlen = uimin(len, sizeof(ps));
3616 		memcpy(buf, &ps, totlen);
3617 		DPRINTFN(5, "get port status: wPortStatus %#jx wPortChange %#jx"
3618 			    " totlen %jd",
3619 		    UGETW(ps.wPortStatus), UGETW(ps.wPortChange), totlen, 0);
3620 		break;
3621 	}
3622 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
3623 		return -1;
3624 	case C(UR_SET_HUB_DEPTH, UT_WRITE_CLASS_DEVICE):
3625 		break;
3626 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
3627 		break;
3628 	/* Set Port Feature request */
3629 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER): {
3630 		int optval = (index >> 8) & 0xff;
3631 		index &= 0xff;
3632 		if (index < 1 || index > sc->sc_rhportcount[bn]) {
3633 			return -1;
3634 		}
3635 
3636 		const size_t cp = xhci_rhport2ctlrport(sc, bn, index);
3637 
3638 		port = XHCI_PORTSC(cp);
3639 		v = xhci_op_read_4(sc, port);
3640 		DPRINTFN(4, "index %jd cp %jd portsc=0x%08jx", index, cp, v, 0);
3641 		v &= ~XHCI_PS_CLEAR;
3642 		switch (value) {
3643 		case UHF_PORT_ENABLE:
3644 			xhci_op_write_4(sc, port, v | XHCI_PS_PED);
3645 			break;
3646 		case UHF_PORT_SUSPEND:
3647 			/* XXX suspend */
3648 			break;
3649 		case UHF_PORT_RESET:
3650 			v &= ~(XHCI_PS_PED | XHCI_PS_PR);
3651 			xhci_op_write_4(sc, port, v | XHCI_PS_PR);
3652 			/* Wait for reset to complete. */
3653 			usb_delay_ms(&sc->sc_bus, USB_PORT_ROOT_RESET_DELAY);
3654 			if (sc->sc_dying) {
3655 				return -1;
3656 			}
3657 			v = xhci_op_read_4(sc, port);
3658 			if (v & XHCI_PS_PR) {
3659 				xhci_op_write_4(sc, port, v & ~XHCI_PS_PR);
3660 				usb_delay_ms(&sc->sc_bus, 10);
3661 				/* XXX */
3662 			}
3663 			break;
3664 		case UHF_PORT_POWER:
3665 			/* XXX power control */
3666 			break;
3667 		/* XXX more */
3668 		case UHF_C_PORT_RESET:
3669 			xhci_op_write_4(sc, port, v | XHCI_PS_PRC);
3670 			break;
3671 		case UHF_PORT_U1_TIMEOUT:
3672 			if (XHCI_PS_SPEED_GET(v) < XHCI_PS_SPEED_SS) {
3673 				return -1;
3674 			}
3675 			port = XHCI_PORTPMSC(cp);
3676 			v = xhci_op_read_4(sc, port);
3677 			DPRINTFN(4, "index %jd cp %jd portpmsc=0x%08jx",
3678 			    index, cp, v, 0);
3679 			v &= ~XHCI_PM3_U1TO_SET(0xff);
3680 			v |= XHCI_PM3_U1TO_SET(optval);
3681 			xhci_op_write_4(sc, port, v);
3682 			break;
3683 		case UHF_PORT_U2_TIMEOUT:
3684 			if (XHCI_PS_SPEED_GET(v) < XHCI_PS_SPEED_SS) {
3685 				return -1;
3686 			}
3687 			port = XHCI_PORTPMSC(cp);
3688 			v = xhci_op_read_4(sc, port);
3689 			DPRINTFN(4, "index %jd cp %jd portpmsc=0x%08jx",
3690 			    index, cp, v, 0);
3691 			v &= ~XHCI_PM3_U2TO_SET(0xff);
3692 			v |= XHCI_PM3_U2TO_SET(optval);
3693 			xhci_op_write_4(sc, port, v);
3694 			break;
3695 		default:
3696 			return -1;
3697 		}
3698 	}
3699 		break;
3700 	case C(UR_CLEAR_TT_BUFFER, UT_WRITE_CLASS_OTHER):
3701 	case C(UR_RESET_TT, UT_WRITE_CLASS_OTHER):
3702 	case C(UR_GET_TT_STATE, UT_READ_CLASS_OTHER):
3703 	case C(UR_STOP_TT, UT_WRITE_CLASS_OTHER):
3704 		break;
3705 	default:
3706 		/* default from usbroothub */
3707 		return buflen;
3708 	}
3709 
3710 	return totlen;
3711 }
3712 
3713 /* root hub interrupt */
3714 
3715 static usbd_status
3716 xhci_root_intr_transfer(struct usbd_xfer *xfer)
3717 {
3718 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3719 	usbd_status err;
3720 
3721 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3722 
3723 	/* Insert last in queue. */
3724 	mutex_enter(&sc->sc_lock);
3725 	err = usb_insert_transfer(xfer);
3726 	mutex_exit(&sc->sc_lock);
3727 	if (err)
3728 		return err;
3729 
3730 	/* Pipe isn't running, start first */
3731 	return xhci_root_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
3732 }
3733 
3734 /* Wait for roothub port status/change */
3735 static usbd_status
3736 xhci_root_intr_start(struct usbd_xfer *xfer)
3737 {
3738 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3739 	const size_t bn = XHCI_XFER2BUS(xfer) == &sc->sc_bus ? 0 : 1;
3740 	const bool polling = xhci_polling_p(sc);
3741 
3742 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3743 
3744 	if (sc->sc_dying)
3745 		return USBD_IOERROR;
3746 
3747 	if (!polling)
3748 		mutex_enter(&sc->sc_lock);
3749 	KASSERT(sc->sc_intrxfer[bn] == NULL);
3750 	sc->sc_intrxfer[bn] = xfer;
3751 	xfer->ux_status = USBD_IN_PROGRESS;
3752 	if (!polling)
3753 		mutex_exit(&sc->sc_lock);
3754 
3755 	return USBD_IN_PROGRESS;
3756 }
3757 
3758 static void
3759 xhci_root_intr_abort(struct usbd_xfer *xfer)
3760 {
3761 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3762 	const size_t bn = XHCI_XFER2BUS(xfer) == &sc->sc_bus ? 0 : 1;
3763 
3764 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3765 
3766 	KASSERT(mutex_owned(&sc->sc_lock));
3767 	KASSERT(xfer->ux_pipe->up_intrxfer == xfer);
3768 
3769 	/* If xfer has already completed, nothing to do here.  */
3770 	if (sc->sc_intrxfer[bn] == NULL)
3771 		return;
3772 
3773 	/*
3774 	 * Otherwise, sc->sc_intrxfer[bn] had better be this transfer.
3775 	 * Cancel it.
3776 	 */
3777 	KASSERT(sc->sc_intrxfer[bn] == xfer);
3778 	xfer->ux_status = USBD_CANCELLED;
3779 	usb_transfer_complete(xfer);
3780 }
3781 
3782 static void
3783 xhci_root_intr_close(struct usbd_pipe *pipe)
3784 {
3785 	struct xhci_softc * const sc __diagused = XHCI_PIPE2SC(pipe);
3786 	const struct usbd_xfer *xfer __diagused = pipe->up_intrxfer;
3787 	const size_t bn __diagused = XHCI_XFER2BUS(xfer) == &sc->sc_bus ? 0 : 1;
3788 
3789 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3790 
3791 	KASSERT(mutex_owned(&sc->sc_lock));
3792 
3793 	/*
3794 	 * Caller must guarantee the xfer has completed first, by
3795 	 * closing the pipe only after normal completion or an abort.
3796 	 */
3797 	KASSERT(sc->sc_intrxfer[bn] == NULL);
3798 }
3799 
3800 static void
3801 xhci_root_intr_done(struct usbd_xfer *xfer)
3802 {
3803 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3804 	const size_t bn = XHCI_XFER2BUS(xfer) == &sc->sc_bus ? 0 : 1;
3805 
3806 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3807 
3808 	KASSERT(mutex_owned(&sc->sc_lock));
3809 
3810 	/* Claim the xfer so it doesn't get completed again.  */
3811 	KASSERT(sc->sc_intrxfer[bn] == xfer);
3812 	KASSERT(xfer->ux_status != USBD_IN_PROGRESS);
3813 	sc->sc_intrxfer[bn] = NULL;
3814 }
3815 
3816 /* -------------- */
3817 /* device control */
3818 
3819 static usbd_status
3820 xhci_device_ctrl_transfer(struct usbd_xfer *xfer)
3821 {
3822 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3823 	usbd_status err;
3824 
3825 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3826 
3827 	/* Insert last in queue. */
3828 	mutex_enter(&sc->sc_lock);
3829 	err = usb_insert_transfer(xfer);
3830 	mutex_exit(&sc->sc_lock);
3831 	if (err)
3832 		return err;
3833 
3834 	/* Pipe isn't running, start first */
3835 	return xhci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
3836 }
3837 
3838 static usbd_status
3839 xhci_device_ctrl_start(struct usbd_xfer *xfer)
3840 {
3841 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3842 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
3843 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
3844 	struct xhci_ring * const tr = xs->xs_xr[dci];
3845 	struct xhci_xfer * const xx = XHCI_XFER2XXFER(xfer);
3846 	usb_device_request_t * const req = &xfer->ux_request;
3847 	const int isread = usbd_xfer_isread(xfer);
3848 	const uint32_t len = UGETW(req->wLength);
3849 	usb_dma_t * const dma = &xfer->ux_dmabuf;
3850 	uint64_t parameter;
3851 	uint32_t status;
3852 	uint32_t control;
3853 	u_int i;
3854 	const bool polling = xhci_polling_p(sc);
3855 
3856 	XHCIHIST_FUNC();
3857 	XHCIHIST_CALLARGS("req: %04jx %04jx %04jx %04jx",
3858 	    req->bmRequestType | (req->bRequest << 8), UGETW(req->wValue),
3859 	    UGETW(req->wIndex), UGETW(req->wLength));
3860 
3861 	/* we rely on the bottom bits for extra info */
3862 	KASSERTMSG(((uintptr_t)xfer & 0x3) == 0x0, "xfer %zx",
3863 	    (uintptr_t) xfer);
3864 
3865 	KASSERT((xfer->ux_rqflags & URQ_REQUEST) != 0);
3866 
3867 	i = 0;
3868 
3869 	/* setup phase */
3870 	memcpy(&parameter, req, sizeof(parameter));
3871 	status = XHCI_TRB_2_IRQ_SET(0) | XHCI_TRB_2_BYTES_SET(sizeof(*req));
3872 	control = ((len == 0) ? XHCI_TRB_3_TRT_NONE :
3873 	     (isread ? XHCI_TRB_3_TRT_IN : XHCI_TRB_3_TRT_OUT)) |
3874 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_SETUP_STAGE) |
3875 	    XHCI_TRB_3_IDT_BIT;
3876 	/* we need parameter un-swapped on big endian, so pre-swap it here */
3877 	xhci_soft_trb_put(&xx->xx_trb[i++], htole64(parameter), status, control);
3878 
3879 	if (len != 0) {
3880 		/* data phase */
3881 		parameter = DMAADDR(dma, 0);
3882 		KASSERTMSG(len <= 0x10000, "len %d", len);
3883 		status = XHCI_TRB_2_IRQ_SET(0) |
3884 		    XHCI_TRB_2_TDSZ_SET(0) |
3885 		    XHCI_TRB_2_BYTES_SET(len);
3886 		control = (isread ? XHCI_TRB_3_DIR_IN : 0) |
3887 		    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_DATA_STAGE) |
3888 		    (usbd_xfer_isread(xfer) ? XHCI_TRB_3_ISP_BIT : 0) |
3889 		    XHCI_TRB_3_IOC_BIT;
3890 		xhci_soft_trb_put(&xx->xx_trb[i++], parameter, status, control);
3891 	}
3892 
3893 	parameter = 0;
3894 	status = XHCI_TRB_2_IRQ_SET(0);
3895 	/* the status stage has inverted direction */
3896 	control = ((isread && (len > 0)) ? 0 : XHCI_TRB_3_DIR_IN) |
3897 	    XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_STATUS_STAGE) |
3898 	    XHCI_TRB_3_IOC_BIT;
3899 	xhci_soft_trb_put(&xx->xx_trb[i++], parameter, status, control);
3900 
3901 	if (!polling)
3902 		mutex_enter(&tr->xr_lock);
3903 	xhci_ring_put(sc, tr, xfer, xx->xx_trb, i);
3904 	if (!polling)
3905 		mutex_exit(&tr->xr_lock);
3906 
3907 	if (!polling)
3908 		mutex_enter(&sc->sc_lock);
3909 	xfer->ux_status = USBD_IN_PROGRESS;
3910 	xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci);
3911 	usbd_xfer_schedule_timeout(xfer);
3912 	if (!polling)
3913 		mutex_exit(&sc->sc_lock);
3914 
3915 	return USBD_IN_PROGRESS;
3916 }
3917 
3918 static void
3919 xhci_device_ctrl_done(struct usbd_xfer *xfer)
3920 {
3921 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3922 	usb_device_request_t *req = &xfer->ux_request;
3923 	int len = UGETW(req->wLength);
3924 	int rd = req->bmRequestType & UT_READ;
3925 
3926 	if (len)
3927 		usb_syncmem(&xfer->ux_dmabuf, 0, len,
3928 		    rd ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
3929 }
3930 
3931 static void
3932 xhci_device_ctrl_abort(struct usbd_xfer *xfer)
3933 {
3934 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3935 
3936 	usbd_xfer_abort(xfer);
3937 }
3938 
3939 static void
3940 xhci_device_ctrl_close(struct usbd_pipe *pipe)
3941 {
3942 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3943 
3944 	xhci_close_pipe(pipe);
3945 }
3946 
3947 /* ------------------ */
3948 /* device isochronous */
3949 
3950 /* ----------- */
3951 /* device bulk */
3952 
3953 static usbd_status
3954 xhci_device_bulk_transfer(struct usbd_xfer *xfer)
3955 {
3956 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3957 	usbd_status err;
3958 
3959 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
3960 
3961 	/* Insert last in queue. */
3962 	mutex_enter(&sc->sc_lock);
3963 	err = usb_insert_transfer(xfer);
3964 	mutex_exit(&sc->sc_lock);
3965 	if (err)
3966 		return err;
3967 
3968 	/*
3969 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
3970 	 * so start it first.
3971 	 */
3972 	return xhci_device_bulk_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
3973 }
3974 
3975 static usbd_status
3976 xhci_device_bulk_start(struct usbd_xfer *xfer)
3977 {
3978 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
3979 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
3980 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
3981 	struct xhci_ring * const tr = xs->xs_xr[dci];
3982 	struct xhci_xfer * const xx = XHCI_XFER2XXFER(xfer);
3983 	const uint32_t len = xfer->ux_length;
3984 	usb_dma_t * const dma = &xfer->ux_dmabuf;
3985 	uint64_t parameter;
3986 	uint32_t status;
3987 	uint32_t control;
3988 	u_int i = 0;
3989 	const bool polling = xhci_polling_p(sc);
3990 
3991 	XHCIHIST_FUNC();
3992 	XHCIHIST_CALLARGS("%#jx slot %ju dci %ju",
3993 	    (uintptr_t)xfer, xs->xs_idx, dci, 0);
3994 
3995 	if (sc->sc_dying)
3996 		return USBD_IOERROR;
3997 
3998 	KASSERT((xfer->ux_rqflags & URQ_REQUEST) == 0);
3999 
4000 	parameter = DMAADDR(dma, 0);
4001 	/*
4002 	 * XXX: (dsl) The physical buffer must not cross a 64k boundary.
4003 	 * If the user supplied buffer crosses such a boundary then 2
4004 	 * (or more) TRB should be used.
4005 	 * If multiple TRB are used the td_size field must be set correctly.
4006 	 * For v1.0 devices (like ivy bridge) this is the number of usb data
4007 	 * blocks needed to complete the transfer.
4008 	 * Setting it to 1 in the last TRB causes an extra zero-length
4009 	 * data block be sent.
4010 	 * The earlier documentation differs, I don't know how it behaves.
4011 	 */
4012 	KASSERTMSG(len <= 0x10000, "len %d", len);
4013 	status = XHCI_TRB_2_IRQ_SET(0) |
4014 	    XHCI_TRB_2_TDSZ_SET(0) |
4015 	    XHCI_TRB_2_BYTES_SET(len);
4016 	control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_NORMAL) |
4017 	    (usbd_xfer_isread(xfer) ? XHCI_TRB_3_ISP_BIT : 0) |
4018 	    XHCI_TRB_3_IOC_BIT;
4019 	xhci_soft_trb_put(&xx->xx_trb[i++], parameter, status, control);
4020 
4021 	if (!polling)
4022 		mutex_enter(&tr->xr_lock);
4023 	xhci_ring_put(sc, tr, xfer, xx->xx_trb, i);
4024 	if (!polling)
4025 		mutex_exit(&tr->xr_lock);
4026 
4027 	if (!polling)
4028 		mutex_enter(&sc->sc_lock);
4029 	xfer->ux_status = USBD_IN_PROGRESS;
4030 	xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci);
4031 	usbd_xfer_schedule_timeout(xfer);
4032 	if (!polling)
4033 		mutex_exit(&sc->sc_lock);
4034 
4035 	return USBD_IN_PROGRESS;
4036 }
4037 
4038 static void
4039 xhci_device_bulk_done(struct usbd_xfer *xfer)
4040 {
4041 #ifdef USB_DEBUG
4042 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
4043 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
4044 #endif
4045 	const int isread = usbd_xfer_isread(xfer);
4046 
4047 	XHCIHIST_FUNC();
4048 	XHCIHIST_CALLARGS("%#jx slot %ju dci %ju",
4049 	    (uintptr_t)xfer, xs->xs_idx, dci, 0);
4050 
4051 	usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
4052 	    isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
4053 }
4054 
4055 static void
4056 xhci_device_bulk_abort(struct usbd_xfer *xfer)
4057 {
4058 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
4059 
4060 	usbd_xfer_abort(xfer);
4061 }
4062 
4063 static void
4064 xhci_device_bulk_close(struct usbd_pipe *pipe)
4065 {
4066 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
4067 
4068 	xhci_close_pipe(pipe);
4069 }
4070 
4071 /* ---------------- */
4072 /* device interrupt */
4073 
4074 static usbd_status
4075 xhci_device_intr_transfer(struct usbd_xfer *xfer)
4076 {
4077 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
4078 	usbd_status err;
4079 
4080 	XHCIHIST_FUNC(); XHCIHIST_CALLED();
4081 
4082 	/* Insert last in queue. */
4083 	mutex_enter(&sc->sc_lock);
4084 	err = usb_insert_transfer(xfer);
4085 	mutex_exit(&sc->sc_lock);
4086 	if (err)
4087 		return err;
4088 
4089 	/*
4090 	 * Pipe isn't running (otherwise err would be USBD_INPROG),
4091 	 * so start it first.
4092 	 */
4093 	return xhci_device_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
4094 }
4095 
4096 static usbd_status
4097 xhci_device_intr_start(struct usbd_xfer *xfer)
4098 {
4099 	struct xhci_softc * const sc = XHCI_XFER2SC(xfer);
4100 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
4101 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
4102 	struct xhci_ring * const tr = xs->xs_xr[dci];
4103 	struct xhci_xfer * const xx = XHCI_XFER2XXFER(xfer);
4104 	const uint32_t len = xfer->ux_length;
4105 	const bool polling = xhci_polling_p(sc);
4106 	usb_dma_t * const dma = &xfer->ux_dmabuf;
4107 	uint64_t parameter;
4108 	uint32_t status;
4109 	uint32_t control;
4110 	u_int i = 0;
4111 
4112 	XHCIHIST_FUNC();
4113 	XHCIHIST_CALLARGS("%#jx slot %ju dci %ju",
4114 	    (uintptr_t)xfer, xs->xs_idx, dci, 0);
4115 
4116 	if (sc->sc_dying)
4117 		return USBD_IOERROR;
4118 
4119 	KASSERT((xfer->ux_rqflags & URQ_REQUEST) == 0);
4120 
4121 	parameter = DMAADDR(dma, 0);
4122 	KASSERTMSG(len <= 0x10000, "len %d", len);
4123 	status = XHCI_TRB_2_IRQ_SET(0) |
4124 	    XHCI_TRB_2_TDSZ_SET(0) |
4125 	    XHCI_TRB_2_BYTES_SET(len);
4126 	control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_NORMAL) |
4127 	    (usbd_xfer_isread(xfer) ? XHCI_TRB_3_ISP_BIT : 0) |
4128 	    XHCI_TRB_3_IOC_BIT;
4129 	xhci_soft_trb_put(&xx->xx_trb[i++], parameter, status, control);
4130 
4131 	if (!polling)
4132 		mutex_enter(&tr->xr_lock);
4133 	xhci_ring_put(sc, tr, xfer, xx->xx_trb, i);
4134 	if (!polling)
4135 		mutex_exit(&tr->xr_lock);
4136 
4137 	if (!polling)
4138 		mutex_enter(&sc->sc_lock);
4139 	xfer->ux_status = USBD_IN_PROGRESS;
4140 	xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci);
4141 	usbd_xfer_schedule_timeout(xfer);
4142 	if (!polling)
4143 		mutex_exit(&sc->sc_lock);
4144 
4145 	return USBD_IN_PROGRESS;
4146 }
4147 
4148 static void
4149 xhci_device_intr_done(struct usbd_xfer *xfer)
4150 {
4151 	struct xhci_softc * const sc __diagused = XHCI_XFER2SC(xfer);
4152 #ifdef USB_DEBUG
4153 	struct xhci_slot * const xs = xfer->ux_pipe->up_dev->ud_hcpriv;
4154 	const u_int dci = xhci_ep_get_dci(xfer->ux_pipe->up_endpoint->ue_edesc);
4155 #endif
4156 	const int isread = usbd_xfer_isread(xfer);
4157 
4158 	XHCIHIST_FUNC();
4159 	XHCIHIST_CALLARGS("%#jx slot %ju dci %ju",
4160 	    (uintptr_t)xfer, xs->xs_idx, dci, 0);
4161 
4162 	KASSERT(xhci_polling_p(sc) || mutex_owned(&sc->sc_lock));
4163 
4164 	usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
4165 	    isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
4166 }
4167 
4168 static void
4169 xhci_device_intr_abort(struct usbd_xfer *xfer)
4170 {
4171 	struct xhci_softc * const sc __diagused = XHCI_XFER2SC(xfer);
4172 
4173 	XHCIHIST_FUNC();
4174 	XHCIHIST_CALLARGS("%#jx", (uintptr_t)xfer, 0, 0, 0);
4175 
4176 	KASSERT(mutex_owned(&sc->sc_lock));
4177 	KASSERT(xfer->ux_pipe->up_intrxfer == xfer);
4178 	usbd_xfer_abort(xfer);
4179 }
4180 
4181 static void
4182 xhci_device_intr_close(struct usbd_pipe *pipe)
4183 {
4184 	//struct xhci_softc * const sc = XHCI_PIPE2SC(pipe);
4185 
4186 	XHCIHIST_FUNC();
4187 	XHCIHIST_CALLARGS("%#jx", (uintptr_t)pipe, 0, 0, 0);
4188 
4189 	xhci_close_pipe(pipe);
4190 }
4191