xref: /netbsd-src/sys/dev/usb/uhci.c (revision 31ba85814f82602aa0fcef3bbba737b5dbbb3f38)
1 /*	$NetBSD: uhci.c,v 1.319 2024/10/06 14:08:58 jakllsch Exp $	*/
2 
3 /*
4  * Copyright (c) 1998, 2004, 2011, 2012, 2016, 2020 The NetBSD Foundation, Inc.
5  * All rights reserved.
6  *
7  * This code is derived from software contributed to The NetBSD Foundation
8  * by Lennart Augustsson (lennart@augustsson.net) at
9  * Carlstedt Research & Technology, Jared D. McNeill (jmcneill@invisible.ca),
10  * Matthew R. Green (mrg@eterna23.net) and Nick Hudson.
11  *
12  * Redistribution and use in source and binary forms, with or without
13  * modification, are permitted provided that the following conditions
14  * are met:
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer.
17  * 2. Redistributions in binary form must reproduce the above copyright
18  *    notice, this list of conditions and the following disclaimer in the
19  *    documentation and/or other materials provided with the distribution.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
22  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
25  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
26  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
27  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
28  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
29  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31  * POSSIBILITY OF SUCH DAMAGE.
32  */
33 
34 /*
35  * USB Universal Host Controller driver.
36  * Handles e.g. PIIX3 and PIIX4.
37  *
38  * UHCI spec: http://www.intel.com/technology/usb/spec.htm
39  * USB spec: http://www.usb.org/developers/docs/
40  * PIIXn spec: ftp://download.intel.com/design/intarch/datashts/29055002.pdf
41  *             ftp://download.intel.com/design/intarch/datashts/29056201.pdf
42  */
43 
44 #include <sys/cdefs.h>
45 __KERNEL_RCSID(0, "$NetBSD: uhci.c,v 1.319 2024/10/06 14:08:58 jakllsch Exp $");
46 
47 #ifdef _KERNEL_OPT
48 #include "opt_usb.h"
49 #endif
50 
51 #include <sys/param.h>
52 
53 #include <sys/bus.h>
54 #include <sys/cpu.h>
55 #include <sys/device.h>
56 #include <sys/kernel.h>
57 #include <sys/kmem.h>
58 #include <sys/mutex.h>
59 #include <sys/proc.h>
60 #include <sys/queue.h>
61 #include <sys/select.h>
62 #include <sys/sysctl.h>
63 #include <sys/systm.h>
64 
65 #include <machine/endian.h>
66 
67 #include <dev/usb/usb.h>
68 #include <dev/usb/usbdi.h>
69 #include <dev/usb/usbdivar.h>
70 #include <dev/usb/usb_mem.h>
71 
72 #include <dev/usb/uhcireg.h>
73 #include <dev/usb/uhcivar.h>
74 #include <dev/usb/usbroothub.h>
75 #include <dev/usb/usbhist.h>
76 
77 /* Use bandwidth reclamation for control transfers. Some devices choke on it. */
78 /*#define UHCI_CTL_LOOP */
79 
80 #ifdef UHCI_DEBUG
81 uhci_softc_t *thesc;
82 int uhcinoloop = 0;
83 #endif
84 
85 #ifdef USB_DEBUG
86 #ifndef UHCI_DEBUG
87 #define uhcidebug 0
88 #else
89 static int uhcidebug = 0;
90 
91 SYSCTL_SETUP(sysctl_hw_uhci_setup, "sysctl hw.uhci setup")
92 {
93 	int err;
94 	const struct sysctlnode *rnode;
95 	const struct sysctlnode *cnode;
96 
97 	err = sysctl_createv(clog, 0, NULL, &rnode,
98 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "uhci",
99 	    SYSCTL_DESCR("uhci global controls"),
100 	    NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
101 
102 	if (err)
103 		goto fail;
104 
105 	/* control debugging printfs */
106 	err = sysctl_createv(clog, 0, &rnode, &cnode,
107 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
108 	    "debug", SYSCTL_DESCR("Enable debugging output"),
109 	    NULL, 0, &uhcidebug, sizeof(uhcidebug), CTL_CREATE, CTL_EOL);
110 	if (err)
111 		goto fail;
112 
113 	return;
114 fail:
115 	aprint_error("%s: sysctl_createv failed (err = %d)\n", __func__, err);
116 }
117 
118 #endif /* UHCI_DEBUG */
119 #endif /* USB_DEBUG */
120 
121 #define	DPRINTF(FMT,A,B,C,D)	USBHIST_LOGN(uhcidebug,1,FMT,A,B,C,D)
122 #define	DPRINTFN(N,FMT,A,B,C,D)	USBHIST_LOGN(uhcidebug,N,FMT,A,B,C,D)
123 #define	UHCIHIST_FUNC()		USBHIST_FUNC()
124 #define	UHCIHIST_CALLED(name)	USBHIST_CALLED(uhcidebug)
125 
126 /*
127  * The UHCI controller is little endian, so on big endian machines
128  * the data stored in memory needs to be swapped.
129  */
130 
131 struct uhci_pipe {
132 	struct usbd_pipe pipe;
133 	int nexttoggle;
134 
135 	u_char aborting;
136 	struct usbd_xfer *abortstart, abortend;
137 
138 	/* Info needed for different pipe kinds. */
139 	union {
140 		/* Control pipe */
141 		struct {
142 			uhci_soft_qh_t *sqh;
143 			usb_dma_t reqdma;
144 			uhci_soft_td_t *setup;
145 			uhci_soft_td_t *stat;
146 		} ctrl;
147 		/* Interrupt pipe */
148 		struct {
149 			int npoll;
150 			uhci_soft_qh_t **qhs;
151 		} intr;
152 		/* Bulk pipe */
153 		struct {
154 			uhci_soft_qh_t *sqh;
155 		} bulk;
156 		/* Isochronous pipe */
157 		struct isoc {
158 			uhci_soft_td_t **stds;
159 			int next, inuse;
160 		} isoc;
161 	};
162 };
163 
164 typedef TAILQ_HEAD(ux_completeq, uhci_xfer) ux_completeq_t;
165 
166 Static void		uhci_globalreset(uhci_softc_t *);
167 Static usbd_status	uhci_portreset(uhci_softc_t*, int);
168 Static void		uhci_reset(uhci_softc_t *);
169 Static usbd_status	uhci_run(uhci_softc_t *, int);
170 Static uhci_soft_td_t  *uhci_alloc_std(uhci_softc_t *);
171 Static void		uhci_free_std(uhci_softc_t *, uhci_soft_td_t *);
172 Static void		uhci_free_std_locked(uhci_softc_t *, uhci_soft_td_t *);
173 Static uhci_soft_qh_t  *uhci_alloc_sqh(uhci_softc_t *);
174 Static void		uhci_free_sqh(uhci_softc_t *, uhci_soft_qh_t *);
175 #if 0
176 Static void		uhci_enter_ctl_q(uhci_softc_t *, uhci_soft_qh_t *,
177 			    uhci_intr_info_t *);
178 Static void		uhci_exit_ctl_q(uhci_softc_t *, uhci_soft_qh_t *);
179 #endif
180 
181 #if 0
182 Static void		uhci_free_std_chain(uhci_softc_t *, uhci_soft_td_t *,
183 			    uhci_soft_td_t *);
184 #endif
185 Static int		uhci_alloc_std_chain(uhci_softc_t *, struct usbd_xfer *,
186 			    int, int, uhci_soft_td_t **);
187 Static void		uhci_free_stds(uhci_softc_t *, struct uhci_xfer *);
188 
189 Static void		uhci_reset_std_chain(uhci_softc_t *, struct usbd_xfer *,
190 			    int, int, int *, uhci_soft_td_t **);
191 
192 Static void		uhci_poll_hub(void *);
193 Static void		uhci_check_intr(uhci_softc_t *, struct uhci_xfer *,
194 			    ux_completeq_t *);
195 Static void		uhci_idone(struct uhci_xfer *, ux_completeq_t *);
196 
197 Static void		uhci_abortx(struct usbd_xfer *);
198 
199 Static void		uhci_add_ls_ctrl(uhci_softc_t *, uhci_soft_qh_t *);
200 Static void		uhci_add_hs_ctrl(uhci_softc_t *, uhci_soft_qh_t *);
201 Static void		uhci_add_bulk(uhci_softc_t *, uhci_soft_qh_t *);
202 Static void		uhci_remove_ls_ctrl(uhci_softc_t *,uhci_soft_qh_t *);
203 Static void		uhci_remove_hs_ctrl(uhci_softc_t *,uhci_soft_qh_t *);
204 Static void		uhci_remove_bulk(uhci_softc_t *,uhci_soft_qh_t *);
205 Static void		uhci_add_loop(uhci_softc_t *);
206 Static void		uhci_rem_loop(uhci_softc_t *);
207 
208 Static usbd_status	uhci_setup_isoc(struct usbd_pipe *);
209 
210 Static struct usbd_xfer *
211 			uhci_allocx(struct usbd_bus *, unsigned int);
212 Static void		uhci_freex(struct usbd_bus *, struct usbd_xfer *);
213 Static bool		uhci_dying(struct usbd_bus *);
214 Static void		uhci_get_lock(struct usbd_bus *, kmutex_t **);
215 Static int		uhci_roothub_ctrl(struct usbd_bus *,
216 			    usb_device_request_t *, void *, int);
217 
218 Static int		uhci_device_ctrl_init(struct usbd_xfer *);
219 Static void		uhci_device_ctrl_fini(struct usbd_xfer *);
220 Static usbd_status	uhci_device_ctrl_transfer(struct usbd_xfer *);
221 Static usbd_status	uhci_device_ctrl_start(struct usbd_xfer *);
222 Static void		uhci_device_ctrl_abort(struct usbd_xfer *);
223 Static void		uhci_device_ctrl_close(struct usbd_pipe *);
224 Static void		uhci_device_ctrl_done(struct usbd_xfer *);
225 
226 Static int		uhci_device_intr_init(struct usbd_xfer *);
227 Static void		uhci_device_intr_fini(struct usbd_xfer *);
228 Static usbd_status	uhci_device_intr_transfer(struct usbd_xfer *);
229 Static usbd_status	uhci_device_intr_start(struct usbd_xfer *);
230 Static void		uhci_device_intr_abort(struct usbd_xfer *);
231 Static void		uhci_device_intr_close(struct usbd_pipe *);
232 Static void		uhci_device_intr_done(struct usbd_xfer *);
233 
234 Static int		uhci_device_bulk_init(struct usbd_xfer *);
235 Static void		uhci_device_bulk_fini(struct usbd_xfer *);
236 Static usbd_status	uhci_device_bulk_transfer(struct usbd_xfer *);
237 Static usbd_status	uhci_device_bulk_start(struct usbd_xfer *);
238 Static void		uhci_device_bulk_abort(struct usbd_xfer *);
239 Static void		uhci_device_bulk_close(struct usbd_pipe *);
240 Static void		uhci_device_bulk_done(struct usbd_xfer *);
241 
242 Static int		uhci_device_isoc_init(struct usbd_xfer *);
243 Static void		uhci_device_isoc_fini(struct usbd_xfer *);
244 Static usbd_status	uhci_device_isoc_transfer(struct usbd_xfer *);
245 Static void		uhci_device_isoc_abort(struct usbd_xfer *);
246 Static void		uhci_device_isoc_close(struct usbd_pipe *);
247 Static void		uhci_device_isoc_done(struct usbd_xfer *);
248 
249 Static usbd_status	uhci_root_intr_transfer(struct usbd_xfer *);
250 Static usbd_status	uhci_root_intr_start(struct usbd_xfer *);
251 Static void		uhci_root_intr_abort(struct usbd_xfer *);
252 Static void		uhci_root_intr_close(struct usbd_pipe *);
253 Static void		uhci_root_intr_done(struct usbd_xfer *);
254 
255 Static usbd_status	uhci_open(struct usbd_pipe *);
256 Static void		uhci_poll(struct usbd_bus *);
257 Static void		uhci_softintr(void *);
258 
259 Static void		uhci_add_intr(uhci_softc_t *, uhci_soft_qh_t *);
260 Static void		uhci_remove_intr(uhci_softc_t *, uhci_soft_qh_t *);
261 Static usbd_status	uhci_device_setintr(uhci_softc_t *,
262 			    struct uhci_pipe *, int);
263 
264 Static void		uhci_device_clear_toggle(struct usbd_pipe *);
265 Static void		uhci_noop(struct usbd_pipe *);
266 
267 static inline uhci_soft_qh_t *
268 			uhci_find_prev_qh(uhci_soft_qh_t *, uhci_soft_qh_t *);
269 
270 #ifdef UHCI_DEBUG
271 Static void		uhci_dump_all(uhci_softc_t *);
272 Static void		uhci_dumpregs(uhci_softc_t *);
273 Static void		uhci_dump_qhs(uhci_soft_qh_t *);
274 Static void		uhci_dump_qh(uhci_soft_qh_t *);
275 Static void		uhci_dump_tds(uhci_soft_td_t *);
276 Static void		uhci_dump_td(uhci_soft_td_t *);
277 Static void		uhci_dump_ii(struct uhci_xfer *);
278 void			uhci_dump(void);
279 #endif
280 
281 #define UBARR(sc) bus_space_barrier((sc)->iot, (sc)->ioh, 0, (sc)->sc_size, \
282 			BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE)
283 #define UWRITE1(sc, r, x) \
284  do { UBARR(sc); bus_space_write_1((sc)->iot, (sc)->ioh, (r), (x)); \
285  } while (/*CONSTCOND*/0)
286 #define UWRITE2(sc, r, x) \
287  do { UBARR(sc); bus_space_write_2((sc)->iot, (sc)->ioh, (r), (x)); \
288  } while (/*CONSTCOND*/0)
289 #define UWRITE4(sc, r, x) \
290  do { UBARR(sc); bus_space_write_4((sc)->iot, (sc)->ioh, (r), (x)); \
291  } while (/*CONSTCOND*/0)
292 
293 static __inline uint8_t
294 UREAD1(uhci_softc_t *sc, bus_size_t r)
295 {
296 
297 	UBARR(sc);
298 	return bus_space_read_1(sc->iot, sc->ioh, r);
299 }
300 
301 static __inline uint16_t
302 UREAD2(uhci_softc_t *sc, bus_size_t r)
303 {
304 
305 	UBARR(sc);
306 	return bus_space_read_2(sc->iot, sc->ioh, r);
307 }
308 
309 #ifdef UHCI_DEBUG
310 static __inline uint32_t
311 UREAD4(uhci_softc_t *sc, bus_size_t r)
312 {
313 
314 	UBARR(sc);
315 	return bus_space_read_4(sc->iot, sc->ioh, r);
316 }
317 #endif
318 
319 #define UHCICMD(sc, cmd) UWRITE2(sc, UHCI_CMD, cmd)
320 #define UHCISTS(sc) UREAD2(sc, UHCI_STS)
321 
322 #define UHCI_RESET_TIMEOUT 100	/* ms, reset timeout */
323 
324 #define UHCI_CURFRAME(sc) (UREAD2(sc, UHCI_FRNUM) & UHCI_FRNUM_MASK)
325 
326 const struct usbd_bus_methods uhci_bus_methods = {
327 	.ubm_open =	uhci_open,
328 	.ubm_softint =	uhci_softintr,
329 	.ubm_dopoll =	uhci_poll,
330 	.ubm_allocx =	uhci_allocx,
331 	.ubm_freex =	uhci_freex,
332 	.ubm_abortx =	uhci_abortx,
333 	.ubm_dying =	uhci_dying,
334 	.ubm_getlock =	uhci_get_lock,
335 	.ubm_rhctrl =	uhci_roothub_ctrl,
336 };
337 
338 const struct usbd_pipe_methods uhci_root_intr_methods = {
339 	.upm_transfer =	uhci_root_intr_transfer,
340 	.upm_start =	uhci_root_intr_start,
341 	.upm_abort =	uhci_root_intr_abort,
342 	.upm_close =	uhci_root_intr_close,
343 	.upm_cleartoggle =	uhci_noop,
344 	.upm_done =	uhci_root_intr_done,
345 };
346 
347 const struct usbd_pipe_methods uhci_device_ctrl_methods = {
348 	.upm_init =	uhci_device_ctrl_init,
349 	.upm_fini =	uhci_device_ctrl_fini,
350 	.upm_transfer =	uhci_device_ctrl_transfer,
351 	.upm_start =	uhci_device_ctrl_start,
352 	.upm_abort =	uhci_device_ctrl_abort,
353 	.upm_close =	uhci_device_ctrl_close,
354 	.upm_cleartoggle =	uhci_noop,
355 	.upm_done =	uhci_device_ctrl_done,
356 };
357 
358 const struct usbd_pipe_methods uhci_device_intr_methods = {
359 	.upm_init =	uhci_device_intr_init,
360 	.upm_fini =	uhci_device_intr_fini,
361 	.upm_transfer =	uhci_device_intr_transfer,
362 	.upm_start =	uhci_device_intr_start,
363 	.upm_abort =	uhci_device_intr_abort,
364 	.upm_close =	uhci_device_intr_close,
365 	.upm_cleartoggle =	uhci_device_clear_toggle,
366 	.upm_done =	uhci_device_intr_done,
367 };
368 
369 const struct usbd_pipe_methods uhci_device_bulk_methods = {
370 	.upm_init =	uhci_device_bulk_init,
371 	.upm_fini =	uhci_device_bulk_fini,
372 	.upm_transfer =	uhci_device_bulk_transfer,
373 	.upm_start =	uhci_device_bulk_start,
374 	.upm_abort =	uhci_device_bulk_abort,
375 	.upm_close =	uhci_device_bulk_close,
376 	.upm_cleartoggle =	uhci_device_clear_toggle,
377 	.upm_done =	uhci_device_bulk_done,
378 };
379 
380 const struct usbd_pipe_methods uhci_device_isoc_methods = {
381 	.upm_init =	uhci_device_isoc_init,
382 	.upm_fini =	uhci_device_isoc_fini,
383 	.upm_transfer =	uhci_device_isoc_transfer,
384 	.upm_abort =	uhci_device_isoc_abort,
385 	.upm_close =	uhci_device_isoc_close,
386 	.upm_cleartoggle =	uhci_noop,
387 	.upm_done =	uhci_device_isoc_done,
388 };
389 
390 static inline void
391 uhci_add_intr_list(uhci_softc_t *sc, struct uhci_xfer *ux)
392 {
393 
394 	TAILQ_INSERT_TAIL(&sc->sc_intrhead, ux, ux_list);
395 }
396 
397 static inline void
398 uhci_del_intr_list(uhci_softc_t *sc, struct uhci_xfer *ux)
399 {
400 
401 	TAILQ_REMOVE(&sc->sc_intrhead, ux, ux_list);
402 }
403 
404 static inline uhci_soft_qh_t *
405 uhci_find_prev_qh(uhci_soft_qh_t *pqh, uhci_soft_qh_t *sqh)
406 {
407 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
408 	DPRINTFN(15, "pqh=%#jx sqh=%#jx", (uintptr_t)pqh, (uintptr_t)sqh, 0, 0);
409 
410 	for (; pqh->hlink != sqh; pqh = pqh->hlink) {
411 #if defined(DIAGNOSTIC) || defined(UHCI_DEBUG)
412 		usb_syncmem(&pqh->dma,
413 		    pqh->offs + offsetof(uhci_qh_t, qh_hlink),
414 		    sizeof(pqh->qh.qh_hlink),
415 		    BUS_DMASYNC_POSTWRITE);
416 		if (le32toh(pqh->qh.qh_hlink) & UHCI_PTR_T) {
417 			printf("%s: QH not found\n", __func__);
418 			return NULL;
419 		}
420 #endif
421 	}
422 	return pqh;
423 }
424 
425 void
426 uhci_globalreset(uhci_softc_t *sc)
427 {
428 	UHCICMD(sc, UHCI_CMD_GRESET);	/* global reset */
429 	usb_delay_ms(&sc->sc_bus, USB_BUS_RESET_DELAY); /* wait a little */
430 	UHCICMD(sc, 0);			/* do nothing */
431 }
432 
433 int
434 uhci_init(uhci_softc_t *sc)
435 {
436 	int i, j;
437 	uhci_soft_qh_t *clsqh, *chsqh, *bsqh, *sqh, *lsqh;
438 	uhci_soft_td_t *std;
439 
440 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
441 
442 #ifdef UHCI_DEBUG
443 	thesc = sc;
444 
445 	if (uhcidebug >= 2)
446 		uhci_dumpregs(sc);
447 #endif
448 
449 	sc->sc_suspend = PWR_RESUME;
450 
451 	UWRITE2(sc, UHCI_INTR, 0);		/* disable interrupts */
452 	uhci_globalreset(sc);			/* reset the controller */
453 	uhci_reset(sc);
454 
455 	/* Allocate and initialize real frame array. */
456 	int err = usb_allocmem(sc->sc_bus.ub_dmatag,
457 	    UHCI_FRAMELIST_COUNT * sizeof(uhci_physaddr_t),
458 	    UHCI_FRAMELIST_ALIGN, USBMALLOC_COHERENT, &sc->sc_dma);
459 	if (err)
460 		return err;
461 	sc->sc_pframes = KERNADDR(&sc->sc_dma, 0);
462 	/* set frame number to 0 */
463 	UWRITE2(sc, UHCI_FRNUM, 0);
464 	/* set frame list */
465 	UWRITE4(sc, UHCI_FLBASEADDR, DMAADDR(&sc->sc_dma, 0));
466 
467 	/* Initialise mutex early for uhci_alloc_* */
468 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB);
469 	mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_USB);
470 
471 	/*
472 	 * Allocate a TD, inactive, that hangs from the last QH.
473 	 * This is to avoid a bug in the PIIX that makes it run berserk
474 	 * otherwise.
475 	 */
476 	std = uhci_alloc_std(sc);
477 	if (std == NULL)
478 		return ENOMEM;
479 	std->link.std = NULL;
480 	std->td.td_link = htole32(UHCI_PTR_T);
481 	std->td.td_status = htole32(0); /* inactive */
482 	std->td.td_token = htole32(0);
483 	std->td.td_buffer = htole32(0);
484 	usb_syncmem(&std->dma, std->offs, sizeof(std->td),
485 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
486 
487 	/* Allocate the dummy QH marking the end and used for looping the QHs.*/
488 	lsqh = uhci_alloc_sqh(sc);
489 	if (lsqh == NULL)
490 		goto fail1;
491 	lsqh->hlink = NULL;
492 	lsqh->qh.qh_hlink = htole32(UHCI_PTR_T);	/* end of QH chain */
493 	lsqh->elink = std;
494 	lsqh->qh.qh_elink = htole32(std->physaddr | UHCI_PTR_TD);
495 	sc->sc_last_qh = lsqh;
496 	usb_syncmem(&lsqh->dma, lsqh->offs, sizeof(lsqh->qh),
497 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
498 
499 	/* Allocate the dummy QH where bulk traffic will be queued. */
500 	bsqh = uhci_alloc_sqh(sc);
501 	if (bsqh == NULL)
502 		goto fail2;
503 	bsqh->hlink = lsqh;
504 	bsqh->qh.qh_hlink = htole32(lsqh->physaddr | UHCI_PTR_QH);
505 	bsqh->elink = NULL;
506 	bsqh->qh.qh_elink = htole32(UHCI_PTR_T);
507 	sc->sc_bulk_start = sc->sc_bulk_end = bsqh;
508 	usb_syncmem(&bsqh->dma, bsqh->offs, sizeof(bsqh->qh),
509 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
510 
511 	/* Allocate dummy QH where high speed control traffic will be queued. */
512 	chsqh = uhci_alloc_sqh(sc);
513 	if (chsqh == NULL)
514 		goto fail3;
515 	chsqh->hlink = bsqh;
516 	chsqh->qh.qh_hlink = htole32(bsqh->physaddr | UHCI_PTR_QH);
517 	chsqh->elink = NULL;
518 	chsqh->qh.qh_elink = htole32(UHCI_PTR_T);
519 	sc->sc_hctl_start = sc->sc_hctl_end = chsqh;
520 	usb_syncmem(&chsqh->dma, chsqh->offs, sizeof(chsqh->qh),
521 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
522 
523 	/* Allocate dummy QH where control traffic will be queued. */
524 	clsqh = uhci_alloc_sqh(sc);
525 	if (clsqh == NULL)
526 		goto fail4;
527 	clsqh->hlink = chsqh;
528 	clsqh->qh.qh_hlink = htole32(chsqh->physaddr | UHCI_PTR_QH);
529 	clsqh->elink = NULL;
530 	clsqh->qh.qh_elink = htole32(UHCI_PTR_T);
531 	sc->sc_lctl_start = sc->sc_lctl_end = clsqh;
532 	usb_syncmem(&clsqh->dma, clsqh->offs, sizeof(clsqh->qh),
533 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
534 
535 	/*
536 	 * Make all (virtual) frame list pointers point to the interrupt
537 	 * queue heads and the interrupt queue heads at the control
538 	 * queue head and point the physical frame list to the virtual.
539 	 */
540 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
541 		std = uhci_alloc_std(sc);
542 		sqh = uhci_alloc_sqh(sc);
543 		if (std == NULL || sqh == NULL)
544 			return USBD_NOMEM;
545 		std->link.sqh = sqh;
546 		std->td.td_link = htole32(sqh->physaddr | UHCI_PTR_QH);
547 		std->td.td_status = htole32(UHCI_TD_IOS); /* iso, inactive */
548 		std->td.td_token = htole32(0);
549 		std->td.td_buffer = htole32(0);
550 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
551 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
552 		sqh->hlink = clsqh;
553 		sqh->qh.qh_hlink = htole32(clsqh->physaddr | UHCI_PTR_QH);
554 		sqh->elink = NULL;
555 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
556 		usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
557 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
558 		sc->sc_vframes[i].htd = std;
559 		sc->sc_vframes[i].etd = std;
560 		sc->sc_vframes[i].hqh = sqh;
561 		sc->sc_vframes[i].eqh = sqh;
562 		for (j = i;
563 		     j < UHCI_FRAMELIST_COUNT;
564 		     j += UHCI_VFRAMELIST_COUNT)
565 			sc->sc_pframes[j] = htole32(std->physaddr);
566 	}
567 	usb_syncmem(&sc->sc_dma, 0,
568 	    UHCI_FRAMELIST_COUNT * sizeof(uhci_physaddr_t),
569 	    BUS_DMASYNC_PREWRITE);
570 
571 
572 	TAILQ_INIT(&sc->sc_intrhead);
573 
574 	sc->sc_xferpool = pool_cache_init(sizeof(struct uhci_xfer), 0, 0, 0,
575 	    "uhcixfer", NULL, IPL_USB, NULL, NULL, NULL);
576 
577 	callout_init(&sc->sc_poll_handle, CALLOUT_MPSAFE);
578 	callout_setfunc(&sc->sc_poll_handle, uhci_poll_hub, sc);
579 
580 	/* Set up the bus struct. */
581 	sc->sc_bus.ub_methods = &uhci_bus_methods;
582 	sc->sc_bus.ub_pipesize = sizeof(struct uhci_pipe);
583 	sc->sc_bus.ub_usedma = true;
584 	sc->sc_bus.ub_dmaflags = USBMALLOC_MULTISEG;
585 
586 	UHCICMD(sc, UHCI_CMD_MAXP); /* Assume 64 byte packets at frame end */
587 
588 	DPRINTF("Enabling...", 0, 0, 0, 0);
589 
590 	err = uhci_run(sc, 1);		/* and here we go... */
591 	UWRITE2(sc, UHCI_INTR, UHCI_INTR_TOCRCIE | UHCI_INTR_RIE |
592 		UHCI_INTR_IOCE | UHCI_INTR_SPIE);	/* enable interrupts */
593 	return err;
594 
595 fail4:
596 	uhci_free_sqh(sc, chsqh);
597 fail3:
598 	uhci_free_sqh(sc, lsqh);
599 fail2:
600 	uhci_free_sqh(sc, lsqh);
601 fail1:
602 	uhci_free_std(sc, std);
603 
604 	return ENOMEM;
605 }
606 
607 int
608 uhci_activate(device_t self, enum devact act)
609 {
610 	struct uhci_softc *sc = device_private(self);
611 
612 	switch (act) {
613 	case DVACT_DEACTIVATE:
614 		sc->sc_dying = 1;
615 		return 0;
616 	default:
617 		return EOPNOTSUPP;
618 	}
619 }
620 
621 void
622 uhci_childdet(device_t self, device_t child)
623 {
624 	struct uhci_softc *sc = device_private(self);
625 
626 	KASSERT(sc->sc_child == child);
627 	sc->sc_child = NULL;
628 }
629 
630 int
631 uhci_detach(struct uhci_softc *sc, int flags)
632 {
633 	int rv = 0;
634 
635 	if (sc->sc_child != NULL)
636 		rv = config_detach(sc->sc_child, flags);
637 
638 	if (rv != 0)
639 		return rv;
640 
641 	KASSERT(sc->sc_intr_xfer == NULL);
642 	callout_halt(&sc->sc_poll_handle, NULL);
643 	callout_destroy(&sc->sc_poll_handle);
644 
645 	mutex_destroy(&sc->sc_lock);
646 	mutex_destroy(&sc->sc_intr_lock);
647 
648 	pool_cache_destroy(sc->sc_xferpool);
649 
650 	/* XXX free other data structures XXX */
651 
652 	return rv;
653 }
654 
655 struct usbd_xfer *
656 uhci_allocx(struct usbd_bus *bus, unsigned int nframes)
657 {
658 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
659 	struct usbd_xfer *xfer;
660 
661 	xfer = pool_cache_get(sc->sc_xferpool, PR_WAITOK);
662 	if (xfer != NULL) {
663 		memset(xfer, 0, sizeof(struct uhci_xfer));
664 
665 #ifdef DIAGNOSTIC
666 		struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
667 		uxfer->ux_isdone = true;
668 		xfer->ux_state = XFER_BUSY;
669 #endif
670 	}
671 	return xfer;
672 }
673 
674 void
675 uhci_freex(struct usbd_bus *bus, struct usbd_xfer *xfer)
676 {
677 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
678 	struct uhci_xfer *uxfer __diagused = UHCI_XFER2UXFER(xfer);
679 
680 	KASSERTMSG(xfer->ux_state == XFER_BUSY ||
681 	    xfer->ux_status == USBD_NOT_STARTED,
682 	    "xfer %p state %d\n", xfer, xfer->ux_state);
683 	KASSERTMSG(uxfer->ux_isdone || xfer->ux_status == USBD_NOT_STARTED,
684 	    "xfer %p not done\n", xfer);
685 #ifdef DIAGNOSTIC
686 	xfer->ux_state = XFER_FREE;
687 #endif
688 	pool_cache_put(sc->sc_xferpool, xfer);
689 }
690 
691 Static bool
692 uhci_dying(struct usbd_bus *bus)
693 {
694 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
695 
696 	return sc->sc_dying;
697 }
698 
699 Static void
700 uhci_get_lock(struct usbd_bus *bus, kmutex_t **lock)
701 {
702 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
703 
704 	*lock = &sc->sc_lock;
705 }
706 
707 
708 /*
709  * Handle suspend/resume.
710  *
711  * We need to switch to polling mode here, because this routine is
712  * called from an interrupt context.  This is all right since we
713  * are almost suspended anyway.
714  */
715 bool
716 uhci_resume(device_t dv, const pmf_qual_t *qual)
717 {
718 	uhci_softc_t *sc = device_private(dv);
719 	int cmd;
720 
721 	cmd = UREAD2(sc, UHCI_CMD);
722 	UWRITE2(sc, UHCI_INTR, 0);
723 	uhci_globalreset(sc);
724 	uhci_reset(sc);
725 	if (cmd & UHCI_CMD_RS)
726 		uhci_run(sc, 0);
727 
728 	/* restore saved state */
729 	UWRITE4(sc, UHCI_FLBASEADDR, DMAADDR(&sc->sc_dma, 0));
730 	UWRITE2(sc, UHCI_FRNUM, sc->sc_saved_frnum);
731 	UWRITE1(sc, UHCI_SOF, sc->sc_saved_sof);
732 
733 	UHCICMD(sc, cmd | UHCI_CMD_FGR); /* force resume */
734 	usb_delay_ms(&sc->sc_bus, USB_RESUME_DELAY);
735 	UHCICMD(sc, cmd & ~UHCI_CMD_EGSM); /* back to normal */
736 	UWRITE2(sc, UHCI_INTR, UHCI_INTR_TOCRCIE |
737 	    UHCI_INTR_RIE | UHCI_INTR_IOCE | UHCI_INTR_SPIE);
738 	UHCICMD(sc, UHCI_CMD_MAXP);
739 	uhci_run(sc, 1); /* and start traffic again */
740 	usb_delay_ms(&sc->sc_bus, USB_RESUME_RECOVERY);
741 #ifdef UHCI_DEBUG
742 	if (uhcidebug >= 2)
743 		uhci_dumpregs(sc);
744 #endif
745 
746 	mutex_enter(&sc->sc_lock);
747 	sc->sc_suspend = PWR_RESUME;
748 	if (sc->sc_intr_xfer != NULL)
749 		callout_schedule(&sc->sc_poll_handle, sc->sc_ival);
750 	mutex_exit(&sc->sc_lock);
751 
752 	return true;
753 }
754 
755 bool
756 uhci_suspend(device_t dv, const pmf_qual_t *qual)
757 {
758 	uhci_softc_t *sc = device_private(dv);
759 	int cmd;
760 
761 	mutex_enter(&sc->sc_lock);
762 	sc->sc_suspend = PWR_SUSPEND;
763 	if (sc->sc_intr_xfer != NULL)
764 		callout_halt(&sc->sc_poll_handle, &sc->sc_lock);
765 	mutex_exit(&sc->sc_lock);
766 
767 	cmd = UREAD2(sc, UHCI_CMD);
768 
769 #ifdef UHCI_DEBUG
770 	if (uhcidebug >= 2)
771 		uhci_dumpregs(sc);
772 #endif
773 
774 	uhci_run(sc, 0); /* stop the controller */
775 	cmd &= ~UHCI_CMD_RS;
776 
777 	/* save some state if BIOS doesn't */
778 	sc->sc_saved_frnum = UREAD2(sc, UHCI_FRNUM);
779 	sc->sc_saved_sof = UREAD1(sc, UHCI_SOF);
780 
781 	UWRITE2(sc, UHCI_INTR, 0); /* disable intrs */
782 
783 	UHCICMD(sc, cmd | UHCI_CMD_EGSM); /* enter suspend */
784 	usb_delay_ms(&sc->sc_bus, USB_RESUME_WAIT);
785 
786 	return true;
787 }
788 
789 #ifdef UHCI_DEBUG
790 Static void
791 uhci_dumpregs(uhci_softc_t *sc)
792 {
793 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
794 	DPRINTF("cmd =%04jx  sts    =%04jx  intr   =%04jx  frnum =%04jx",
795 	    UREAD2(sc, UHCI_CMD), UREAD2(sc, UHCI_STS),
796 	    UREAD2(sc, UHCI_INTR), UREAD2(sc, UHCI_FRNUM));
797 	DPRINTF("sof =%04jx  portsc1=%04jx  portsc2=%04jx  flbase=%08jx",
798 	    UREAD1(sc, UHCI_SOF), UREAD2(sc, UHCI_PORTSC1),
799 	    UREAD2(sc, UHCI_PORTSC2), UREAD4(sc, UHCI_FLBASEADDR));
800 }
801 
802 void
803 uhci_dump_td(uhci_soft_td_t *p)
804 {
805 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
806 
807 	usb_syncmem(&p->dma, p->offs, sizeof(p->td),
808 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
809 
810 	DPRINTF("TD(%#jx) at 0x%08jx", (uintptr_t)p, p->physaddr, 0, 0);
811 	DPRINTF("   link=0x%08jx status=0x%08jx "
812 	    "token=0x%08x buffer=0x%08x",
813 	     le32toh(p->td.td_link),
814 	     le32toh(p->td.td_status),
815 	     le32toh(p->td.td_token),
816 	     le32toh(p->td.td_buffer));
817 
818 	DPRINTF("bitstuff=%jd crcto   =%jd nak     =%jd babble  =%jd",
819 	    !!(le32toh(p->td.td_status) & UHCI_TD_BITSTUFF),
820 	    !!(le32toh(p->td.td_status) & UHCI_TD_CRCTO),
821 	    !!(le32toh(p->td.td_status) & UHCI_TD_NAK),
822 	    !!(le32toh(p->td.td_status) & UHCI_TD_BABBLE));
823 	DPRINTF("dbuffer =%jd stalled =%jd active  =%jd ioc     =%jd",
824 	    !!(le32toh(p->td.td_status) & UHCI_TD_DBUFFER),
825 	    !!(le32toh(p->td.td_status) & UHCI_TD_STALLED),
826 	    !!(le32toh(p->td.td_status) & UHCI_TD_ACTIVE),
827 	    !!(le32toh(p->td.td_status) & UHCI_TD_IOC));
828 	DPRINTF("ios     =%jd ls      =%jd spd     =%jd",
829 	    !!(le32toh(p->td.td_status) & UHCI_TD_IOS),
830 	    !!(le32toh(p->td.td_status) & UHCI_TD_LS),
831 	    !!(le32toh(p->td.td_status) & UHCI_TD_SPD), 0);
832 	DPRINTF("errcnt  =%d actlen  =%d pid=%02x",
833 	    UHCI_TD_GET_ERRCNT(le32toh(p->td.td_status)),
834 	    UHCI_TD_GET_ACTLEN(le32toh(p->td.td_status)),
835 	    UHCI_TD_GET_PID(le32toh(p->td.td_token)), 0);
836 	DPRINTF("addr=%jd  endpt=%jd  D=%jd  maxlen=%jd,",
837 	    UHCI_TD_GET_DEVADDR(le32toh(p->td.td_token)),
838 	    UHCI_TD_GET_ENDPT(le32toh(p->td.td_token)),
839 	    UHCI_TD_GET_DT(le32toh(p->td.td_token)),
840 	    UHCI_TD_GET_MAXLEN(le32toh(p->td.td_token)));
841 }
842 
843 void
844 uhci_dump_qh(uhci_soft_qh_t *sqh)
845 {
846 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
847 
848 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
849 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
850 
851 	DPRINTF("QH(%#jx) at 0x%08jx: hlink=%08jx elink=%08jx", (uintptr_t)sqh,
852 	    (int)sqh->physaddr, le32toh(sqh->qh.qh_hlink),
853 	    le32toh(sqh->qh.qh_elink));
854 
855 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh), BUS_DMASYNC_PREREAD);
856 }
857 
858 
859 #if 1
860 void
861 uhci_dump(void)
862 {
863 	uhci_dump_all(thesc);
864 }
865 #endif
866 
867 void
868 uhci_dump_all(uhci_softc_t *sc)
869 {
870 	uhci_dumpregs(sc);
871 	/*printf("framelist[i].link = %08x\n", sc->sc_framelist[0].link);*/
872 	uhci_dump_qhs(sc->sc_lctl_start);
873 }
874 
875 
876 void
877 uhci_dump_qhs(uhci_soft_qh_t *sqh)
878 {
879 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
880 
881 	uhci_dump_qh(sqh);
882 
883 	/*
884 	 * uhci_dump_qhs displays all the QHs and TDs from the given QH onwards
885 	 * Traverses sideways first, then down.
886 	 *
887 	 * QH1
888 	 * QH2
889 	 * No QH
890 	 * TD2.1
891 	 * TD2.2
892 	 * TD1.1
893 	 * etc.
894 	 *
895 	 * TD2.x being the TDs queued at QH2 and QH1 being referenced from QH1.
896 	 */
897 
898 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
899 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
900 	if (sqh->hlink != NULL && !(le32toh(sqh->qh.qh_hlink) & UHCI_PTR_T))
901 		uhci_dump_qhs(sqh->hlink);
902 	else
903 		DPRINTF("No QH", 0, 0, 0, 0);
904 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh), BUS_DMASYNC_PREREAD);
905 
906 	if (sqh->elink != NULL && !(le32toh(sqh->qh.qh_elink) & UHCI_PTR_T))
907 		uhci_dump_tds(sqh->elink);
908 	else
909 		DPRINTF("No QH", 0, 0, 0, 0);
910 }
911 
912 void
913 uhci_dump_tds(uhci_soft_td_t *std)
914 {
915 	uhci_soft_td_t *td;
916 	int stop;
917 
918 	for (td = std; td != NULL; td = td->link.std) {
919 		uhci_dump_td(td);
920 
921 		/*
922 		 * Check whether the link pointer in this TD marks
923 		 * the link pointer as end of queue. This avoids
924 		 * printing the free list in case the queue/TD has
925 		 * already been moved there (seatbelt).
926 		 */
927 		usb_syncmem(&td->dma, td->offs + offsetof(uhci_td_t, td_link),
928 		    sizeof(td->td.td_link),
929 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
930 		stop = (le32toh(td->td.td_link) & UHCI_PTR_T ||
931 			le32toh(td->td.td_link) == 0);
932 		usb_syncmem(&td->dma, td->offs + offsetof(uhci_td_t, td_link),
933 		    sizeof(td->td.td_link), BUS_DMASYNC_PREREAD);
934 		if (stop)
935 			break;
936 	}
937 }
938 
939 Static void
940 uhci_dump_ii(struct uhci_xfer *ux)
941 {
942 	struct usbd_pipe *pipe;
943 	usb_endpoint_descriptor_t *ed;
944 	struct usbd_device *dev;
945 
946 	if (ux == NULL) {
947 		printf("ux NULL\n");
948 		return;
949 	}
950 	pipe = ux->ux_xfer.ux_pipe;
951 	if (pipe == NULL) {
952 		printf("ux %p: done=%d pipe=NULL\n", ux, ux->ux_isdone);
953 		return;
954 	}
955 	if (pipe->up_endpoint == NULL) {
956 		printf("ux %p: done=%d pipe=%p pipe->up_endpoint=NULL\n",
957 		       ux, ux->ux_isdone, pipe);
958 		return;
959 	}
960 	if (pipe->up_dev == NULL) {
961 		printf("ux %p: done=%d pipe=%p pipe->up_dev=NULL\n",
962 		       ux, ux->ux_isdone, pipe);
963 		return;
964 	}
965 	ed = pipe->up_endpoint->ue_edesc;
966 	dev = pipe->up_dev;
967 	printf("ux %p: done=%d dev=%p vid=0x%04x pid=0x%04x addr=%d pipe=%p ep=0x%02x attr=0x%02x\n",
968 	       ux, ux->ux_isdone, dev,
969 	       UGETW(dev->ud_ddesc.idVendor),
970 	       UGETW(dev->ud_ddesc.idProduct),
971 	       dev->ud_addr, pipe,
972 	       ed->bEndpointAddress, ed->bmAttributes);
973 }
974 
975 void uhci_dump_iis(struct uhci_softc *sc);
976 void
977 uhci_dump_iis(struct uhci_softc *sc)
978 {
979 	struct uhci_xfer *ux;
980 
981 	printf("interrupt list:\n");
982 	TAILQ_FOREACH(ux, &sc->sc_intrhead, ux_list)
983 		uhci_dump_ii(ux);
984 }
985 
986 void iidump(void);
987 void iidump(void) { uhci_dump_iis(thesc); }
988 
989 #endif
990 
991 /*
992  * This routine is executed periodically and simulates interrupts
993  * from the root controller interrupt pipe for port status change.
994  */
995 void
996 uhci_poll_hub(void *addr)
997 {
998 	struct uhci_softc *sc = addr;
999 	struct usbd_xfer *xfer;
1000 	u_char *p;
1001 
1002 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1003 
1004 	mutex_enter(&sc->sc_lock);
1005 
1006 	/*
1007 	 * If the intr xfer has completed or been synchronously
1008 	 * aborted, we have nothing to do.
1009 	 */
1010 	xfer = sc->sc_intr_xfer;
1011 	if (xfer == NULL)
1012 		goto out;
1013 	KASSERT(xfer->ux_status == USBD_IN_PROGRESS);
1014 
1015 	/*
1016 	 * If the intr xfer for which we were scheduled is done, and
1017 	 * another intr xfer has been submitted, let that one be dealt
1018 	 * with when the callout fires again.
1019 	 *
1020 	 * The call to callout_pending is racy, but the transition
1021 	 * from pending to invoking happens atomically.  The
1022 	 * callout_ack ensures callout_invoking does not return true
1023 	 * due to this invocation of the callout; the lock ensures the
1024 	 * next invocation of the callout cannot callout_ack (unless it
1025 	 * had already run to completion and nulled sc->sc_intr_xfer,
1026 	 * in which case would have bailed out already).
1027 	 */
1028 	callout_ack(&sc->sc_poll_handle);
1029 	if (callout_pending(&sc->sc_poll_handle) ||
1030 	    callout_invoking(&sc->sc_poll_handle))
1031 		goto out;
1032 
1033 	/*
1034 	 * Check flags for the two interrupt ports, and set them in the
1035 	 * buffer if an interrupt arrived; otherwise arrange .
1036 	 */
1037 	p = xfer->ux_buf;
1038 	p[0] = 0;
1039 	if (UREAD2(sc, UHCI_PORTSC1) & (UHCI_PORTSC_CSC|UHCI_PORTSC_OCIC))
1040 		p[0] |= 1<<1;
1041 	if (UREAD2(sc, UHCI_PORTSC2) & (UHCI_PORTSC_CSC|UHCI_PORTSC_OCIC))
1042 		p[0] |= 1<<2;
1043 	if (p[0] == 0) {
1044 		/*
1045 		 * No change -- try again in a while, unless we're
1046 		 * suspending, in which case we'll try again after
1047 		 * resume.
1048 		 */
1049 		if (sc->sc_suspend != PWR_SUSPEND)
1050 			callout_schedule(&sc->sc_poll_handle, sc->sc_ival);
1051 		goto out;
1052 	}
1053 
1054 	/*
1055 	 * Interrupt completed, and the xfer has not been completed or
1056 	 * synchronously aborted.  Complete the xfer now.
1057 	 */
1058 	xfer->ux_actlen = 1;
1059 	xfer->ux_status = USBD_NORMAL_COMPLETION;
1060 #ifdef DIAGNOSTIC
1061 	UHCI_XFER2UXFER(xfer)->ux_isdone = true;
1062 #endif
1063 	usb_transfer_complete(xfer);
1064 
1065 out:	mutex_exit(&sc->sc_lock);
1066 }
1067 
1068 void
1069 uhci_root_intr_done(struct usbd_xfer *xfer)
1070 {
1071 	struct uhci_softc *sc = UHCI_XFER2SC(xfer);
1072 
1073 	KASSERT(mutex_owned(&sc->sc_lock));
1074 
1075 	/* Claim the xfer so it doesn't get completed again.  */
1076 	KASSERT(sc->sc_intr_xfer == xfer);
1077 	KASSERT(xfer->ux_status != USBD_IN_PROGRESS);
1078 	sc->sc_intr_xfer = NULL;
1079 }
1080 
1081 /*
1082  * Let the last QH loop back to the high speed control transfer QH.
1083  * This is what intel calls "bandwidth reclamation" and improves
1084  * USB performance a lot for some devices.
1085  * If we are already looping, just count it.
1086  */
1087 void
1088 uhci_add_loop(uhci_softc_t *sc)
1089 {
1090 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1091 
1092 #ifdef UHCI_DEBUG
1093 	if (uhcinoloop)
1094 		return;
1095 #endif
1096 	if (++sc->sc_loops == 1) {
1097 		DPRINTFN(5, "add loop", 0, 0, 0, 0);
1098 		/* Note, we don't loop back the soft pointer. */
1099 		sc->sc_last_qh->qh.qh_hlink =
1100 		    htole32(sc->sc_hctl_start->physaddr | UHCI_PTR_QH);
1101 		usb_syncmem(&sc->sc_last_qh->dma,
1102 		    sc->sc_last_qh->offs + offsetof(uhci_qh_t, qh_hlink),
1103 		    sizeof(sc->sc_last_qh->qh.qh_hlink),
1104 		    BUS_DMASYNC_PREWRITE);
1105 	}
1106 }
1107 
1108 void
1109 uhci_rem_loop(uhci_softc_t *sc)
1110 {
1111 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1112 
1113 #ifdef UHCI_DEBUG
1114 	if (uhcinoloop)
1115 		return;
1116 #endif
1117 	if (--sc->sc_loops == 0) {
1118 		DPRINTFN(5, "remove loop", 0, 0, 0, 0);
1119 		sc->sc_last_qh->qh.qh_hlink = htole32(UHCI_PTR_T);
1120 		usb_syncmem(&sc->sc_last_qh->dma,
1121 		    sc->sc_last_qh->offs + offsetof(uhci_qh_t, qh_hlink),
1122 		    sizeof(sc->sc_last_qh->qh.qh_hlink),
1123 		    BUS_DMASYNC_PREWRITE);
1124 	}
1125 }
1126 
1127 /* Add high speed control QH, called with lock held. */
1128 void
1129 uhci_add_hs_ctrl(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1130 {
1131 	uhci_soft_qh_t *eqh;
1132 
1133 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1134 
1135 	KASSERT(mutex_owned(&sc->sc_lock));
1136 
1137 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1138 	eqh = sc->sc_hctl_end;
1139 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1140 	    sizeof(eqh->qh.qh_hlink),
1141 	    BUS_DMASYNC_POSTWRITE);
1142 	sqh->hlink       = eqh->hlink;
1143 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
1144 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
1145 	    BUS_DMASYNC_PREWRITE);
1146 	eqh->hlink       = sqh;
1147 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_QH);
1148 	sc->sc_hctl_end = sqh;
1149 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1150 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
1151 #ifdef UHCI_CTL_LOOP
1152 	uhci_add_loop(sc);
1153 #endif
1154 }
1155 
1156 /* Remove high speed control QH, called with lock held. */
1157 void
1158 uhci_remove_hs_ctrl(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1159 {
1160 	uhci_soft_qh_t *pqh;
1161 	uint32_t elink;
1162 
1163 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1164 
1165 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1166 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1167 #ifdef UHCI_CTL_LOOP
1168 	uhci_rem_loop(sc);
1169 #endif
1170 	/*
1171 	 * The T bit should be set in the elink of the QH so that the HC
1172 	 * doesn't follow the pointer.  This condition may fail if the
1173 	 * the transferred packet was short so that the QH still points
1174 	 * at the last used TD.
1175 	 * In this case we set the T bit and wait a little for the HC
1176 	 * to stop looking at the TD.
1177 	 * Note that if the TD chain is large enough, the controller
1178 	 * may still be looking at the chain at the end of this function.
1179 	 * uhci_free_std_chain() will make sure the controller stops
1180 	 * looking at it quickly, but until then we should not change
1181 	 * sqh->hlink.
1182 	 */
1183 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
1184 	    sizeof(sqh->qh.qh_elink),
1185 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1186 	elink = le32toh(sqh->qh.qh_elink);
1187 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
1188 	    sizeof(sqh->qh.qh_elink), BUS_DMASYNC_PREREAD);
1189 	if (!(elink & UHCI_PTR_T)) {
1190 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
1191 		usb_syncmem(&sqh->dma,
1192 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
1193 		    sizeof(sqh->qh.qh_elink),
1194 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1195 		delay(UHCI_QH_REMOVE_DELAY);
1196 	}
1197 
1198 	pqh = uhci_find_prev_qh(sc->sc_hctl_start, sqh);
1199 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_hlink),
1200 	    sizeof(sqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
1201 	pqh->hlink = sqh->hlink;
1202 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
1203 	usb_syncmem(&pqh->dma, pqh->offs + offsetof(uhci_qh_t, qh_hlink),
1204 	    sizeof(pqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
1205 	delay(UHCI_QH_REMOVE_DELAY);
1206 	if (sc->sc_hctl_end == sqh)
1207 		sc->sc_hctl_end = pqh;
1208 }
1209 
1210 /* Add low speed control QH, called with lock held. */
1211 void
1212 uhci_add_ls_ctrl(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1213 {
1214 	uhci_soft_qh_t *eqh;
1215 
1216 	KASSERT(mutex_owned(&sc->sc_lock));
1217 
1218 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1219 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1220 
1221 	eqh = sc->sc_lctl_end;
1222 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1223 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
1224 	sqh->hlink = eqh->hlink;
1225 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
1226 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
1227 	    BUS_DMASYNC_PREWRITE);
1228 	eqh->hlink = sqh;
1229 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_QH);
1230 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1231 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
1232 	sc->sc_lctl_end = sqh;
1233 }
1234 
1235 /* Remove low speed control QH, called with lock held. */
1236 void
1237 uhci_remove_ls_ctrl(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1238 {
1239 	uhci_soft_qh_t *pqh;
1240 	uint32_t elink;
1241 
1242 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1243 
1244 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1245 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1246 
1247 	/* See comment in uhci_remove_hs_ctrl() */
1248 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
1249 	    sizeof(sqh->qh.qh_elink),
1250 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1251 	elink = le32toh(sqh->qh.qh_elink);
1252 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
1253 	    sizeof(sqh->qh.qh_elink), BUS_DMASYNC_PREREAD);
1254 	if (!(elink & UHCI_PTR_T)) {
1255 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
1256 		usb_syncmem(&sqh->dma,
1257 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
1258 		    sizeof(sqh->qh.qh_elink),
1259 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1260 		delay(UHCI_QH_REMOVE_DELAY);
1261 	}
1262 	pqh = uhci_find_prev_qh(sc->sc_lctl_start, sqh);
1263 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_hlink),
1264 	    sizeof(sqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
1265 	pqh->hlink = sqh->hlink;
1266 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
1267 	usb_syncmem(&pqh->dma, pqh->offs + offsetof(uhci_qh_t, qh_hlink),
1268 	    sizeof(pqh->qh.qh_hlink),
1269 	    BUS_DMASYNC_PREWRITE);
1270 	delay(UHCI_QH_REMOVE_DELAY);
1271 	if (sc->sc_lctl_end == sqh)
1272 		sc->sc_lctl_end = pqh;
1273 }
1274 
1275 /* Add bulk QH, called with lock held. */
1276 void
1277 uhci_add_bulk(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1278 {
1279 	uhci_soft_qh_t *eqh;
1280 
1281 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1282 
1283 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1284 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1285 
1286 	eqh = sc->sc_bulk_end;
1287 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1288 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
1289 	sqh->hlink = eqh->hlink;
1290 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
1291 	usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
1292 	    BUS_DMASYNC_PREWRITE);
1293 	eqh->hlink = sqh;
1294 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_QH);
1295 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
1296 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
1297 	sc->sc_bulk_end = sqh;
1298 	uhci_add_loop(sc);
1299 }
1300 
1301 /* Remove bulk QH, called with lock held. */
1302 void
1303 uhci_remove_bulk(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1304 {
1305 	uhci_soft_qh_t *pqh;
1306 
1307 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1308 
1309 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1310 	DPRINTFN(10, "sqh %#jx", (uintptr_t)sqh, 0, 0, 0);
1311 
1312 	uhci_rem_loop(sc);
1313 	/* See comment in uhci_remove_hs_ctrl() */
1314 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
1315 	    sizeof(sqh->qh.qh_elink),
1316 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1317 	if (!(sqh->qh.qh_elink & htole32(UHCI_PTR_T))) {
1318 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
1319 		usb_syncmem(&sqh->dma,
1320 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
1321 		    sizeof(sqh->qh.qh_elink),
1322 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1323 		delay(UHCI_QH_REMOVE_DELAY);
1324 	}
1325 	pqh = uhci_find_prev_qh(sc->sc_bulk_start, sqh);
1326 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_hlink),
1327 	    sizeof(sqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
1328 	pqh->hlink       = sqh->hlink;
1329 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
1330 	usb_syncmem(&pqh->dma, pqh->offs + offsetof(uhci_qh_t, qh_hlink),
1331 	    sizeof(pqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
1332 	delay(UHCI_QH_REMOVE_DELAY);
1333 	if (sc->sc_bulk_end == sqh)
1334 		sc->sc_bulk_end = pqh;
1335 }
1336 
1337 Static int uhci_intr1(uhci_softc_t *);
1338 
1339 int
1340 uhci_intr(void *arg)
1341 {
1342 	uhci_softc_t *sc = arg;
1343 	int ret = 0;
1344 
1345 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1346 
1347 	mutex_spin_enter(&sc->sc_intr_lock);
1348 
1349 	if (sc->sc_dying || !device_has_power(sc->sc_dev))
1350 		goto done;
1351 
1352 	if (sc->sc_bus.ub_usepolling || UREAD2(sc, UHCI_INTR) == 0) {
1353 		DPRINTFN(16, "ignored interrupt while polling", 0, 0, 0, 0);
1354 		goto done;
1355 	}
1356 
1357 	ret = uhci_intr1(sc);
1358 
1359  done:
1360 	mutex_spin_exit(&sc->sc_intr_lock);
1361 	return ret;
1362 }
1363 
1364 int
1365 uhci_intr1(uhci_softc_t *sc)
1366 {
1367 	int status;
1368 	int ack;
1369 
1370 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1371 
1372 #ifdef UHCI_DEBUG
1373 	if (uhcidebug >= 15) {
1374 		DPRINTF("sc %#jx", (uintptr_t)sc, 0, 0, 0);
1375 		uhci_dumpregs(sc);
1376 	}
1377 #endif
1378 
1379 	KASSERT(mutex_owned(&sc->sc_intr_lock));
1380 
1381 	status = UREAD2(sc, UHCI_STS) & UHCI_STS_ALLINTRS;
1382 	/* Check if the interrupt was for us. */
1383 	if (status == 0)
1384 		return 0;
1385 
1386 	if (sc->sc_suspend != PWR_RESUME) {
1387 #ifdef DIAGNOSTIC
1388 		printf("%s: interrupt while not operating ignored\n",
1389 		       device_xname(sc->sc_dev));
1390 #endif
1391 		UWRITE2(sc, UHCI_STS, status); /* acknowledge the ints */
1392 		return 0;
1393 	}
1394 
1395 	ack = 0;
1396 	if (status & UHCI_STS_USBINT)
1397 		ack |= UHCI_STS_USBINT;
1398 	if (status & UHCI_STS_USBEI)
1399 		ack |= UHCI_STS_USBEI;
1400 	if (status & UHCI_STS_RD) {
1401 		ack |= UHCI_STS_RD;
1402 #ifdef UHCI_DEBUG
1403 		printf("%s: resume detect\n", device_xname(sc->sc_dev));
1404 #endif
1405 	}
1406 	if (status & UHCI_STS_HSE) {
1407 		ack |= UHCI_STS_HSE;
1408 		printf("%s: host system error\n", device_xname(sc->sc_dev));
1409 	}
1410 	if (status & UHCI_STS_HCPE) {
1411 		ack |= UHCI_STS_HCPE;
1412 		printf("%s: host controller process error\n",
1413 		       device_xname(sc->sc_dev));
1414 	}
1415 
1416 	/* When HCHalted=1 and Run/Stop=0 , it is normal */
1417 	if ((status & UHCI_STS_HCH) && (UREAD2(sc, UHCI_CMD) & UHCI_CMD_RS)) {
1418 		/* no acknowledge needed */
1419 		if (!sc->sc_dying) {
1420 			printf("%s: host controller halted\n",
1421 			    device_xname(sc->sc_dev));
1422 #ifdef UHCI_DEBUG
1423 			uhci_dump_all(sc);
1424 #endif
1425 		}
1426 		sc->sc_dying = 1;
1427 	}
1428 
1429 	if (!ack)
1430 		return 0;	/* nothing to acknowledge */
1431 	UWRITE2(sc, UHCI_STS, ack); /* acknowledge the ints */
1432 
1433 	usb_schedsoftintr(&sc->sc_bus);
1434 
1435 	DPRINTFN(15, "sc %#jx done", (uintptr_t)sc, 0, 0, 0);
1436 
1437 	return 1;
1438 }
1439 
1440 void
1441 uhci_softintr(void *v)
1442 {
1443 	struct usbd_bus *bus = v;
1444 	uhci_softc_t *sc = UHCI_BUS2SC(bus);
1445 	struct uhci_xfer *ux, *nextux;
1446 	ux_completeq_t cq;
1447 
1448 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1449 	DPRINTF("sc %#jx", (uintptr_t)sc, 0, 0, 0);
1450 
1451 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1452 
1453 	TAILQ_INIT(&cq);
1454 	/*
1455 	 * Interrupts on UHCI really suck.  When the host controller
1456 	 * interrupts because a transfer is completed there is no
1457 	 * way of knowing which transfer it was.  You can scan down
1458 	 * the TDs and QHs of the previous frame to limit the search,
1459 	 * but that assumes that the interrupt was not delayed by more
1460 	 * than 1 ms, which may not always be true (e.g. after debug
1461 	 * output on a slow console).
1462 	 * We scan all interrupt descriptors to see if any have
1463 	 * completed.
1464 	 */
1465 	TAILQ_FOREACH_SAFE(ux, &sc->sc_intrhead, ux_list, nextux) {
1466 		uhci_check_intr(sc, ux, &cq);
1467 	}
1468 
1469 	/*
1470 	 * We abuse ux_list for the interrupt and complete lists and
1471 	 * interrupt transfers will get re-added here so use
1472 	 * the _SAFE version of TAILQ_FOREACH.
1473 	 */
1474 	TAILQ_FOREACH_SAFE(ux, &cq, ux_list, nextux) {
1475 		DPRINTF("ux %#jx", (uintptr_t)ux, 0, 0, 0);
1476 		usb_transfer_complete(&ux->ux_xfer);
1477 	}
1478 
1479 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1480 }
1481 
1482 /* Check for an interrupt. */
1483 void
1484 uhci_check_intr(uhci_softc_t *sc, struct uhci_xfer *ux, ux_completeq_t *cqp)
1485 {
1486 	uhci_soft_td_t *std, *fstd = NULL, *lstd = NULL;
1487 	uint32_t status;
1488 
1489 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1490 	DPRINTFN(15, "ux %#jx", (uintptr_t)ux, 0, 0, 0);
1491 
1492 	KASSERT(ux != NULL);
1493 
1494 	struct usbd_xfer *xfer = &ux->ux_xfer;
1495 	if (xfer->ux_status == USBD_CANCELLED ||
1496 	    xfer->ux_status == USBD_TIMEOUT) {
1497 		DPRINTF("aborted xfer %#jx", (uintptr_t)xfer, 0, 0, 0);
1498 		return;
1499 	}
1500 
1501 	switch (ux->ux_type) {
1502 	case UX_CTRL:
1503 		fstd = ux->ux_setup;
1504 		lstd = ux->ux_stat;
1505 		break;
1506 	case UX_BULK:
1507 	case UX_INTR:
1508 	case UX_ISOC:
1509 		fstd = ux->ux_stdstart;
1510 		lstd = ux->ux_stdend;
1511 		break;
1512 	default:
1513 		KASSERT(false);
1514 		break;
1515 	}
1516 	if (fstd == NULL)
1517 		return;
1518 
1519 	KASSERT(lstd != NULL);
1520 
1521 	usb_syncmem(&lstd->dma,
1522 	    lstd->offs + offsetof(uhci_td_t, td_status),
1523 	    sizeof(lstd->td.td_status),
1524 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1525 	status = le32toh(lstd->td.td_status);
1526 	usb_syncmem(&lstd->dma,
1527 	    lstd->offs + offsetof(uhci_td_t, td_status),
1528 	    sizeof(lstd->td.td_status),
1529 	    BUS_DMASYNC_PREREAD);
1530 
1531 	/* If the last TD is not marked active we can complete */
1532 	if (!(status & UHCI_TD_ACTIVE)) {
1533  done:
1534 		DPRINTFN(12, "ux=%#jx done", (uintptr_t)ux, 0, 0, 0);
1535 		uhci_idone(ux, cqp);
1536 		return;
1537 	}
1538 
1539 	/*
1540 	 * If the last TD is still active we need to check whether there
1541 	 * is an error somewhere in the middle, or whether there was a
1542 	 * short packet (SPD and not ACTIVE).
1543 	 */
1544 	DPRINTFN(12, "active ux=%#jx", (uintptr_t)ux, 0, 0, 0);
1545 	for (std = fstd; std != lstd; std = std->link.std) {
1546 		usb_syncmem(&std->dma,
1547 		    std->offs + offsetof(uhci_td_t, td_status),
1548 		    sizeof(std->td.td_status),
1549 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1550 		status = le32toh(std->td.td_status);
1551 		usb_syncmem(&std->dma,
1552 		    std->offs + offsetof(uhci_td_t, td_status),
1553 		    sizeof(std->td.td_status), BUS_DMASYNC_PREREAD);
1554 
1555 		/* If there's an active TD the xfer isn't done. */
1556 		if (status & UHCI_TD_ACTIVE) {
1557 			DPRINTFN(12, "ux=%#jx std=%#jx still active",
1558 			    (uintptr_t)ux, (uintptr_t)std, 0, 0);
1559 			return;
1560 		}
1561 
1562 		/* Any kind of error makes the xfer done. */
1563 		if (status & UHCI_TD_STALLED)
1564 			goto done;
1565 
1566 		/*
1567 		 * If the data phase of a control transfer is short, we need
1568 		 * to complete the status stage
1569 		 */
1570 
1571 		if ((status & UHCI_TD_SPD) && ux->ux_type == UX_CTRL) {
1572 			struct uhci_pipe *upipe =
1573 			    UHCI_PIPE2UPIPE(xfer->ux_pipe);
1574 			uhci_soft_qh_t *sqh = upipe->ctrl.sqh;
1575 			uhci_soft_td_t *stat = upipe->ctrl.stat;
1576 
1577 			DPRINTFN(12, "ux=%#jx std=%#jx control status"
1578 			    "phase needs completion", (uintptr_t)ux,
1579 			    (uintptr_t)ux->ux_stdstart, 0, 0);
1580 
1581 			sqh->qh.qh_elink =
1582 			    htole32(stat->physaddr | UHCI_PTR_TD);
1583 			usb_syncmem(&sqh->dma, sqh->offs, sizeof(sqh->qh),
1584 			    BUS_DMASYNC_PREWRITE);
1585 			break;
1586 		}
1587 
1588 		/* We want short packets, and it is short: it's done */
1589 		usb_syncmem(&std->dma,
1590 		    std->offs + offsetof(uhci_td_t, td_token),
1591 		    sizeof(std->td.td_token),
1592 		    BUS_DMASYNC_POSTWRITE);
1593 
1594 		if ((status & UHCI_TD_SPD) &&
1595 			UHCI_TD_GET_ACTLEN(status) <
1596 			UHCI_TD_GET_MAXLEN(le32toh(std->td.td_token))) {
1597 			goto done;
1598 		}
1599 	}
1600 }
1601 
1602 /* Called with USB lock held. */
1603 void
1604 uhci_idone(struct uhci_xfer *ux, ux_completeq_t *cqp)
1605 {
1606 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1607 	struct usbd_xfer *xfer = &ux->ux_xfer;
1608 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
1609 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
1610 	uhci_soft_td_t *std;
1611 	uint32_t status = 0, nstatus;
1612 	int actlen;
1613 
1614 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1615 
1616 	DPRINTFN(12, "ux=%#jx", (uintptr_t)ux, 0, 0, 0);
1617 
1618 	/*
1619 	 * Try to claim this xfer for completion.  If it has already
1620 	 * completed or aborted, drop it on the floor.
1621 	 */
1622 	if (!usbd_xfer_trycomplete(xfer))
1623 		return;
1624 
1625 #ifdef DIAGNOSTIC
1626 #ifdef UHCI_DEBUG
1627 	if (ux->ux_isdone) {
1628 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
1629 		uhci_dump_ii(ux);
1630 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
1631 	}
1632 #endif
1633 	KASSERT(!ux->ux_isdone);
1634 	KASSERTMSG(!ux->ux_isdone, "xfer %p type %d status %d", xfer,
1635 	    ux->ux_type, xfer->ux_status);
1636 	ux->ux_isdone = true;
1637 #endif
1638 
1639 	if (xfer->ux_nframes != 0) {
1640 		/* Isoc transfer, do things differently. */
1641 		uhci_soft_td_t **stds = upipe->isoc.stds;
1642 		int i, n, nframes, len;
1643 
1644 		DPRINTFN(5, "ux=%#jx isoc ready", (uintptr_t)ux, 0, 0, 0);
1645 
1646 		nframes = xfer->ux_nframes;
1647 		actlen = 0;
1648 		n = ux->ux_curframe;
1649 		for (i = 0; i < nframes; i++) {
1650 			std = stds[n];
1651 #ifdef UHCI_DEBUG
1652 			if (uhcidebug >= 5) {
1653 				DPRINTF("isoc TD %jd", i, 0, 0, 0);
1654 				DPRINTF("--- dump start ---", 0, 0, 0, 0);
1655 				uhci_dump_td(std);
1656 				DPRINTF("--- dump end ---", 0, 0, 0, 0);
1657 			}
1658 #endif
1659 			if (++n >= UHCI_VFRAMELIST_COUNT)
1660 				n = 0;
1661 			usb_syncmem(&std->dma,
1662 			    std->offs + offsetof(uhci_td_t, td_status),
1663 			    sizeof(std->td.td_status),
1664 			    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1665 			status = le32toh(std->td.td_status);
1666 			len = UHCI_TD_GET_ACTLEN(status);
1667 			xfer->ux_frlengths[i] = len;
1668 			actlen += len;
1669 		}
1670 		upipe->isoc.inuse -= nframes;
1671 		xfer->ux_actlen = actlen;
1672 		xfer->ux_status = USBD_NORMAL_COMPLETION;
1673 		goto end;
1674 	}
1675 
1676 #ifdef UHCI_DEBUG
1677 	DPRINTFN(10, "ux=%#jx, xfer=%#jx, pipe=%#jx ready", (uintptr_t)ux,
1678 	    (uintptr_t)xfer, (uintptr_t)upipe, 0);
1679 	if (uhcidebug >= 10) {
1680 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
1681 		uhci_dump_tds(ux->ux_stdstart);
1682 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
1683 	}
1684 #endif
1685 
1686 	/* The transfer is done, compute actual length and status. */
1687 	actlen = 0;
1688 	for (std = ux->ux_stdstart; std != NULL; std = std->link.std) {
1689 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
1690 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1691 		nstatus = le32toh(std->td.td_status);
1692 		if (nstatus & UHCI_TD_ACTIVE)
1693 			break;
1694 
1695 		status = nstatus;
1696 		if (UHCI_TD_GET_PID(le32toh(std->td.td_token)) !=
1697 			UHCI_TD_PID_SETUP)
1698 			actlen += UHCI_TD_GET_ACTLEN(status);
1699 		else {
1700 			/*
1701 			 * UHCI will report CRCTO in addition to a STALL or NAK
1702 			 * for a SETUP transaction.  See section 3.2.2, "TD
1703 			 * CONTROL AND STATUS".
1704 			 */
1705 			if (status & (UHCI_TD_STALLED | UHCI_TD_NAK))
1706 				status &= ~UHCI_TD_CRCTO;
1707 		}
1708 	}
1709 	/* If there are left over TDs we need to update the toggle. */
1710 	if (std != NULL)
1711 		upipe->nexttoggle = UHCI_TD_GET_DT(le32toh(std->td.td_token));
1712 
1713 	status &= UHCI_TD_ERROR;
1714 	DPRINTFN(10, "actlen=%jd, status=%#jx", actlen, status, 0, 0);
1715 	xfer->ux_actlen = actlen;
1716 	if (status != 0) {
1717 
1718 		DPRINTFN((status == UHCI_TD_STALLED) * 10,
1719 		    "error, addr=%jd, endpt=0x%02jx",
1720 		    xfer->ux_pipe->up_dev->ud_addr,
1721 		    xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress,
1722 		    0, 0);
1723 		DPRINTFN((status == UHCI_TD_STALLED) * 10,
1724 		    "bitstuff=%jd crcto   =%jd nak     =%jd babble  =%jd",
1725 		    !!(status & UHCI_TD_BITSTUFF),
1726 		    !!(status & UHCI_TD_CRCTO),
1727 		    !!(status & UHCI_TD_NAK),
1728 		    !!(status & UHCI_TD_BABBLE));
1729 		DPRINTFN((status == UHCI_TD_STALLED) * 10,
1730 		    "dbuffer =%jd stalled =%jd active  =%jd",
1731 		    !!(status & UHCI_TD_DBUFFER),
1732 		    !!(status & UHCI_TD_STALLED),
1733 		    !!(status & UHCI_TD_ACTIVE),
1734 		    0);
1735 
1736 		if (status == UHCI_TD_STALLED)
1737 			xfer->ux_status = USBD_STALLED;
1738 		else
1739 			xfer->ux_status = USBD_IOERROR; /* more info XXX */
1740 	} else {
1741 		xfer->ux_status = USBD_NORMAL_COMPLETION;
1742 	}
1743 
1744  end:
1745 	uhci_del_intr_list(sc, ux);
1746 	if (cqp)
1747 		TAILQ_INSERT_TAIL(cqp, ux, ux_list);
1748 
1749 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
1750 	DPRINTFN(12, "ux=%#jx done", (uintptr_t)ux, 0, 0, 0);
1751 }
1752 
1753 void
1754 uhci_poll(struct usbd_bus *bus)
1755 {
1756 	uhci_softc_t *sc = UHCI_BUS2SC(bus);
1757 
1758 	if (UREAD2(sc, UHCI_STS) & UHCI_STS_USBINT) {
1759 		mutex_spin_enter(&sc->sc_intr_lock);
1760 		uhci_intr1(sc);
1761 		mutex_spin_exit(&sc->sc_intr_lock);
1762 	}
1763 }
1764 
1765 void
1766 uhci_reset(uhci_softc_t *sc)
1767 {
1768 	int n;
1769 
1770 	UHCICMD(sc, UHCI_CMD_HCRESET);
1771 	/* The reset bit goes low when the controller is done. */
1772 	for (n = 0; n < UHCI_RESET_TIMEOUT &&
1773 		    (UREAD2(sc, UHCI_CMD) & UHCI_CMD_HCRESET); n++)
1774 		usb_delay_ms(&sc->sc_bus, 1);
1775 	if (n >= UHCI_RESET_TIMEOUT)
1776 		printf("%s: controller did not reset\n",
1777 		       device_xname(sc->sc_dev));
1778 }
1779 
1780 usbd_status
1781 uhci_run(uhci_softc_t *sc, int run)
1782 {
1783 	int n, running;
1784 	uint16_t cmd;
1785 
1786 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1787 
1788 	run = run != 0;
1789 
1790 	DPRINTF("setting run=%jd", run, 0, 0, 0);
1791 	cmd = UREAD2(sc, UHCI_CMD);
1792 	if (run)
1793 		cmd |= UHCI_CMD_RS;
1794 	else
1795 		cmd &= ~UHCI_CMD_RS;
1796 	UHCICMD(sc, cmd);
1797 	for (n = 0; n < 10; n++) {
1798 		running = !(UREAD2(sc, UHCI_STS) & UHCI_STS_HCH);
1799 		/* return when we've entered the state we want */
1800 		if (run == running) {
1801 			DPRINTF("done cmd=%#jx sts=%#jx",
1802 			    UREAD2(sc, UHCI_CMD), UREAD2(sc, UHCI_STS), 0, 0);
1803 			return USBD_NORMAL_COMPLETION;
1804 		}
1805 		usb_delay_ms(&sc->sc_bus, 1);
1806 	}
1807 	printf("%s: cannot %s\n", device_xname(sc->sc_dev),
1808 	       run ? "start" : "stop");
1809 	return USBD_IOERROR;
1810 }
1811 
1812 /*
1813  * Memory management routines.
1814  *  uhci_alloc_std allocates TDs
1815  *  uhci_alloc_sqh allocates QHs
1816  * These two routines do their own free list management,
1817  * partly for speed, partly because allocating DMAable memory
1818  * has page size granularity so much memory would be wasted if
1819  * only one TD/QH (32 bytes) was placed in each allocated chunk.
1820  */
1821 
1822 uhci_soft_td_t *
1823 uhci_alloc_std(uhci_softc_t *sc)
1824 {
1825 	uhci_soft_td_t *std;
1826 	int i, offs;
1827 	usb_dma_t dma;
1828 
1829 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1830 
1831 	mutex_enter(&sc->sc_lock);
1832 	if (sc->sc_freetds == NULL) {
1833 		DPRINTFN(2, "allocating chunk", 0, 0, 0, 0);
1834 		mutex_exit(&sc->sc_lock);
1835 
1836 		int err = usb_allocmem(sc->sc_bus.ub_dmatag, UHCI_STD_SIZE * UHCI_STD_CHUNK,
1837 		    UHCI_TD_ALIGN, USBMALLOC_COHERENT, &dma);
1838 		if (err)
1839 			return NULL;
1840 
1841 		mutex_enter(&sc->sc_lock);
1842 		for (i = 0; i < UHCI_STD_CHUNK; i++) {
1843 			offs = i * UHCI_STD_SIZE;
1844 			std = KERNADDR(&dma, offs);
1845 			std->physaddr = DMAADDR(&dma, offs);
1846 			std->dma = dma;
1847 			std->offs = offs;
1848 			std->link.std = sc->sc_freetds;
1849 			sc->sc_freetds = std;
1850 		}
1851 	}
1852 	std = sc->sc_freetds;
1853 	sc->sc_freetds = std->link.std;
1854 	mutex_exit(&sc->sc_lock);
1855 
1856 	memset(&std->td, 0, sizeof(uhci_td_t));
1857 
1858 	return std;
1859 }
1860 
1861 #define TD_IS_FREE 0x12345678
1862 
1863 void
1864 uhci_free_std_locked(uhci_softc_t *sc, uhci_soft_td_t *std)
1865 {
1866 	KASSERT(mutex_owned(&sc->sc_lock));
1867 
1868 #ifdef DIAGNOSTIC
1869 	if (le32toh(std->td.td_token) == TD_IS_FREE) {
1870 		printf("%s: freeing free TD %p\n", __func__, std);
1871 		return;
1872 	}
1873 	std->td.td_token = htole32(TD_IS_FREE);
1874 #endif
1875 
1876 	std->link.std = sc->sc_freetds;
1877 	sc->sc_freetds = std;
1878 }
1879 
1880 void
1881 uhci_free_std(uhci_softc_t *sc, uhci_soft_td_t *std)
1882 {
1883 	mutex_enter(&sc->sc_lock);
1884 	uhci_free_std_locked(sc, std);
1885 	mutex_exit(&sc->sc_lock);
1886 }
1887 
1888 uhci_soft_qh_t *
1889 uhci_alloc_sqh(uhci_softc_t *sc)
1890 {
1891 	uhci_soft_qh_t *sqh;
1892 	int i, offs;
1893 	usb_dma_t dma;
1894 
1895 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1896 
1897 	mutex_enter(&sc->sc_lock);
1898 	if (sc->sc_freeqhs == NULL) {
1899 		DPRINTFN(2, "allocating chunk", 0, 0, 0, 0);
1900 		mutex_exit(&sc->sc_lock);
1901 
1902 		int err = usb_allocmem(sc->sc_bus.ub_dmatag, UHCI_SQH_SIZE * UHCI_SQH_CHUNK,
1903 		    UHCI_QH_ALIGN, USBMALLOC_COHERENT, &dma);
1904 		if (err)
1905 			return NULL;
1906 
1907 		mutex_enter(&sc->sc_lock);
1908 		for (i = 0; i < UHCI_SQH_CHUNK; i++) {
1909 			offs = i * UHCI_SQH_SIZE;
1910 			sqh = KERNADDR(&dma, offs);
1911 			sqh->physaddr = DMAADDR(&dma, offs);
1912 			sqh->dma = dma;
1913 			sqh->offs = offs;
1914 			sqh->hlink = sc->sc_freeqhs;
1915 			sc->sc_freeqhs = sqh;
1916 		}
1917 	}
1918 	sqh = sc->sc_freeqhs;
1919 	sc->sc_freeqhs = sqh->hlink;
1920 	mutex_exit(&sc->sc_lock);
1921 
1922 	memset(&sqh->qh, 0, sizeof(uhci_qh_t));
1923 
1924 	return sqh;
1925 }
1926 
1927 void
1928 uhci_free_sqh(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
1929 {
1930 	KASSERT(mutex_owned(&sc->sc_lock));
1931 
1932 	sqh->hlink = sc->sc_freeqhs;
1933 	sc->sc_freeqhs = sqh;
1934 }
1935 
1936 #if 0
1937 void
1938 uhci_free_std_chain(uhci_softc_t *sc, uhci_soft_td_t *std,
1939 		    uhci_soft_td_t *stdend)
1940 {
1941 	uhci_soft_td_t *p;
1942 	uint32_t td_link;
1943 
1944 	/*
1945 	 * to avoid race condition with the controller which may be looking
1946 	 * at this chain, we need to first invalidate all links, and
1947 	 * then wait for the controller to move to another queue
1948 	 */
1949 	for (p = std; p != stdend; p = p->link.std) {
1950 		usb_syncmem(&p->dma,
1951 		    p->offs + offsetof(uhci_td_t, td_link),
1952 		    sizeof(p->td.td_link),
1953 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1954 		td_link = le32toh(p->td.td_link);
1955 		usb_syncmem(&p->dma,
1956 		    p->offs + offsetof(uhci_td_t, td_link),
1957 		    sizeof(p->td.td_link),
1958 		    BUS_DMASYNC_PREREAD);
1959 		if ((td_link & UHCI_PTR_T) == 0) {
1960 			p->td.td_link = htole32(UHCI_PTR_T);
1961 			usb_syncmem(&p->dma,
1962 			    p->offs + offsetof(uhci_td_t, td_link),
1963 			    sizeof(p->td.td_link),
1964 			    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1965 		}
1966 	}
1967 	delay(UHCI_QH_REMOVE_DELAY);
1968 
1969 	for (; std != stdend; std = p) {
1970 		p = std->link.std;
1971 		uhci_free_std(sc, std);
1972 	}
1973 }
1974 #endif
1975 
1976 int
1977 uhci_alloc_std_chain(uhci_softc_t *sc, struct usbd_xfer *xfer, int len,
1978     int rd, uhci_soft_td_t **sp)
1979 {
1980 	struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
1981 	uint16_t flags = xfer->ux_flags;
1982 	uhci_soft_td_t *p;
1983 
1984 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
1985 
1986 	DPRINTFN(8, "xfer=%#jx pipe=%#jx", (uintptr_t)xfer,
1987 	    (uintptr_t)xfer->ux_pipe, 0, 0);
1988 
1989 	ASSERT_SLEEPABLE();
1990 	KASSERT(sp);
1991 
1992 	int maxp = UGETW(xfer->ux_pipe->up_endpoint->ue_edesc->wMaxPacketSize);
1993 	if (maxp == 0) {
1994 		printf("%s: maxp=0\n", __func__);
1995 		return EINVAL;
1996 	}
1997 	size_t ntd = howmany(len, maxp);
1998 	/*
1999 	 * if our transfer is bigger than PAGE_SIZE and maxp not a factor of
2000 	 * PAGE_SIZE then we will need another TD per page.
2001 	 */
2002 	if (len > PAGE_SIZE && (PAGE_SIZE % maxp) != 0) {
2003 		ntd += howmany(len, PAGE_SIZE);
2004 	}
2005 
2006 	/*
2007 	 * Might need one more TD if we're writing a ZLP
2008 	 */
2009 	if (!rd && (flags & USBD_FORCE_SHORT_XFER)) {
2010 		ntd++;
2011 	}
2012 	DPRINTFN(10, "maxp=%jd ntd=%jd", maxp, ntd, 0, 0);
2013 
2014 	uxfer->ux_stds = NULL;
2015 	uxfer->ux_nstd = ntd;
2016 	if (ntd == 0) {
2017 		*sp = NULL;
2018 		DPRINTF("ntd=0", 0, 0, 0, 0);
2019 		return 0;
2020 	}
2021 	uxfer->ux_stds = kmem_alloc(sizeof(uhci_soft_td_t *) * ntd,
2022 	    KM_SLEEP);
2023 
2024 	for (int i = 0; i < ntd; i++) {
2025 		p = uhci_alloc_std(sc);
2026 		if (p == NULL) {
2027 			if (i != 0) {
2028 				uxfer->ux_nstd = i;
2029 				uhci_free_stds(sc, uxfer);
2030 			}
2031 			kmem_free(uxfer->ux_stds,
2032 			    sizeof(uhci_soft_td_t *) * ntd);
2033 			return ENOMEM;
2034 		}
2035 		uxfer->ux_stds[i] = p;
2036 	}
2037 
2038 	*sp = uxfer->ux_stds[0];
2039 
2040 	return 0;
2041 }
2042 
2043 Static void
2044 uhci_free_stds(uhci_softc_t *sc, struct uhci_xfer *ux)
2045 {
2046 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2047 
2048 	DPRINTFN(8, "ux=%#jx", (uintptr_t)ux, 0, 0, 0);
2049 
2050 	mutex_enter(&sc->sc_lock);
2051 	for (size_t i = 0; i < ux->ux_nstd; i++) {
2052 		uhci_soft_td_t *std = ux->ux_stds[i];
2053 #ifdef DIAGNOSTIC
2054 		if (le32toh(std->td.td_token) == TD_IS_FREE) {
2055 			printf("%s: freeing free TD %p\n", __func__, std);
2056 			return;
2057 		}
2058 		std->td.td_token = htole32(TD_IS_FREE);
2059 #endif
2060 		ux->ux_stds[i]->link.std = sc->sc_freetds;
2061 		sc->sc_freetds = std;
2062 	}
2063 	mutex_exit(&sc->sc_lock);
2064 }
2065 
2066 
2067 Static void
2068 uhci_reset_std_chain(uhci_softc_t *sc, struct usbd_xfer *xfer,
2069     int length, int isread, int *toggle, uhci_soft_td_t **lstd)
2070 {
2071 	struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
2072 	struct usbd_pipe *pipe = xfer->ux_pipe;
2073 	usb_dma_t *dma = &xfer->ux_dmabuf;
2074 	uint16_t flags = xfer->ux_flags;
2075 	uhci_soft_td_t *std, *prev;
2076 	int len = length;
2077 	int tog = *toggle;
2078 	int maxp;
2079 	uint32_t status;
2080 	size_t i, offs;
2081 
2082 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2083 	DPRINTFN(8, "xfer=%#jx len %jd isread %jd toggle %jd", (uintptr_t)xfer,
2084 	    len, isread, *toggle);
2085 
2086 	KASSERT(len != 0 || (!isread && (flags & USBD_FORCE_SHORT_XFER)));
2087 
2088 	maxp = UGETW(pipe->up_endpoint->ue_edesc->wMaxPacketSize);
2089 	KASSERT(maxp != 0);
2090 
2091 	int addr = xfer->ux_pipe->up_dev->ud_addr;
2092 	int endpt = xfer->ux_pipe->up_endpoint->ue_edesc->bEndpointAddress;
2093 
2094 	status = UHCI_TD_ZERO_ACTLEN(UHCI_TD_SET_ERRCNT(3) | UHCI_TD_ACTIVE);
2095 	if (pipe->up_dev->ud_speed == USB_SPEED_LOW)
2096 		status |= UHCI_TD_LS;
2097 	if (flags & USBD_SHORT_XFER_OK)
2098 		status |= UHCI_TD_SPD;
2099 	usb_syncmem(dma, 0, len,
2100 	    isread ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
2101 	std = prev = NULL;
2102 	for (offs = i = 0; len != 0 && i < uxfer->ux_nstd; i++, prev = std) {
2103 		int l = len;
2104 		std = uxfer->ux_stds[i];
2105 
2106 		const bus_addr_t sbp = DMAADDR(dma, offs);
2107 		const bus_addr_t ebp = DMAADDR(dma, offs + l - 1);
2108 		if (((sbp ^ ebp) & ~PAGE_MASK) != 0)
2109 			l = PAGE_SIZE - (DMAADDR(dma, offs) & PAGE_MASK);
2110 
2111 		if (l > maxp)
2112 			l = maxp;
2113 
2114 		if (prev) {
2115 			prev->link.std = std;
2116 			prev->td.td_link = htole32(
2117 			    std->physaddr | UHCI_PTR_VF | UHCI_PTR_TD
2118 			    );
2119 			usb_syncmem(&prev->dma, prev->offs, sizeof(prev->td),
2120 			    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2121 		}
2122 
2123 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
2124 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
2125 
2126 		std->td.td_link = htole32(UHCI_PTR_T | UHCI_PTR_VF | UHCI_PTR_TD);
2127 		std->td.td_status = htole32(status);
2128 		std->td.td_token = htole32(
2129 		    UHCI_TD_SET_ENDPT(UE_GET_ADDR(endpt)) |
2130 		    UHCI_TD_SET_DEVADDR(addr) |
2131 		    UHCI_TD_SET_PID(isread ? UHCI_TD_PID_IN : UHCI_TD_PID_OUT) |
2132 		    UHCI_TD_SET_DT(tog) |
2133 		    UHCI_TD_SET_MAXLEN(l)
2134 		    );
2135 		std->td.td_buffer = htole32(DMAADDR(dma, offs));
2136 
2137 		std->link.std = NULL;
2138 
2139 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
2140 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2141 		tog ^= 1;
2142 
2143 		offs += l;
2144 		len -= l;
2145 	}
2146 	KASSERTMSG(len == 0, "xfer %p alen %d len %d mps %d ux_nqtd %zu i %zu",
2147 	    xfer, length, len, maxp, uxfer->ux_nstd, i);
2148 
2149 	if (!isread &&
2150 	    (flags & USBD_FORCE_SHORT_XFER) &&
2151 	    length % maxp == 0) {
2152 		/* Force a 0 length transfer at the end. */
2153 		KASSERTMSG(i < uxfer->ux_nstd, "i=%zu nstd=%zu", i,
2154 		    uxfer->ux_nstd);
2155 		std = uxfer->ux_stds[i++];
2156 
2157 		std->td.td_link = htole32(UHCI_PTR_T | UHCI_PTR_VF | UHCI_PTR_TD);
2158 		std->td.td_status = htole32(status);
2159 		std->td.td_token = htole32(
2160 		    UHCI_TD_SET_ENDPT(UE_GET_ADDR(endpt)) |
2161 		    UHCI_TD_SET_DEVADDR(addr) |
2162 		    UHCI_TD_SET_PID(UHCI_TD_PID_OUT) |
2163 		    UHCI_TD_SET_DT(tog) |
2164 		    UHCI_TD_SET_MAXLEN(0)
2165 		    );
2166 		std->td.td_buffer = 0;
2167 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
2168 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2169 
2170 		std->link.std = NULL;
2171 		if (prev) {
2172 			prev->link.std = std;
2173 			prev->td.td_link = htole32(
2174 			    std->physaddr | UHCI_PTR_VF | UHCI_PTR_TD
2175 			    );
2176 			usb_syncmem(&prev->dma, prev->offs, sizeof(prev->td),
2177 			    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2178 		}
2179 		tog ^= 1;
2180 	}
2181 	*lstd = std;
2182 	*toggle = tog;
2183 }
2184 
2185 void
2186 uhci_device_clear_toggle(struct usbd_pipe *pipe)
2187 {
2188 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
2189 	upipe->nexttoggle = 0;
2190 }
2191 
2192 void
2193 uhci_noop(struct usbd_pipe *pipe)
2194 {
2195 }
2196 
2197 int
2198 uhci_device_bulk_init(struct usbd_xfer *xfer)
2199 {
2200 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2201 	struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
2202 	usb_endpoint_descriptor_t *ed = xfer->ux_pipe->up_endpoint->ue_edesc;
2203 	int endpt = ed->bEndpointAddress;
2204 	int isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2205 	int len = xfer->ux_bufsize;
2206 	int err = 0;
2207 
2208 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2209 	DPRINTFN(3, "xfer=%#jx len=%jd flags=%jd", (uintptr_t)xfer, len,
2210 	    xfer->ux_flags, 0);
2211 
2212 	if (sc->sc_dying)
2213 		return USBD_IOERROR;
2214 
2215 	KASSERT(!(xfer->ux_rqflags & URQ_REQUEST));
2216 
2217 	uxfer->ux_type = UX_BULK;
2218 	err = uhci_alloc_std_chain(sc, xfer, len, isread, &uxfer->ux_stdstart);
2219 	if (err)
2220 		return err;
2221 
2222 #ifdef UHCI_DEBUG
2223 	if (uhcidebug >= 10) {
2224 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
2225 		uhci_dump_tds(uxfer->ux_stdstart);
2226 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2227 	}
2228 #endif
2229 
2230 	return 0;
2231 }
2232 
2233 Static void
2234 uhci_device_bulk_fini(struct usbd_xfer *xfer)
2235 {
2236 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2237 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2238 
2239 	KASSERT(ux->ux_type == UX_BULK);
2240 
2241 	if (ux->ux_nstd) {
2242 		uhci_free_stds(sc, ux);
2243 		kmem_free(ux->ux_stds, sizeof(uhci_soft_td_t *) * ux->ux_nstd);
2244 	}
2245 }
2246 
2247 usbd_status
2248 uhci_device_bulk_transfer(struct usbd_xfer *xfer)
2249 {
2250 
2251 	/* Pipe isn't running, so start it first.  */
2252 	return uhci_device_bulk_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
2253 }
2254 
2255 usbd_status
2256 uhci_device_bulk_start(struct usbd_xfer *xfer)
2257 {
2258 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2259 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2260 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2261 	uhci_soft_td_t *data, *dataend;
2262 	uhci_soft_qh_t *sqh;
2263 	int len;
2264 	int endpt;
2265 	int isread;
2266 
2267 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2268 	DPRINTFN(3, "xfer=%#jx len=%jd flags=%jd", (uintptr_t)xfer,
2269 	    xfer->ux_length, xfer->ux_flags, 0);
2270 
2271 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
2272 
2273 	if (sc->sc_dying)
2274 		return USBD_IOERROR;
2275 
2276 	KASSERT(!(xfer->ux_rqflags & URQ_REQUEST));
2277 	KASSERT(xfer->ux_length <= xfer->ux_bufsize);
2278 
2279 	len = xfer->ux_length;
2280 	endpt = upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress;
2281 	isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2282 	sqh = upipe->bulk.sqh;
2283 
2284 	uhci_reset_std_chain(sc, xfer, len, isread, &upipe->nexttoggle,
2285 	    &dataend);
2286 
2287 	data = ux->ux_stdstart;
2288 	ux->ux_stdend = dataend;
2289 	dataend->td.td_status |= htole32(UHCI_TD_IOC);
2290 	usb_syncmem(&dataend->dma,
2291 	    dataend->offs + offsetof(uhci_td_t, td_status),
2292 	    sizeof(dataend->td.td_status),
2293 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2294 
2295 #ifdef UHCI_DEBUG
2296 	if (uhcidebug >= 10) {
2297 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
2298 		DPRINTFN(10, "before transfer", 0, 0, 0, 0);
2299 		uhci_dump_tds(data);
2300 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2301 	}
2302 #endif
2303 
2304 	KASSERT(ux->ux_isdone);
2305 #ifdef DIAGNOSTIC
2306 	ux->ux_isdone = false;
2307 #endif
2308 
2309 	sqh->elink = data;
2310 	sqh->qh.qh_elink = htole32(data->physaddr | UHCI_PTR_TD);
2311 	/* uhci_add_bulk() will do usb_syncmem(sqh) */
2312 
2313 	uhci_add_bulk(sc, sqh);
2314 	uhci_add_intr_list(sc, ux);
2315 	xfer->ux_status = USBD_IN_PROGRESS;
2316 	usbd_xfer_schedule_timeout(xfer);
2317 
2318 	return USBD_IN_PROGRESS;
2319 }
2320 
2321 /* Abort a device bulk request. */
2322 void
2323 uhci_device_bulk_abort(struct usbd_xfer *xfer)
2324 {
2325 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
2326 
2327 	KASSERT(mutex_owned(&sc->sc_lock));
2328 
2329 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2330 
2331 	usbd_xfer_abort(xfer);
2332 }
2333 
2334 /*
2335  * To allow the hardware time to notice we simply wait.
2336  */
2337 Static void
2338 uhci_abortx(struct usbd_xfer *xfer)
2339 {
2340 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2341 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2342 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2343 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2344 	uhci_soft_td_t *std;
2345 
2346 	DPRINTFN(1,"xfer=%#jx", (uintptr_t)xfer, 0, 0, 0);
2347 
2348 	KASSERT(mutex_owned(&sc->sc_lock));
2349 	ASSERT_SLEEPABLE();
2350 
2351 	KASSERTMSG((xfer->ux_status == USBD_CANCELLED ||
2352 		xfer->ux_status == USBD_TIMEOUT),
2353 	    "bad abort status: %d", xfer->ux_status);
2354 
2355 	/*
2356 	 * If we're dying, skip the hardware action and just notify the
2357 	 * software that we're done.
2358 	 */
2359 	if (sc->sc_dying) {
2360 		DPRINTFN(4, "xfer %#jx dying %ju", (uintptr_t)xfer,
2361 		    xfer->ux_status, 0, 0);
2362 		goto dying;
2363 	}
2364 
2365 	/*
2366 	 * HC Step 1: Make interrupt routine and hardware ignore xfer.
2367 	 */
2368 	uhci_del_intr_list(sc, ux);
2369 
2370 	DPRINTF("stop ux=%#jx", (uintptr_t)ux, 0, 0, 0);
2371 	for (std = ux->ux_stdstart; std != NULL; std = std->link.std) {
2372 		usb_syncmem(&std->dma,
2373 		    std->offs + offsetof(uhci_td_t, td_status),
2374 		    sizeof(std->td.td_status),
2375 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
2376 		std->td.td_status &= htole32(~(UHCI_TD_ACTIVE | UHCI_TD_IOC));
2377 		usb_syncmem(&std->dma,
2378 		    std->offs + offsetof(uhci_td_t, td_status),
2379 		    sizeof(std->td.td_status),
2380 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2381 	}
2382 
2383 	/*
2384 	 * HC Step 2: Wait until we know hardware has finished any possible
2385 	 * use of the xfer.
2386 	 */
2387 	/* Hardware finishes in 1ms */
2388 	usb_delay_ms_locked(upipe->pipe.up_dev->ud_bus, 2, &sc->sc_lock);
2389 dying:
2390 #ifdef DIAGNOSTIC
2391 	ux->ux_isdone = true;
2392 #endif
2393 	DPRINTFN(14, "end", 0, 0, 0, 0);
2394 
2395 	KASSERT(mutex_owned(&sc->sc_lock));
2396 }
2397 
2398 /* Close a device bulk pipe. */
2399 void
2400 uhci_device_bulk_close(struct usbd_pipe *pipe)
2401 {
2402 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
2403 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
2404 
2405 	KASSERT(mutex_owned(&sc->sc_lock));
2406 
2407 	uhci_free_sqh(sc, upipe->bulk.sqh);
2408 
2409 	pipe->up_endpoint->ue_toggle = upipe->nexttoggle;
2410 }
2411 
2412 int
2413 uhci_device_ctrl_init(struct usbd_xfer *xfer)
2414 {
2415 	struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
2416 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2417 	usb_device_request_t *req = &xfer->ux_request;
2418 	struct usbd_device *dev = upipe->pipe.up_dev;
2419 	uhci_softc_t *sc = dev->ud_bus->ub_hcpriv;
2420 	uhci_soft_td_t *data = NULL;
2421 	int len;
2422 	usbd_status err;
2423 	int isread;
2424 
2425 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2426 	DPRINTFN(3, "xfer=%#jx len=%jd, addr=%jd, endpt=%jd",
2427 	    (uintptr_t)xfer, xfer->ux_bufsize, dev->ud_addr,
2428 	    upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress);
2429 
2430 	isread = req->bmRequestType & UT_READ;
2431 	len = xfer->ux_bufsize;
2432 
2433 	uxfer->ux_type = UX_CTRL;
2434 	/* Set up data transaction */
2435 	if (len != 0) {
2436 		err = uhci_alloc_std_chain(sc, xfer, len, isread, &data);
2437 		if (err)
2438 			return err;
2439 	}
2440 	/* Set up interrupt info. */
2441 	uxfer->ux_setup = upipe->ctrl.setup;
2442 	uxfer->ux_stat = upipe->ctrl.stat;
2443 	uxfer->ux_data = data;
2444 
2445 	return 0;
2446 }
2447 
2448 Static void
2449 uhci_device_ctrl_fini(struct usbd_xfer *xfer)
2450 {
2451 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2452 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2453 
2454 	KASSERT(ux->ux_type == UX_CTRL);
2455 
2456 	if (ux->ux_nstd) {
2457 		uhci_free_stds(sc, ux);
2458 		kmem_free(ux->ux_stds, sizeof(uhci_soft_td_t *) * ux->ux_nstd);
2459 	}
2460 }
2461 
2462 usbd_status
2463 uhci_device_ctrl_transfer(struct usbd_xfer *xfer)
2464 {
2465 
2466 	/* Pipe isn't running, so start it first.  */
2467 	return uhci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
2468 }
2469 
2470 usbd_status
2471 uhci_device_ctrl_start(struct usbd_xfer *xfer)
2472 {
2473 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2474 	struct uhci_xfer *uxfer = UHCI_XFER2UXFER(xfer);
2475 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2476 	usb_device_request_t *req = &xfer->ux_request;
2477 	struct usbd_device *dev = upipe->pipe.up_dev;
2478 	int addr = dev->ud_addr;
2479 	int endpt = upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress;
2480 	uhci_soft_td_t *setup, *stat, *next, *dataend;
2481 	uhci_soft_qh_t *sqh;
2482 	int len;
2483 	int isread;
2484 
2485 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2486 
2487 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
2488 
2489 	if (sc->sc_dying)
2490 		return USBD_IOERROR;
2491 
2492 	KASSERT(xfer->ux_rqflags & URQ_REQUEST);
2493 
2494 	DPRINTFN(3, "type=0x%02jx, request=0x%02jx, "
2495 	    "wValue=0x%04jx, wIndex=0x%04jx",
2496 	    req->bmRequestType, req->bRequest, UGETW(req->wValue),
2497 	    UGETW(req->wIndex));
2498 	DPRINTFN(3, "len=%jd, addr=%jd, endpt=%jd",
2499 	    UGETW(req->wLength), dev->ud_addr, endpt, 0);
2500 
2501 	isread = req->bmRequestType & UT_READ;
2502 	len = UGETW(req->wLength);
2503 
2504 	setup = upipe->ctrl.setup;
2505 	stat = upipe->ctrl.stat;
2506 	sqh = upipe->ctrl.sqh;
2507 
2508 	memcpy(KERNADDR(&upipe->ctrl.reqdma, 0), req, sizeof(*req));
2509 	usb_syncmem(&upipe->ctrl.reqdma, 0, sizeof(*req), BUS_DMASYNC_PREWRITE);
2510 
2511 	/* Set up data transaction */
2512 	if (len != 0) {
2513 		upipe->nexttoggle = 1;
2514 		next = uxfer->ux_data;
2515 		uhci_reset_std_chain(sc, xfer, len, isread,
2516 		    &upipe->nexttoggle, &dataend);
2517 		dataend->link.std = stat;
2518 		dataend->td.td_link = htole32(stat->physaddr | UHCI_PTR_TD);
2519 		usb_syncmem(&dataend->dma,
2520 		    dataend->offs + offsetof(uhci_td_t, td_link),
2521 		    sizeof(dataend->td.td_link),
2522 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2523 	} else {
2524 		next = stat;
2525 	}
2526 
2527 	const uint32_t status = UHCI_TD_ZERO_ACTLEN(
2528 	    UHCI_TD_SET_ERRCNT(3) |
2529 	    UHCI_TD_ACTIVE |
2530 	    (dev->ud_speed == USB_SPEED_LOW ? UHCI_TD_LS : 0)
2531 	    );
2532 	setup->link.std = next;
2533 	setup->td.td_link = htole32(next->physaddr | UHCI_PTR_TD);
2534 	setup->td.td_status = htole32(status);
2535 	setup->td.td_token = htole32(UHCI_TD_SETUP(sizeof(*req), endpt, addr));
2536 	setup->td.td_buffer = htole32(DMAADDR(&upipe->ctrl.reqdma, 0));
2537 
2538 	usb_syncmem(&setup->dma, setup->offs, sizeof(setup->td),
2539 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2540 
2541 	stat->link.std = NULL;
2542 	stat->td.td_link = htole32(UHCI_PTR_T);
2543 	stat->td.td_status = htole32(status | UHCI_TD_IOC);
2544 	stat->td.td_token =
2545 		htole32(isread ? UHCI_TD_OUT(0, endpt, addr, 1) :
2546 				 UHCI_TD_IN (0, endpt, addr, 1));
2547 	stat->td.td_buffer = htole32(0);
2548 	usb_syncmem(&stat->dma, stat->offs, sizeof(stat->td),
2549 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2550 
2551 #ifdef UHCI_DEBUG
2552 	if (uhcidebug >= 10) {
2553 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
2554 		DPRINTF("before transfer", 0, 0, 0, 0);
2555 		uhci_dump_tds(setup);
2556 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2557 	}
2558 #endif
2559 
2560 	/* Set up interrupt info. */
2561 	uxfer->ux_setup = setup;
2562 	uxfer->ux_stat = stat;
2563 	KASSERT(uxfer->ux_isdone);
2564 #ifdef DIAGNOSTIC
2565 	uxfer->ux_isdone = false;
2566 #endif
2567 
2568 	sqh->elink = setup;
2569 	sqh->qh.qh_elink = htole32(setup->physaddr | UHCI_PTR_TD);
2570 	/* uhci_add_?s_ctrl() will do usb_syncmem(sqh) */
2571 
2572 	if (dev->ud_speed == USB_SPEED_LOW)
2573 		uhci_add_ls_ctrl(sc, sqh);
2574 	else
2575 		uhci_add_hs_ctrl(sc, sqh);
2576 	uhci_add_intr_list(sc, uxfer);
2577 #ifdef UHCI_DEBUG
2578 	if (uhcidebug >= 12) {
2579 		uhci_soft_td_t *std;
2580 		uhci_soft_qh_t *xqh;
2581 		uhci_soft_qh_t *sxqh;
2582 		int maxqh = 0;
2583 		uhci_physaddr_t link;
2584 		DPRINTFN(12, "--- dump start ---", 0, 0, 0, 0);
2585 		DPRINTFN(12, "follow from [0]", 0, 0, 0, 0);
2586 		for (std = sc->sc_vframes[0].htd, link = 0;
2587 		     (link & UHCI_PTR_QH) == 0;
2588 		     std = std->link.std) {
2589 			link = le32toh(std->td.td_link);
2590 			uhci_dump_td(std);
2591 		}
2592 		sxqh = (uhci_soft_qh_t *)std;
2593 		uhci_dump_qh(sxqh);
2594 		for (xqh = sxqh;
2595 		     xqh != NULL;
2596 		     xqh = (maxqh++ == 5 || xqh->hlink == sxqh ||
2597 			xqh->hlink == xqh ? NULL : xqh->hlink)) {
2598 			uhci_dump_qh(xqh);
2599 		}
2600 		DPRINTFN(12, "Enqueued QH:", 0, 0, 0, 0);
2601 		uhci_dump_qh(sqh);
2602 		uhci_dump_tds(sqh->elink);
2603 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2604 	}
2605 #endif
2606 	xfer->ux_status = USBD_IN_PROGRESS;
2607 	usbd_xfer_schedule_timeout(xfer);
2608 
2609 	return USBD_IN_PROGRESS;
2610 }
2611 
2612 int
2613 uhci_device_intr_init(struct usbd_xfer *xfer)
2614 {
2615 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2616 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2617 	usb_endpoint_descriptor_t *ed = xfer->ux_pipe->up_endpoint->ue_edesc;
2618 	int endpt = ed->bEndpointAddress;
2619 	int isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2620 	int len = xfer->ux_bufsize;
2621 	int err;
2622 
2623 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2624 
2625 	DPRINTFN(3, "xfer=%#jx len=%jd flags=%jd", (uintptr_t)xfer,
2626 	    xfer->ux_length, xfer->ux_flags, 0);
2627 
2628 	KASSERT(!(xfer->ux_rqflags & URQ_REQUEST));
2629 	KASSERT(len != 0);
2630 
2631 	ux->ux_type = UX_INTR;
2632 	ux->ux_nstd = 0;
2633 	err = uhci_alloc_std_chain(sc, xfer, len, isread, &ux->ux_stdstart);
2634 
2635 	return err;
2636 }
2637 
2638 Static void
2639 uhci_device_intr_fini(struct usbd_xfer *xfer)
2640 {
2641 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2642 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2643 
2644 	KASSERT(ux->ux_type == UX_INTR);
2645 
2646 	if (ux->ux_nstd) {
2647 		uhci_free_stds(sc, ux);
2648 		kmem_free(ux->ux_stds, sizeof(uhci_soft_td_t *) * ux->ux_nstd);
2649 	}
2650 }
2651 
2652 usbd_status
2653 uhci_device_intr_transfer(struct usbd_xfer *xfer)
2654 {
2655 
2656 	/* Pipe isn't running, so start it first.  */
2657 	return uhci_device_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
2658 }
2659 
2660 usbd_status
2661 uhci_device_intr_start(struct usbd_xfer *xfer)
2662 {
2663 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2664 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2665 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2666 	uhci_soft_td_t *data, *dataend;
2667 	uhci_soft_qh_t *sqh;
2668 	int isread, endpt;
2669 	int i;
2670 
2671 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2672 
2673 	DPRINTFN(3, "xfer=%#jx len=%jd flags=%jd", (uintptr_t)xfer,
2674 	    xfer->ux_length, xfer->ux_flags, 0);
2675 
2676 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
2677 
2678 	if (sc->sc_dying)
2679 		return USBD_IOERROR;
2680 
2681 	KASSERT(!(xfer->ux_rqflags & URQ_REQUEST));
2682 	KASSERT(xfer->ux_length <= xfer->ux_bufsize);
2683 
2684 	endpt = upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress;
2685 	isread = UE_GET_DIR(endpt) == UE_DIR_IN;
2686 
2687 	data = ux->ux_stdstart;
2688 
2689 	KASSERT(ux->ux_isdone);
2690 #ifdef DIAGNOSTIC
2691 	ux->ux_isdone = false;
2692 #endif
2693 
2694 	/* Take lock to protect nexttoggle */
2695 	uhci_reset_std_chain(sc, xfer, xfer->ux_length, isread,
2696 	    &upipe->nexttoggle, &dataend);
2697 
2698 	dataend->td.td_status |= htole32(UHCI_TD_IOC);
2699 	usb_syncmem(&dataend->dma,
2700 	    dataend->offs + offsetof(uhci_td_t, td_status),
2701 	    sizeof(dataend->td.td_status),
2702 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2703 	ux->ux_stdend = dataend;
2704 
2705 #ifdef UHCI_DEBUG
2706 	if (uhcidebug >= 10) {
2707 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
2708 		uhci_dump_tds(data);
2709 		uhci_dump_qh(upipe->intr.qhs[0]);
2710 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2711 	}
2712 #endif
2713 
2714 	DPRINTFN(10, "qhs[0]=%#jx", (uintptr_t)upipe->intr.qhs[0], 0, 0, 0);
2715 	for (i = 0; i < upipe->intr.npoll; i++) {
2716 		sqh = upipe->intr.qhs[i];
2717 		sqh->elink = data;
2718 		sqh->qh.qh_elink = htole32(data->physaddr | UHCI_PTR_TD);
2719 		usb_syncmem(&sqh->dma,
2720 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
2721 		    sizeof(sqh->qh.qh_elink),
2722 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2723 	}
2724 	uhci_add_intr_list(sc, ux);
2725 	xfer->ux_status = USBD_IN_PROGRESS;
2726 
2727 #ifdef UHCI_DEBUG
2728 	if (uhcidebug >= 10) {
2729 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
2730 		uhci_dump_tds(data);
2731 		uhci_dump_qh(upipe->intr.qhs[0]);
2732 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
2733 	}
2734 #endif
2735 
2736 	return USBD_IN_PROGRESS;
2737 }
2738 
2739 /* Abort a device control request. */
2740 void
2741 uhci_device_ctrl_abort(struct usbd_xfer *xfer)
2742 {
2743 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
2744 
2745 	KASSERT(mutex_owned(&sc->sc_lock));
2746 
2747 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2748 	usbd_xfer_abort(xfer);
2749 }
2750 
2751 /* Close a device control pipe. */
2752 void
2753 uhci_device_ctrl_close(struct usbd_pipe *pipe)
2754 {
2755 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
2756 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
2757 
2758 	uhci_free_sqh(sc, upipe->ctrl.sqh);
2759 	uhci_free_std_locked(sc, upipe->ctrl.setup);
2760 	uhci_free_std_locked(sc, upipe->ctrl.stat);
2761 
2762 	usb_freemem(&upipe->ctrl.reqdma);
2763 }
2764 
2765 /* Abort a device interrupt request. */
2766 void
2767 uhci_device_intr_abort(struct usbd_xfer *xfer)
2768 {
2769 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
2770 
2771 	KASSERT(mutex_owned(&sc->sc_lock));
2772 
2773 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2774 	DPRINTF("xfer=%#jx", (uintptr_t)xfer, 0, 0, 0);
2775 
2776 	usbd_xfer_abort(xfer);
2777 }
2778 
2779 /* Close a device interrupt pipe. */
2780 void
2781 uhci_device_intr_close(struct usbd_pipe *pipe)
2782 {
2783 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
2784 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
2785 	int i, npoll;
2786 
2787 	KASSERT(mutex_owned(&sc->sc_lock));
2788 
2789 	/* Unlink descriptors from controller data structures. */
2790 	npoll = upipe->intr.npoll;
2791 	for (i = 0; i < npoll; i++)
2792 		uhci_remove_intr(sc, upipe->intr.qhs[i]);
2793 
2794 	/*
2795 	 * We now have to wait for any activity on the physical
2796 	 * descriptors to stop.
2797 	 */
2798 	usb_delay_ms_locked(&sc->sc_bus, 2, &sc->sc_lock);
2799 
2800 	for (i = 0; i < npoll; i++)
2801 		uhci_free_sqh(sc, upipe->intr.qhs[i]);
2802 	kmem_free(upipe->intr.qhs, npoll * sizeof(uhci_soft_qh_t *));
2803 }
2804 
2805 int
2806 uhci_device_isoc_init(struct usbd_xfer *xfer)
2807 {
2808 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2809 
2810 	KASSERT(!(xfer->ux_rqflags & URQ_REQUEST));
2811 	KASSERT(xfer->ux_nframes != 0);
2812 	KASSERT(ux->ux_isdone);
2813 
2814 	ux->ux_type = UX_ISOC;
2815 	return 0;
2816 }
2817 
2818 Static void
2819 uhci_device_isoc_fini(struct usbd_xfer *xfer)
2820 {
2821 	struct uhci_xfer *ux __diagused = UHCI_XFER2UXFER(xfer);
2822 
2823 	KASSERT(ux->ux_type == UX_ISOC);
2824 }
2825 
2826 usbd_status
2827 uhci_device_isoc_transfer(struct usbd_xfer *xfer)
2828 {
2829 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2830 
2831 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
2832 	DPRINTFN(5, "xfer=%#jx", (uintptr_t)xfer, 0, 0, 0);
2833 
2834 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
2835 
2836 	/* insert into schedule, */
2837 
2838 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2839 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2840 	struct isoc *isoc = &upipe->isoc;
2841 	uhci_soft_td_t *std = NULL;
2842 	uint32_t buf, len, status, offs;
2843 	int i, next, nframes;
2844 	int rd = UE_GET_DIR(upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress) == UE_DIR_IN;
2845 
2846 	DPRINTFN(5, "used=%jd next=%jd xfer=%#jx nframes=%jd",
2847 	    isoc->inuse, isoc->next, (uintptr_t)xfer, xfer->ux_nframes);
2848 
2849 	if (sc->sc_dying)
2850 		return USBD_IOERROR;
2851 
2852 	if (xfer->ux_status == USBD_IN_PROGRESS) {
2853 		/* This request has already been entered into the frame list */
2854 		printf("%s: xfer=%p in frame list\n", __func__, xfer);
2855 		/* XXX */
2856 	}
2857 
2858 #ifdef DIAGNOSTIC
2859 	if (isoc->inuse >= UHCI_VFRAMELIST_COUNT)
2860 		printf("%s: overflow!\n", __func__);
2861 #endif
2862 
2863 	KASSERT(xfer->ux_nframes != 0);
2864 
2865 	if (xfer->ux_length)
2866 		usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
2867 		    rd ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
2868 
2869 	next = isoc->next;
2870 	if (next == -1) {
2871 		/* Not in use yet, schedule it a few frames ahead. */
2872 		next = (UREAD2(sc, UHCI_FRNUM) + 3) % UHCI_VFRAMELIST_COUNT;
2873 		DPRINTFN(2, "start next=%jd", next, 0, 0, 0);
2874 	}
2875 
2876 	xfer->ux_status = USBD_IN_PROGRESS;
2877 	ux->ux_curframe = next;
2878 
2879 	offs = 0;
2880 	status = UHCI_TD_ZERO_ACTLEN(UHCI_TD_SET_ERRCNT(0) |
2881 				     UHCI_TD_ACTIVE |
2882 				     UHCI_TD_IOS);
2883 	nframes = xfer->ux_nframes;
2884 	for (i = 0; i < nframes; i++) {
2885 		buf = DMAADDR(&xfer->ux_dmabuf, offs);
2886 		std = isoc->stds[next];
2887 		if (++next >= UHCI_VFRAMELIST_COUNT)
2888 			next = 0;
2889 		len = xfer->ux_frlengths[i];
2890 
2891 		KASSERTMSG(len <= __SHIFTOUT_MASK(UHCI_TD_MAXLEN_MASK),
2892 		    "len %d", len);
2893 		std->td.td_buffer = htole32(buf);
2894 		usb_syncmem(&xfer->ux_dmabuf, offs, len,
2895 		    rd ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
2896 		if (i == nframes - 1)
2897 			status |= UHCI_TD_IOC;
2898 		std->td.td_status = htole32(status);
2899 		std->td.td_token &= htole32(~UHCI_TD_MAXLEN_MASK);
2900 		std->td.td_token |= htole32(UHCI_TD_SET_MAXLEN(len));
2901 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
2902 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2903 #ifdef UHCI_DEBUG
2904 		if (uhcidebug >= 5) {
2905 			DPRINTF("--- dump start ---", 0, 0, 0, 0);
2906 			DPRINTF("TD %jd", i, 0, 0, 0);
2907 			uhci_dump_td(std);
2908 			DPRINTF("--- dump end ---", 0, 0, 0, 0);
2909 		}
2910 #endif
2911 		offs += len;
2912 		const bus_addr_t bend __diagused =
2913 		    DMAADDR(&xfer->ux_dmabuf, offs - 1);
2914 
2915 		KASSERT(((buf ^ bend) & ~PAGE_MASK) == 0);
2916 	}
2917 	isoc->next = next;
2918 	isoc->inuse += xfer->ux_nframes;
2919 
2920 	/* Set up interrupt info. */
2921 	ux->ux_stdstart = std;
2922 	ux->ux_stdend = std;
2923 
2924 	KASSERT(ux->ux_isdone);
2925 #ifdef DIAGNOSTIC
2926 	ux->ux_isdone = false;
2927 #endif
2928 	uhci_add_intr_list(sc, ux);
2929 
2930 	return USBD_IN_PROGRESS;
2931 }
2932 
2933 void
2934 uhci_device_isoc_abort(struct usbd_xfer *xfer)
2935 {
2936 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
2937 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
2938 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
2939 	uhci_soft_td_t **stds = upipe->isoc.stds;
2940 	uhci_soft_td_t *std;
2941 	int i, n, nframes, maxlen, len;
2942 
2943 	KASSERT(mutex_owned(&sc->sc_lock));
2944 
2945 	/* Transfer is already done. */
2946 	if (xfer->ux_status != USBD_NOT_STARTED &&
2947 	    xfer->ux_status != USBD_IN_PROGRESS) {
2948 		return;
2949 	}
2950 
2951 	/* Give xfer the requested abort code. */
2952 	xfer->ux_status = USBD_CANCELLED;
2953 
2954 	/* make hardware ignore it, */
2955 	nframes = xfer->ux_nframes;
2956 	n = ux->ux_curframe;
2957 	maxlen = 0;
2958 	for (i = 0; i < nframes; i++) {
2959 		std = stds[n];
2960 		usb_syncmem(&std->dma,
2961 		    std->offs + offsetof(uhci_td_t, td_status),
2962 		    sizeof(std->td.td_status),
2963 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
2964 		std->td.td_status &= htole32(~(UHCI_TD_ACTIVE | UHCI_TD_IOC));
2965 		usb_syncmem(&std->dma,
2966 		    std->offs + offsetof(uhci_td_t, td_status),
2967 		    sizeof(std->td.td_status),
2968 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
2969 		usb_syncmem(&std->dma,
2970 		    std->offs + offsetof(uhci_td_t, td_token),
2971 		    sizeof(std->td.td_token),
2972 		    BUS_DMASYNC_POSTWRITE);
2973 		len = UHCI_TD_GET_MAXLEN(le32toh(std->td.td_token));
2974 		if (len > maxlen)
2975 			maxlen = len;
2976 		if (++n >= UHCI_VFRAMELIST_COUNT)
2977 			n = 0;
2978 	}
2979 
2980 	/* and wait until we are sure the hardware has finished. */
2981 	delay(maxlen);
2982 
2983 #ifdef DIAGNOSTIC
2984 	ux->ux_isdone = true;
2985 #endif
2986 	/* Remove from interrupt list. */
2987 	uhci_del_intr_list(sc, ux);
2988 
2989 	/* Run callback. */
2990 	usb_transfer_complete(xfer);
2991 
2992 	KASSERT(mutex_owned(&sc->sc_lock));
2993 }
2994 
2995 void
2996 uhci_device_isoc_close(struct usbd_pipe *pipe)
2997 {
2998 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
2999 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
3000 	uhci_soft_td_t *std, *vstd;
3001 	struct isoc *isoc;
3002 	int i;
3003 
3004 	KASSERT(mutex_owned(&sc->sc_lock));
3005 
3006 	/*
3007 	 * Make sure all TDs are marked as inactive.
3008 	 * Wait for completion.
3009 	 * Unschedule.
3010 	 * Deallocate.
3011 	 */
3012 	isoc = &upipe->isoc;
3013 
3014 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
3015 		std = isoc->stds[i];
3016 		usb_syncmem(&std->dma,
3017 		    std->offs + offsetof(uhci_td_t, td_status),
3018 		    sizeof(std->td.td_status),
3019 		    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
3020 		std->td.td_status &= htole32(~UHCI_TD_ACTIVE);
3021 		usb_syncmem(&std->dma,
3022 		    std->offs + offsetof(uhci_td_t, td_status),
3023 		    sizeof(std->td.td_status),
3024 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3025 	}
3026 	/* wait for completion */
3027 	usb_delay_ms_locked(&sc->sc_bus, 2, &sc->sc_lock);
3028 
3029 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
3030 		std = isoc->stds[i];
3031 		for (vstd = sc->sc_vframes[i].htd;
3032 		     vstd != NULL && vstd->link.std != std;
3033 		     vstd = vstd->link.std)
3034 			;
3035 		if (vstd == NULL) {
3036 			/*panic*/
3037 			printf("%s: %p not found\n", __func__, std);
3038 			mutex_exit(&sc->sc_lock);
3039 			return;
3040 		}
3041 		vstd->link = std->link;
3042 		usb_syncmem(&std->dma,
3043 		    std->offs + offsetof(uhci_td_t, td_link),
3044 		    sizeof(std->td.td_link),
3045 		    BUS_DMASYNC_POSTWRITE);
3046 		vstd->td.td_link = std->td.td_link;
3047 		usb_syncmem(&vstd->dma,
3048 		    vstd->offs + offsetof(uhci_td_t, td_link),
3049 		    sizeof(vstd->td.td_link),
3050 		    BUS_DMASYNC_PREWRITE);
3051 		uhci_free_std_locked(sc, std);
3052 	}
3053 
3054 	kmem_free(isoc->stds, UHCI_VFRAMELIST_COUNT * sizeof(uhci_soft_td_t *));
3055 }
3056 
3057 usbd_status
3058 uhci_setup_isoc(struct usbd_pipe *pipe)
3059 {
3060 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
3061 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
3062 	int addr = upipe->pipe.up_dev->ud_addr;
3063 	int endpt = upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress;
3064 	int rd = UE_GET_DIR(endpt) == UE_DIR_IN;
3065 	uhci_soft_td_t *std, *vstd;
3066 	uint32_t token;
3067 	struct isoc *isoc;
3068 	int i;
3069 
3070 	isoc = &upipe->isoc;
3071 
3072 	isoc->stds = kmem_alloc(
3073 	    UHCI_VFRAMELIST_COUNT * sizeof(uhci_soft_td_t *), KM_SLEEP);
3074 	if (isoc->stds == NULL)
3075 		return USBD_NOMEM;
3076 
3077 	token = rd ? UHCI_TD_IN (0, endpt, addr, 0) :
3078 		     UHCI_TD_OUT(0, endpt, addr, 0);
3079 
3080 	/* Allocate the TDs and mark as inactive; */
3081 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
3082 		std = uhci_alloc_std(sc);
3083 		if (std == 0)
3084 			goto bad;
3085 		std->td.td_status = htole32(UHCI_TD_IOS); /* iso, inactive */
3086 		std->td.td_token = htole32(token);
3087 		usb_syncmem(&std->dma, std->offs, sizeof(std->td),
3088 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3089 		isoc->stds[i] = std;
3090 	}
3091 
3092 	mutex_enter(&sc->sc_lock);
3093 
3094 	/* Insert TDs into schedule. */
3095 	for (i = 0; i < UHCI_VFRAMELIST_COUNT; i++) {
3096 		std = isoc->stds[i];
3097 		vstd = sc->sc_vframes[i].htd;
3098 		usb_syncmem(&vstd->dma,
3099 		    vstd->offs + offsetof(uhci_td_t, td_link),
3100 		    sizeof(vstd->td.td_link),
3101 		    BUS_DMASYNC_POSTWRITE);
3102 		std->link = vstd->link;
3103 		std->td.td_link = vstd->td.td_link;
3104 		usb_syncmem(&std->dma,
3105 		    std->offs + offsetof(uhci_td_t, td_link),
3106 		    sizeof(std->td.td_link),
3107 		    BUS_DMASYNC_PREWRITE);
3108 		vstd->link.std = std;
3109 		vstd->td.td_link = htole32(std->physaddr | UHCI_PTR_TD);
3110 		usb_syncmem(&vstd->dma,
3111 		    vstd->offs + offsetof(uhci_td_t, td_link),
3112 		    sizeof(vstd->td.td_link),
3113 		    BUS_DMASYNC_PREWRITE);
3114 	}
3115 	mutex_exit(&sc->sc_lock);
3116 
3117 	isoc->next = -1;
3118 	isoc->inuse = 0;
3119 
3120 	return USBD_NORMAL_COMPLETION;
3121 
3122  bad:
3123 	while (--i >= 0)
3124 		uhci_free_std(sc, isoc->stds[i]);
3125 	kmem_free(isoc->stds, UHCI_VFRAMELIST_COUNT * sizeof(uhci_soft_td_t *));
3126 	return USBD_NOMEM;
3127 }
3128 
3129 void
3130 uhci_device_isoc_done(struct usbd_xfer *xfer)
3131 {
3132 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
3133 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
3134 	struct uhci_xfer *ux = UHCI_XFER2UXFER(xfer);
3135 	int rd = UE_GET_DIR(upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress) == UE_DIR_IN;
3136 
3137 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3138 	DPRINTFN(4, "length=%jd, ux_state=0x%08jx",
3139 	    xfer->ux_actlen, xfer->ux_state, 0, 0);
3140 
3141 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
3142 
3143 #ifdef DIAGNOSTIC
3144 	if (ux->ux_stdend == NULL) {
3145 		printf("%s: xfer=%p stdend==NULL\n", __func__, xfer);
3146 #ifdef UHCI_DEBUG
3147 		DPRINTF("--- dump start ---", 0, 0, 0, 0);
3148 		uhci_dump_ii(ux);
3149 		DPRINTF("--- dump end ---", 0, 0, 0, 0);
3150 #endif
3151 		return;
3152 	}
3153 #endif
3154 
3155 	/* Turn off the interrupt since it is active even if the TD is not. */
3156 	usb_syncmem(&ux->ux_stdend->dma,
3157 	    ux->ux_stdend->offs + offsetof(uhci_td_t, td_status),
3158 	    sizeof(ux->ux_stdend->td.td_status),
3159 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
3160 	ux->ux_stdend->td.td_status &= htole32(~UHCI_TD_IOC);
3161 	usb_syncmem(&ux->ux_stdend->dma,
3162 	    ux->ux_stdend->offs + offsetof(uhci_td_t, td_status),
3163 	    sizeof(ux->ux_stdend->td.td_status),
3164 	    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3165 
3166 	if (xfer->ux_length)
3167 		usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
3168 		    rd ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
3169 }
3170 
3171 void
3172 uhci_device_intr_done(struct usbd_xfer *xfer)
3173 {
3174 	uhci_softc_t *sc __diagused = UHCI_XFER2SC(xfer);
3175 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
3176 	uhci_soft_qh_t *sqh;
3177 	int i, npoll;
3178 
3179 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3180 	DPRINTFN(5, "length=%jd", xfer->ux_actlen, 0, 0, 0);
3181 
3182 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
3183 
3184 	npoll = upipe->intr.npoll;
3185 	for (i = 0; i < npoll; i++) {
3186 		sqh = upipe->intr.qhs[i];
3187 		sqh->elink = NULL;
3188 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
3189 		usb_syncmem(&sqh->dma,
3190 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
3191 		    sizeof(sqh->qh.qh_elink),
3192 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3193 	}
3194 	const int endpt = upipe->pipe.up_endpoint->ue_edesc->bEndpointAddress;
3195 	const bool isread = UE_GET_DIR(endpt) == UE_DIR_IN;
3196 	usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
3197 	    isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
3198 }
3199 
3200 /* Deallocate request data structures */
3201 void
3202 uhci_device_ctrl_done(struct usbd_xfer *xfer)
3203 {
3204 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
3205 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
3206 	int len = UGETW(xfer->ux_request.wLength);
3207 	int isread = (xfer->ux_request.bmRequestType & UT_READ);
3208 
3209 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3210 
3211 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
3212 	KASSERT(xfer->ux_rqflags & URQ_REQUEST);
3213 
3214 	/* XXXNH move to uhci_idone??? */
3215 	if (upipe->pipe.up_dev->ud_speed == USB_SPEED_LOW)
3216 		uhci_remove_ls_ctrl(sc, upipe->ctrl.sqh);
3217 	else
3218 		uhci_remove_hs_ctrl(sc, upipe->ctrl.sqh);
3219 
3220 	if (len) {
3221 		usb_syncmem(&xfer->ux_dmabuf, 0, len,
3222 		    isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
3223 	}
3224 	usb_syncmem(&upipe->ctrl.reqdma, 0,
3225 	    sizeof(usb_device_request_t),  BUS_DMASYNC_POSTWRITE);
3226 
3227 	DPRINTF("length=%jd", xfer->ux_actlen, 0, 0, 0);
3228 }
3229 
3230 /* Deallocate request data structures */
3231 void
3232 uhci_device_bulk_done(struct usbd_xfer *xfer)
3233 {
3234 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
3235 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(xfer->ux_pipe);
3236 	usb_endpoint_descriptor_t *ed = xfer->ux_pipe->up_endpoint->ue_edesc;
3237 	int endpt = ed->bEndpointAddress;
3238 	int isread = UE_GET_DIR(endpt) == UE_DIR_IN;
3239 
3240 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3241 	DPRINTFN(5, "xfer=%#jx sc=%#jx upipe=%#jx", (uintptr_t)xfer,
3242 	    (uintptr_t)sc, (uintptr_t)upipe, 0);
3243 
3244 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
3245 
3246 	uhci_remove_bulk(sc, upipe->bulk.sqh);
3247 
3248 	if (xfer->ux_length) {
3249 		usb_syncmem(&xfer->ux_dmabuf, 0, xfer->ux_length,
3250 		    isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
3251 	}
3252 
3253 	DPRINTFN(5, "length=%jd", xfer->ux_actlen, 0, 0, 0);
3254 }
3255 
3256 /* Add interrupt QH, called with vflock. */
3257 void
3258 uhci_add_intr(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
3259 {
3260 	struct uhci_vframe *vf = &sc->sc_vframes[sqh->pos];
3261 	uhci_soft_qh_t *eqh;
3262 
3263 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3264 	DPRINTFN(4, "n=%jd sqh=%#jx", sqh->pos, (uintptr_t)sqh, 0, 0);
3265 
3266 	eqh = vf->eqh;
3267 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
3268 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_POSTWRITE);
3269 	sqh->hlink       = eqh->hlink;
3270 	sqh->qh.qh_hlink = eqh->qh.qh_hlink;
3271 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_hlink),
3272 	    sizeof(sqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
3273 	eqh->hlink       = sqh;
3274 	eqh->qh.qh_hlink = htole32(sqh->physaddr | UHCI_PTR_QH);
3275 	usb_syncmem(&eqh->dma, eqh->offs + offsetof(uhci_qh_t, qh_hlink),
3276 	    sizeof(eqh->qh.qh_hlink), BUS_DMASYNC_PREWRITE);
3277 	vf->eqh = sqh;
3278 	vf->bandwidth++;
3279 }
3280 
3281 /* Remove interrupt QH. */
3282 void
3283 uhci_remove_intr(uhci_softc_t *sc, uhci_soft_qh_t *sqh)
3284 {
3285 	struct uhci_vframe *vf = &sc->sc_vframes[sqh->pos];
3286 	uhci_soft_qh_t *pqh;
3287 
3288 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3289 	DPRINTFN(4, "n=%jd sqh=%#jx", sqh->pos, (uintptr_t)sqh, 0, 0);
3290 
3291 	/* See comment in uhci_remove_ctrl() */
3292 
3293 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_elink),
3294 	    sizeof(sqh->qh.qh_elink),
3295 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
3296 	if (!(sqh->qh.qh_elink & htole32(UHCI_PTR_T))) {
3297 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
3298 		usb_syncmem(&sqh->dma,
3299 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
3300 		    sizeof(sqh->qh.qh_elink),
3301 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3302 		delay(UHCI_QH_REMOVE_DELAY);
3303 	}
3304 
3305 	pqh = uhci_find_prev_qh(vf->hqh, sqh);
3306 	usb_syncmem(&sqh->dma, sqh->offs + offsetof(uhci_qh_t, qh_hlink),
3307 	    sizeof(sqh->qh.qh_hlink),
3308 	    BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
3309 	pqh->hlink       = sqh->hlink;
3310 	pqh->qh.qh_hlink = sqh->qh.qh_hlink;
3311 	usb_syncmem(&pqh->dma, pqh->offs + offsetof(uhci_qh_t, qh_hlink),
3312 	    sizeof(pqh->qh.qh_hlink),
3313 	    BUS_DMASYNC_PREWRITE);
3314 	delay(UHCI_QH_REMOVE_DELAY);
3315 	if (vf->eqh == sqh)
3316 		vf->eqh = pqh;
3317 	vf->bandwidth--;
3318 }
3319 
3320 usbd_status
3321 uhci_device_setintr(uhci_softc_t *sc, struct uhci_pipe *upipe, int ival)
3322 {
3323 	uhci_soft_qh_t *sqh;
3324 	int i, npoll;
3325 	u_int bestbw, bw, bestoffs, offs;
3326 
3327 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3328 	DPRINTFN(2, "pipe=%#jx", (uintptr_t)upipe, 0, 0, 0);
3329 	if (ival == 0) {
3330 		printf("%s: 0 interval\n", __func__);
3331 		return USBD_INVAL;
3332 	}
3333 
3334 	if (ival > UHCI_VFRAMELIST_COUNT)
3335 		ival = UHCI_VFRAMELIST_COUNT;
3336 	npoll = howmany(UHCI_VFRAMELIST_COUNT, ival);
3337 	DPRINTF("ival=%jd npoll=%jd", ival, npoll, 0, 0);
3338 
3339 	upipe->intr.npoll = npoll;
3340 	upipe->intr.qhs =
3341 		kmem_alloc(npoll * sizeof(uhci_soft_qh_t *), KM_SLEEP);
3342 
3343 	/*
3344 	 * Figure out which offset in the schedule that has most
3345 	 * bandwidth left over.
3346 	 */
3347 #define MOD(i) ((i) & (UHCI_VFRAMELIST_COUNT-1))
3348 	for (bestoffs = offs = 0, bestbw = ~0; offs < ival; offs++) {
3349 		for (bw = i = 0; i < npoll; i++)
3350 			bw += sc->sc_vframes[MOD(i * ival + offs)].bandwidth;
3351 		if (bw < bestbw) {
3352 			bestbw = bw;
3353 			bestoffs = offs;
3354 		}
3355 	}
3356 	DPRINTF("bw=%jd offs=%jd", bestbw, bestoffs, 0, 0);
3357 	for (i = 0; i < npoll; i++) {
3358 		upipe->intr.qhs[i] = sqh = uhci_alloc_sqh(sc);
3359 		sqh->elink = NULL;
3360 		sqh->qh.qh_elink = htole32(UHCI_PTR_T);
3361 		usb_syncmem(&sqh->dma,
3362 		    sqh->offs + offsetof(uhci_qh_t, qh_elink),
3363 		    sizeof(sqh->qh.qh_elink),
3364 		    BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
3365 		sqh->pos = MOD(i * ival + bestoffs);
3366 	}
3367 #undef MOD
3368 
3369 	mutex_enter(&sc->sc_lock);
3370 	/* Enter QHs into the controller data structures. */
3371 	for (i = 0; i < npoll; i++)
3372 		uhci_add_intr(sc, upipe->intr.qhs[i]);
3373 	mutex_exit(&sc->sc_lock);
3374 
3375 	DPRINTFN(5, "returns %#jx", (uintptr_t)upipe, 0, 0, 0);
3376 
3377 	return USBD_NORMAL_COMPLETION;
3378 }
3379 
3380 /* Open a new pipe. */
3381 usbd_status
3382 uhci_open(struct usbd_pipe *pipe)
3383 {
3384 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
3385 	struct usbd_bus *bus = pipe->up_dev->ud_bus;
3386 	struct uhci_pipe *upipe = UHCI_PIPE2UPIPE(pipe);
3387 	usb_endpoint_descriptor_t *ed = pipe->up_endpoint->ue_edesc;
3388 	int ival;
3389 
3390 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3391 	DPRINTF("pipe=%#jx, addr=%jd, endpt=%jd (%jd)",
3392 	    (uintptr_t)pipe, pipe->up_dev->ud_addr, ed->bEndpointAddress,
3393 	    bus->ub_rhaddr);
3394 
3395 	if (sc->sc_dying)
3396 		return USBD_IOERROR;
3397 
3398 	upipe->aborting = 0;
3399 	/* toggle state needed for bulk endpoints */
3400 	upipe->nexttoggle = pipe->up_endpoint->ue_toggle;
3401 
3402 	if (pipe->up_dev->ud_addr == bus->ub_rhaddr) {
3403 		switch (ed->bEndpointAddress) {
3404 		case USB_CONTROL_ENDPOINT:
3405 			pipe->up_methods = &roothub_ctrl_methods;
3406 			break;
3407 		case UE_DIR_IN | USBROOTHUB_INTR_ENDPT:
3408 			pipe->up_methods = &uhci_root_intr_methods;
3409 			break;
3410 		default:
3411 			return USBD_INVAL;
3412 		}
3413 	} else {
3414 		switch (ed->bmAttributes & UE_XFERTYPE) {
3415 		case UE_CONTROL:
3416 			pipe->up_methods = &uhci_device_ctrl_methods;
3417 			upipe->ctrl.sqh = uhci_alloc_sqh(sc);
3418 			if (upipe->ctrl.sqh == NULL)
3419 				goto bad;
3420 			upipe->ctrl.setup = uhci_alloc_std(sc);
3421 			if (upipe->ctrl.setup == NULL) {
3422 				uhci_free_sqh(sc, upipe->ctrl.sqh);
3423 				goto bad;
3424 			}
3425 			upipe->ctrl.stat = uhci_alloc_std(sc);
3426 			if (upipe->ctrl.stat == NULL) {
3427 				uhci_free_sqh(sc, upipe->ctrl.sqh);
3428 				uhci_free_std(sc, upipe->ctrl.setup);
3429 				goto bad;
3430 			}
3431 			int err = usb_allocmem(sc->sc_bus.ub_dmatag,
3432 			    sizeof(usb_device_request_t), 0,
3433 			    USBMALLOC_COHERENT, &upipe->ctrl.reqdma);
3434 			if (err) {
3435 				uhci_free_sqh(sc, upipe->ctrl.sqh);
3436 				uhci_free_std(sc, upipe->ctrl.setup);
3437 				uhci_free_std(sc, upipe->ctrl.stat);
3438 				goto bad;
3439 			}
3440 			break;
3441 		case UE_INTERRUPT:
3442 			pipe->up_methods = &uhci_device_intr_methods;
3443 			ival = pipe->up_interval;
3444 			if (ival == USBD_DEFAULT_INTERVAL)
3445 				ival = ed->bInterval;
3446 			return uhci_device_setintr(sc, upipe, ival);
3447 		case UE_ISOCHRONOUS:
3448 			pipe->up_serialise = false;
3449 			pipe->up_methods = &uhci_device_isoc_methods;
3450 			return uhci_setup_isoc(pipe);
3451 		case UE_BULK:
3452 			pipe->up_methods = &uhci_device_bulk_methods;
3453 			upipe->bulk.sqh = uhci_alloc_sqh(sc);
3454 			if (upipe->bulk.sqh == NULL)
3455 				goto bad;
3456 			break;
3457 		}
3458 	}
3459 	return USBD_NORMAL_COMPLETION;
3460 
3461  bad:
3462 	return USBD_NOMEM;
3463 }
3464 
3465 /*
3466  * Data structures and routines to emulate the root hub.
3467  */
3468 /*
3469  * The USB hub protocol requires that SET_FEATURE(PORT_RESET) also
3470  * enables the port, and also states that SET_FEATURE(PORT_ENABLE)
3471  * should not be used by the USB subsystem.  As we cannot issue a
3472  * SET_FEATURE(PORT_ENABLE) externally, we must ensure that the port
3473  * will be enabled as part of the reset.
3474  *
3475  * On the VT83C572, the port cannot be successfully enabled until the
3476  * outstanding "port enable change" and "connection status change"
3477  * events have been reset.
3478  */
3479 Static usbd_status
3480 uhci_portreset(uhci_softc_t *sc, int index)
3481 {
3482 	int lim, port, x;
3483 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3484 
3485 	if (index == 1)
3486 		port = UHCI_PORTSC1;
3487 	else if (index == 2)
3488 		port = UHCI_PORTSC2;
3489 	else
3490 		return USBD_IOERROR;
3491 
3492 	x = URWMASK(UREAD2(sc, port));
3493 	UWRITE2(sc, port, x | UHCI_PORTSC_PR);
3494 
3495 	usb_delay_ms(&sc->sc_bus, USB_PORT_ROOT_RESET_DELAY);
3496 
3497 	DPRINTF("uhci port %jd reset, status0 = 0x%04jx", index,
3498 	    UREAD2(sc, port), 0, 0);
3499 
3500 	x = URWMASK(UREAD2(sc, port));
3501 	UWRITE2(sc, port, x & ~(UHCI_PORTSC_PR | UHCI_PORTSC_SUSP));
3502 
3503 	delay(100);
3504 
3505 	DPRINTF("uhci port %jd reset, status1 = 0x%04jx", index,
3506 	    UREAD2(sc, port), 0, 0);
3507 
3508 	x = URWMASK(UREAD2(sc, port));
3509 	UWRITE2(sc, port, x  | UHCI_PORTSC_PE);
3510 
3511 	for (lim = 10; --lim > 0;) {
3512 		usb_delay_ms(&sc->sc_bus, USB_PORT_RESET_DELAY);
3513 
3514 		x = UREAD2(sc, port);
3515 		DPRINTF("uhci port %jd iteration %ju, status = 0x%04jx", index,
3516 		    lim, x, 0);
3517 
3518 		if (!(x & UHCI_PORTSC_CCS)) {
3519 			/*
3520 			 * No device is connected (or was disconnected
3521 			 * during reset).  Consider the port reset.
3522 			 * The delay must be long enough to ensure on
3523 			 * the initial iteration that the device
3524 			 * connection will have been registered.  50ms
3525 			 * appears to be sufficient, but 20ms is not.
3526 			 */
3527 			DPRINTFN(3, "uhci port %jd loop %ju, device detached",
3528 			    index, lim, 0, 0);
3529 			break;
3530 		}
3531 
3532 		if (x & (UHCI_PORTSC_POEDC | UHCI_PORTSC_CSC)) {
3533 			/*
3534 			 * Port enabled changed and/or connection
3535 			 * status changed were set.  Reset either or
3536 			 * both raised flags (by writing a 1 to that
3537 			 * bit), and wait again for state to settle.
3538 			 */
3539 			UWRITE2(sc, port, URWMASK(x) |
3540 				(x & (UHCI_PORTSC_POEDC | UHCI_PORTSC_CSC)));
3541 			continue;
3542 		}
3543 
3544 		if (x & UHCI_PORTSC_PE)
3545 			/* Port is enabled */
3546 			break;
3547 
3548 		UWRITE2(sc, port, URWMASK(x) | UHCI_PORTSC_PE);
3549 	}
3550 
3551 	DPRINTFN(3, "uhci port %jd reset, status2 = 0x%04jx", index,
3552 	    UREAD2(sc, port), 0, 0);
3553 
3554 	if (lim <= 0) {
3555 		DPRINTF("uhci port %jd reset timed out", index,
3556 		    0, 0, 0);
3557 		return USBD_TIMEOUT;
3558 	}
3559 
3560 	sc->sc_isreset = 1;
3561 	return USBD_NORMAL_COMPLETION;
3562 }
3563 
3564 Static int
3565 uhci_roothub_ctrl(struct usbd_bus *bus, usb_device_request_t *req,
3566     void *buf, int buflen)
3567 {
3568 	uhci_softc_t *sc = UHCI_BUS2SC(bus);
3569 	int port, x;
3570 	int status, change, totlen = 0;
3571 	uint16_t len, value, index;
3572 	usb_port_status_t ps;
3573 	usbd_status err;
3574 
3575 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3576 
3577 	if (sc->sc_dying)
3578 		return -1;
3579 
3580 	DPRINTF("type=0x%02jx request=%02jx", req->bmRequestType,
3581 	    req->bRequest, 0, 0);
3582 
3583 	len = UGETW(req->wLength);
3584 	value = UGETW(req->wValue);
3585 	index = UGETW(req->wIndex);
3586 
3587 #define C(x,y) ((x) | ((y) << 8))
3588 	switch (C(req->bRequest, req->bmRequestType)) {
3589 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
3590 		DPRINTF("wValue=0x%04jx", value, 0, 0, 0);
3591 		if (len == 0)
3592 			break;
3593 		switch (value) {
3594 #define sd ((usb_string_descriptor_t *)buf)
3595 		case C(2, UDESC_STRING):
3596 			/* Product */
3597 			totlen = usb_makestrdesc(sd, len, "UHCI root hub");
3598 			break;
3599 #undef sd
3600 		default:
3601 			/* default from usbroothub */
3602 			return buflen;
3603 		}
3604 		break;
3605 
3606 	/* Hub requests */
3607 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
3608 		break;
3609 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
3610 		DPRINTF("UR_CLEAR_PORT_FEATURE port=%jd feature=%jd", index,
3611 		    value, 0, 0);
3612 		if (index == 1)
3613 			port = UHCI_PORTSC1;
3614 		else if (index == 2)
3615 			port = UHCI_PORTSC2;
3616 		else {
3617 			return -1;
3618 		}
3619 		switch(value) {
3620 		case UHF_PORT_ENABLE:
3621 			x = URWMASK(UREAD2(sc, port));
3622 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PE);
3623 			break;
3624 		case UHF_PORT_SUSPEND:
3625 			x = URWMASK(UREAD2(sc, port));
3626 			if (!(x & UHCI_PORTSC_SUSP)) /* not suspended */
3627 				break;
3628 			UWRITE2(sc, port, x | UHCI_PORTSC_RD);
3629 			/* see USB2 spec ch. 7.1.7.7 */
3630 			usb_delay_ms(&sc->sc_bus, 20);
3631 			UWRITE2(sc, port, x & ~UHCI_PORTSC_SUSP);
3632 			/* 10ms resume delay must be provided by caller */
3633 			break;
3634 		case UHF_PORT_RESET:
3635 			x = URWMASK(UREAD2(sc, port));
3636 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PR);
3637 			break;
3638 		case UHF_C_PORT_CONNECTION:
3639 			x = URWMASK(UREAD2(sc, port));
3640 			UWRITE2(sc, port, x | UHCI_PORTSC_CSC);
3641 			break;
3642 		case UHF_C_PORT_ENABLE:
3643 			x = URWMASK(UREAD2(sc, port));
3644 			UWRITE2(sc, port, x | UHCI_PORTSC_POEDC);
3645 			break;
3646 		case UHF_C_PORT_OVER_CURRENT:
3647 			x = URWMASK(UREAD2(sc, port));
3648 			UWRITE2(sc, port, x | UHCI_PORTSC_OCIC);
3649 			break;
3650 		case UHF_C_PORT_RESET:
3651 			sc->sc_isreset = 0;
3652 			break;
3653 		case UHF_PORT_CONNECTION:
3654 		case UHF_PORT_OVER_CURRENT:
3655 		case UHF_PORT_POWER:
3656 		case UHF_PORT_LOW_SPEED:
3657 		case UHF_C_PORT_SUSPEND:
3658 		default:
3659 			return -1;
3660 		}
3661 		break;
3662 	case C(UR_GET_BUS_STATE, UT_READ_CLASS_OTHER):
3663 		if (index == 1)
3664 			port = UHCI_PORTSC1;
3665 		else if (index == 2)
3666 			port = UHCI_PORTSC2;
3667 		else {
3668 			return -1;
3669 		}
3670 		if (len > 0) {
3671 			*(uint8_t *)buf =
3672 			    UHCI_PORTSC_GET_LS(UREAD2(sc, port));
3673 			totlen = 1;
3674 		}
3675 		break;
3676 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
3677 		if (len == 0)
3678 			break;
3679 		if ((value & 0xff) != 0) {
3680 			return -1;
3681 		}
3682 		usb_hub_descriptor_t hubd;
3683 
3684 		totlen = uimin(buflen, sizeof(hubd));
3685 		memcpy(&hubd, buf, totlen);
3686 		hubd.bNbrPorts = 2;
3687 		memcpy(buf, &hubd, totlen);
3688 		break;
3689 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
3690 		if (len != 4) {
3691 			return -1;
3692 		}
3693 		memset(buf, 0, len);
3694 		totlen = len;
3695 		break;
3696 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
3697 		if (index == 1)
3698 			port = UHCI_PORTSC1;
3699 		else if (index == 2)
3700 			port = UHCI_PORTSC2;
3701 		else {
3702 			return -1;
3703 		}
3704 		if (len != 4) {
3705 			return -1;
3706 		}
3707 		x = UREAD2(sc, port);
3708 		status = change = 0;
3709 		if (x & UHCI_PORTSC_CCS)
3710 			status |= UPS_CURRENT_CONNECT_STATUS;
3711 		if (x & UHCI_PORTSC_CSC)
3712 			change |= UPS_C_CONNECT_STATUS;
3713 		if (x & UHCI_PORTSC_PE)
3714 			status |= UPS_PORT_ENABLED;
3715 		if (x & UHCI_PORTSC_POEDC)
3716 			change |= UPS_C_PORT_ENABLED;
3717 		if (x & UHCI_PORTSC_OCI)
3718 			status |= UPS_OVERCURRENT_INDICATOR;
3719 		if (x & UHCI_PORTSC_OCIC)
3720 			change |= UPS_C_OVERCURRENT_INDICATOR;
3721 		if (x & UHCI_PORTSC_SUSP)
3722 			status |= UPS_SUSPEND;
3723 		if (x & UHCI_PORTSC_LSDA)
3724 			status |= UPS_LOW_SPEED;
3725 		status |= UPS_PORT_POWER;
3726 		if (sc->sc_isreset)
3727 			change |= UPS_C_PORT_RESET;
3728 		USETW(ps.wPortStatus, status);
3729 		USETW(ps.wPortChange, change);
3730 		totlen = uimin(len, sizeof(ps));
3731 		memcpy(buf, &ps, totlen);
3732 		break;
3733 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
3734 		return -1;
3735 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
3736 		break;
3737 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
3738 		if (index == 1)
3739 			port = UHCI_PORTSC1;
3740 		else if (index == 2)
3741 			port = UHCI_PORTSC2;
3742 		else {
3743 			return -1;
3744 		}
3745 		switch(value) {
3746 		case UHF_PORT_ENABLE:
3747 			x = URWMASK(UREAD2(sc, port));
3748 			UWRITE2(sc, port, x | UHCI_PORTSC_PE);
3749 			break;
3750 		case UHF_PORT_SUSPEND:
3751 			x = URWMASK(UREAD2(sc, port));
3752 			UWRITE2(sc, port, x | UHCI_PORTSC_SUSP);
3753 			break;
3754 		case UHF_PORT_RESET:
3755 			err = uhci_portreset(sc, index);
3756 			if (err != USBD_NORMAL_COMPLETION)
3757 				return -1;
3758 			return 0;
3759 		case UHF_PORT_POWER:
3760 			/* Pretend we turned on power */
3761 			return 0;
3762 		case UHF_C_PORT_CONNECTION:
3763 		case UHF_C_PORT_ENABLE:
3764 		case UHF_C_PORT_OVER_CURRENT:
3765 		case UHF_PORT_CONNECTION:
3766 		case UHF_PORT_OVER_CURRENT:
3767 		case UHF_PORT_LOW_SPEED:
3768 		case UHF_C_PORT_SUSPEND:
3769 		case UHF_C_PORT_RESET:
3770 		default:
3771 			return -1;
3772 		}
3773 		break;
3774 	default:
3775 		/* default from usbroothub */
3776 		DPRINTF("returning %jd (usbroothub default)",
3777 		    buflen, 0, 0, 0);
3778 		return buflen;
3779 	}
3780 
3781 	DPRINTF("returning %jd", totlen, 0, 0, 0);
3782 
3783 	return totlen;
3784 }
3785 
3786 /* Abort a root interrupt request. */
3787 void
3788 uhci_root_intr_abort(struct usbd_xfer *xfer)
3789 {
3790 	uhci_softc_t *sc = UHCI_XFER2SC(xfer);
3791 
3792 	KASSERT(mutex_owned(&sc->sc_lock));
3793 	KASSERT(xfer->ux_pipe->up_intrxfer == xfer);
3794 
3795 	/*
3796 	 * Try to stop the callout before it starts.  If we got in too
3797 	 * late, too bad; but if the callout had yet to run and time
3798 	 * out the xfer, cancel it ourselves.
3799 	 */
3800 	callout_stop(&sc->sc_poll_handle);
3801 	if (sc->sc_intr_xfer == NULL)
3802 		return;
3803 
3804 	KASSERT(sc->sc_intr_xfer == xfer);
3805 	KASSERT(xfer->ux_status == USBD_IN_PROGRESS);
3806 	xfer->ux_status = USBD_CANCELLED;
3807 #ifdef DIAGNOSTIC
3808 	UHCI_XFER2UXFER(xfer)->ux_isdone = true;
3809 #endif
3810 	usb_transfer_complete(xfer);
3811 }
3812 
3813 usbd_status
3814 uhci_root_intr_transfer(struct usbd_xfer *xfer)
3815 {
3816 
3817 	/* Pipe isn't running, start first */
3818 	return uhci_root_intr_start(SIMPLEQ_FIRST(&xfer->ux_pipe->up_queue));
3819 }
3820 
3821 /* Start a transfer on the root interrupt pipe */
3822 usbd_status
3823 uhci_root_intr_start(struct usbd_xfer *xfer)
3824 {
3825 	struct usbd_pipe *pipe = xfer->ux_pipe;
3826 	uhci_softc_t *sc = UHCI_PIPE2SC(pipe);
3827 	unsigned int ival;
3828 
3829 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3830 	DPRINTF("xfer=%#jx len=%jd flags=%jd", (uintptr_t)xfer, xfer->ux_length,
3831 	    xfer->ux_flags, 0);
3832 
3833 	KASSERT(sc->sc_bus.ub_usepolling || mutex_owned(&sc->sc_lock));
3834 
3835 	if (sc->sc_dying)
3836 		return USBD_IOERROR;
3837 
3838 	KASSERT(sc->sc_intr_xfer == NULL);
3839 
3840 	/* XXX temporary variable needed to avoid gcc3 warning */
3841 	ival = xfer->ux_pipe->up_endpoint->ue_edesc->bInterval;
3842 	sc->sc_ival = mstohz(ival);
3843 	if (sc->sc_suspend == PWR_RESUME)
3844 		callout_schedule(&sc->sc_poll_handle, sc->sc_ival);
3845 	sc->sc_intr_xfer = xfer;
3846 	xfer->ux_status = USBD_IN_PROGRESS;
3847 
3848 	return USBD_IN_PROGRESS;
3849 }
3850 
3851 /* Close the root interrupt pipe. */
3852 void
3853 uhci_root_intr_close(struct usbd_pipe *pipe)
3854 {
3855 	uhci_softc_t *sc __diagused = UHCI_PIPE2SC(pipe);
3856 	UHCIHIST_FUNC(); UHCIHIST_CALLED();
3857 
3858 	KASSERT(mutex_owned(&sc->sc_lock));
3859 
3860 	/*
3861 	 * The caller must arrange to have aborted the pipe already, so
3862 	 * there can be no intr xfer in progress.  The callout may
3863 	 * still be pending from a prior intr xfer -- if it has already
3864 	 * fired, it will see there is nothing to do, and do nothing.
3865 	 */
3866 	KASSERT(sc->sc_intr_xfer == NULL);
3867 	KASSERT(!callout_pending(&sc->sc_poll_handle));
3868 }
3869