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