xref: /freebsd/sys/dev/usb/controller/uhci.c (revision ed6d949afdbe3f25e6ef640881d8a0a72d7b7aa8)
102ac6454SAndrew Thompson /*-
202ac6454SAndrew Thompson  * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
302ac6454SAndrew Thompson  * Copyright (c) 1998 The NetBSD Foundation, Inc. All rights reserved.
402ac6454SAndrew Thompson  * Copyright (c) 1998 Lennart Augustsson. All rights reserved.
502ac6454SAndrew Thompson  *
602ac6454SAndrew Thompson  * Redistribution and use in source and binary forms, with or without
702ac6454SAndrew Thompson  * modification, are permitted provided that the following conditions
802ac6454SAndrew Thompson  * are met:
902ac6454SAndrew Thompson  * 1. Redistributions of source code must retain the above copyright
1002ac6454SAndrew Thompson  *    notice, this list of conditions and the following disclaimer.
1102ac6454SAndrew Thompson  * 2. Redistributions in binary form must reproduce the above copyright
1202ac6454SAndrew Thompson  *    notice, this list of conditions and the following disclaimer in the
1302ac6454SAndrew Thompson  *    documentation and/or other materials provided with the distribution.
1402ac6454SAndrew Thompson  *
1502ac6454SAndrew Thompson  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1602ac6454SAndrew Thompson  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1702ac6454SAndrew Thompson  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1802ac6454SAndrew Thompson  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1902ac6454SAndrew Thompson  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2002ac6454SAndrew Thompson  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2102ac6454SAndrew Thompson  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2202ac6454SAndrew Thompson  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2302ac6454SAndrew Thompson  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2402ac6454SAndrew Thompson  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2502ac6454SAndrew Thompson  * SUCH DAMAGE.
2602ac6454SAndrew Thompson  */
2702ac6454SAndrew Thompson 
2802ac6454SAndrew Thompson #include <sys/cdefs.h>
2902ac6454SAndrew Thompson __FBSDID("$FreeBSD$");
3002ac6454SAndrew Thompson 
3102ac6454SAndrew Thompson /*
3202ac6454SAndrew Thompson  * USB Universal Host Controller driver.
3302ac6454SAndrew Thompson  * Handles e.g. PIIX3 and PIIX4.
3402ac6454SAndrew Thompson  *
3502ac6454SAndrew Thompson  * UHCI spec: http://developer.intel.com/design/USB/UHCI11D.htm
3602ac6454SAndrew Thompson  * USB spec:  http://www.usb.org/developers/docs/usbspec.zip
3702ac6454SAndrew Thompson  * PIIXn spec: ftp://download.intel.com/design/intarch/datashts/29055002.pdf
3802ac6454SAndrew Thompson  *             ftp://download.intel.com/design/intarch/datashts/29056201.pdf
3902ac6454SAndrew Thompson  */
4002ac6454SAndrew Thompson 
41ed6d949aSAndrew Thompson #include <sys/stdint.h>
42ed6d949aSAndrew Thompson #include <sys/stddef.h>
43ed6d949aSAndrew Thompson #include <sys/param.h>
44ed6d949aSAndrew Thompson #include <sys/queue.h>
45ed6d949aSAndrew Thompson #include <sys/types.h>
46ed6d949aSAndrew Thompson #include <sys/systm.h>
47ed6d949aSAndrew Thompson #include <sys/kernel.h>
48ed6d949aSAndrew Thompson #include <sys/bus.h>
49ed6d949aSAndrew Thompson #include <sys/linker_set.h>
50ed6d949aSAndrew Thompson #include <sys/module.h>
51ed6d949aSAndrew Thompson #include <sys/lock.h>
52ed6d949aSAndrew Thompson #include <sys/mutex.h>
53ed6d949aSAndrew Thompson #include <sys/condvar.h>
54ed6d949aSAndrew Thompson #include <sys/sysctl.h>
55ed6d949aSAndrew Thompson #include <sys/sx.h>
56ed6d949aSAndrew Thompson #include <sys/unistd.h>
57ed6d949aSAndrew Thompson #include <sys/callout.h>
58ed6d949aSAndrew Thompson #include <sys/malloc.h>
59ed6d949aSAndrew Thompson #include <sys/priv.h>
60ed6d949aSAndrew Thompson 
6102ac6454SAndrew Thompson #include <dev/usb/usb.h>
62ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h>
6302ac6454SAndrew Thompson 
6402ac6454SAndrew Thompson #define	USB_DEBUG_VAR uhcidebug
6502ac6454SAndrew Thompson 
6602ac6454SAndrew Thompson #include <dev/usb/usb_core.h>
6702ac6454SAndrew Thompson #include <dev/usb/usb_debug.h>
6802ac6454SAndrew Thompson #include <dev/usb/usb_busdma.h>
6902ac6454SAndrew Thompson #include <dev/usb/usb_process.h>
7002ac6454SAndrew Thompson #include <dev/usb/usb_transfer.h>
7102ac6454SAndrew Thompson #include <dev/usb/usb_device.h>
7202ac6454SAndrew Thompson #include <dev/usb/usb_hub.h>
7302ac6454SAndrew Thompson #include <dev/usb/usb_util.h>
7402ac6454SAndrew Thompson 
7502ac6454SAndrew Thompson #include <dev/usb/usb_controller.h>
7602ac6454SAndrew Thompson #include <dev/usb/usb_bus.h>
7702ac6454SAndrew Thompson #include <dev/usb/controller/uhci.h>
7802ac6454SAndrew Thompson 
7902ac6454SAndrew Thompson #define	alt_next next
80578d0effSAndrew Thompson #define	UHCI_BUS2SC(bus) \
81578d0effSAndrew Thompson    ((uhci_softc_t *)(((uint8_t *)(bus)) - \
82578d0effSAndrew Thompson     ((uint8_t *)&(((uhci_softc_t *)0)->sc_bus))))
8302ac6454SAndrew Thompson 
8402ac6454SAndrew Thompson #if USB_DEBUG
8502ac6454SAndrew Thompson static int uhcidebug = 0;
8602ac6454SAndrew Thompson static int uhcinoloop = 0;
8702ac6454SAndrew Thompson 
889360ae40SAndrew Thompson SYSCTL_NODE(_hw_usb, OID_AUTO, uhci, CTLFLAG_RW, 0, "USB uhci");
899360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_uhci, OID_AUTO, debug, CTLFLAG_RW,
9002ac6454SAndrew Thompson     &uhcidebug, 0, "uhci debug level");
919360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_uhci, OID_AUTO, loop, CTLFLAG_RW,
9202ac6454SAndrew Thompson     &uhcinoloop, 0, "uhci noloop");
9302ac6454SAndrew Thompson static void uhci_dumpregs(uhci_softc_t *sc);
9402ac6454SAndrew Thompson static void uhci_dump_tds(uhci_td_t *td);
9502ac6454SAndrew Thompson 
9602ac6454SAndrew Thompson #endif
9702ac6454SAndrew Thompson 
9802ac6454SAndrew Thompson #define	UBARR(sc) bus_space_barrier((sc)->sc_io_tag, (sc)->sc_io_hdl, 0, (sc)->sc_io_size, \
9902ac6454SAndrew Thompson 			BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE)
10002ac6454SAndrew Thompson #define	UWRITE1(sc, r, x) \
10102ac6454SAndrew Thompson  do { UBARR(sc); bus_space_write_1((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); \
10202ac6454SAndrew Thompson  } while (/*CONSTCOND*/0)
10302ac6454SAndrew Thompson #define	UWRITE2(sc, r, x) \
10402ac6454SAndrew Thompson  do { UBARR(sc); bus_space_write_2((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); \
10502ac6454SAndrew Thompson  } while (/*CONSTCOND*/0)
10602ac6454SAndrew Thompson #define	UWRITE4(sc, r, x) \
10702ac6454SAndrew Thompson  do { UBARR(sc); bus_space_write_4((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); \
10802ac6454SAndrew Thompson  } while (/*CONSTCOND*/0)
10902ac6454SAndrew Thompson #define	UREAD1(sc, r) (UBARR(sc), bus_space_read_1((sc)->sc_io_tag, (sc)->sc_io_hdl, (r)))
11002ac6454SAndrew Thompson #define	UREAD2(sc, r) (UBARR(sc), bus_space_read_2((sc)->sc_io_tag, (sc)->sc_io_hdl, (r)))
11102ac6454SAndrew Thompson #define	UREAD4(sc, r) (UBARR(sc), bus_space_read_4((sc)->sc_io_tag, (sc)->sc_io_hdl, (r)))
11202ac6454SAndrew Thompson 
11302ac6454SAndrew Thompson #define	UHCICMD(sc, cmd) UWRITE2(sc, UHCI_CMD, cmd)
11402ac6454SAndrew Thompson #define	UHCISTS(sc) UREAD2(sc, UHCI_STS)
11502ac6454SAndrew Thompson 
11602ac6454SAndrew Thompson #define	UHCI_RESET_TIMEOUT 100		/* ms, reset timeout */
11702ac6454SAndrew Thompson 
11802ac6454SAndrew Thompson #define	UHCI_INTR_ENDPT 1
11902ac6454SAndrew Thompson 
12002ac6454SAndrew Thompson struct uhci_mem_layout {
12102ac6454SAndrew Thompson 
122760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
123760bc48eSAndrew Thompson 	struct usb_page_search fix_res;
12402ac6454SAndrew Thompson 
125760bc48eSAndrew Thompson 	struct usb_page_cache *buf_pc;
126760bc48eSAndrew Thompson 	struct usb_page_cache *fix_pc;
12702ac6454SAndrew Thompson 
12802ac6454SAndrew Thompson 	uint32_t buf_offset;
12902ac6454SAndrew Thompson 
13002ac6454SAndrew Thompson 	uint16_t max_frame_size;
13102ac6454SAndrew Thompson };
13202ac6454SAndrew Thompson 
13302ac6454SAndrew Thompson struct uhci_std_temp {
13402ac6454SAndrew Thompson 
13502ac6454SAndrew Thompson 	struct uhci_mem_layout ml;
13602ac6454SAndrew Thompson 	uhci_td_t *td;
13702ac6454SAndrew Thompson 	uhci_td_t *td_next;
13802ac6454SAndrew Thompson 	uint32_t average;
13902ac6454SAndrew Thompson 	uint32_t td_status;
14002ac6454SAndrew Thompson 	uint32_t td_token;
14102ac6454SAndrew Thompson 	uint32_t len;
14202ac6454SAndrew Thompson 	uint16_t max_frame_size;
14302ac6454SAndrew Thompson 	uint8_t	shortpkt;
14402ac6454SAndrew Thompson 	uint8_t	setup_alt_next;
1450f7d4548SAndrew Thompson 	uint8_t	last_frame;
14602ac6454SAndrew Thompson };
14702ac6454SAndrew Thompson 
148760bc48eSAndrew Thompson extern struct usb_bus_methods uhci_bus_methods;
149760bc48eSAndrew Thompson extern struct usb_pipe_methods uhci_device_bulk_methods;
150760bc48eSAndrew Thompson extern struct usb_pipe_methods uhci_device_ctrl_methods;
151760bc48eSAndrew Thompson extern struct usb_pipe_methods uhci_device_intr_methods;
152760bc48eSAndrew Thompson extern struct usb_pipe_methods uhci_device_isoc_methods;
15302ac6454SAndrew Thompson 
154b9c81a5dSAndrew Thompson static uint8_t	uhci_restart(uhci_softc_t *sc);
155760bc48eSAndrew Thompson static void	uhci_do_poll(struct usb_bus *);
156e0a69b51SAndrew Thompson static void	uhci_device_done(struct usb_xfer *, usb_error_t);
157760bc48eSAndrew Thompson static void	uhci_transfer_intr_enqueue(struct usb_xfer *);
15802ac6454SAndrew Thompson static void	uhci_timeout(void *);
159760bc48eSAndrew Thompson static uint8_t	uhci_check_transfer(struct usb_xfer *);
16039307315SAndrew Thompson static void	uhci_root_intr(uhci_softc_t *sc);
16102ac6454SAndrew Thompson 
16202ac6454SAndrew Thompson void
163e0a69b51SAndrew Thompson uhci_iterate_hw_softc(struct usb_bus *bus, usb_bus_mem_sub_cb_t *cb)
16402ac6454SAndrew Thompson {
16502ac6454SAndrew Thompson 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
16602ac6454SAndrew Thompson 	uint32_t i;
16702ac6454SAndrew Thompson 
16802ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.pframes_pc, &sc->sc_hw.pframes_pg,
16902ac6454SAndrew Thompson 	    sizeof(uint32_t) * UHCI_FRAMELIST_COUNT, UHCI_FRAMELIST_ALIGN);
17002ac6454SAndrew Thompson 
17102ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.ls_ctl_start_pc, &sc->sc_hw.ls_ctl_start_pg,
17202ac6454SAndrew Thompson 	    sizeof(uhci_qh_t), UHCI_QH_ALIGN);
17302ac6454SAndrew Thompson 
17402ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.fs_ctl_start_pc, &sc->sc_hw.fs_ctl_start_pg,
17502ac6454SAndrew Thompson 	    sizeof(uhci_qh_t), UHCI_QH_ALIGN);
17602ac6454SAndrew Thompson 
17702ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.bulk_start_pc, &sc->sc_hw.bulk_start_pg,
17802ac6454SAndrew Thompson 	    sizeof(uhci_qh_t), UHCI_QH_ALIGN);
17902ac6454SAndrew Thompson 
18002ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.last_qh_pc, &sc->sc_hw.last_qh_pg,
18102ac6454SAndrew Thompson 	    sizeof(uhci_qh_t), UHCI_QH_ALIGN);
18202ac6454SAndrew Thompson 
18302ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.last_td_pc, &sc->sc_hw.last_td_pg,
18402ac6454SAndrew Thompson 	    sizeof(uhci_td_t), UHCI_TD_ALIGN);
18502ac6454SAndrew Thompson 
18602ac6454SAndrew Thompson 	for (i = 0; i != UHCI_VFRAMELIST_COUNT; i++) {
18702ac6454SAndrew Thompson 		cb(bus, sc->sc_hw.isoc_start_pc + i,
18802ac6454SAndrew Thompson 		    sc->sc_hw.isoc_start_pg + i,
18902ac6454SAndrew Thompson 		    sizeof(uhci_td_t), UHCI_TD_ALIGN);
19002ac6454SAndrew Thompson 	}
19102ac6454SAndrew Thompson 
19202ac6454SAndrew Thompson 	for (i = 0; i != UHCI_IFRAMELIST_COUNT; i++) {
19302ac6454SAndrew Thompson 		cb(bus, sc->sc_hw.intr_start_pc + i,
19402ac6454SAndrew Thompson 		    sc->sc_hw.intr_start_pg + i,
19502ac6454SAndrew Thompson 		    sizeof(uhci_qh_t), UHCI_QH_ALIGN);
19602ac6454SAndrew Thompson 	}
19702ac6454SAndrew Thompson }
19802ac6454SAndrew Thompson 
19902ac6454SAndrew Thompson static void
200760bc48eSAndrew Thompson uhci_mem_layout_init(struct uhci_mem_layout *ml, struct usb_xfer *xfer)
20102ac6454SAndrew Thompson {
20202ac6454SAndrew Thompson 	ml->buf_pc = xfer->frbuffers + 0;
20302ac6454SAndrew Thompson 	ml->fix_pc = xfer->buf_fixup;
20402ac6454SAndrew Thompson 
20502ac6454SAndrew Thompson 	ml->buf_offset = 0;
20602ac6454SAndrew Thompson 
20702ac6454SAndrew Thompson 	ml->max_frame_size = xfer->max_frame_size;
20802ac6454SAndrew Thompson }
20902ac6454SAndrew Thompson 
21002ac6454SAndrew Thompson static void
21102ac6454SAndrew Thompson uhci_mem_layout_fixup(struct uhci_mem_layout *ml, struct uhci_td *td)
21202ac6454SAndrew Thompson {
213a593f6b8SAndrew Thompson 	usbd_get_page(ml->buf_pc, ml->buf_offset, &ml->buf_res);
21402ac6454SAndrew Thompson 
21502ac6454SAndrew Thompson 	if (ml->buf_res.length < td->len) {
21602ac6454SAndrew Thompson 
21702ac6454SAndrew Thompson 		/* need to do a fixup */
21802ac6454SAndrew Thompson 
219a593f6b8SAndrew Thompson 		usbd_get_page(ml->fix_pc, 0, &ml->fix_res);
22002ac6454SAndrew Thompson 
22102ac6454SAndrew Thompson 		td->td_buffer = htole32(ml->fix_res.physaddr);
22202ac6454SAndrew Thompson 
22302ac6454SAndrew Thompson 		/*
22402ac6454SAndrew Thompson 	         * The UHCI driver cannot handle
22502ac6454SAndrew Thompson 	         * page crossings, so a fixup is
22602ac6454SAndrew Thompson 	         * needed:
22702ac6454SAndrew Thompson 	         *
22802ac6454SAndrew Thompson 	         *  +----+----+ - - -
22902ac6454SAndrew Thompson 	         *  | YYY|Y   |
23002ac6454SAndrew Thompson 	         *  +----+----+ - - -
23102ac6454SAndrew Thompson 	         *     \    \
23202ac6454SAndrew Thompson 	         *      \    \
23302ac6454SAndrew Thompson 	         *       +----+
23402ac6454SAndrew Thompson 	         *       |YYYY|  (fixup)
23502ac6454SAndrew Thompson 	         *       +----+
23602ac6454SAndrew Thompson 	         */
23702ac6454SAndrew Thompson 
23802ac6454SAndrew Thompson 		if ((td->td_token & htole32(UHCI_TD_PID)) ==
23902ac6454SAndrew Thompson 		    htole32(UHCI_TD_PID_IN)) {
24002ac6454SAndrew Thompson 			td->fix_pc = ml->fix_pc;
241a593f6b8SAndrew Thompson 			usb_pc_cpu_invalidate(ml->fix_pc);
24202ac6454SAndrew Thompson 
24302ac6454SAndrew Thompson 		} else {
24402ac6454SAndrew Thompson 			td->fix_pc = NULL;
24502ac6454SAndrew Thompson 
24602ac6454SAndrew Thompson 			/* copy data to fixup location */
24702ac6454SAndrew Thompson 
248a593f6b8SAndrew Thompson 			usbd_copy_out(ml->buf_pc, ml->buf_offset,
24902ac6454SAndrew Thompson 			    ml->fix_res.buffer, td->len);
25002ac6454SAndrew Thompson 
251a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(ml->fix_pc);
25202ac6454SAndrew Thompson 		}
25302ac6454SAndrew Thompson 
25402ac6454SAndrew Thompson 		/* prepare next fixup */
25502ac6454SAndrew Thompson 
25602ac6454SAndrew Thompson 		ml->fix_pc++;
25702ac6454SAndrew Thompson 
25802ac6454SAndrew Thompson 	} else {
25902ac6454SAndrew Thompson 
26002ac6454SAndrew Thompson 		td->td_buffer = htole32(ml->buf_res.physaddr);
26102ac6454SAndrew Thompson 		td->fix_pc = NULL;
26202ac6454SAndrew Thompson 	}
26302ac6454SAndrew Thompson 
26402ac6454SAndrew Thompson 	/* prepare next data location */
26502ac6454SAndrew Thompson 
26602ac6454SAndrew Thompson 	ml->buf_offset += td->len;
26702ac6454SAndrew Thompson }
26802ac6454SAndrew Thompson 
269b9c81a5dSAndrew Thompson /*
270b9c81a5dSAndrew Thompson  * Return values:
271b9c81a5dSAndrew Thompson  * 0: Success
272b9c81a5dSAndrew Thompson  * Else: Failure
273b9c81a5dSAndrew Thompson  */
274b9c81a5dSAndrew Thompson static uint8_t
275b9c81a5dSAndrew Thompson uhci_restart(uhci_softc_t *sc)
276b9c81a5dSAndrew Thompson {
277760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
278b9c81a5dSAndrew Thompson 
279b9c81a5dSAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
280b9c81a5dSAndrew Thompson 
281b9c81a5dSAndrew Thompson   	if (UREAD2(sc, UHCI_CMD) & UHCI_CMD_RS) {
282b9c81a5dSAndrew Thompson 		DPRINTFN(2, "Already started\n");
283b9c81a5dSAndrew Thompson 		return (0);
284b9c81a5dSAndrew Thompson 	}
285b9c81a5dSAndrew Thompson 
286b9c81a5dSAndrew Thompson 	DPRINTFN(2, "Restarting\n");
287b9c81a5dSAndrew Thompson 
288a593f6b8SAndrew Thompson 	usbd_get_page(&sc->sc_hw.pframes_pc, 0, &buf_res);
289b9c81a5dSAndrew Thompson 
290b9c81a5dSAndrew Thompson 	/* Reload fresh base address */
291b9c81a5dSAndrew Thompson 	UWRITE4(sc, UHCI_FLBASEADDR, buf_res.physaddr);
292b9c81a5dSAndrew Thompson 
293b9c81a5dSAndrew Thompson 	/*
294b9c81a5dSAndrew Thompson 	 * Assume 64 byte packets at frame end and start HC controller:
295b9c81a5dSAndrew Thompson 	 */
296b9c81a5dSAndrew Thompson 	UHCICMD(sc, (UHCI_CMD_MAXP | UHCI_CMD_RS));
297b9c81a5dSAndrew Thompson 
298b9c81a5dSAndrew Thompson 	/* wait 10 milliseconds */
299b9c81a5dSAndrew Thompson 
300a593f6b8SAndrew Thompson 	usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 100);
301b9c81a5dSAndrew Thompson 
302b9c81a5dSAndrew Thompson 	/* check that controller has started */
303b9c81a5dSAndrew Thompson 
304b9c81a5dSAndrew Thompson 	if (UREAD2(sc, UHCI_STS) & UHCI_STS_HCH) {
305b9c81a5dSAndrew Thompson 		DPRINTFN(2, "Failed\n");
306b9c81a5dSAndrew Thompson 		return (1);
307b9c81a5dSAndrew Thompson 	}
308b9c81a5dSAndrew Thompson 	return (0);
309b9c81a5dSAndrew Thompson }
310b9c81a5dSAndrew Thompson 
31102ac6454SAndrew Thompson void
31202ac6454SAndrew Thompson uhci_reset(uhci_softc_t *sc)
31302ac6454SAndrew Thompson {
31402ac6454SAndrew Thompson 	uint16_t n;
31502ac6454SAndrew Thompson 
31602ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
31702ac6454SAndrew Thompson 
31802ac6454SAndrew Thompson 	DPRINTF("resetting the HC\n");
31902ac6454SAndrew Thompson 
32002ac6454SAndrew Thompson 	/* disable interrupts */
32102ac6454SAndrew Thompson 
32202ac6454SAndrew Thompson 	UWRITE2(sc, UHCI_INTR, 0);
32302ac6454SAndrew Thompson 
32402ac6454SAndrew Thompson 	/* global reset */
32502ac6454SAndrew Thompson 
32602ac6454SAndrew Thompson 	UHCICMD(sc, UHCI_CMD_GRESET);
32702ac6454SAndrew Thompson 
32802ac6454SAndrew Thompson 	/* wait */
32902ac6454SAndrew Thompson 
330a593f6b8SAndrew Thompson 	usb_pause_mtx(&sc->sc_bus.bus_mtx,
33102ac6454SAndrew Thompson 	    USB_MS_TO_TICKS(USB_BUS_RESET_DELAY));
33202ac6454SAndrew Thompson 
33302ac6454SAndrew Thompson 	/* terminate all transfers */
33402ac6454SAndrew Thompson 
33502ac6454SAndrew Thompson 	UHCICMD(sc, UHCI_CMD_HCRESET);
33602ac6454SAndrew Thompson 
33702ac6454SAndrew Thompson 	/* the reset bit goes low when the controller is done */
33802ac6454SAndrew Thompson 
33902ac6454SAndrew Thompson 	n = UHCI_RESET_TIMEOUT;
34002ac6454SAndrew Thompson 	while (n--) {
34102ac6454SAndrew Thompson 		/* wait one millisecond */
34202ac6454SAndrew Thompson 
343a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 1000);
34402ac6454SAndrew Thompson 
34502ac6454SAndrew Thompson 		if (!(UREAD2(sc, UHCI_CMD) & UHCI_CMD_HCRESET)) {
34602ac6454SAndrew Thompson 			goto done_1;
34702ac6454SAndrew Thompson 		}
34802ac6454SAndrew Thompson 	}
34902ac6454SAndrew Thompson 
35002ac6454SAndrew Thompson 	device_printf(sc->sc_bus.bdev,
35102ac6454SAndrew Thompson 	    "controller did not reset\n");
35202ac6454SAndrew Thompson 
35302ac6454SAndrew Thompson done_1:
35402ac6454SAndrew Thompson 
35502ac6454SAndrew Thompson 	n = 10;
35602ac6454SAndrew Thompson 	while (n--) {
35702ac6454SAndrew Thompson 		/* wait one millisecond */
35802ac6454SAndrew Thompson 
359a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 1000);
36002ac6454SAndrew Thompson 
36102ac6454SAndrew Thompson 		/* check if HC is stopped */
36202ac6454SAndrew Thompson 		if (UREAD2(sc, UHCI_STS) & UHCI_STS_HCH) {
36302ac6454SAndrew Thompson 			goto done_2;
36402ac6454SAndrew Thompson 		}
36502ac6454SAndrew Thompson 	}
36602ac6454SAndrew Thompson 
36702ac6454SAndrew Thompson 	device_printf(sc->sc_bus.bdev,
36802ac6454SAndrew Thompson 	    "controller did not stop\n");
36902ac6454SAndrew Thompson 
37002ac6454SAndrew Thompson done_2:
37102ac6454SAndrew Thompson 
37202ac6454SAndrew Thompson 	/* reload the configuration */
37302ac6454SAndrew Thompson 	UWRITE2(sc, UHCI_FRNUM, sc->sc_saved_frnum);
37402ac6454SAndrew Thompson 	UWRITE1(sc, UHCI_SOF, sc->sc_saved_sof);
37539307315SAndrew Thompson 
37639307315SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
37739307315SAndrew Thompson 
37839307315SAndrew Thompson 	/* stop root interrupt */
379a593f6b8SAndrew Thompson 	usb_callout_drain(&sc->sc_root_intr);
38039307315SAndrew Thompson 
38139307315SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
38202ac6454SAndrew Thompson }
38302ac6454SAndrew Thompson 
38402ac6454SAndrew Thompson static void
38502ac6454SAndrew Thompson uhci_start(uhci_softc_t *sc)
38602ac6454SAndrew Thompson {
38702ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
38802ac6454SAndrew Thompson 
38902ac6454SAndrew Thompson 	DPRINTFN(2, "enabling\n");
39002ac6454SAndrew Thompson 
39102ac6454SAndrew Thompson 	/* enable interrupts */
39202ac6454SAndrew Thompson 
39302ac6454SAndrew Thompson 	UWRITE2(sc, UHCI_INTR,
39402ac6454SAndrew Thompson 	    (UHCI_INTR_TOCRCIE |
39502ac6454SAndrew Thompson 	    UHCI_INTR_RIE |
39602ac6454SAndrew Thompson 	    UHCI_INTR_IOCE |
39702ac6454SAndrew Thompson 	    UHCI_INTR_SPIE));
39802ac6454SAndrew Thompson 
399b9c81a5dSAndrew Thompson 	if (uhci_restart(sc)) {
40002ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev,
40102ac6454SAndrew Thompson 		    "cannot start HC controller\n");
402b9c81a5dSAndrew Thompson 	}
40302ac6454SAndrew Thompson 
40439307315SAndrew Thompson 	/* start root interrupt */
40539307315SAndrew Thompson 	uhci_root_intr(sc);
40602ac6454SAndrew Thompson }
40702ac6454SAndrew Thompson 
40802ac6454SAndrew Thompson static struct uhci_qh *
409760bc48eSAndrew Thompson uhci_init_qh(struct usb_page_cache *pc)
41002ac6454SAndrew Thompson {
411760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
41202ac6454SAndrew Thompson 	struct uhci_qh *qh;
41302ac6454SAndrew Thompson 
414a593f6b8SAndrew Thompson 	usbd_get_page(pc, 0, &buf_res);
41502ac6454SAndrew Thompson 
41602ac6454SAndrew Thompson 	qh = buf_res.buffer;
41702ac6454SAndrew Thompson 
41802ac6454SAndrew Thompson 	qh->qh_self =
41902ac6454SAndrew Thompson 	    htole32(buf_res.physaddr) |
42002ac6454SAndrew Thompson 	    htole32(UHCI_PTR_QH);
42102ac6454SAndrew Thompson 
42202ac6454SAndrew Thompson 	qh->page_cache = pc;
42302ac6454SAndrew Thompson 
42402ac6454SAndrew Thompson 	return (qh);
42502ac6454SAndrew Thompson }
42602ac6454SAndrew Thompson 
42702ac6454SAndrew Thompson static struct uhci_td *
428760bc48eSAndrew Thompson uhci_init_td(struct usb_page_cache *pc)
42902ac6454SAndrew Thompson {
430760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
43102ac6454SAndrew Thompson 	struct uhci_td *td;
43202ac6454SAndrew Thompson 
433a593f6b8SAndrew Thompson 	usbd_get_page(pc, 0, &buf_res);
43402ac6454SAndrew Thompson 
43502ac6454SAndrew Thompson 	td = buf_res.buffer;
43602ac6454SAndrew Thompson 
43702ac6454SAndrew Thompson 	td->td_self =
43802ac6454SAndrew Thompson 	    htole32(buf_res.physaddr) |
43902ac6454SAndrew Thompson 	    htole32(UHCI_PTR_TD);
44002ac6454SAndrew Thompson 
44102ac6454SAndrew Thompson 	td->page_cache = pc;
44202ac6454SAndrew Thompson 
44302ac6454SAndrew Thompson 	return (td);
44402ac6454SAndrew Thompson }
44502ac6454SAndrew Thompson 
446e0a69b51SAndrew Thompson usb_error_t
44702ac6454SAndrew Thompson uhci_init(uhci_softc_t *sc)
44802ac6454SAndrew Thompson {
44902ac6454SAndrew Thompson 	uint16_t bit;
45002ac6454SAndrew Thompson 	uint16_t x;
45102ac6454SAndrew Thompson 	uint16_t y;
45202ac6454SAndrew Thompson 
45302ac6454SAndrew Thompson 	DPRINTF("start\n");
45402ac6454SAndrew Thompson 
455a593f6b8SAndrew Thompson 	usb_callout_init_mtx(&sc->sc_root_intr, &sc->sc_bus.bus_mtx, 0);
45639307315SAndrew Thompson 
45702ac6454SAndrew Thompson #if USB_DEBUG
45802ac6454SAndrew Thompson 	if (uhcidebug > 2) {
45902ac6454SAndrew Thompson 		uhci_dumpregs(sc);
46002ac6454SAndrew Thompson 	}
46102ac6454SAndrew Thompson #endif
46202ac6454SAndrew Thompson 	sc->sc_saved_sof = 0x40;	/* default value */
46302ac6454SAndrew Thompson 	sc->sc_saved_frnum = 0;		/* default frame number */
46402ac6454SAndrew Thompson 
46502ac6454SAndrew Thompson 	/*
46602ac6454SAndrew Thompson 	 * Setup QH's
46702ac6454SAndrew Thompson 	 */
46802ac6454SAndrew Thompson 	sc->sc_ls_ctl_p_last =
46902ac6454SAndrew Thompson 	    uhci_init_qh(&sc->sc_hw.ls_ctl_start_pc);
47002ac6454SAndrew Thompson 
47102ac6454SAndrew Thompson 	sc->sc_fs_ctl_p_last =
47202ac6454SAndrew Thompson 	    uhci_init_qh(&sc->sc_hw.fs_ctl_start_pc);
47302ac6454SAndrew Thompson 
47402ac6454SAndrew Thompson 	sc->sc_bulk_p_last =
47502ac6454SAndrew Thompson 	    uhci_init_qh(&sc->sc_hw.bulk_start_pc);
47602ac6454SAndrew Thompson #if 0
47702ac6454SAndrew Thompson 	sc->sc_reclaim_qh_p =
47802ac6454SAndrew Thompson 	    sc->sc_fs_ctl_p_last;
47902ac6454SAndrew Thompson #else
48002ac6454SAndrew Thompson 	/* setup reclaim looping point */
48102ac6454SAndrew Thompson 	sc->sc_reclaim_qh_p =
48202ac6454SAndrew Thompson 	    sc->sc_bulk_p_last;
48302ac6454SAndrew Thompson #endif
48402ac6454SAndrew Thompson 
48502ac6454SAndrew Thompson 	sc->sc_last_qh_p =
48602ac6454SAndrew Thompson 	    uhci_init_qh(&sc->sc_hw.last_qh_pc);
48702ac6454SAndrew Thompson 
48802ac6454SAndrew Thompson 	sc->sc_last_td_p =
48902ac6454SAndrew Thompson 	    uhci_init_td(&sc->sc_hw.last_td_pc);
49002ac6454SAndrew Thompson 
49102ac6454SAndrew Thompson 	for (x = 0; x != UHCI_VFRAMELIST_COUNT; x++) {
49202ac6454SAndrew Thompson 		sc->sc_isoc_p_last[x] =
49302ac6454SAndrew Thompson 		    uhci_init_td(sc->sc_hw.isoc_start_pc + x);
49402ac6454SAndrew Thompson 	}
49502ac6454SAndrew Thompson 
49602ac6454SAndrew Thompson 	for (x = 0; x != UHCI_IFRAMELIST_COUNT; x++) {
49702ac6454SAndrew Thompson 		sc->sc_intr_p_last[x] =
49802ac6454SAndrew Thompson 		    uhci_init_qh(sc->sc_hw.intr_start_pc + x);
49902ac6454SAndrew Thompson 	}
50002ac6454SAndrew Thompson 
50102ac6454SAndrew Thompson 	/*
50202ac6454SAndrew Thompson 	 * the QHs are arranged to give poll intervals that are
50302ac6454SAndrew Thompson 	 * powers of 2 times 1ms
50402ac6454SAndrew Thompson 	 */
50502ac6454SAndrew Thompson 	bit = UHCI_IFRAMELIST_COUNT / 2;
50602ac6454SAndrew Thompson 	while (bit) {
50702ac6454SAndrew Thompson 		x = bit;
50802ac6454SAndrew Thompson 		while (x & bit) {
50902ac6454SAndrew Thompson 			uhci_qh_t *qh_x;
51002ac6454SAndrew Thompson 			uhci_qh_t *qh_y;
51102ac6454SAndrew Thompson 
51202ac6454SAndrew Thompson 			y = (x ^ bit) | (bit / 2);
51302ac6454SAndrew Thompson 
51402ac6454SAndrew Thompson 			/*
51502ac6454SAndrew Thompson 			 * the next QH has half the poll interval
51602ac6454SAndrew Thompson 			 */
51702ac6454SAndrew Thompson 			qh_x = sc->sc_intr_p_last[x];
51802ac6454SAndrew Thompson 			qh_y = sc->sc_intr_p_last[y];
51902ac6454SAndrew Thompson 
52002ac6454SAndrew Thompson 			qh_x->h_next = NULL;
52102ac6454SAndrew Thompson 			qh_x->qh_h_next = qh_y->qh_self;
52202ac6454SAndrew Thompson 			qh_x->e_next = NULL;
52302ac6454SAndrew Thompson 			qh_x->qh_e_next = htole32(UHCI_PTR_T);
52402ac6454SAndrew Thompson 			x++;
52502ac6454SAndrew Thompson 		}
52602ac6454SAndrew Thompson 		bit >>= 1;
52702ac6454SAndrew Thompson 	}
52802ac6454SAndrew Thompson 
52902ac6454SAndrew Thompson 	if (1) {
53002ac6454SAndrew Thompson 		uhci_qh_t *qh_ls;
53102ac6454SAndrew Thompson 		uhci_qh_t *qh_intr;
53202ac6454SAndrew Thompson 
53302ac6454SAndrew Thompson 		qh_ls = sc->sc_ls_ctl_p_last;
53402ac6454SAndrew Thompson 		qh_intr = sc->sc_intr_p_last[0];
53502ac6454SAndrew Thompson 
53602ac6454SAndrew Thompson 		/* start QH for interrupt traffic */
53702ac6454SAndrew Thompson 		qh_intr->h_next = qh_ls;
53802ac6454SAndrew Thompson 		qh_intr->qh_h_next = qh_ls->qh_self;
53902ac6454SAndrew Thompson 		qh_intr->e_next = 0;
54002ac6454SAndrew Thompson 		qh_intr->qh_e_next = htole32(UHCI_PTR_T);
54102ac6454SAndrew Thompson 	}
54202ac6454SAndrew Thompson 	for (x = 0; x != UHCI_VFRAMELIST_COUNT; x++) {
54302ac6454SAndrew Thompson 
54402ac6454SAndrew Thompson 		uhci_td_t *td_x;
54502ac6454SAndrew Thompson 		uhci_qh_t *qh_intr;
54602ac6454SAndrew Thompson 
54702ac6454SAndrew Thompson 		td_x = sc->sc_isoc_p_last[x];
54802ac6454SAndrew Thompson 		qh_intr = sc->sc_intr_p_last[x | (UHCI_IFRAMELIST_COUNT / 2)];
54902ac6454SAndrew Thompson 
55002ac6454SAndrew Thompson 		/* start TD for isochronous traffic */
55102ac6454SAndrew Thompson 		td_x->next = NULL;
55202ac6454SAndrew Thompson 		td_x->td_next = qh_intr->qh_self;
55302ac6454SAndrew Thompson 		td_x->td_status = htole32(UHCI_TD_IOS);
55402ac6454SAndrew Thompson 		td_x->td_token = htole32(0);
55502ac6454SAndrew Thompson 		td_x->td_buffer = htole32(0);
55602ac6454SAndrew Thompson 	}
55702ac6454SAndrew Thompson 
55802ac6454SAndrew Thompson 	if (1) {
55902ac6454SAndrew Thompson 		uhci_qh_t *qh_ls;
56002ac6454SAndrew Thompson 		uhci_qh_t *qh_fs;
56102ac6454SAndrew Thompson 
56202ac6454SAndrew Thompson 		qh_ls = sc->sc_ls_ctl_p_last;
56302ac6454SAndrew Thompson 		qh_fs = sc->sc_fs_ctl_p_last;
56402ac6454SAndrew Thompson 
56502ac6454SAndrew Thompson 		/* start QH where low speed control traffic will be queued */
56602ac6454SAndrew Thompson 		qh_ls->h_next = qh_fs;
56702ac6454SAndrew Thompson 		qh_ls->qh_h_next = qh_fs->qh_self;
56802ac6454SAndrew Thompson 		qh_ls->e_next = 0;
56902ac6454SAndrew Thompson 		qh_ls->qh_e_next = htole32(UHCI_PTR_T);
57002ac6454SAndrew Thompson 	}
57102ac6454SAndrew Thompson 	if (1) {
57202ac6454SAndrew Thompson 		uhci_qh_t *qh_ctl;
57302ac6454SAndrew Thompson 		uhci_qh_t *qh_blk;
57402ac6454SAndrew Thompson 		uhci_qh_t *qh_lst;
57502ac6454SAndrew Thompson 		uhci_td_t *td_lst;
57602ac6454SAndrew Thompson 
57702ac6454SAndrew Thompson 		qh_ctl = sc->sc_fs_ctl_p_last;
57802ac6454SAndrew Thompson 		qh_blk = sc->sc_bulk_p_last;
57902ac6454SAndrew Thompson 
58002ac6454SAndrew Thompson 		/* start QH where full speed control traffic will be queued */
58102ac6454SAndrew Thompson 		qh_ctl->h_next = qh_blk;
58202ac6454SAndrew Thompson 		qh_ctl->qh_h_next = qh_blk->qh_self;
58302ac6454SAndrew Thompson 		qh_ctl->e_next = 0;
58402ac6454SAndrew Thompson 		qh_ctl->qh_e_next = htole32(UHCI_PTR_T);
58502ac6454SAndrew Thompson 
58602ac6454SAndrew Thompson 		qh_lst = sc->sc_last_qh_p;
58702ac6454SAndrew Thompson 
58802ac6454SAndrew Thompson 		/* start QH where bulk traffic will be queued */
58902ac6454SAndrew Thompson 		qh_blk->h_next = qh_lst;
59002ac6454SAndrew Thompson 		qh_blk->qh_h_next = qh_lst->qh_self;
59102ac6454SAndrew Thompson 		qh_blk->e_next = 0;
59202ac6454SAndrew Thompson 		qh_blk->qh_e_next = htole32(UHCI_PTR_T);
59302ac6454SAndrew Thompson 
59402ac6454SAndrew Thompson 		td_lst = sc->sc_last_td_p;
59502ac6454SAndrew Thompson 
59602ac6454SAndrew Thompson 		/* end QH which is used for looping the QHs */
59702ac6454SAndrew Thompson 		qh_lst->h_next = 0;
59802ac6454SAndrew Thompson 		qh_lst->qh_h_next = htole32(UHCI_PTR_T);	/* end of QH chain */
59902ac6454SAndrew Thompson 		qh_lst->e_next = td_lst;
60002ac6454SAndrew Thompson 		qh_lst->qh_e_next = td_lst->td_self;
60102ac6454SAndrew Thompson 
60202ac6454SAndrew Thompson 		/*
60302ac6454SAndrew Thompson 		 * end TD which hangs from the last QH, to avoid a bug in the PIIX
60402ac6454SAndrew Thompson 		 * that makes it run berserk otherwise
60502ac6454SAndrew Thompson 		 */
60602ac6454SAndrew Thompson 		td_lst->next = 0;
60702ac6454SAndrew Thompson 		td_lst->td_next = htole32(UHCI_PTR_T);
60802ac6454SAndrew Thompson 		td_lst->td_status = htole32(0);	/* inactive */
60902ac6454SAndrew Thompson 		td_lst->td_token = htole32(0);
61002ac6454SAndrew Thompson 		td_lst->td_buffer = htole32(0);
61102ac6454SAndrew Thompson 	}
61202ac6454SAndrew Thompson 	if (1) {
613760bc48eSAndrew Thompson 		struct usb_page_search buf_res;
61402ac6454SAndrew Thompson 		uint32_t *pframes;
61502ac6454SAndrew Thompson 
616a593f6b8SAndrew Thompson 		usbd_get_page(&sc->sc_hw.pframes_pc, 0, &buf_res);
61702ac6454SAndrew Thompson 
61802ac6454SAndrew Thompson 		pframes = buf_res.buffer;
61902ac6454SAndrew Thompson 
62002ac6454SAndrew Thompson 
62102ac6454SAndrew Thompson 		/*
62202ac6454SAndrew Thompson 		 * Setup UHCI framelist
62302ac6454SAndrew Thompson 		 *
62402ac6454SAndrew Thompson 		 * Execution order:
62502ac6454SAndrew Thompson 		 *
62602ac6454SAndrew Thompson 		 * pframes -> full speed isochronous -> interrupt QH's -> low
62702ac6454SAndrew Thompson 		 * speed control -> full speed control -> bulk transfers
62802ac6454SAndrew Thompson 		 *
62902ac6454SAndrew Thompson 		 */
63002ac6454SAndrew Thompson 
63102ac6454SAndrew Thompson 		for (x = 0; x != UHCI_FRAMELIST_COUNT; x++) {
63202ac6454SAndrew Thompson 			pframes[x] =
63302ac6454SAndrew Thompson 			    sc->sc_isoc_p_last[x % UHCI_VFRAMELIST_COUNT]->td_self;
63402ac6454SAndrew Thompson 		}
63502ac6454SAndrew Thompson 	}
63602ac6454SAndrew Thompson 	/* flush all cache into memory */
63702ac6454SAndrew Thompson 
638a593f6b8SAndrew Thompson 	usb_bus_mem_flush_all(&sc->sc_bus, &uhci_iterate_hw_softc);
63902ac6454SAndrew Thompson 
64002ac6454SAndrew Thompson 	/* set up the bus struct */
64102ac6454SAndrew Thompson 	sc->sc_bus.methods = &uhci_bus_methods;
64202ac6454SAndrew Thompson 
64302ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
64402ac6454SAndrew Thompson 	/* reset the controller */
64502ac6454SAndrew Thompson 	uhci_reset(sc);
64602ac6454SAndrew Thompson 
64702ac6454SAndrew Thompson 	/* start the controller */
64802ac6454SAndrew Thompson 	uhci_start(sc);
64902ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
65002ac6454SAndrew Thompson 
65102ac6454SAndrew Thompson 	/* catch lost interrupts */
65202ac6454SAndrew Thompson 	uhci_do_poll(&sc->sc_bus);
65302ac6454SAndrew Thompson 
65402ac6454SAndrew Thompson 	return (0);
65502ac6454SAndrew Thompson }
65602ac6454SAndrew Thompson 
65702ac6454SAndrew Thompson /* NOTE: suspend/resume is called from
65802ac6454SAndrew Thompson  * interrupt context and cannot sleep!
65902ac6454SAndrew Thompson  */
66002ac6454SAndrew Thompson 
66102ac6454SAndrew Thompson void
66202ac6454SAndrew Thompson uhci_suspend(uhci_softc_t *sc)
66302ac6454SAndrew Thompson {
66402ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
66502ac6454SAndrew Thompson 
66602ac6454SAndrew Thompson #if USB_DEBUG
66702ac6454SAndrew Thompson 	if (uhcidebug > 2) {
66802ac6454SAndrew Thompson 		uhci_dumpregs(sc);
66902ac6454SAndrew Thompson 	}
67002ac6454SAndrew Thompson #endif
67102ac6454SAndrew Thompson 	/* save some state if BIOS doesn't */
67202ac6454SAndrew Thompson 
67302ac6454SAndrew Thompson 	sc->sc_saved_frnum = UREAD2(sc, UHCI_FRNUM);
67402ac6454SAndrew Thompson 	sc->sc_saved_sof = UREAD1(sc, UHCI_SOF);
67502ac6454SAndrew Thompson 
67602ac6454SAndrew Thompson 	/* stop the controller */
67702ac6454SAndrew Thompson 
67802ac6454SAndrew Thompson 	uhci_reset(sc);
67902ac6454SAndrew Thompson 
68002ac6454SAndrew Thompson 	/* enter global suspend */
68102ac6454SAndrew Thompson 
68202ac6454SAndrew Thompson 	UHCICMD(sc, UHCI_CMD_EGSM);
68302ac6454SAndrew Thompson 
684a593f6b8SAndrew Thompson 	usb_pause_mtx(&sc->sc_bus.bus_mtx,
68502ac6454SAndrew Thompson 	    USB_MS_TO_TICKS(USB_RESUME_WAIT));
68602ac6454SAndrew Thompson 
68702ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
68802ac6454SAndrew Thompson }
68902ac6454SAndrew Thompson 
69002ac6454SAndrew Thompson void
69102ac6454SAndrew Thompson uhci_resume(uhci_softc_t *sc)
69202ac6454SAndrew Thompson {
69302ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
69402ac6454SAndrew Thompson 
69502ac6454SAndrew Thompson 	/* reset the controller */
69602ac6454SAndrew Thompson 
69702ac6454SAndrew Thompson 	uhci_reset(sc);
69802ac6454SAndrew Thompson 
69902ac6454SAndrew Thompson 	/* force global resume */
70002ac6454SAndrew Thompson 
70102ac6454SAndrew Thompson 	UHCICMD(sc, UHCI_CMD_FGR);
70202ac6454SAndrew Thompson 
703a593f6b8SAndrew Thompson 	usb_pause_mtx(&sc->sc_bus.bus_mtx,
70402ac6454SAndrew Thompson 	    USB_MS_TO_TICKS(USB_RESUME_DELAY));
70502ac6454SAndrew Thompson 
70602ac6454SAndrew Thompson 	/* and start traffic again */
70702ac6454SAndrew Thompson 
70802ac6454SAndrew Thompson 	uhci_start(sc);
70902ac6454SAndrew Thompson 
71002ac6454SAndrew Thompson #if USB_DEBUG
71102ac6454SAndrew Thompson 	if (uhcidebug > 2) {
71202ac6454SAndrew Thompson 		uhci_dumpregs(sc);
71302ac6454SAndrew Thompson 	}
71402ac6454SAndrew Thompson #endif
71502ac6454SAndrew Thompson 
71602ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
71702ac6454SAndrew Thompson 
71802ac6454SAndrew Thompson 	/* catch lost interrupts */
71902ac6454SAndrew Thompson 	uhci_do_poll(&sc->sc_bus);
72002ac6454SAndrew Thompson }
72102ac6454SAndrew Thompson 
72202ac6454SAndrew Thompson #if USB_DEBUG
72302ac6454SAndrew Thompson static void
72402ac6454SAndrew Thompson uhci_dumpregs(uhci_softc_t *sc)
72502ac6454SAndrew Thompson {
72602ac6454SAndrew Thompson 	DPRINTFN(0, "%s regs: cmd=%04x, sts=%04x, intr=%04x, frnum=%04x, "
72702ac6454SAndrew Thompson 	    "flbase=%08x, sof=%04x, portsc1=%04x, portsc2=%04x\n",
72802ac6454SAndrew Thompson 	    device_get_nameunit(sc->sc_bus.bdev),
72902ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_CMD),
73002ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_STS),
73102ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_INTR),
73202ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_FRNUM),
73302ac6454SAndrew Thompson 	    UREAD4(sc, UHCI_FLBASEADDR),
73402ac6454SAndrew Thompson 	    UREAD1(sc, UHCI_SOF),
73502ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_PORTSC1),
73602ac6454SAndrew Thompson 	    UREAD2(sc, UHCI_PORTSC2));
73702ac6454SAndrew Thompson }
73802ac6454SAndrew Thompson 
73902ac6454SAndrew Thompson static uint8_t
74002ac6454SAndrew Thompson uhci_dump_td(uhci_td_t *p)
74102ac6454SAndrew Thompson {
74202ac6454SAndrew Thompson 	uint32_t td_next;
74302ac6454SAndrew Thompson 	uint32_t td_status;
74402ac6454SAndrew Thompson 	uint32_t td_token;
74502ac6454SAndrew Thompson 	uint8_t temp;
74602ac6454SAndrew Thompson 
747a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(p->page_cache);
74802ac6454SAndrew Thompson 
74902ac6454SAndrew Thompson 	td_next = le32toh(p->td_next);
75002ac6454SAndrew Thompson 	td_status = le32toh(p->td_status);
75102ac6454SAndrew Thompson 	td_token = le32toh(p->td_token);
75202ac6454SAndrew Thompson 
75302ac6454SAndrew Thompson 	/*
75402ac6454SAndrew Thompson 	 * Check whether the link pointer in this TD marks the link pointer
75502ac6454SAndrew Thompson 	 * as end of queue:
75602ac6454SAndrew Thompson 	 */
75702ac6454SAndrew Thompson 	temp = ((td_next & UHCI_PTR_T) || (td_next == 0));
75802ac6454SAndrew Thompson 
75902ac6454SAndrew Thompson 	printf("TD(%p) at 0x%08x = link=0x%08x status=0x%08x "
76002ac6454SAndrew Thompson 	    "token=0x%08x buffer=0x%08x\n",
76102ac6454SAndrew Thompson 	    p,
76202ac6454SAndrew Thompson 	    le32toh(p->td_self),
76302ac6454SAndrew Thompson 	    td_next,
76402ac6454SAndrew Thompson 	    td_status,
76502ac6454SAndrew Thompson 	    td_token,
76602ac6454SAndrew Thompson 	    le32toh(p->td_buffer));
76702ac6454SAndrew Thompson 
76802ac6454SAndrew Thompson 	printf("TD(%p) td_next=%s%s%s td_status=%s%s%s%s%s%s%s%s%s%s%s, errcnt=%d, actlen=%d pid=%02x,"
76902ac6454SAndrew Thompson 	    "addr=%d,endpt=%d,D=%d,maxlen=%d\n",
77002ac6454SAndrew Thompson 	    p,
77102ac6454SAndrew Thompson 	    (td_next & 1) ? "-T" : "",
77202ac6454SAndrew Thompson 	    (td_next & 2) ? "-Q" : "",
77302ac6454SAndrew Thompson 	    (td_next & 4) ? "-VF" : "",
77402ac6454SAndrew Thompson 	    (td_status & UHCI_TD_BITSTUFF) ? "-BITSTUFF" : "",
77502ac6454SAndrew Thompson 	    (td_status & UHCI_TD_CRCTO) ? "-CRCTO" : "",
77602ac6454SAndrew Thompson 	    (td_status & UHCI_TD_NAK) ? "-NAK" : "",
77702ac6454SAndrew Thompson 	    (td_status & UHCI_TD_BABBLE) ? "-BABBLE" : "",
77802ac6454SAndrew Thompson 	    (td_status & UHCI_TD_DBUFFER) ? "-DBUFFER" : "",
77902ac6454SAndrew Thompson 	    (td_status & UHCI_TD_STALLED) ? "-STALLED" : "",
78002ac6454SAndrew Thompson 	    (td_status & UHCI_TD_ACTIVE) ? "-ACTIVE" : "",
78102ac6454SAndrew Thompson 	    (td_status & UHCI_TD_IOC) ? "-IOC" : "",
78202ac6454SAndrew Thompson 	    (td_status & UHCI_TD_IOS) ? "-IOS" : "",
78302ac6454SAndrew Thompson 	    (td_status & UHCI_TD_LS) ? "-LS" : "",
78402ac6454SAndrew Thompson 	    (td_status & UHCI_TD_SPD) ? "-SPD" : "",
78502ac6454SAndrew Thompson 	    UHCI_TD_GET_ERRCNT(td_status),
78602ac6454SAndrew Thompson 	    UHCI_TD_GET_ACTLEN(td_status),
78702ac6454SAndrew Thompson 	    UHCI_TD_GET_PID(td_token),
78802ac6454SAndrew Thompson 	    UHCI_TD_GET_DEVADDR(td_token),
78902ac6454SAndrew Thompson 	    UHCI_TD_GET_ENDPT(td_token),
79002ac6454SAndrew Thompson 	    UHCI_TD_GET_DT(td_token),
79102ac6454SAndrew Thompson 	    UHCI_TD_GET_MAXLEN(td_token));
79202ac6454SAndrew Thompson 
79302ac6454SAndrew Thompson 	return (temp);
79402ac6454SAndrew Thompson }
79502ac6454SAndrew Thompson 
79602ac6454SAndrew Thompson static uint8_t
79702ac6454SAndrew Thompson uhci_dump_qh(uhci_qh_t *sqh)
79802ac6454SAndrew Thompson {
79902ac6454SAndrew Thompson 	uint8_t temp;
80002ac6454SAndrew Thompson 	uint32_t qh_h_next;
80102ac6454SAndrew Thompson 	uint32_t qh_e_next;
80202ac6454SAndrew Thompson 
803a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(sqh->page_cache);
80402ac6454SAndrew Thompson 
80502ac6454SAndrew Thompson 	qh_h_next = le32toh(sqh->qh_h_next);
80602ac6454SAndrew Thompson 	qh_e_next = le32toh(sqh->qh_e_next);
80702ac6454SAndrew Thompson 
80802ac6454SAndrew Thompson 	DPRINTFN(0, "QH(%p) at 0x%08x: h_next=0x%08x e_next=0x%08x\n", sqh,
80902ac6454SAndrew Thompson 	    le32toh(sqh->qh_self), qh_h_next, qh_e_next);
81002ac6454SAndrew Thompson 
81102ac6454SAndrew Thompson 	temp = ((((sqh->h_next != NULL) && !(qh_h_next & UHCI_PTR_T)) ? 1 : 0) |
81202ac6454SAndrew Thompson 	    (((sqh->e_next != NULL) && !(qh_e_next & UHCI_PTR_T)) ? 2 : 0));
81302ac6454SAndrew Thompson 
81402ac6454SAndrew Thompson 	return (temp);
81502ac6454SAndrew Thompson }
81602ac6454SAndrew Thompson 
81702ac6454SAndrew Thompson static void
81802ac6454SAndrew Thompson uhci_dump_all(uhci_softc_t *sc)
81902ac6454SAndrew Thompson {
82002ac6454SAndrew Thompson 	uhci_dumpregs(sc);
82102ac6454SAndrew Thompson 	uhci_dump_qh(sc->sc_ls_ctl_p_last);
82202ac6454SAndrew Thompson 	uhci_dump_qh(sc->sc_fs_ctl_p_last);
82302ac6454SAndrew Thompson 	uhci_dump_qh(sc->sc_bulk_p_last);
82402ac6454SAndrew Thompson 	uhci_dump_qh(sc->sc_last_qh_p);
82502ac6454SAndrew Thompson }
82602ac6454SAndrew Thompson 
82702ac6454SAndrew Thompson static void
82802ac6454SAndrew Thompson uhci_dump_qhs(uhci_qh_t *sqh)
82902ac6454SAndrew Thompson {
83002ac6454SAndrew Thompson 	uint8_t temp;
83102ac6454SAndrew Thompson 
83202ac6454SAndrew Thompson 	temp = uhci_dump_qh(sqh);
83302ac6454SAndrew Thompson 
83402ac6454SAndrew Thompson 	/*
83502ac6454SAndrew Thompson 	 * uhci_dump_qhs displays all the QHs and TDs from the given QH
83602ac6454SAndrew Thompson 	 * onwards Traverses sideways first, then down.
83702ac6454SAndrew Thompson 	 *
83802ac6454SAndrew Thompson 	 * QH1 QH2 No QH TD2.1 TD2.2 TD1.1 etc.
83902ac6454SAndrew Thompson 	 *
84002ac6454SAndrew Thompson 	 * TD2.x being the TDs queued at QH2 and QH1 being referenced from QH1.
84102ac6454SAndrew Thompson 	 */
84202ac6454SAndrew Thompson 
84302ac6454SAndrew Thompson 	if (temp & 1)
84402ac6454SAndrew Thompson 		uhci_dump_qhs(sqh->h_next);
84502ac6454SAndrew Thompson 	else
84602ac6454SAndrew Thompson 		DPRINTF("No QH\n");
84702ac6454SAndrew Thompson 
84802ac6454SAndrew Thompson 	if (temp & 2)
84902ac6454SAndrew Thompson 		uhci_dump_tds(sqh->e_next);
85002ac6454SAndrew Thompson 	else
85102ac6454SAndrew Thompson 		DPRINTF("No TD\n");
85202ac6454SAndrew Thompson }
85302ac6454SAndrew Thompson 
85402ac6454SAndrew Thompson static void
85502ac6454SAndrew Thompson uhci_dump_tds(uhci_td_t *td)
85602ac6454SAndrew Thompson {
85702ac6454SAndrew Thompson 	for (;
85802ac6454SAndrew Thompson 	    td != NULL;
85902ac6454SAndrew Thompson 	    td = td->obj_next) {
86002ac6454SAndrew Thompson 		if (uhci_dump_td(td)) {
86102ac6454SAndrew Thompson 			break;
86202ac6454SAndrew Thompson 		}
86302ac6454SAndrew Thompson 	}
86402ac6454SAndrew Thompson }
86502ac6454SAndrew Thompson 
86602ac6454SAndrew Thompson #endif
86702ac6454SAndrew Thompson 
86802ac6454SAndrew Thompson /*
86902ac6454SAndrew Thompson  * Let the last QH loop back to the full speed control transfer QH.
87002ac6454SAndrew Thompson  * This is what intel calls "bandwidth reclamation" and improves
87102ac6454SAndrew Thompson  * USB performance a lot for some devices.
87202ac6454SAndrew Thompson  * If we are already looping, just count it.
87302ac6454SAndrew Thompson  */
87402ac6454SAndrew Thompson static void
87502ac6454SAndrew Thompson uhci_add_loop(uhci_softc_t *sc)
87602ac6454SAndrew Thompson {
87702ac6454SAndrew Thompson 	struct uhci_qh *qh_lst;
87802ac6454SAndrew Thompson 	struct uhci_qh *qh_rec;
87902ac6454SAndrew Thompson 
88002ac6454SAndrew Thompson #if USB_DEBUG
88102ac6454SAndrew Thompson 	if (uhcinoloop) {
88202ac6454SAndrew Thompson 		return;
88302ac6454SAndrew Thompson 	}
88402ac6454SAndrew Thompson #endif
88502ac6454SAndrew Thompson 	if (++(sc->sc_loops) == 1) {
88602ac6454SAndrew Thompson 		DPRINTFN(6, "add\n");
88702ac6454SAndrew Thompson 
88802ac6454SAndrew Thompson 		qh_lst = sc->sc_last_qh_p;
88902ac6454SAndrew Thompson 		qh_rec = sc->sc_reclaim_qh_p;
89002ac6454SAndrew Thompson 
89102ac6454SAndrew Thompson 		/* NOTE: we don't loop back the soft pointer */
89202ac6454SAndrew Thompson 
89302ac6454SAndrew Thompson 		qh_lst->qh_h_next = qh_rec->qh_self;
894a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(qh_lst->page_cache);
89502ac6454SAndrew Thompson 	}
89602ac6454SAndrew Thompson }
89702ac6454SAndrew Thompson 
89802ac6454SAndrew Thompson static void
89902ac6454SAndrew Thompson uhci_rem_loop(uhci_softc_t *sc)
90002ac6454SAndrew Thompson {
90102ac6454SAndrew Thompson 	struct uhci_qh *qh_lst;
90202ac6454SAndrew Thompson 
90302ac6454SAndrew Thompson #if USB_DEBUG
90402ac6454SAndrew Thompson 	if (uhcinoloop) {
90502ac6454SAndrew Thompson 		return;
90602ac6454SAndrew Thompson 	}
90702ac6454SAndrew Thompson #endif
90802ac6454SAndrew Thompson 	if (--(sc->sc_loops) == 0) {
90902ac6454SAndrew Thompson 		DPRINTFN(6, "remove\n");
91002ac6454SAndrew Thompson 
91102ac6454SAndrew Thompson 		qh_lst = sc->sc_last_qh_p;
91202ac6454SAndrew Thompson 		qh_lst->qh_h_next = htole32(UHCI_PTR_T);
913a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(qh_lst->page_cache);
91402ac6454SAndrew Thompson 	}
91502ac6454SAndrew Thompson }
91602ac6454SAndrew Thompson 
91702ac6454SAndrew Thompson static void
918760bc48eSAndrew Thompson uhci_transfer_intr_enqueue(struct usb_xfer *xfer)
91902ac6454SAndrew Thompson {
92002ac6454SAndrew Thompson 	/* check for early completion */
92102ac6454SAndrew Thompson 	if (uhci_check_transfer(xfer)) {
92202ac6454SAndrew Thompson 		return;
92302ac6454SAndrew Thompson 	}
92402ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
925a593f6b8SAndrew Thompson 	usbd_transfer_enqueue(&xfer->xroot->bus->intr_q, xfer);
92602ac6454SAndrew Thompson 
92702ac6454SAndrew Thompson 	/* start timeout, if any */
92802ac6454SAndrew Thompson 	if (xfer->timeout != 0) {
929a593f6b8SAndrew Thompson 		usbd_transfer_timeout_ms(xfer, &uhci_timeout, xfer->timeout);
93002ac6454SAndrew Thompson 	}
93102ac6454SAndrew Thompson }
93202ac6454SAndrew Thompson 
93302ac6454SAndrew Thompson #define	UHCI_APPEND_TD(std,last) (last) = _uhci_append_td(std,last)
93402ac6454SAndrew Thompson static uhci_td_t *
93502ac6454SAndrew Thompson _uhci_append_td(uhci_td_t *std, uhci_td_t *last)
93602ac6454SAndrew Thompson {
93702ac6454SAndrew Thompson 	DPRINTFN(11, "%p to %p\n", std, last);
93802ac6454SAndrew Thompson 
93902ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
94002ac6454SAndrew Thompson 
94102ac6454SAndrew Thompson 	std->next = last->next;
94202ac6454SAndrew Thompson 	std->td_next = last->td_next;
94302ac6454SAndrew Thompson 
94402ac6454SAndrew Thompson 	std->prev = last;
94502ac6454SAndrew Thompson 
946a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->page_cache);
94702ac6454SAndrew Thompson 
94802ac6454SAndrew Thompson 	/*
94902ac6454SAndrew Thompson 	 * the last->next->prev is never followed: std->next->prev = std;
95002ac6454SAndrew Thompson 	 */
95102ac6454SAndrew Thompson 	last->next = std;
95202ac6454SAndrew Thompson 	last->td_next = std->td_self;
95302ac6454SAndrew Thompson 
954a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(last->page_cache);
95502ac6454SAndrew Thompson 
95602ac6454SAndrew Thompson 	return (std);
95702ac6454SAndrew Thompson }
95802ac6454SAndrew Thompson 
95902ac6454SAndrew Thompson #define	UHCI_APPEND_QH(sqh,last) (last) = _uhci_append_qh(sqh,last)
96002ac6454SAndrew Thompson static uhci_qh_t *
96102ac6454SAndrew Thompson _uhci_append_qh(uhci_qh_t *sqh, uhci_qh_t *last)
96202ac6454SAndrew Thompson {
96302ac6454SAndrew Thompson 	DPRINTFN(11, "%p to %p\n", sqh, last);
96402ac6454SAndrew Thompson 
96502ac6454SAndrew Thompson 	if (sqh->h_prev != NULL) {
96602ac6454SAndrew Thompson 		/* should not happen */
96702ac6454SAndrew Thompson 		DPRINTFN(0, "QH already linked!\n");
96802ac6454SAndrew Thompson 		return (last);
96902ac6454SAndrew Thompson 	}
97002ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
97102ac6454SAndrew Thompson 
97202ac6454SAndrew Thompson 	sqh->h_next = last->h_next;
97302ac6454SAndrew Thompson 	sqh->qh_h_next = last->qh_h_next;
97402ac6454SAndrew Thompson 
97502ac6454SAndrew Thompson 	sqh->h_prev = last;
97602ac6454SAndrew Thompson 
977a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(sqh->page_cache);
97802ac6454SAndrew Thompson 
97902ac6454SAndrew Thompson 	/*
98002ac6454SAndrew Thompson 	 * The "last->h_next->h_prev" is never followed:
98102ac6454SAndrew Thompson 	 *
98202ac6454SAndrew Thompson 	 * "sqh->h_next->h_prev" = sqh;
98302ac6454SAndrew Thompson 	 */
98402ac6454SAndrew Thompson 
98502ac6454SAndrew Thompson 	last->h_next = sqh;
98602ac6454SAndrew Thompson 	last->qh_h_next = sqh->qh_self;
98702ac6454SAndrew Thompson 
988a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(last->page_cache);
98902ac6454SAndrew Thompson 
99002ac6454SAndrew Thompson 	return (sqh);
99102ac6454SAndrew Thompson }
99202ac6454SAndrew Thompson 
99302ac6454SAndrew Thompson /**/
99402ac6454SAndrew Thompson 
99502ac6454SAndrew Thompson #define	UHCI_REMOVE_TD(std,last) (last) = _uhci_remove_td(std,last)
99602ac6454SAndrew Thompson static uhci_td_t *
99702ac6454SAndrew Thompson _uhci_remove_td(uhci_td_t *std, uhci_td_t *last)
99802ac6454SAndrew Thompson {
99902ac6454SAndrew Thompson 	DPRINTFN(11, "%p from %p\n", std, last);
100002ac6454SAndrew Thompson 
100102ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
100202ac6454SAndrew Thompson 
100302ac6454SAndrew Thompson 	std->prev->next = std->next;
100402ac6454SAndrew Thompson 	std->prev->td_next = std->td_next;
100502ac6454SAndrew Thompson 
1006a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->prev->page_cache);
100702ac6454SAndrew Thompson 
100802ac6454SAndrew Thompson 	if (std->next) {
100902ac6454SAndrew Thompson 		std->next->prev = std->prev;
1010a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(std->next->page_cache);
101102ac6454SAndrew Thompson 	}
101202ac6454SAndrew Thompson 	return ((last == std) ? std->prev : last);
101302ac6454SAndrew Thompson }
101402ac6454SAndrew Thompson 
101502ac6454SAndrew Thompson #define	UHCI_REMOVE_QH(sqh,last) (last) = _uhci_remove_qh(sqh,last)
101602ac6454SAndrew Thompson static uhci_qh_t *
101702ac6454SAndrew Thompson _uhci_remove_qh(uhci_qh_t *sqh, uhci_qh_t *last)
101802ac6454SAndrew Thompson {
101902ac6454SAndrew Thompson 	DPRINTFN(11, "%p from %p\n", sqh, last);
102002ac6454SAndrew Thompson 
102102ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
102202ac6454SAndrew Thompson 
102302ac6454SAndrew Thompson 	/* only remove if not removed from a queue */
102402ac6454SAndrew Thompson 	if (sqh->h_prev) {
102502ac6454SAndrew Thompson 
102602ac6454SAndrew Thompson 		sqh->h_prev->h_next = sqh->h_next;
102702ac6454SAndrew Thompson 		sqh->h_prev->qh_h_next = sqh->qh_h_next;
102802ac6454SAndrew Thompson 
1029a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(sqh->h_prev->page_cache);
103002ac6454SAndrew Thompson 
103102ac6454SAndrew Thompson 		if (sqh->h_next) {
103202ac6454SAndrew Thompson 			sqh->h_next->h_prev = sqh->h_prev;
1033a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(sqh->h_next->page_cache);
103402ac6454SAndrew Thompson 		}
103502ac6454SAndrew Thompson 		last = ((last == sqh) ? sqh->h_prev : last);
103602ac6454SAndrew Thompson 
103702ac6454SAndrew Thompson 		sqh->h_prev = 0;
103802ac6454SAndrew Thompson 
1039a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(sqh->page_cache);
104002ac6454SAndrew Thompson 	}
104102ac6454SAndrew Thompson 	return (last);
104202ac6454SAndrew Thompson }
104302ac6454SAndrew Thompson 
104402ac6454SAndrew Thompson static void
1045760bc48eSAndrew Thompson uhci_isoc_done(uhci_softc_t *sc, struct usb_xfer *xfer)
104602ac6454SAndrew Thompson {
1047760bc48eSAndrew Thompson 	struct usb_page_search res;
104802ac6454SAndrew Thompson 	uint32_t nframes = xfer->nframes;
104902ac6454SAndrew Thompson 	uint32_t status;
105002ac6454SAndrew Thompson 	uint32_t offset = 0;
105102ac6454SAndrew Thompson 	uint32_t *plen = xfer->frlengths;
105202ac6454SAndrew Thompson 	uint16_t len = 0;
105302ac6454SAndrew Thompson 	uhci_td_t *td = xfer->td_transfer_first;
105402ac6454SAndrew Thompson 	uhci_td_t **pp_last = &sc->sc_isoc_p_last[xfer->qh_pos];
105502ac6454SAndrew Thompson 
1056ae60fdfbSAndrew Thompson 	DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n",
1057ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint);
105802ac6454SAndrew Thompson 
105902ac6454SAndrew Thompson 	/* sync any DMA memory before doing fixups */
106002ac6454SAndrew Thompson 
1061a593f6b8SAndrew Thompson 	usb_bdma_post_sync(xfer);
106202ac6454SAndrew Thompson 
106302ac6454SAndrew Thompson 	while (nframes--) {
106402ac6454SAndrew Thompson 		if (td == NULL) {
106502ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
106602ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
106702ac6454SAndrew Thompson 		}
106802ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_p_last[UHCI_VFRAMELIST_COUNT]) {
106902ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_p_last[0];
107002ac6454SAndrew Thompson 		}
107102ac6454SAndrew Thompson #if USB_DEBUG
107202ac6454SAndrew Thompson 		if (uhcidebug > 5) {
107302ac6454SAndrew Thompson 			DPRINTF("isoc TD\n");
107402ac6454SAndrew Thompson 			uhci_dump_td(td);
107502ac6454SAndrew Thompson 		}
107602ac6454SAndrew Thompson #endif
1077a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
107802ac6454SAndrew Thompson 		status = le32toh(td->td_status);
107902ac6454SAndrew Thompson 
108002ac6454SAndrew Thompson 		len = UHCI_TD_GET_ACTLEN(status);
108102ac6454SAndrew Thompson 
108202ac6454SAndrew Thompson 		if (len > *plen) {
108302ac6454SAndrew Thompson 			len = *plen;
108402ac6454SAndrew Thompson 		}
108502ac6454SAndrew Thompson 		if (td->fix_pc) {
108602ac6454SAndrew Thompson 
1087a593f6b8SAndrew Thompson 			usbd_get_page(td->fix_pc, 0, &res);
108802ac6454SAndrew Thompson 
108902ac6454SAndrew Thompson 			/* copy data from fixup location to real location */
109002ac6454SAndrew Thompson 
1091a593f6b8SAndrew Thompson 			usb_pc_cpu_invalidate(td->fix_pc);
109202ac6454SAndrew Thompson 
1093a593f6b8SAndrew Thompson 			usbd_copy_in(xfer->frbuffers, offset,
109402ac6454SAndrew Thompson 			    res.buffer, len);
109502ac6454SAndrew Thompson 		}
109602ac6454SAndrew Thompson 		offset += *plen;
109702ac6454SAndrew Thompson 
109802ac6454SAndrew Thompson 		*plen = len;
109902ac6454SAndrew Thompson 
110002ac6454SAndrew Thompson 		/* remove TD from schedule */
110102ac6454SAndrew Thompson 		UHCI_REMOVE_TD(td, *pp_last);
110202ac6454SAndrew Thompson 
110302ac6454SAndrew Thompson 		pp_last++;
110402ac6454SAndrew Thompson 		plen++;
110502ac6454SAndrew Thompson 		td = td->obj_next;
110602ac6454SAndrew Thompson 	}
110702ac6454SAndrew Thompson 
110802ac6454SAndrew Thompson 	xfer->aframes = xfer->nframes;
110902ac6454SAndrew Thompson }
111002ac6454SAndrew Thompson 
1111e0a69b51SAndrew Thompson static usb_error_t
1112760bc48eSAndrew Thompson uhci_non_isoc_done_sub(struct usb_xfer *xfer)
111302ac6454SAndrew Thompson {
1114760bc48eSAndrew Thompson 	struct usb_page_search res;
111502ac6454SAndrew Thompson 	uhci_td_t *td;
111602ac6454SAndrew Thompson 	uhci_td_t *td_alt_next;
111702ac6454SAndrew Thompson 	uint32_t status;
111802ac6454SAndrew Thompson 	uint32_t token;
111902ac6454SAndrew Thompson 	uint16_t len;
112002ac6454SAndrew Thompson 
112102ac6454SAndrew Thompson 	td = xfer->td_transfer_cache;
112202ac6454SAndrew Thompson 	td_alt_next = td->alt_next;
112302ac6454SAndrew Thompson 
112402ac6454SAndrew Thompson 	if (xfer->aframes != xfer->nframes) {
1125ed6d949aSAndrew Thompson 		usbd_xfer_set_frame_len(xfer, xfer->aframes, 0);
112602ac6454SAndrew Thompson 	}
112702ac6454SAndrew Thompson 	while (1) {
112802ac6454SAndrew Thompson 
1129a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
113002ac6454SAndrew Thompson 		status = le32toh(td->td_status);
113102ac6454SAndrew Thompson 		token = le32toh(td->td_token);
113202ac6454SAndrew Thompson 
113302ac6454SAndrew Thompson 		/*
113402ac6454SAndrew Thompson 	         * Verify the status and add
113502ac6454SAndrew Thompson 	         * up the actual length:
113602ac6454SAndrew Thompson 	         */
113702ac6454SAndrew Thompson 
113802ac6454SAndrew Thompson 		len = UHCI_TD_GET_ACTLEN(status);
113902ac6454SAndrew Thompson 		if (len > td->len) {
114002ac6454SAndrew Thompson 			/* should not happen */
114102ac6454SAndrew Thompson 			DPRINTF("Invalid status length, "
114202ac6454SAndrew Thompson 			    "0x%04x/0x%04x bytes\n", len, td->len);
114302ac6454SAndrew Thompson 			status |= UHCI_TD_STALLED;
114402ac6454SAndrew Thompson 
114502ac6454SAndrew Thompson 		} else if ((xfer->aframes != xfer->nframes) && (len > 0)) {
114602ac6454SAndrew Thompson 
114702ac6454SAndrew Thompson 			if (td->fix_pc) {
114802ac6454SAndrew Thompson 
1149a593f6b8SAndrew Thompson 				usbd_get_page(td->fix_pc, 0, &res);
115002ac6454SAndrew Thompson 
115102ac6454SAndrew Thompson 				/*
115202ac6454SAndrew Thompson 				 * copy data from fixup location to real
115302ac6454SAndrew Thompson 				 * location
115402ac6454SAndrew Thompson 				 */
115502ac6454SAndrew Thompson 
1156a593f6b8SAndrew Thompson 				usb_pc_cpu_invalidate(td->fix_pc);
115702ac6454SAndrew Thompson 
1158a593f6b8SAndrew Thompson 				usbd_copy_in(xfer->frbuffers + xfer->aframes,
115902ac6454SAndrew Thompson 				    xfer->frlengths[xfer->aframes], res.buffer, len);
116002ac6454SAndrew Thompson 			}
116102ac6454SAndrew Thompson 			/* update actual length */
116202ac6454SAndrew Thompson 
116302ac6454SAndrew Thompson 			xfer->frlengths[xfer->aframes] += len;
116402ac6454SAndrew Thompson 		}
116502ac6454SAndrew Thompson 		/* Check for last transfer */
116602ac6454SAndrew Thompson 		if (((void *)td) == xfer->td_transfer_last) {
116702ac6454SAndrew Thompson 			td = NULL;
116802ac6454SAndrew Thompson 			break;
116902ac6454SAndrew Thompson 		}
117002ac6454SAndrew Thompson 		if (status & UHCI_TD_STALLED) {
117102ac6454SAndrew Thompson 			/* the transfer is finished */
117202ac6454SAndrew Thompson 			td = NULL;
117302ac6454SAndrew Thompson 			break;
117402ac6454SAndrew Thompson 		}
117502ac6454SAndrew Thompson 		/* Check for short transfer */
117602ac6454SAndrew Thompson 		if (len != td->len) {
117702ac6454SAndrew Thompson 			if (xfer->flags_int.short_frames_ok) {
117802ac6454SAndrew Thompson 				/* follow alt next */
117902ac6454SAndrew Thompson 				td = td->alt_next;
118002ac6454SAndrew Thompson 			} else {
118102ac6454SAndrew Thompson 				/* the transfer is finished */
118202ac6454SAndrew Thompson 				td = NULL;
118302ac6454SAndrew Thompson 			}
118402ac6454SAndrew Thompson 			break;
118502ac6454SAndrew Thompson 		}
118602ac6454SAndrew Thompson 		td = td->obj_next;
118702ac6454SAndrew Thompson 
118802ac6454SAndrew Thompson 		if (td->alt_next != td_alt_next) {
118902ac6454SAndrew Thompson 			/* this USB frame is complete */
119002ac6454SAndrew Thompson 			break;
119102ac6454SAndrew Thompson 		}
119202ac6454SAndrew Thompson 	}
119302ac6454SAndrew Thompson 
119402ac6454SAndrew Thompson 	/* update transfer cache */
119502ac6454SAndrew Thompson 
119602ac6454SAndrew Thompson 	xfer->td_transfer_cache = td;
119702ac6454SAndrew Thompson 
119802ac6454SAndrew Thompson 	/* update data toggle */
119902ac6454SAndrew Thompson 
1200ae60fdfbSAndrew Thompson 	xfer->endpoint->toggle_next = (token & UHCI_TD_SET_DT(1)) ? 0 : 1;
120102ac6454SAndrew Thompson 
120202ac6454SAndrew Thompson #if USB_DEBUG
120302ac6454SAndrew Thompson 	if (status & UHCI_TD_ERROR) {
120402ac6454SAndrew Thompson 		DPRINTFN(11, "error, addr=%d, endpt=0x%02x, frame=0x%02x "
120502ac6454SAndrew Thompson 		    "status=%s%s%s%s%s%s%s%s%s%s%s\n",
1206ae60fdfbSAndrew Thompson 		    xfer->address, xfer->endpointno, xfer->aframes,
120702ac6454SAndrew Thompson 		    (status & UHCI_TD_BITSTUFF) ? "[BITSTUFF]" : "",
120802ac6454SAndrew Thompson 		    (status & UHCI_TD_CRCTO) ? "[CRCTO]" : "",
120902ac6454SAndrew Thompson 		    (status & UHCI_TD_NAK) ? "[NAK]" : "",
121002ac6454SAndrew Thompson 		    (status & UHCI_TD_BABBLE) ? "[BABBLE]" : "",
121102ac6454SAndrew Thompson 		    (status & UHCI_TD_DBUFFER) ? "[DBUFFER]" : "",
121202ac6454SAndrew Thompson 		    (status & UHCI_TD_STALLED) ? "[STALLED]" : "",
121302ac6454SAndrew Thompson 		    (status & UHCI_TD_ACTIVE) ? "[ACTIVE]" : "[NOT_ACTIVE]",
121402ac6454SAndrew Thompson 		    (status & UHCI_TD_IOC) ? "[IOC]" : "",
121502ac6454SAndrew Thompson 		    (status & UHCI_TD_IOS) ? "[IOS]" : "",
121602ac6454SAndrew Thompson 		    (status & UHCI_TD_LS) ? "[LS]" : "",
121702ac6454SAndrew Thompson 		    (status & UHCI_TD_SPD) ? "[SPD]" : "");
121802ac6454SAndrew Thompson 	}
121902ac6454SAndrew Thompson #endif
122002ac6454SAndrew Thompson 	return (status & UHCI_TD_STALLED) ?
122102ac6454SAndrew Thompson 	    USB_ERR_STALLED : USB_ERR_NORMAL_COMPLETION;
122202ac6454SAndrew Thompson }
122302ac6454SAndrew Thompson 
122402ac6454SAndrew Thompson static void
1225760bc48eSAndrew Thompson uhci_non_isoc_done(struct usb_xfer *xfer)
122602ac6454SAndrew Thompson {
1227e0a69b51SAndrew Thompson 	usb_error_t err = 0;
122802ac6454SAndrew Thompson 
1229ae60fdfbSAndrew Thompson 	DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n",
1230ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint);
123102ac6454SAndrew Thompson 
123202ac6454SAndrew Thompson #if USB_DEBUG
123302ac6454SAndrew Thompson 	if (uhcidebug > 10) {
123402ac6454SAndrew Thompson 		uhci_dump_tds(xfer->td_transfer_first);
123502ac6454SAndrew Thompson 	}
123602ac6454SAndrew Thompson #endif
123702ac6454SAndrew Thompson 
123802ac6454SAndrew Thompson 	/* sync any DMA memory before doing fixups */
123902ac6454SAndrew Thompson 
1240a593f6b8SAndrew Thompson 	usb_bdma_post_sync(xfer);
124102ac6454SAndrew Thompson 
124202ac6454SAndrew Thompson 	/* reset scanner */
124302ac6454SAndrew Thompson 
124402ac6454SAndrew Thompson 	xfer->td_transfer_cache = xfer->td_transfer_first;
124502ac6454SAndrew Thompson 
124602ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr) {
124702ac6454SAndrew Thompson 		if (xfer->flags_int.control_hdr) {
124802ac6454SAndrew Thompson 
124902ac6454SAndrew Thompson 			err = uhci_non_isoc_done_sub(xfer);
125002ac6454SAndrew Thompson 		}
125102ac6454SAndrew Thompson 		xfer->aframes = 1;
125202ac6454SAndrew Thompson 
125302ac6454SAndrew Thompson 		if (xfer->td_transfer_cache == NULL) {
125402ac6454SAndrew Thompson 			goto done;
125502ac6454SAndrew Thompson 		}
125602ac6454SAndrew Thompson 	}
125702ac6454SAndrew Thompson 	while (xfer->aframes != xfer->nframes) {
125802ac6454SAndrew Thompson 
125902ac6454SAndrew Thompson 		err = uhci_non_isoc_done_sub(xfer);
126002ac6454SAndrew Thompson 		xfer->aframes++;
126102ac6454SAndrew Thompson 
126202ac6454SAndrew Thompson 		if (xfer->td_transfer_cache == NULL) {
126302ac6454SAndrew Thompson 			goto done;
126402ac6454SAndrew Thompson 		}
126502ac6454SAndrew Thompson 	}
126602ac6454SAndrew Thompson 
126702ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr &&
126802ac6454SAndrew Thompson 	    !xfer->flags_int.control_act) {
126902ac6454SAndrew Thompson 
127002ac6454SAndrew Thompson 		err = uhci_non_isoc_done_sub(xfer);
127102ac6454SAndrew Thompson 	}
127202ac6454SAndrew Thompson done:
127302ac6454SAndrew Thompson 	uhci_device_done(xfer, err);
127402ac6454SAndrew Thompson }
127502ac6454SAndrew Thompson 
127602ac6454SAndrew Thompson /*------------------------------------------------------------------------*
127702ac6454SAndrew Thompson  *	uhci_check_transfer_sub
127802ac6454SAndrew Thompson  *
127902ac6454SAndrew Thompson  * The main purpose of this function is to update the data-toggle
128002ac6454SAndrew Thompson  * in case it is wrong.
128102ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
128202ac6454SAndrew Thompson static void
1283760bc48eSAndrew Thompson uhci_check_transfer_sub(struct usb_xfer *xfer)
128402ac6454SAndrew Thompson {
128502ac6454SAndrew Thompson 	uhci_qh_t *qh;
128602ac6454SAndrew Thompson 	uhci_td_t *td;
128702ac6454SAndrew Thompson 	uhci_td_t *td_alt_next;
128802ac6454SAndrew Thompson 
128902ac6454SAndrew Thompson 	uint32_t td_token;
129002ac6454SAndrew Thompson 	uint32_t td_self;
129102ac6454SAndrew Thompson 
129202ac6454SAndrew Thompson 	td = xfer->td_transfer_cache;
129302ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
129402ac6454SAndrew Thompson 
129502ac6454SAndrew Thompson 	td_token = td->obj_next->td_token;
129602ac6454SAndrew Thompson 	td = td->alt_next;
129702ac6454SAndrew Thompson 	xfer->td_transfer_cache = td;
129802ac6454SAndrew Thompson 	td_self = td->td_self;
129902ac6454SAndrew Thompson 	td_alt_next = td->alt_next;
130002ac6454SAndrew Thompson 
13010f7d4548SAndrew Thompson 	if (xfer->flags_int.control_xfr)
13020f7d4548SAndrew Thompson 		goto skip;	/* don't touch the DT value! */
13030f7d4548SAndrew Thompson 
13040f7d4548SAndrew Thompson 	if (!((td->td_token ^ td_token) & htole32(UHCI_TD_SET_DT(1))))
13050f7d4548SAndrew Thompson 		goto skip;	/* data toggle has correct value */
130602ac6454SAndrew Thompson 
130702ac6454SAndrew Thompson 	/*
13080f7d4548SAndrew Thompson 	 * The data toggle is wrong and we need to toggle it !
130902ac6454SAndrew Thompson 	 */
131002ac6454SAndrew Thompson 	while (1) {
131102ac6454SAndrew Thompson 
131202ac6454SAndrew Thompson 		td->td_token ^= htole32(UHCI_TD_SET_DT(1));
1313a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(td->page_cache);
131402ac6454SAndrew Thompson 
131502ac6454SAndrew Thompson 		if (td == xfer->td_transfer_last) {
131602ac6454SAndrew Thompson 			/* last transfer */
131702ac6454SAndrew Thompson 			break;
131802ac6454SAndrew Thompson 		}
131902ac6454SAndrew Thompson 		td = td->obj_next;
132002ac6454SAndrew Thompson 
132102ac6454SAndrew Thompson 		if (td->alt_next != td_alt_next) {
132202ac6454SAndrew Thompson 			/* next frame */
132302ac6454SAndrew Thompson 			break;
132402ac6454SAndrew Thompson 		}
132502ac6454SAndrew Thompson 	}
13260f7d4548SAndrew Thompson skip:
13270f7d4548SAndrew Thompson 
132802ac6454SAndrew Thompson 	/* update the QH */
132902ac6454SAndrew Thompson 	qh->qh_e_next = td_self;
1330a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(qh->page_cache);
133102ac6454SAndrew Thompson 
133202ac6454SAndrew Thompson 	DPRINTFN(13, "xfer=%p following alt next\n", xfer);
133302ac6454SAndrew Thompson }
133402ac6454SAndrew Thompson 
133502ac6454SAndrew Thompson /*------------------------------------------------------------------------*
133602ac6454SAndrew Thompson  *	uhci_check_transfer
133702ac6454SAndrew Thompson  *
133802ac6454SAndrew Thompson  * Return values:
133902ac6454SAndrew Thompson  *    0: USB transfer is not finished
134002ac6454SAndrew Thompson  * Else: USB transfer is finished
134102ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
134202ac6454SAndrew Thompson static uint8_t
1343760bc48eSAndrew Thompson uhci_check_transfer(struct usb_xfer *xfer)
134402ac6454SAndrew Thompson {
134502ac6454SAndrew Thompson 	uint32_t status;
134602ac6454SAndrew Thompson 	uint32_t token;
134702ac6454SAndrew Thompson 	uhci_td_t *td;
134802ac6454SAndrew Thompson 
134902ac6454SAndrew Thompson 	DPRINTFN(16, "xfer=%p checking transfer\n", xfer);
135002ac6454SAndrew Thompson 
1351ae60fdfbSAndrew Thompson 	if (xfer->endpoint->methods == &uhci_device_isoc_methods) {
135202ac6454SAndrew Thompson 		/* isochronous transfer */
135302ac6454SAndrew Thompson 
135402ac6454SAndrew Thompson 		td = xfer->td_transfer_last;
135502ac6454SAndrew Thompson 
1356a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
135702ac6454SAndrew Thompson 		status = le32toh(td->td_status);
135802ac6454SAndrew Thompson 
135902ac6454SAndrew Thompson 		/* check also if the first is complete */
136002ac6454SAndrew Thompson 
136102ac6454SAndrew Thompson 		td = xfer->td_transfer_first;
136202ac6454SAndrew Thompson 
1363a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
136402ac6454SAndrew Thompson 		status |= le32toh(td->td_status);
136502ac6454SAndrew Thompson 
136602ac6454SAndrew Thompson 		if (!(status & UHCI_TD_ACTIVE)) {
136702ac6454SAndrew Thompson 			uhci_device_done(xfer, USB_ERR_NORMAL_COMPLETION);
136802ac6454SAndrew Thompson 			goto transferred;
136902ac6454SAndrew Thompson 		}
137002ac6454SAndrew Thompson 	} else {
137102ac6454SAndrew Thompson 		/* non-isochronous transfer */
137202ac6454SAndrew Thompson 
137302ac6454SAndrew Thompson 		/*
137402ac6454SAndrew Thompson 		 * check whether there is an error somewhere
137502ac6454SAndrew Thompson 		 * in the middle, or whether there was a short
137602ac6454SAndrew Thompson 		 * packet (SPD and not ACTIVE)
137702ac6454SAndrew Thompson 		 */
137802ac6454SAndrew Thompson 		td = xfer->td_transfer_cache;
137902ac6454SAndrew Thompson 
138002ac6454SAndrew Thompson 		while (1) {
1381a593f6b8SAndrew Thompson 			usb_pc_cpu_invalidate(td->page_cache);
138202ac6454SAndrew Thompson 			status = le32toh(td->td_status);
138302ac6454SAndrew Thompson 			token = le32toh(td->td_token);
138402ac6454SAndrew Thompson 
138502ac6454SAndrew Thompson 			/*
138602ac6454SAndrew Thompson 			 * if there is an active TD the transfer isn't done
138702ac6454SAndrew Thompson 			 */
138802ac6454SAndrew Thompson 			if (status & UHCI_TD_ACTIVE) {
138902ac6454SAndrew Thompson 				/* update cache */
139002ac6454SAndrew Thompson 				xfer->td_transfer_cache = td;
139102ac6454SAndrew Thompson 				goto done;
139202ac6454SAndrew Thompson 			}
139302ac6454SAndrew Thompson 			/*
139402ac6454SAndrew Thompson 			 * last transfer descriptor makes the transfer done
139502ac6454SAndrew Thompson 			 */
139602ac6454SAndrew Thompson 			if (((void *)td) == xfer->td_transfer_last) {
139702ac6454SAndrew Thompson 				break;
139802ac6454SAndrew Thompson 			}
139902ac6454SAndrew Thompson 			/*
140002ac6454SAndrew Thompson 			 * any kind of error makes the transfer done
140102ac6454SAndrew Thompson 			 */
140202ac6454SAndrew Thompson 			if (status & UHCI_TD_STALLED) {
140302ac6454SAndrew Thompson 				break;
140402ac6454SAndrew Thompson 			}
140502ac6454SAndrew Thompson 			/*
140602ac6454SAndrew Thompson 			 * check if we reached the last packet
140702ac6454SAndrew Thompson 			 * or if there is a short packet:
140802ac6454SAndrew Thompson 			 */
140902ac6454SAndrew Thompson 			if ((td->td_next == htole32(UHCI_PTR_T)) ||
141002ac6454SAndrew Thompson 			    (UHCI_TD_GET_ACTLEN(status) < td->len)) {
141102ac6454SAndrew Thompson 
141202ac6454SAndrew Thompson 				if (xfer->flags_int.short_frames_ok) {
141302ac6454SAndrew Thompson 					/* follow alt next */
141402ac6454SAndrew Thompson 					if (td->alt_next) {
141502ac6454SAndrew Thompson 						/* update cache */
141602ac6454SAndrew Thompson 						xfer->td_transfer_cache = td;
141702ac6454SAndrew Thompson 						uhci_check_transfer_sub(xfer);
141802ac6454SAndrew Thompson 						goto done;
141902ac6454SAndrew Thompson 					}
142002ac6454SAndrew Thompson 				}
142102ac6454SAndrew Thompson 				/* transfer is done */
142202ac6454SAndrew Thompson 				break;
142302ac6454SAndrew Thompson 			}
142402ac6454SAndrew Thompson 			td = td->obj_next;
142502ac6454SAndrew Thompson 		}
142602ac6454SAndrew Thompson 		uhci_non_isoc_done(xfer);
142702ac6454SAndrew Thompson 		goto transferred;
142802ac6454SAndrew Thompson 	}
142902ac6454SAndrew Thompson 
143002ac6454SAndrew Thompson done:
143102ac6454SAndrew Thompson 	DPRINTFN(13, "xfer=%p is still active\n", xfer);
143202ac6454SAndrew Thompson 	return (0);
143302ac6454SAndrew Thompson 
143402ac6454SAndrew Thompson transferred:
143502ac6454SAndrew Thompson 	return (1);
143602ac6454SAndrew Thompson }
143702ac6454SAndrew Thompson 
143802ac6454SAndrew Thompson static void
143902ac6454SAndrew Thompson uhci_interrupt_poll(uhci_softc_t *sc)
144002ac6454SAndrew Thompson {
1441760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
144202ac6454SAndrew Thompson 
144302ac6454SAndrew Thompson repeat:
144402ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
144502ac6454SAndrew Thompson 		/*
144602ac6454SAndrew Thompson 		 * check if transfer is transferred
144702ac6454SAndrew Thompson 		 */
144802ac6454SAndrew Thompson 		if (uhci_check_transfer(xfer)) {
144902ac6454SAndrew Thompson 			/* queue has been modified */
145002ac6454SAndrew Thompson 			goto repeat;
145102ac6454SAndrew Thompson 		}
145202ac6454SAndrew Thompson 	}
145302ac6454SAndrew Thompson }
145402ac6454SAndrew Thompson 
145502ac6454SAndrew Thompson /*------------------------------------------------------------------------*
145602ac6454SAndrew Thompson  *	uhci_interrupt - UHCI interrupt handler
145702ac6454SAndrew Thompson  *
145802ac6454SAndrew Thompson  * NOTE: Do not access "sc->sc_bus.bdev" inside the interrupt handler,
145902ac6454SAndrew Thompson  * hence the interrupt handler will be setup before "sc->sc_bus.bdev"
146002ac6454SAndrew Thompson  * is present !
146102ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
146202ac6454SAndrew Thompson void
146302ac6454SAndrew Thompson uhci_interrupt(uhci_softc_t *sc)
146402ac6454SAndrew Thompson {
146502ac6454SAndrew Thompson 	uint32_t status;
146602ac6454SAndrew Thompson 
146702ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
146802ac6454SAndrew Thompson 
146902ac6454SAndrew Thompson 	DPRINTFN(16, "real interrupt\n");
147002ac6454SAndrew Thompson 
147102ac6454SAndrew Thompson #if USB_DEBUG
147202ac6454SAndrew Thompson 	if (uhcidebug > 15) {
147302ac6454SAndrew Thompson 		uhci_dumpregs(sc);
147402ac6454SAndrew Thompson 	}
147502ac6454SAndrew Thompson #endif
147602ac6454SAndrew Thompson 	status = UREAD2(sc, UHCI_STS) & UHCI_STS_ALLINTRS;
147702ac6454SAndrew Thompson 	if (status == 0) {
147802ac6454SAndrew Thompson 		/* the interrupt was not for us */
147902ac6454SAndrew Thompson 		goto done;
148002ac6454SAndrew Thompson 	}
148102ac6454SAndrew Thompson 	if (status & (UHCI_STS_RD | UHCI_STS_HSE |
148202ac6454SAndrew Thompson 	    UHCI_STS_HCPE | UHCI_STS_HCH)) {
148302ac6454SAndrew Thompson 
148402ac6454SAndrew Thompson 		if (status & UHCI_STS_RD) {
148502ac6454SAndrew Thompson #if USB_DEBUG
148602ac6454SAndrew Thompson 			printf("%s: resume detect\n",
148702ac6454SAndrew Thompson 			    __FUNCTION__);
148802ac6454SAndrew Thompson #endif
148902ac6454SAndrew Thompson 		}
149002ac6454SAndrew Thompson 		if (status & UHCI_STS_HSE) {
149102ac6454SAndrew Thompson 			printf("%s: host system error\n",
149202ac6454SAndrew Thompson 			    __FUNCTION__);
149302ac6454SAndrew Thompson 		}
149402ac6454SAndrew Thompson 		if (status & UHCI_STS_HCPE) {
149502ac6454SAndrew Thompson 			printf("%s: host controller process error\n",
149602ac6454SAndrew Thompson 			    __FUNCTION__);
149702ac6454SAndrew Thompson 		}
149802ac6454SAndrew Thompson 		if (status & UHCI_STS_HCH) {
149902ac6454SAndrew Thompson 			/* no acknowledge needed */
150002ac6454SAndrew Thompson 			DPRINTF("%s: host controller halted\n",
150102ac6454SAndrew Thompson 			    __FUNCTION__);
150202ac6454SAndrew Thompson #if USB_DEBUG
150302ac6454SAndrew Thompson 			if (uhcidebug > 0) {
150402ac6454SAndrew Thompson 				uhci_dump_all(sc);
150502ac6454SAndrew Thompson 			}
150602ac6454SAndrew Thompson #endif
150702ac6454SAndrew Thompson 		}
150802ac6454SAndrew Thompson 	}
150902ac6454SAndrew Thompson 	/* get acknowledge bits */
151002ac6454SAndrew Thompson 	status &= (UHCI_STS_USBINT |
151102ac6454SAndrew Thompson 	    UHCI_STS_USBEI |
151202ac6454SAndrew Thompson 	    UHCI_STS_RD |
151302ac6454SAndrew Thompson 	    UHCI_STS_HSE |
151402ac6454SAndrew Thompson 	    UHCI_STS_HCPE);
151502ac6454SAndrew Thompson 
151602ac6454SAndrew Thompson 	if (status == 0) {
151702ac6454SAndrew Thompson 		/* nothing to acknowledge */
151802ac6454SAndrew Thompson 		goto done;
151902ac6454SAndrew Thompson 	}
152002ac6454SAndrew Thompson 	/* acknowledge interrupts */
152102ac6454SAndrew Thompson 	UWRITE2(sc, UHCI_STS, status);
152202ac6454SAndrew Thompson 
152302ac6454SAndrew Thompson 	/* poll all the USB transfers */
152402ac6454SAndrew Thompson 	uhci_interrupt_poll(sc);
152502ac6454SAndrew Thompson 
152602ac6454SAndrew Thompson done:
152702ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
152802ac6454SAndrew Thompson }
152902ac6454SAndrew Thompson 
153002ac6454SAndrew Thompson /*
153102ac6454SAndrew Thompson  * called when a request does not complete
153202ac6454SAndrew Thompson  */
153302ac6454SAndrew Thompson static void
153402ac6454SAndrew Thompson uhci_timeout(void *arg)
153502ac6454SAndrew Thompson {
1536760bc48eSAndrew Thompson 	struct usb_xfer *xfer = arg;
153702ac6454SAndrew Thompson 
153802ac6454SAndrew Thompson 	DPRINTF("xfer=%p\n", xfer);
153902ac6454SAndrew Thompson 
154002ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED);
154102ac6454SAndrew Thompson 
154202ac6454SAndrew Thompson 	/* transfer is transferred */
154302ac6454SAndrew Thompson 	uhci_device_done(xfer, USB_ERR_TIMEOUT);
154402ac6454SAndrew Thompson }
154502ac6454SAndrew Thompson 
154602ac6454SAndrew Thompson static void
1547760bc48eSAndrew Thompson uhci_do_poll(struct usb_bus *bus)
154802ac6454SAndrew Thompson {
154902ac6454SAndrew Thompson 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
155002ac6454SAndrew Thompson 
155102ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
155202ac6454SAndrew Thompson 	uhci_interrupt_poll(sc);
155302ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
155402ac6454SAndrew Thompson }
155502ac6454SAndrew Thompson 
155602ac6454SAndrew Thompson static void
155702ac6454SAndrew Thompson uhci_setup_standard_chain_sub(struct uhci_std_temp *temp)
155802ac6454SAndrew Thompson {
155902ac6454SAndrew Thompson 	uhci_td_t *td;
156002ac6454SAndrew Thompson 	uhci_td_t *td_next;
156102ac6454SAndrew Thompson 	uhci_td_t *td_alt_next;
156202ac6454SAndrew Thompson 	uint32_t average;
156302ac6454SAndrew Thompson 	uint32_t len_old;
156402ac6454SAndrew Thompson 	uint8_t shortpkt_old;
156502ac6454SAndrew Thompson 	uint8_t precompute;
156602ac6454SAndrew Thompson 
156702ac6454SAndrew Thompson 	td_alt_next = NULL;
156802ac6454SAndrew Thompson 	shortpkt_old = temp->shortpkt;
156902ac6454SAndrew Thompson 	len_old = temp->len;
157002ac6454SAndrew Thompson 	precompute = 1;
157102ac6454SAndrew Thompson 
157202ac6454SAndrew Thompson 	/* software is used to detect short incoming transfers */
157302ac6454SAndrew Thompson 
157402ac6454SAndrew Thompson 	if ((temp->td_token & htole32(UHCI_TD_PID)) == htole32(UHCI_TD_PID_IN)) {
157502ac6454SAndrew Thompson 		temp->td_status |= htole32(UHCI_TD_SPD);
157602ac6454SAndrew Thompson 	} else {
157702ac6454SAndrew Thompson 		temp->td_status &= ~htole32(UHCI_TD_SPD);
157802ac6454SAndrew Thompson 	}
157902ac6454SAndrew Thompson 
158002ac6454SAndrew Thompson 	temp->ml.buf_offset = 0;
158102ac6454SAndrew Thompson 
158202ac6454SAndrew Thompson restart:
158302ac6454SAndrew Thompson 
158402ac6454SAndrew Thompson 	temp->td_token &= ~htole32(UHCI_TD_SET_MAXLEN(0));
158502ac6454SAndrew Thompson 	temp->td_token |= htole32(UHCI_TD_SET_MAXLEN(temp->average));
158602ac6454SAndrew Thompson 
158702ac6454SAndrew Thompson 	td = temp->td;
158802ac6454SAndrew Thompson 	td_next = temp->td_next;
158902ac6454SAndrew Thompson 
159002ac6454SAndrew Thompson 	while (1) {
159102ac6454SAndrew Thompson 
159202ac6454SAndrew Thompson 		if (temp->len == 0) {
159302ac6454SAndrew Thompson 
159402ac6454SAndrew Thompson 			if (temp->shortpkt) {
159502ac6454SAndrew Thompson 				break;
159602ac6454SAndrew Thompson 			}
159702ac6454SAndrew Thompson 			/* send a Zero Length Packet, ZLP, last */
159802ac6454SAndrew Thompson 
159902ac6454SAndrew Thompson 			temp->shortpkt = 1;
160002ac6454SAndrew Thompson 			temp->td_token |= htole32(UHCI_TD_SET_MAXLEN(0));
160102ac6454SAndrew Thompson 			average = 0;
160202ac6454SAndrew Thompson 
160302ac6454SAndrew Thompson 		} else {
160402ac6454SAndrew Thompson 
160502ac6454SAndrew Thompson 			average = temp->average;
160602ac6454SAndrew Thompson 
160702ac6454SAndrew Thompson 			if (temp->len < average) {
160802ac6454SAndrew Thompson 				temp->shortpkt = 1;
160902ac6454SAndrew Thompson 				temp->td_token &= ~htole32(UHCI_TD_SET_MAXLEN(0));
161002ac6454SAndrew Thompson 				temp->td_token |= htole32(UHCI_TD_SET_MAXLEN(temp->len));
161102ac6454SAndrew Thompson 				average = temp->len;
161202ac6454SAndrew Thompson 			}
161302ac6454SAndrew Thompson 		}
161402ac6454SAndrew Thompson 
161502ac6454SAndrew Thompson 		if (td_next == NULL) {
161602ac6454SAndrew Thompson 			panic("%s: out of UHCI transfer descriptors!", __FUNCTION__);
161702ac6454SAndrew Thompson 		}
161802ac6454SAndrew Thompson 		/* get next TD */
161902ac6454SAndrew Thompson 
162002ac6454SAndrew Thompson 		td = td_next;
162102ac6454SAndrew Thompson 		td_next = td->obj_next;
162202ac6454SAndrew Thompson 
162302ac6454SAndrew Thompson 		/* check if we are pre-computing */
162402ac6454SAndrew Thompson 
162502ac6454SAndrew Thompson 		if (precompute) {
162602ac6454SAndrew Thompson 
162702ac6454SAndrew Thompson 			/* update remaining length */
162802ac6454SAndrew Thompson 
162902ac6454SAndrew Thompson 			temp->len -= average;
163002ac6454SAndrew Thompson 
163102ac6454SAndrew Thompson 			continue;
163202ac6454SAndrew Thompson 		}
163302ac6454SAndrew Thompson 		/* fill out current TD */
163402ac6454SAndrew Thompson 
163502ac6454SAndrew Thompson 		td->td_status = temp->td_status;
163602ac6454SAndrew Thompson 		td->td_token = temp->td_token;
163702ac6454SAndrew Thompson 
163802ac6454SAndrew Thompson 		/* update data toggle */
163902ac6454SAndrew Thompson 
164002ac6454SAndrew Thompson 		temp->td_token ^= htole32(UHCI_TD_SET_DT(1));
164102ac6454SAndrew Thompson 
164202ac6454SAndrew Thompson 		if (average == 0) {
164302ac6454SAndrew Thompson 
164402ac6454SAndrew Thompson 			td->len = 0;
164502ac6454SAndrew Thompson 			td->td_buffer = 0;
164602ac6454SAndrew Thompson 			td->fix_pc = NULL;
164702ac6454SAndrew Thompson 
164802ac6454SAndrew Thompson 		} else {
164902ac6454SAndrew Thompson 
165002ac6454SAndrew Thompson 			/* update remaining length */
165102ac6454SAndrew Thompson 
165202ac6454SAndrew Thompson 			temp->len -= average;
165302ac6454SAndrew Thompson 
165402ac6454SAndrew Thompson 			td->len = average;
165502ac6454SAndrew Thompson 
165602ac6454SAndrew Thompson 			/* fill out buffer pointer and do fixup, if any */
165702ac6454SAndrew Thompson 
165802ac6454SAndrew Thompson 			uhci_mem_layout_fixup(&temp->ml, td);
165902ac6454SAndrew Thompson 		}
166002ac6454SAndrew Thompson 
166102ac6454SAndrew Thompson 		td->alt_next = td_alt_next;
166202ac6454SAndrew Thompson 
166302ac6454SAndrew Thompson 		if ((td_next == td_alt_next) && temp->setup_alt_next) {
166402ac6454SAndrew Thompson 			/* we need to receive these frames one by one ! */
166502ac6454SAndrew Thompson 			td->td_status |= htole32(UHCI_TD_IOC);
166602ac6454SAndrew Thompson 			td->td_next = htole32(UHCI_PTR_T);
166702ac6454SAndrew Thompson 		} else {
166802ac6454SAndrew Thompson 			if (td_next) {
166902ac6454SAndrew Thompson 				/* link the current TD with the next one */
167002ac6454SAndrew Thompson 				td->td_next = td_next->td_self;
167102ac6454SAndrew Thompson 			}
167202ac6454SAndrew Thompson 		}
167302ac6454SAndrew Thompson 
1674a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(td->page_cache);
167502ac6454SAndrew Thompson 	}
167602ac6454SAndrew Thompson 
167702ac6454SAndrew Thompson 	if (precompute) {
167802ac6454SAndrew Thompson 		precompute = 0;
167902ac6454SAndrew Thompson 
168002ac6454SAndrew Thompson 		/* setup alt next pointer, if any */
16810f7d4548SAndrew Thompson 		if (temp->last_frame) {
16820f7d4548SAndrew Thompson 			td_alt_next = NULL;
168302ac6454SAndrew Thompson 		} else {
168402ac6454SAndrew Thompson 			/* we use this field internally */
168502ac6454SAndrew Thompson 			td_alt_next = td_next;
168602ac6454SAndrew Thompson 		}
168702ac6454SAndrew Thompson 
168802ac6454SAndrew Thompson 		/* restore */
168902ac6454SAndrew Thompson 		temp->shortpkt = shortpkt_old;
169002ac6454SAndrew Thompson 		temp->len = len_old;
169102ac6454SAndrew Thompson 		goto restart;
169202ac6454SAndrew Thompson 	}
169302ac6454SAndrew Thompson 	temp->td = td;
169402ac6454SAndrew Thompson 	temp->td_next = td_next;
169502ac6454SAndrew Thompson }
169602ac6454SAndrew Thompson 
169702ac6454SAndrew Thompson static uhci_td_t *
1698760bc48eSAndrew Thompson uhci_setup_standard_chain(struct usb_xfer *xfer)
169902ac6454SAndrew Thompson {
170002ac6454SAndrew Thompson 	struct uhci_std_temp temp;
170102ac6454SAndrew Thompson 	uhci_td_t *td;
170202ac6454SAndrew Thompson 	uint32_t x;
170302ac6454SAndrew Thompson 
170402ac6454SAndrew Thompson 	DPRINTFN(9, "addr=%d endpt=%d sumlen=%d speed=%d\n",
1705ae60fdfbSAndrew Thompson 	    xfer->address, UE_GET_ADDR(xfer->endpointno),
1706a593f6b8SAndrew Thompson 	    xfer->sumlen, usbd_get_speed(xfer->xroot->udev));
170702ac6454SAndrew Thompson 
170802ac6454SAndrew Thompson 	temp.average = xfer->max_frame_size;
170902ac6454SAndrew Thompson 	temp.max_frame_size = xfer->max_frame_size;
171002ac6454SAndrew Thompson 
171102ac6454SAndrew Thompson 	/* toggle the DMA set we are using */
171202ac6454SAndrew Thompson 	xfer->flags_int.curr_dma_set ^= 1;
171302ac6454SAndrew Thompson 
171402ac6454SAndrew Thompson 	/* get next DMA set */
171502ac6454SAndrew Thompson 	td = xfer->td_start[xfer->flags_int.curr_dma_set];
171602ac6454SAndrew Thompson 	xfer->td_transfer_first = td;
171702ac6454SAndrew Thompson 	xfer->td_transfer_cache = td;
171802ac6454SAndrew Thompson 
171902ac6454SAndrew Thompson 	temp.td = NULL;
172002ac6454SAndrew Thompson 	temp.td_next = td;
17210f7d4548SAndrew Thompson 	temp.last_frame = 0;
172202ac6454SAndrew Thompson 	temp.setup_alt_next = xfer->flags_int.short_frames_ok;
172302ac6454SAndrew Thompson 
172402ac6454SAndrew Thompson 	uhci_mem_layout_init(&temp.ml, xfer);
172502ac6454SAndrew Thompson 
172602ac6454SAndrew Thompson 	temp.td_status =
172702ac6454SAndrew Thompson 	    htole32(UHCI_TD_ZERO_ACTLEN(UHCI_TD_SET_ERRCNT(3) |
172802ac6454SAndrew Thompson 	    UHCI_TD_ACTIVE));
172902ac6454SAndrew Thompson 
173002ac6454SAndrew Thompson 	if (xfer->xroot->udev->speed == USB_SPEED_LOW) {
173102ac6454SAndrew Thompson 		temp.td_status |= htole32(UHCI_TD_LS);
173202ac6454SAndrew Thompson 	}
173302ac6454SAndrew Thompson 	temp.td_token =
1734ae60fdfbSAndrew Thompson 	    htole32(UHCI_TD_SET_ENDPT(xfer->endpointno) |
173502ac6454SAndrew Thompson 	    UHCI_TD_SET_DEVADDR(xfer->address));
173602ac6454SAndrew Thompson 
1737ae60fdfbSAndrew Thompson 	if (xfer->endpoint->toggle_next) {
173802ac6454SAndrew Thompson 		/* DATA1 is next */
173902ac6454SAndrew Thompson 		temp.td_token |= htole32(UHCI_TD_SET_DT(1));
174002ac6454SAndrew Thompson 	}
174102ac6454SAndrew Thompson 	/* check if we should prepend a setup message */
174202ac6454SAndrew Thompson 
174302ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr) {
174402ac6454SAndrew Thompson 
174502ac6454SAndrew Thompson 		if (xfer->flags_int.control_hdr) {
174602ac6454SAndrew Thompson 
174702ac6454SAndrew Thompson 			temp.td_token &= htole32(UHCI_TD_SET_DEVADDR(0x7F) |
174802ac6454SAndrew Thompson 			    UHCI_TD_SET_ENDPT(0xF));
174902ac6454SAndrew Thompson 			temp.td_token |= htole32(UHCI_TD_PID_SETUP |
175002ac6454SAndrew Thompson 			    UHCI_TD_SET_DT(0));
175102ac6454SAndrew Thompson 
175202ac6454SAndrew Thompson 			temp.len = xfer->frlengths[0];
175302ac6454SAndrew Thompson 			temp.ml.buf_pc = xfer->frbuffers + 0;
175402ac6454SAndrew Thompson 			temp.shortpkt = temp.len ? 1 : 0;
17550f7d4548SAndrew Thompson 			/* check for last frame */
17560f7d4548SAndrew Thompson 			if (xfer->nframes == 1) {
17570f7d4548SAndrew Thompson 				/* no STATUS stage yet, SETUP is last */
17580f7d4548SAndrew Thompson 				if (xfer->flags_int.control_act) {
17590f7d4548SAndrew Thompson 					temp.last_frame = 1;
17600f7d4548SAndrew Thompson 					temp.setup_alt_next = 0;
17610f7d4548SAndrew Thompson 				}
17620f7d4548SAndrew Thompson 			}
176302ac6454SAndrew Thompson 			uhci_setup_standard_chain_sub(&temp);
176402ac6454SAndrew Thompson 		}
176502ac6454SAndrew Thompson 		x = 1;
176602ac6454SAndrew Thompson 	} else {
176702ac6454SAndrew Thompson 		x = 0;
176802ac6454SAndrew Thompson 	}
176902ac6454SAndrew Thompson 
177002ac6454SAndrew Thompson 	while (x != xfer->nframes) {
177102ac6454SAndrew Thompson 
177202ac6454SAndrew Thompson 		/* DATA0 / DATA1 message */
177302ac6454SAndrew Thompson 
177402ac6454SAndrew Thompson 		temp.len = xfer->frlengths[x];
177502ac6454SAndrew Thompson 		temp.ml.buf_pc = xfer->frbuffers + x;
177602ac6454SAndrew Thompson 
177702ac6454SAndrew Thompson 		x++;
177802ac6454SAndrew Thompson 
177902ac6454SAndrew Thompson 		if (x == xfer->nframes) {
17800f7d4548SAndrew Thompson 			if (xfer->flags_int.control_xfr) {
17810f7d4548SAndrew Thompson 				/* no STATUS stage yet, DATA is last */
17820f7d4548SAndrew Thompson 				if (xfer->flags_int.control_act) {
17830f7d4548SAndrew Thompson 					temp.last_frame = 1;
178402ac6454SAndrew Thompson 					temp.setup_alt_next = 0;
178502ac6454SAndrew Thompson 				}
17860f7d4548SAndrew Thompson 			} else {
17870f7d4548SAndrew Thompson 				temp.last_frame = 1;
17880f7d4548SAndrew Thompson 				temp.setup_alt_next = 0;
17890f7d4548SAndrew Thompson 			}
17900f7d4548SAndrew Thompson 		}
179102ac6454SAndrew Thompson 		/*
179202ac6454SAndrew Thompson 		 * Keep previous data toggle,
179302ac6454SAndrew Thompson 		 * device address and endpoint number:
179402ac6454SAndrew Thompson 		 */
179502ac6454SAndrew Thompson 
179602ac6454SAndrew Thompson 		temp.td_token &= htole32(UHCI_TD_SET_DEVADDR(0x7F) |
179702ac6454SAndrew Thompson 		    UHCI_TD_SET_ENDPT(0xF) |
179802ac6454SAndrew Thompson 		    UHCI_TD_SET_DT(1));
179902ac6454SAndrew Thompson 
180002ac6454SAndrew Thompson 		if (temp.len == 0) {
180102ac6454SAndrew Thompson 
180202ac6454SAndrew Thompson 			/* make sure that we send an USB packet */
180302ac6454SAndrew Thompson 
180402ac6454SAndrew Thompson 			temp.shortpkt = 0;
180502ac6454SAndrew Thompson 
180602ac6454SAndrew Thompson 		} else {
180702ac6454SAndrew Thompson 
180802ac6454SAndrew Thompson 			/* regular data transfer */
180902ac6454SAndrew Thompson 
181002ac6454SAndrew Thompson 			temp.shortpkt = (xfer->flags.force_short_xfer) ? 0 : 1;
181102ac6454SAndrew Thompson 		}
181202ac6454SAndrew Thompson 
181302ac6454SAndrew Thompson 		/* set endpoint direction */
181402ac6454SAndrew Thompson 
181502ac6454SAndrew Thompson 		temp.td_token |=
1816ae60fdfbSAndrew Thompson 		    (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) ?
181702ac6454SAndrew Thompson 		    htole32(UHCI_TD_PID_IN) :
181802ac6454SAndrew Thompson 		    htole32(UHCI_TD_PID_OUT);
181902ac6454SAndrew Thompson 
182002ac6454SAndrew Thompson 		uhci_setup_standard_chain_sub(&temp);
182102ac6454SAndrew Thompson 	}
182202ac6454SAndrew Thompson 
182302ac6454SAndrew Thompson 	/* check if we should append a status stage */
182402ac6454SAndrew Thompson 
182502ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr &&
182602ac6454SAndrew Thompson 	    !xfer->flags_int.control_act) {
182702ac6454SAndrew Thompson 
182802ac6454SAndrew Thompson 		/*
182902ac6454SAndrew Thompson 		 * send a DATA1 message and reverse the current endpoint
183002ac6454SAndrew Thompson 		 * direction
183102ac6454SAndrew Thompson 		 */
183202ac6454SAndrew Thompson 
183302ac6454SAndrew Thompson 		temp.td_token &= htole32(UHCI_TD_SET_DEVADDR(0x7F) |
183402ac6454SAndrew Thompson 		    UHCI_TD_SET_ENDPT(0xF) |
183502ac6454SAndrew Thompson 		    UHCI_TD_SET_DT(1));
183602ac6454SAndrew Thompson 		temp.td_token |=
1837ae60fdfbSAndrew Thompson 		    (UE_GET_DIR(xfer->endpointno) == UE_DIR_OUT) ?
183802ac6454SAndrew Thompson 		    htole32(UHCI_TD_PID_IN | UHCI_TD_SET_DT(1)) :
183902ac6454SAndrew Thompson 		    htole32(UHCI_TD_PID_OUT | UHCI_TD_SET_DT(1));
184002ac6454SAndrew Thompson 
184102ac6454SAndrew Thompson 		temp.len = 0;
184202ac6454SAndrew Thompson 		temp.ml.buf_pc = NULL;
184302ac6454SAndrew Thompson 		temp.shortpkt = 0;
18440f7d4548SAndrew Thompson 		temp.last_frame = 1;
18450f7d4548SAndrew Thompson 		temp.setup_alt_next = 0;
184602ac6454SAndrew Thompson 
184702ac6454SAndrew Thompson 		uhci_setup_standard_chain_sub(&temp);
184802ac6454SAndrew Thompson 	}
184902ac6454SAndrew Thompson 	td = temp.td;
185002ac6454SAndrew Thompson 
18510f7d4548SAndrew Thompson 	/* Ensure that last TD is terminating: */
185202ac6454SAndrew Thompson 	td->td_next = htole32(UHCI_PTR_T);
185302ac6454SAndrew Thompson 
185402ac6454SAndrew Thompson 	/* set interrupt bit */
185502ac6454SAndrew Thompson 
185602ac6454SAndrew Thompson 	td->td_status |= htole32(UHCI_TD_IOC);
185702ac6454SAndrew Thompson 
1858a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(td->page_cache);
185902ac6454SAndrew Thompson 
186002ac6454SAndrew Thompson 	/* must have at least one frame! */
186102ac6454SAndrew Thompson 
186202ac6454SAndrew Thompson 	xfer->td_transfer_last = td;
186302ac6454SAndrew Thompson 
186402ac6454SAndrew Thompson #if USB_DEBUG
186502ac6454SAndrew Thompson 	if (uhcidebug > 8) {
186602ac6454SAndrew Thompson 		DPRINTF("nexttog=%d; data before transfer:\n",
1867ae60fdfbSAndrew Thompson 		    xfer->endpoint->toggle_next);
186802ac6454SAndrew Thompson 		uhci_dump_tds(xfer->td_transfer_first);
186902ac6454SAndrew Thompson 	}
187002ac6454SAndrew Thompson #endif
187102ac6454SAndrew Thompson 	return (xfer->td_transfer_first);
187202ac6454SAndrew Thompson }
187302ac6454SAndrew Thompson 
187402ac6454SAndrew Thompson /* NOTE: "done" can be run two times in a row,
187502ac6454SAndrew Thompson  * from close and from interrupt
187602ac6454SAndrew Thompson  */
187702ac6454SAndrew Thompson 
187802ac6454SAndrew Thompson static void
1879e0a69b51SAndrew Thompson uhci_device_done(struct usb_xfer *xfer, usb_error_t error)
188002ac6454SAndrew Thompson {
1881ae60fdfbSAndrew Thompson 	struct usb_pipe_methods *methods = xfer->endpoint->methods;
188202ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
188302ac6454SAndrew Thompson 	uhci_qh_t *qh;
188402ac6454SAndrew Thompson 
188502ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
188602ac6454SAndrew Thompson 
1887ae60fdfbSAndrew Thompson 	DPRINTFN(2, "xfer=%p, endpoint=%p, error=%d\n",
1888ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint, error);
188902ac6454SAndrew Thompson 
189002ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
189102ac6454SAndrew Thompson 	if (qh) {
1892a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(qh->page_cache);
189302ac6454SAndrew Thompson 	}
189402ac6454SAndrew Thompson 	if (xfer->flags_int.bandwidth_reclaimed) {
189502ac6454SAndrew Thompson 		xfer->flags_int.bandwidth_reclaimed = 0;
189602ac6454SAndrew Thompson 		uhci_rem_loop(sc);
189702ac6454SAndrew Thompson 	}
189802ac6454SAndrew Thompson 	if (methods == &uhci_device_bulk_methods) {
189902ac6454SAndrew Thompson 		UHCI_REMOVE_QH(qh, sc->sc_bulk_p_last);
190002ac6454SAndrew Thompson 	}
190102ac6454SAndrew Thompson 	if (methods == &uhci_device_ctrl_methods) {
190202ac6454SAndrew Thompson 		if (xfer->xroot->udev->speed == USB_SPEED_LOW) {
190302ac6454SAndrew Thompson 			UHCI_REMOVE_QH(qh, sc->sc_ls_ctl_p_last);
190402ac6454SAndrew Thompson 		} else {
190502ac6454SAndrew Thompson 			UHCI_REMOVE_QH(qh, sc->sc_fs_ctl_p_last);
190602ac6454SAndrew Thompson 		}
190702ac6454SAndrew Thompson 	}
190802ac6454SAndrew Thompson 	if (methods == &uhci_device_intr_methods) {
190902ac6454SAndrew Thompson 		UHCI_REMOVE_QH(qh, sc->sc_intr_p_last[xfer->qh_pos]);
191002ac6454SAndrew Thompson 	}
191102ac6454SAndrew Thompson 	/*
191202ac6454SAndrew Thompson 	 * Only finish isochronous transfers once
191302ac6454SAndrew Thompson 	 * which will update "xfer->frlengths".
191402ac6454SAndrew Thompson 	 */
191502ac6454SAndrew Thompson 	if (xfer->td_transfer_first &&
191602ac6454SAndrew Thompson 	    xfer->td_transfer_last) {
191702ac6454SAndrew Thompson 		if (methods == &uhci_device_isoc_methods) {
191802ac6454SAndrew Thompson 			uhci_isoc_done(sc, xfer);
191902ac6454SAndrew Thompson 		}
192002ac6454SAndrew Thompson 		xfer->td_transfer_first = NULL;
192102ac6454SAndrew Thompson 		xfer->td_transfer_last = NULL;
192202ac6454SAndrew Thompson 	}
192302ac6454SAndrew Thompson 	/* dequeue transfer and start next transfer */
1924a593f6b8SAndrew Thompson 	usbd_transfer_done(xfer, error);
192502ac6454SAndrew Thompson }
192602ac6454SAndrew Thompson 
192702ac6454SAndrew Thompson /*------------------------------------------------------------------------*
192802ac6454SAndrew Thompson  * uhci bulk support
192902ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
193002ac6454SAndrew Thompson static void
1931760bc48eSAndrew Thompson uhci_device_bulk_open(struct usb_xfer *xfer)
193202ac6454SAndrew Thompson {
193302ac6454SAndrew Thompson 	return;
193402ac6454SAndrew Thompson }
193502ac6454SAndrew Thompson 
193602ac6454SAndrew Thompson static void
1937760bc48eSAndrew Thompson uhci_device_bulk_close(struct usb_xfer *xfer)
193802ac6454SAndrew Thompson {
193902ac6454SAndrew Thompson 	uhci_device_done(xfer, USB_ERR_CANCELLED);
194002ac6454SAndrew Thompson }
194102ac6454SAndrew Thompson 
194202ac6454SAndrew Thompson static void
1943760bc48eSAndrew Thompson uhci_device_bulk_enter(struct usb_xfer *xfer)
194402ac6454SAndrew Thompson {
194502ac6454SAndrew Thompson 	return;
194602ac6454SAndrew Thompson }
194702ac6454SAndrew Thompson 
194802ac6454SAndrew Thompson static void
1949760bc48eSAndrew Thompson uhci_device_bulk_start(struct usb_xfer *xfer)
195002ac6454SAndrew Thompson {
195102ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
195202ac6454SAndrew Thompson 	uhci_td_t *td;
195302ac6454SAndrew Thompson 	uhci_qh_t *qh;
195402ac6454SAndrew Thompson 
195502ac6454SAndrew Thompson 	/* setup TD's */
195602ac6454SAndrew Thompson 	td = uhci_setup_standard_chain(xfer);
195702ac6454SAndrew Thompson 
195802ac6454SAndrew Thompson 	/* setup QH */
195902ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
196002ac6454SAndrew Thompson 
196102ac6454SAndrew Thompson 	qh->e_next = td;
196202ac6454SAndrew Thompson 	qh->qh_e_next = td->td_self;
196302ac6454SAndrew Thompson 
1964ec8f3127SAndrew Thompson 	if (xfer->xroot->udev->flags.self_suspended == 0) {
196502ac6454SAndrew Thompson 		UHCI_APPEND_QH(qh, sc->sc_bulk_p_last);
196602ac6454SAndrew Thompson 		uhci_add_loop(sc);
196702ac6454SAndrew Thompson 		xfer->flags_int.bandwidth_reclaimed = 1;
196802ac6454SAndrew Thompson 	} else {
1969a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(qh->page_cache);
197002ac6454SAndrew Thompson 	}
197102ac6454SAndrew Thompson 
197202ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
197302ac6454SAndrew Thompson 	uhci_transfer_intr_enqueue(xfer);
197402ac6454SAndrew Thompson }
197502ac6454SAndrew Thompson 
1976760bc48eSAndrew Thompson struct usb_pipe_methods uhci_device_bulk_methods =
197702ac6454SAndrew Thompson {
197802ac6454SAndrew Thompson 	.open = uhci_device_bulk_open,
197902ac6454SAndrew Thompson 	.close = uhci_device_bulk_close,
198002ac6454SAndrew Thompson 	.enter = uhci_device_bulk_enter,
198102ac6454SAndrew Thompson 	.start = uhci_device_bulk_start,
198202ac6454SAndrew Thompson };
198302ac6454SAndrew Thompson 
198402ac6454SAndrew Thompson /*------------------------------------------------------------------------*
198502ac6454SAndrew Thompson  * uhci control support
198602ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
198702ac6454SAndrew Thompson static void
1988760bc48eSAndrew Thompson uhci_device_ctrl_open(struct usb_xfer *xfer)
198902ac6454SAndrew Thompson {
199002ac6454SAndrew Thompson 	return;
199102ac6454SAndrew Thompson }
199202ac6454SAndrew Thompson 
199302ac6454SAndrew Thompson static void
1994760bc48eSAndrew Thompson uhci_device_ctrl_close(struct usb_xfer *xfer)
199502ac6454SAndrew Thompson {
199602ac6454SAndrew Thompson 	uhci_device_done(xfer, USB_ERR_CANCELLED);
199702ac6454SAndrew Thompson }
199802ac6454SAndrew Thompson 
199902ac6454SAndrew Thompson static void
2000760bc48eSAndrew Thompson uhci_device_ctrl_enter(struct usb_xfer *xfer)
200102ac6454SAndrew Thompson {
200202ac6454SAndrew Thompson 	return;
200302ac6454SAndrew Thompson }
200402ac6454SAndrew Thompson 
200502ac6454SAndrew Thompson static void
2006760bc48eSAndrew Thompson uhci_device_ctrl_start(struct usb_xfer *xfer)
200702ac6454SAndrew Thompson {
200802ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
200902ac6454SAndrew Thompson 	uhci_qh_t *qh;
201002ac6454SAndrew Thompson 	uhci_td_t *td;
201102ac6454SAndrew Thompson 
201202ac6454SAndrew Thompson 	/* setup TD's */
201302ac6454SAndrew Thompson 	td = uhci_setup_standard_chain(xfer);
201402ac6454SAndrew Thompson 
201502ac6454SAndrew Thompson 	/* setup QH */
201602ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
201702ac6454SAndrew Thompson 
201802ac6454SAndrew Thompson 	qh->e_next = td;
201902ac6454SAndrew Thompson 	qh->qh_e_next = td->td_self;
202002ac6454SAndrew Thompson 
202102ac6454SAndrew Thompson 	/*
202202ac6454SAndrew Thompson 	 * NOTE: some devices choke on bandwidth- reclamation for control
202302ac6454SAndrew Thompson 	 * transfers
202402ac6454SAndrew Thompson 	 */
2025ec8f3127SAndrew Thompson 	if (xfer->xroot->udev->flags.self_suspended == 0) {
202602ac6454SAndrew Thompson 		if (xfer->xroot->udev->speed == USB_SPEED_LOW) {
202702ac6454SAndrew Thompson 			UHCI_APPEND_QH(qh, sc->sc_ls_ctl_p_last);
202802ac6454SAndrew Thompson 		} else {
202902ac6454SAndrew Thompson 			UHCI_APPEND_QH(qh, sc->sc_fs_ctl_p_last);
203002ac6454SAndrew Thompson 		}
203102ac6454SAndrew Thompson 	} else {
2032a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(qh->page_cache);
203302ac6454SAndrew Thompson 	}
203402ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
203502ac6454SAndrew Thompson 	uhci_transfer_intr_enqueue(xfer);
203602ac6454SAndrew Thompson }
203702ac6454SAndrew Thompson 
2038760bc48eSAndrew Thompson struct usb_pipe_methods uhci_device_ctrl_methods =
203902ac6454SAndrew Thompson {
204002ac6454SAndrew Thompson 	.open = uhci_device_ctrl_open,
204102ac6454SAndrew Thompson 	.close = uhci_device_ctrl_close,
204202ac6454SAndrew Thompson 	.enter = uhci_device_ctrl_enter,
204302ac6454SAndrew Thompson 	.start = uhci_device_ctrl_start,
204402ac6454SAndrew Thompson };
204502ac6454SAndrew Thompson 
204602ac6454SAndrew Thompson /*------------------------------------------------------------------------*
204702ac6454SAndrew Thompson  * uhci interrupt support
204802ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
204902ac6454SAndrew Thompson static void
2050760bc48eSAndrew Thompson uhci_device_intr_open(struct usb_xfer *xfer)
205102ac6454SAndrew Thompson {
205202ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
205302ac6454SAndrew Thompson 	uint16_t best;
205402ac6454SAndrew Thompson 	uint16_t bit;
205502ac6454SAndrew Thompson 	uint16_t x;
205602ac6454SAndrew Thompson 
205702ac6454SAndrew Thompson 	best = 0;
205802ac6454SAndrew Thompson 	bit = UHCI_IFRAMELIST_COUNT / 2;
205902ac6454SAndrew Thompson 	while (bit) {
206002ac6454SAndrew Thompson 		if (xfer->interval >= bit) {
206102ac6454SAndrew Thompson 			x = bit;
206202ac6454SAndrew Thompson 			best = bit;
206302ac6454SAndrew Thompson 			while (x & bit) {
206402ac6454SAndrew Thompson 				if (sc->sc_intr_stat[x] <
206502ac6454SAndrew Thompson 				    sc->sc_intr_stat[best]) {
206602ac6454SAndrew Thompson 					best = x;
206702ac6454SAndrew Thompson 				}
206802ac6454SAndrew Thompson 				x++;
206902ac6454SAndrew Thompson 			}
207002ac6454SAndrew Thompson 			break;
207102ac6454SAndrew Thompson 		}
207202ac6454SAndrew Thompson 		bit >>= 1;
207302ac6454SAndrew Thompson 	}
207402ac6454SAndrew Thompson 
207502ac6454SAndrew Thompson 	sc->sc_intr_stat[best]++;
207602ac6454SAndrew Thompson 	xfer->qh_pos = best;
207702ac6454SAndrew Thompson 
207802ac6454SAndrew Thompson 	DPRINTFN(3, "best=%d interval=%d\n",
207902ac6454SAndrew Thompson 	    best, xfer->interval);
208002ac6454SAndrew Thompson }
208102ac6454SAndrew Thompson 
208202ac6454SAndrew Thompson static void
2083760bc48eSAndrew Thompson uhci_device_intr_close(struct usb_xfer *xfer)
208402ac6454SAndrew Thompson {
208502ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
208602ac6454SAndrew Thompson 
208702ac6454SAndrew Thompson 	sc->sc_intr_stat[xfer->qh_pos]--;
208802ac6454SAndrew Thompson 
208902ac6454SAndrew Thompson 	uhci_device_done(xfer, USB_ERR_CANCELLED);
209002ac6454SAndrew Thompson }
209102ac6454SAndrew Thompson 
209202ac6454SAndrew Thompson static void
2093760bc48eSAndrew Thompson uhci_device_intr_enter(struct usb_xfer *xfer)
209402ac6454SAndrew Thompson {
209502ac6454SAndrew Thompson 	return;
209602ac6454SAndrew Thompson }
209702ac6454SAndrew Thompson 
209802ac6454SAndrew Thompson static void
2099760bc48eSAndrew Thompson uhci_device_intr_start(struct usb_xfer *xfer)
210002ac6454SAndrew Thompson {
210102ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
210202ac6454SAndrew Thompson 	uhci_qh_t *qh;
210302ac6454SAndrew Thompson 	uhci_td_t *td;
210402ac6454SAndrew Thompson 
210502ac6454SAndrew Thompson 	/* setup TD's */
210602ac6454SAndrew Thompson 	td = uhci_setup_standard_chain(xfer);
210702ac6454SAndrew Thompson 
210802ac6454SAndrew Thompson 	/* setup QH */
210902ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
211002ac6454SAndrew Thompson 
211102ac6454SAndrew Thompson 	qh->e_next = td;
211202ac6454SAndrew Thompson 	qh->qh_e_next = td->td_self;
211302ac6454SAndrew Thompson 
2114ec8f3127SAndrew Thompson 	if (xfer->xroot->udev->flags.self_suspended == 0) {
211502ac6454SAndrew Thompson 		/* enter QHs into the controller data structures */
211602ac6454SAndrew Thompson 		UHCI_APPEND_QH(qh, sc->sc_intr_p_last[xfer->qh_pos]);
211702ac6454SAndrew Thompson 	} else {
2118a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(qh->page_cache);
211902ac6454SAndrew Thompson 	}
212002ac6454SAndrew Thompson 
212102ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
212202ac6454SAndrew Thompson 	uhci_transfer_intr_enqueue(xfer);
212302ac6454SAndrew Thompson }
212402ac6454SAndrew Thompson 
2125760bc48eSAndrew Thompson struct usb_pipe_methods uhci_device_intr_methods =
212602ac6454SAndrew Thompson {
212702ac6454SAndrew Thompson 	.open = uhci_device_intr_open,
212802ac6454SAndrew Thompson 	.close = uhci_device_intr_close,
212902ac6454SAndrew Thompson 	.enter = uhci_device_intr_enter,
213002ac6454SAndrew Thompson 	.start = uhci_device_intr_start,
213102ac6454SAndrew Thompson };
213202ac6454SAndrew Thompson 
213302ac6454SAndrew Thompson /*------------------------------------------------------------------------*
213402ac6454SAndrew Thompson  * uhci isochronous support
213502ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
213602ac6454SAndrew Thompson static void
2137760bc48eSAndrew Thompson uhci_device_isoc_open(struct usb_xfer *xfer)
213802ac6454SAndrew Thompson {
213902ac6454SAndrew Thompson 	uhci_td_t *td;
214002ac6454SAndrew Thompson 	uint32_t td_token;
214102ac6454SAndrew Thompson 	uint8_t ds;
214202ac6454SAndrew Thompson 
214302ac6454SAndrew Thompson 	td_token =
2144ae60fdfbSAndrew Thompson 	    (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) ?
2145ae60fdfbSAndrew Thompson 	    UHCI_TD_IN(0, xfer->endpointno, xfer->address, 0) :
2146ae60fdfbSAndrew Thompson 	    UHCI_TD_OUT(0, xfer->endpointno, xfer->address, 0);
214702ac6454SAndrew Thompson 
214802ac6454SAndrew Thompson 	td_token = htole32(td_token);
214902ac6454SAndrew Thompson 
215002ac6454SAndrew Thompson 	/* initialize all TD's */
215102ac6454SAndrew Thompson 
215202ac6454SAndrew Thompson 	for (ds = 0; ds != 2; ds++) {
215302ac6454SAndrew Thompson 
215402ac6454SAndrew Thompson 		for (td = xfer->td_start[ds]; td; td = td->obj_next) {
215502ac6454SAndrew Thompson 
215602ac6454SAndrew Thompson 			/* mark TD as inactive */
215702ac6454SAndrew Thompson 			td->td_status = htole32(UHCI_TD_IOS);
215802ac6454SAndrew Thompson 			td->td_token = td_token;
215902ac6454SAndrew Thompson 
2160a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(td->page_cache);
216102ac6454SAndrew Thompson 		}
216202ac6454SAndrew Thompson 	}
216302ac6454SAndrew Thompson }
216402ac6454SAndrew Thompson 
216502ac6454SAndrew Thompson static void
2166760bc48eSAndrew Thompson uhci_device_isoc_close(struct usb_xfer *xfer)
216702ac6454SAndrew Thompson {
216802ac6454SAndrew Thompson 	uhci_device_done(xfer, USB_ERR_CANCELLED);
216902ac6454SAndrew Thompson }
217002ac6454SAndrew Thompson 
217102ac6454SAndrew Thompson static void
2172760bc48eSAndrew Thompson uhci_device_isoc_enter(struct usb_xfer *xfer)
217302ac6454SAndrew Thompson {
217402ac6454SAndrew Thompson 	struct uhci_mem_layout ml;
217502ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(xfer->xroot->bus);
217602ac6454SAndrew Thompson 	uint32_t nframes;
217702ac6454SAndrew Thompson 	uint32_t temp;
217802ac6454SAndrew Thompson 	uint32_t *plen;
217902ac6454SAndrew Thompson 
218002ac6454SAndrew Thompson #if USB_DEBUG
218102ac6454SAndrew Thompson 	uint8_t once = 1;
218202ac6454SAndrew Thompson 
218302ac6454SAndrew Thompson #endif
218402ac6454SAndrew Thompson 	uhci_td_t *td;
218502ac6454SAndrew Thompson 	uhci_td_t *td_last = NULL;
218602ac6454SAndrew Thompson 	uhci_td_t **pp_last;
218702ac6454SAndrew Thompson 
218802ac6454SAndrew Thompson 	DPRINTFN(6, "xfer=%p next=%d nframes=%d\n",
2189ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint->isoc_next, xfer->nframes);
219002ac6454SAndrew Thompson 
219102ac6454SAndrew Thompson 	nframes = UREAD2(sc, UHCI_FRNUM);
219202ac6454SAndrew Thompson 
2193ae60fdfbSAndrew Thompson 	temp = (nframes - xfer->endpoint->isoc_next) &
219402ac6454SAndrew Thompson 	    (UHCI_VFRAMELIST_COUNT - 1);
219502ac6454SAndrew Thompson 
2196ae60fdfbSAndrew Thompson 	if ((xfer->endpoint->is_synced == 0) ||
219702ac6454SAndrew Thompson 	    (temp < xfer->nframes)) {
219802ac6454SAndrew Thompson 		/*
219902ac6454SAndrew Thompson 		 * If there is data underflow or the pipe queue is empty we
220002ac6454SAndrew Thompson 		 * schedule the transfer a few frames ahead of the current
220102ac6454SAndrew Thompson 		 * frame position. Else two isochronous transfers might
220202ac6454SAndrew Thompson 		 * overlap.
220302ac6454SAndrew Thompson 		 */
2204ae60fdfbSAndrew Thompson 		xfer->endpoint->isoc_next = (nframes + 3) & (UHCI_VFRAMELIST_COUNT - 1);
2205ae60fdfbSAndrew Thompson 		xfer->endpoint->is_synced = 1;
2206ae60fdfbSAndrew Thompson 		DPRINTFN(3, "start next=%d\n", xfer->endpoint->isoc_next);
220702ac6454SAndrew Thompson 	}
220802ac6454SAndrew Thompson 	/*
220902ac6454SAndrew Thompson 	 * compute how many milliseconds the insertion is ahead of the
221002ac6454SAndrew Thompson 	 * current frame position:
221102ac6454SAndrew Thompson 	 */
2212ae60fdfbSAndrew Thompson 	temp = (xfer->endpoint->isoc_next - nframes) &
221302ac6454SAndrew Thompson 	    (UHCI_VFRAMELIST_COUNT - 1);
221402ac6454SAndrew Thompson 
221502ac6454SAndrew Thompson 	/*
221602ac6454SAndrew Thompson 	 * pre-compute when the isochronous transfer will be finished:
221702ac6454SAndrew Thompson 	 */
221802ac6454SAndrew Thompson 	xfer->isoc_time_complete =
2219a593f6b8SAndrew Thompson 	    usb_isoc_time_expand(&sc->sc_bus, nframes) + temp +
222002ac6454SAndrew Thompson 	    xfer->nframes;
222102ac6454SAndrew Thompson 
222202ac6454SAndrew Thompson 	/* get the real number of frames */
222302ac6454SAndrew Thompson 
222402ac6454SAndrew Thompson 	nframes = xfer->nframes;
222502ac6454SAndrew Thompson 
222602ac6454SAndrew Thompson 	uhci_mem_layout_init(&ml, xfer);
222702ac6454SAndrew Thompson 
222802ac6454SAndrew Thompson 	plen = xfer->frlengths;
222902ac6454SAndrew Thompson 
223002ac6454SAndrew Thompson 	/* toggle the DMA set we are using */
223102ac6454SAndrew Thompson 	xfer->flags_int.curr_dma_set ^= 1;
223202ac6454SAndrew Thompson 
223302ac6454SAndrew Thompson 	/* get next DMA set */
223402ac6454SAndrew Thompson 	td = xfer->td_start[xfer->flags_int.curr_dma_set];
223502ac6454SAndrew Thompson 	xfer->td_transfer_first = td;
223602ac6454SAndrew Thompson 
2237ae60fdfbSAndrew Thompson 	pp_last = &sc->sc_isoc_p_last[xfer->endpoint->isoc_next];
223802ac6454SAndrew Thompson 
223902ac6454SAndrew Thompson 	/* store starting position */
224002ac6454SAndrew Thompson 
2241ae60fdfbSAndrew Thompson 	xfer->qh_pos = xfer->endpoint->isoc_next;
224202ac6454SAndrew Thompson 
224302ac6454SAndrew Thompson 	while (nframes--) {
224402ac6454SAndrew Thompson 		if (td == NULL) {
224502ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
224602ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
224702ac6454SAndrew Thompson 		}
224802ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_p_last[UHCI_VFRAMELIST_COUNT]) {
224902ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_p_last[0];
225002ac6454SAndrew Thompson 		}
225102ac6454SAndrew Thompson 		if (*plen > xfer->max_frame_size) {
225202ac6454SAndrew Thompson #if USB_DEBUG
225302ac6454SAndrew Thompson 			if (once) {
225402ac6454SAndrew Thompson 				once = 0;
225502ac6454SAndrew Thompson 				printf("%s: frame length(%d) exceeds %d "
225602ac6454SAndrew Thompson 				    "bytes (frame truncated)\n",
225702ac6454SAndrew Thompson 				    __FUNCTION__, *plen,
225802ac6454SAndrew Thompson 				    xfer->max_frame_size);
225902ac6454SAndrew Thompson 			}
226002ac6454SAndrew Thompson #endif
226102ac6454SAndrew Thompson 			*plen = xfer->max_frame_size;
226202ac6454SAndrew Thompson 		}
226302ac6454SAndrew Thompson 		/* reuse td_token from last transfer */
226402ac6454SAndrew Thompson 
226502ac6454SAndrew Thompson 		td->td_token &= htole32(~UHCI_TD_MAXLEN_MASK);
226602ac6454SAndrew Thompson 		td->td_token |= htole32(UHCI_TD_SET_MAXLEN(*plen));
226702ac6454SAndrew Thompson 
226802ac6454SAndrew Thompson 		td->len = *plen;
226902ac6454SAndrew Thompson 
227002ac6454SAndrew Thompson 		if (td->len == 0) {
227102ac6454SAndrew Thompson 			/*
227202ac6454SAndrew Thompson 			 * Do not call "uhci_mem_layout_fixup()" when the
227302ac6454SAndrew Thompson 			 * length is zero!
227402ac6454SAndrew Thompson 			 */
227502ac6454SAndrew Thompson 			td->td_buffer = 0;
227602ac6454SAndrew Thompson 			td->fix_pc = NULL;
227702ac6454SAndrew Thompson 
227802ac6454SAndrew Thompson 		} else {
227902ac6454SAndrew Thompson 
228002ac6454SAndrew Thompson 			/* fill out buffer pointer and do fixup, if any */
228102ac6454SAndrew Thompson 
228202ac6454SAndrew Thompson 			uhci_mem_layout_fixup(&ml, td);
228302ac6454SAndrew Thompson 
228402ac6454SAndrew Thompson 		}
228502ac6454SAndrew Thompson 
228602ac6454SAndrew Thompson 		/* update status */
228702ac6454SAndrew Thompson 		if (nframes == 0) {
228802ac6454SAndrew Thompson 			td->td_status = htole32
228902ac6454SAndrew Thompson 			    (UHCI_TD_ZERO_ACTLEN
229002ac6454SAndrew Thompson 			    (UHCI_TD_SET_ERRCNT(0) |
229102ac6454SAndrew Thompson 			    UHCI_TD_ACTIVE |
229202ac6454SAndrew Thompson 			    UHCI_TD_IOS |
229302ac6454SAndrew Thompson 			    UHCI_TD_IOC));
229402ac6454SAndrew Thompson 		} else {
229502ac6454SAndrew Thompson 			td->td_status = htole32
229602ac6454SAndrew Thompson 			    (UHCI_TD_ZERO_ACTLEN
229702ac6454SAndrew Thompson 			    (UHCI_TD_SET_ERRCNT(0) |
229802ac6454SAndrew Thompson 			    UHCI_TD_ACTIVE |
229902ac6454SAndrew Thompson 			    UHCI_TD_IOS));
230002ac6454SAndrew Thompson 		}
230102ac6454SAndrew Thompson 
2302a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(td->page_cache);
230302ac6454SAndrew Thompson 
230402ac6454SAndrew Thompson #if USB_DEBUG
230502ac6454SAndrew Thompson 		if (uhcidebug > 5) {
230602ac6454SAndrew Thompson 			DPRINTF("TD %d\n", nframes);
230702ac6454SAndrew Thompson 			uhci_dump_td(td);
230802ac6454SAndrew Thompson 		}
230902ac6454SAndrew Thompson #endif
231002ac6454SAndrew Thompson 		/* insert TD into schedule */
231102ac6454SAndrew Thompson 		UHCI_APPEND_TD(td, *pp_last);
231202ac6454SAndrew Thompson 		pp_last++;
231302ac6454SAndrew Thompson 
231402ac6454SAndrew Thompson 		plen++;
231502ac6454SAndrew Thompson 		td_last = td;
231602ac6454SAndrew Thompson 		td = td->obj_next;
231702ac6454SAndrew Thompson 	}
231802ac6454SAndrew Thompson 
231902ac6454SAndrew Thompson 	xfer->td_transfer_last = td_last;
232002ac6454SAndrew Thompson 
232102ac6454SAndrew Thompson 	/* update isoc_next */
2322ae60fdfbSAndrew Thompson 	xfer->endpoint->isoc_next = (pp_last - &sc->sc_isoc_p_last[0]) &
232302ac6454SAndrew Thompson 	    (UHCI_VFRAMELIST_COUNT - 1);
232402ac6454SAndrew Thompson }
232502ac6454SAndrew Thompson 
232602ac6454SAndrew Thompson static void
2327760bc48eSAndrew Thompson uhci_device_isoc_start(struct usb_xfer *xfer)
232802ac6454SAndrew Thompson {
232902ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
233002ac6454SAndrew Thompson 	uhci_transfer_intr_enqueue(xfer);
233102ac6454SAndrew Thompson }
233202ac6454SAndrew Thompson 
2333760bc48eSAndrew Thompson struct usb_pipe_methods uhci_device_isoc_methods =
233402ac6454SAndrew Thompson {
233502ac6454SAndrew Thompson 	.open = uhci_device_isoc_open,
233602ac6454SAndrew Thompson 	.close = uhci_device_isoc_close,
233702ac6454SAndrew Thompson 	.enter = uhci_device_isoc_enter,
233802ac6454SAndrew Thompson 	.start = uhci_device_isoc_start,
233902ac6454SAndrew Thompson };
234002ac6454SAndrew Thompson 
234102ac6454SAndrew Thompson /*------------------------------------------------------------------------*
234202ac6454SAndrew Thompson  * uhci root control support
234302ac6454SAndrew Thompson  *------------------------------------------------------------------------*
234439307315SAndrew Thompson  * Simulate a hardware hub by handling all the necessary requests.
234502ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
234602ac6454SAndrew Thompson 
234702ac6454SAndrew Thompson static const
2348760bc48eSAndrew Thompson struct usb_device_descriptor uhci_devd =
234902ac6454SAndrew Thompson {
2350760bc48eSAndrew Thompson 	sizeof(struct usb_device_descriptor),
235102ac6454SAndrew Thompson 	UDESC_DEVICE,			/* type */
235202ac6454SAndrew Thompson 	{0x00, 0x01},			/* USB version */
235302ac6454SAndrew Thompson 	UDCLASS_HUB,			/* class */
235402ac6454SAndrew Thompson 	UDSUBCLASS_HUB,			/* subclass */
235502ac6454SAndrew Thompson 	UDPROTO_FSHUB,			/* protocol */
235602ac6454SAndrew Thompson 	64,				/* max packet */
235702ac6454SAndrew Thompson 	{0}, {0}, {0x00, 0x01},		/* device id */
235802ac6454SAndrew Thompson 	1, 2, 0,			/* string indicies */
235902ac6454SAndrew Thompson 	1				/* # of configurations */
236002ac6454SAndrew Thompson };
236102ac6454SAndrew Thompson 
236202ac6454SAndrew Thompson static const struct uhci_config_desc uhci_confd = {
236302ac6454SAndrew Thompson 	.confd = {
2364760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_config_descriptor),
236502ac6454SAndrew Thompson 		.bDescriptorType = UDESC_CONFIG,
236602ac6454SAndrew Thompson 		.wTotalLength[0] = sizeof(uhci_confd),
236702ac6454SAndrew Thompson 		.bNumInterface = 1,
236802ac6454SAndrew Thompson 		.bConfigurationValue = 1,
236902ac6454SAndrew Thompson 		.iConfiguration = 0,
237002ac6454SAndrew Thompson 		.bmAttributes = UC_SELF_POWERED,
237102ac6454SAndrew Thompson 		.bMaxPower = 0		/* max power */
237202ac6454SAndrew Thompson 	},
237302ac6454SAndrew Thompson 	.ifcd = {
2374760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_interface_descriptor),
237502ac6454SAndrew Thompson 		.bDescriptorType = UDESC_INTERFACE,
237602ac6454SAndrew Thompson 		.bNumEndpoints = 1,
237702ac6454SAndrew Thompson 		.bInterfaceClass = UICLASS_HUB,
237802ac6454SAndrew Thompson 		.bInterfaceSubClass = UISUBCLASS_HUB,
237902ac6454SAndrew Thompson 		.bInterfaceProtocol = UIPROTO_FSHUB,
238002ac6454SAndrew Thompson 	},
238102ac6454SAndrew Thompson 	.endpd = {
2382760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_endpoint_descriptor),
238302ac6454SAndrew Thompson 		.bDescriptorType = UDESC_ENDPOINT,
238402ac6454SAndrew Thompson 		.bEndpointAddress = UE_DIR_IN | UHCI_INTR_ENDPT,
238502ac6454SAndrew Thompson 		.bmAttributes = UE_INTERRUPT,
238602ac6454SAndrew Thompson 		.wMaxPacketSize[0] = 8,	/* max packet (63 ports) */
238702ac6454SAndrew Thompson 		.bInterval = 255,
238802ac6454SAndrew Thompson 	},
238902ac6454SAndrew Thompson };
239002ac6454SAndrew Thompson 
239102ac6454SAndrew Thompson static const
2392760bc48eSAndrew Thompson struct usb_hub_descriptor_min uhci_hubd_piix =
239302ac6454SAndrew Thompson {
239402ac6454SAndrew Thompson 	sizeof(uhci_hubd_piix),
239502ac6454SAndrew Thompson 	UDESC_HUB,
239602ac6454SAndrew Thompson 	2,
239702ac6454SAndrew Thompson 	{UHD_PWR_NO_SWITCH | UHD_OC_INDIVIDUAL, 0},
239802ac6454SAndrew Thompson 	50,				/* power on to power good */
239902ac6454SAndrew Thompson 	0,
240002ac6454SAndrew Thompson 	{0x00},				/* both ports are removable */
240102ac6454SAndrew Thompson };
240202ac6454SAndrew Thompson 
240302ac6454SAndrew Thompson /*
240402ac6454SAndrew Thompson  * The USB hub protocol requires that SET_FEATURE(PORT_RESET) also
240502ac6454SAndrew Thompson  * enables the port, and also states that SET_FEATURE(PORT_ENABLE)
240602ac6454SAndrew Thompson  * should not be used by the USB subsystem.  As we cannot issue a
240702ac6454SAndrew Thompson  * SET_FEATURE(PORT_ENABLE) externally, we must ensure that the port
240802ac6454SAndrew Thompson  * will be enabled as part of the reset.
240902ac6454SAndrew Thompson  *
241002ac6454SAndrew Thompson  * On the VT83C572, the port cannot be successfully enabled until the
241102ac6454SAndrew Thompson  * outstanding "port enable change" and "connection status change"
241202ac6454SAndrew Thompson  * events have been reset.
241302ac6454SAndrew Thompson  */
2414e0a69b51SAndrew Thompson static usb_error_t
24154a35cda7SAndrew Thompson uhci_portreset(uhci_softc_t *sc, uint16_t index)
241602ac6454SAndrew Thompson {
241702ac6454SAndrew Thompson 	uint16_t port;
241802ac6454SAndrew Thompson 	uint16_t x;
241902ac6454SAndrew Thompson 	uint8_t lim;
242002ac6454SAndrew Thompson 
242102ac6454SAndrew Thompson 	if (index == 1)
242202ac6454SAndrew Thompson 		port = UHCI_PORTSC1;
242302ac6454SAndrew Thompson 	else if (index == 2)
242402ac6454SAndrew Thompson 		port = UHCI_PORTSC2;
242502ac6454SAndrew Thompson 	else
242602ac6454SAndrew Thompson 		return (USB_ERR_IOERROR);
242702ac6454SAndrew Thompson 
242802ac6454SAndrew Thompson 	/*
242902ac6454SAndrew Thompson 	 * Before we do anything, turn on SOF messages on the USB
243002ac6454SAndrew Thompson 	 * BUS. Some USB devices do not cope without them!
243102ac6454SAndrew Thompson 	 */
2432b9c81a5dSAndrew Thompson 	uhci_restart(sc);
243302ac6454SAndrew Thompson 
243402ac6454SAndrew Thompson 	x = URWMASK(UREAD2(sc, port));
243502ac6454SAndrew Thompson 	UWRITE2(sc, port, x | UHCI_PORTSC_PR);
243602ac6454SAndrew Thompson 
2437a593f6b8SAndrew Thompson 	usb_pause_mtx(&sc->sc_bus.bus_mtx,
243802ac6454SAndrew Thompson 	    USB_MS_TO_TICKS(USB_PORT_ROOT_RESET_DELAY));
243902ac6454SAndrew Thompson 
244002ac6454SAndrew Thompson 	DPRINTFN(4, "uhci port %d reset, status0 = 0x%04x\n",
244102ac6454SAndrew Thompson 	    index, UREAD2(sc, port));
244202ac6454SAndrew Thompson 
244302ac6454SAndrew Thompson 	x = URWMASK(UREAD2(sc, port));
244402ac6454SAndrew Thompson 	UWRITE2(sc, port, x & ~UHCI_PORTSC_PR);
244502ac6454SAndrew Thompson 
244602ac6454SAndrew Thompson 
244702ac6454SAndrew Thompson 	mtx_unlock(&sc->sc_bus.bus_mtx);
244802ac6454SAndrew Thompson 
244902ac6454SAndrew Thompson 	/*
245002ac6454SAndrew Thompson 	 * This delay needs to be exactly 100us, else some USB devices
245102ac6454SAndrew Thompson 	 * fail to attach!
245202ac6454SAndrew Thompson 	 */
245302ac6454SAndrew Thompson 	DELAY(100);
245402ac6454SAndrew Thompson 
245502ac6454SAndrew Thompson 	mtx_lock(&sc->sc_bus.bus_mtx);
245602ac6454SAndrew Thompson 
245702ac6454SAndrew Thompson 	DPRINTFN(4, "uhci port %d reset, status1 = 0x%04x\n",
245802ac6454SAndrew Thompson 	    index, UREAD2(sc, port));
245902ac6454SAndrew Thompson 
246002ac6454SAndrew Thompson 	x = URWMASK(UREAD2(sc, port));
246102ac6454SAndrew Thompson 	UWRITE2(sc, port, x | UHCI_PORTSC_PE);
246202ac6454SAndrew Thompson 
246302ac6454SAndrew Thompson 	for (lim = 0; lim < 12; lim++) {
246402ac6454SAndrew Thompson 
2465a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx,
246602ac6454SAndrew Thompson 		    USB_MS_TO_TICKS(USB_PORT_RESET_DELAY));
246702ac6454SAndrew Thompson 
246802ac6454SAndrew Thompson 		x = UREAD2(sc, port);
246902ac6454SAndrew Thompson 
247002ac6454SAndrew Thompson 		DPRINTFN(4, "uhci port %d iteration %u, status = 0x%04x\n",
247102ac6454SAndrew Thompson 		    index, lim, x);
247202ac6454SAndrew Thompson 
247302ac6454SAndrew Thompson 		if (!(x & UHCI_PORTSC_CCS)) {
247402ac6454SAndrew Thompson 			/*
247502ac6454SAndrew Thompson 			 * No device is connected (or was disconnected
247602ac6454SAndrew Thompson 			 * during reset).  Consider the port reset.
247702ac6454SAndrew Thompson 			 * The delay must be long enough to ensure on
247802ac6454SAndrew Thompson 			 * the initial iteration that the device
247902ac6454SAndrew Thompson 			 * connection will have been registered.  50ms
248002ac6454SAndrew Thompson 			 * appears to be sufficient, but 20ms is not.
248102ac6454SAndrew Thompson 			 */
248202ac6454SAndrew Thompson 			DPRINTFN(4, "uhci port %d loop %u, device detached\n",
248302ac6454SAndrew Thompson 			    index, lim);
248402ac6454SAndrew Thompson 			goto done;
248502ac6454SAndrew Thompson 		}
248602ac6454SAndrew Thompson 		if (x & (UHCI_PORTSC_POEDC | UHCI_PORTSC_CSC)) {
248702ac6454SAndrew Thompson 			/*
248802ac6454SAndrew Thompson 			 * Port enabled changed and/or connection
248902ac6454SAndrew Thompson 			 * status changed were set.  Reset either or
249002ac6454SAndrew Thompson 			 * both raised flags (by writing a 1 to that
249102ac6454SAndrew Thompson 			 * bit), and wait again for state to settle.
249202ac6454SAndrew Thompson 			 */
249302ac6454SAndrew Thompson 			UWRITE2(sc, port, URWMASK(x) |
249402ac6454SAndrew Thompson 			    (x & (UHCI_PORTSC_POEDC | UHCI_PORTSC_CSC)));
249502ac6454SAndrew Thompson 			continue;
249602ac6454SAndrew Thompson 		}
249702ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_PE) {
249802ac6454SAndrew Thompson 			/* port is enabled */
249902ac6454SAndrew Thompson 			goto done;
250002ac6454SAndrew Thompson 		}
250102ac6454SAndrew Thompson 		UWRITE2(sc, port, URWMASK(x) | UHCI_PORTSC_PE);
250202ac6454SAndrew Thompson 	}
250302ac6454SAndrew Thompson 
250402ac6454SAndrew Thompson 	DPRINTFN(2, "uhci port %d reset timed out\n", index);
250502ac6454SAndrew Thompson 	return (USB_ERR_TIMEOUT);
250602ac6454SAndrew Thompson 
250702ac6454SAndrew Thompson done:
250802ac6454SAndrew Thompson 	DPRINTFN(4, "uhci port %d reset, status2 = 0x%04x\n",
250902ac6454SAndrew Thompson 	    index, UREAD2(sc, port));
251002ac6454SAndrew Thompson 
251102ac6454SAndrew Thompson 	sc->sc_isreset = 1;
251202ac6454SAndrew Thompson 	return (USB_ERR_NORMAL_COMPLETION);
251302ac6454SAndrew Thompson }
251402ac6454SAndrew Thompson 
2515e0a69b51SAndrew Thompson static usb_error_t
2516760bc48eSAndrew Thompson uhci_roothub_exec(struct usb_device *udev,
2517760bc48eSAndrew Thompson     struct usb_device_request *req, const void **pptr, uint16_t *plength)
251802ac6454SAndrew Thompson {
2519459d369eSAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(udev->bus);
2520459d369eSAndrew Thompson 	const void *ptr;
2521459d369eSAndrew Thompson 	const char *str_ptr;
252202ac6454SAndrew Thompson 	uint16_t x;
252302ac6454SAndrew Thompson 	uint16_t port;
252402ac6454SAndrew Thompson 	uint16_t value;
252502ac6454SAndrew Thompson 	uint16_t index;
252602ac6454SAndrew Thompson 	uint16_t status;
252702ac6454SAndrew Thompson 	uint16_t change;
2528459d369eSAndrew Thompson 	uint16_t len;
2529e0a69b51SAndrew Thompson 	usb_error_t err;
253002ac6454SAndrew Thompson 
253102ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
253202ac6454SAndrew Thompson 
253302ac6454SAndrew Thompson 	/* buffer reset */
2534459d369eSAndrew Thompson 	ptr = (const void *)&sc->sc_hub_desc.temp;
2535459d369eSAndrew Thompson 	len = 0;
2536459d369eSAndrew Thompson 	err = 0;
253702ac6454SAndrew Thompson 
2538459d369eSAndrew Thompson 	value = UGETW(req->wValue);
2539459d369eSAndrew Thompson 	index = UGETW(req->wIndex);
254002ac6454SAndrew Thompson 
254102ac6454SAndrew Thompson 	DPRINTFN(3, "type=0x%02x request=0x%02x wLen=0x%04x "
254202ac6454SAndrew Thompson 	    "wValue=0x%04x wIndex=0x%04x\n",
2543459d369eSAndrew Thompson 	    req->bmRequestType, req->bRequest,
2544459d369eSAndrew Thompson 	    UGETW(req->wLength), value, index);
254502ac6454SAndrew Thompson 
254602ac6454SAndrew Thompson #define	C(x,y) ((x) | ((y) << 8))
2547459d369eSAndrew Thompson 	switch (C(req->bRequest, req->bmRequestType)) {
254802ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
254902ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
255002ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
255102ac6454SAndrew Thompson 		/*
255202ac6454SAndrew Thompson 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
255302ac6454SAndrew Thompson 		 * for the integrated root hub.
255402ac6454SAndrew Thompson 		 */
255502ac6454SAndrew Thompson 		break;
255602ac6454SAndrew Thompson 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
2557459d369eSAndrew Thompson 		len = 1;
255802ac6454SAndrew Thompson 		sc->sc_hub_desc.temp[0] = sc->sc_conf;
255902ac6454SAndrew Thompson 		break;
256002ac6454SAndrew Thompson 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
256102ac6454SAndrew Thompson 		switch (value >> 8) {
256202ac6454SAndrew Thompson 		case UDESC_DEVICE:
256302ac6454SAndrew Thompson 			if ((value & 0xff) != 0) {
2564459d369eSAndrew Thompson 				err = USB_ERR_IOERROR;
256502ac6454SAndrew Thompson 				goto done;
256602ac6454SAndrew Thompson 			}
2567459d369eSAndrew Thompson 			len = sizeof(uhci_devd);
2568459d369eSAndrew Thompson 			ptr = (const void *)&uhci_devd;
256902ac6454SAndrew Thompson 			break;
257002ac6454SAndrew Thompson 
257102ac6454SAndrew Thompson 		case UDESC_CONFIG:
257202ac6454SAndrew Thompson 			if ((value & 0xff) != 0) {
2573459d369eSAndrew Thompson 				err = USB_ERR_IOERROR;
257402ac6454SAndrew Thompson 				goto done;
257502ac6454SAndrew Thompson 			}
2576459d369eSAndrew Thompson 			len = sizeof(uhci_confd);
2577459d369eSAndrew Thompson 			ptr = (const void *)&uhci_confd;
257802ac6454SAndrew Thompson 			break;
257902ac6454SAndrew Thompson 
258002ac6454SAndrew Thompson 		case UDESC_STRING:
258102ac6454SAndrew Thompson 			switch (value & 0xff) {
258202ac6454SAndrew Thompson 			case 0:	/* Language table */
2583459d369eSAndrew Thompson 				str_ptr = "\001";
258402ac6454SAndrew Thompson 				break;
258502ac6454SAndrew Thompson 
258602ac6454SAndrew Thompson 			case 1:	/* Vendor */
2587459d369eSAndrew Thompson 				str_ptr = sc->sc_vendor;
258802ac6454SAndrew Thompson 				break;
258902ac6454SAndrew Thompson 
259002ac6454SAndrew Thompson 			case 2:	/* Product */
2591459d369eSAndrew Thompson 				str_ptr = "UHCI root HUB";
259202ac6454SAndrew Thompson 				break;
259302ac6454SAndrew Thompson 
259402ac6454SAndrew Thompson 			default:
2595459d369eSAndrew Thompson 				str_ptr = "";
259602ac6454SAndrew Thompson 				break;
259702ac6454SAndrew Thompson 			}
259802ac6454SAndrew Thompson 
2599a593f6b8SAndrew Thompson 			len = usb_make_str_desc
260002ac6454SAndrew Thompson 			    (sc->sc_hub_desc.temp,
260102ac6454SAndrew Thompson 			    sizeof(sc->sc_hub_desc.temp),
2602459d369eSAndrew Thompson 			    str_ptr);
260302ac6454SAndrew Thompson 			break;
260402ac6454SAndrew Thompson 
260502ac6454SAndrew Thompson 		default:
2606459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
260702ac6454SAndrew Thompson 			goto done;
260802ac6454SAndrew Thompson 		}
260902ac6454SAndrew Thompson 		break;
261002ac6454SAndrew Thompson 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
2611459d369eSAndrew Thompson 		len = 1;
261202ac6454SAndrew Thompson 		sc->sc_hub_desc.temp[0] = 0;
261302ac6454SAndrew Thompson 		break;
261402ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_DEVICE):
2615459d369eSAndrew Thompson 		len = 2;
261602ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.stat.wStatus, UDS_SELF_POWERED);
261702ac6454SAndrew Thompson 		break;
261802ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
261902ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
2620459d369eSAndrew Thompson 		len = 2;
262102ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.stat.wStatus, 0);
262202ac6454SAndrew Thompson 		break;
262302ac6454SAndrew Thompson 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
2624ab42e8b2SAndrew Thompson 		if (value >= UHCI_MAX_DEVICES) {
2625459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
262602ac6454SAndrew Thompson 			goto done;
262702ac6454SAndrew Thompson 		}
262802ac6454SAndrew Thompson 		sc->sc_addr = value;
262902ac6454SAndrew Thompson 		break;
263002ac6454SAndrew Thompson 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
263102ac6454SAndrew Thompson 		if ((value != 0) && (value != 1)) {
2632459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
263302ac6454SAndrew Thompson 			goto done;
263402ac6454SAndrew Thompson 		}
263502ac6454SAndrew Thompson 		sc->sc_conf = value;
263602ac6454SAndrew Thompson 		break;
263702ac6454SAndrew Thompson 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
263802ac6454SAndrew Thompson 		break;
263902ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
264002ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
264102ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
2642459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
264302ac6454SAndrew Thompson 		goto done;
264402ac6454SAndrew Thompson 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
264502ac6454SAndrew Thompson 		break;
264602ac6454SAndrew Thompson 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
264702ac6454SAndrew Thompson 		break;
264802ac6454SAndrew Thompson 		/* Hub requests */
264902ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
265002ac6454SAndrew Thompson 		break;
265102ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
265202ac6454SAndrew Thompson 		DPRINTFN(4, "UR_CLEAR_PORT_FEATURE "
265302ac6454SAndrew Thompson 		    "port=%d feature=%d\n",
265402ac6454SAndrew Thompson 		    index, value);
265502ac6454SAndrew Thompson 		if (index == 1)
265602ac6454SAndrew Thompson 			port = UHCI_PORTSC1;
265702ac6454SAndrew Thompson 		else if (index == 2)
265802ac6454SAndrew Thompson 			port = UHCI_PORTSC2;
265902ac6454SAndrew Thompson 		else {
2660459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
266102ac6454SAndrew Thompson 			goto done;
266202ac6454SAndrew Thompson 		}
266302ac6454SAndrew Thompson 		switch (value) {
266402ac6454SAndrew Thompson 		case UHF_PORT_ENABLE:
266502ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
266602ac6454SAndrew Thompson 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PE);
266702ac6454SAndrew Thompson 			break;
266802ac6454SAndrew Thompson 		case UHF_PORT_SUSPEND:
266902ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
267002ac6454SAndrew Thompson 			UWRITE2(sc, port, x & ~(UHCI_PORTSC_SUSP));
267102ac6454SAndrew Thompson 			break;
267202ac6454SAndrew Thompson 		case UHF_PORT_RESET:
267302ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
267402ac6454SAndrew Thompson 			UWRITE2(sc, port, x & ~UHCI_PORTSC_PR);
267502ac6454SAndrew Thompson 			break;
267602ac6454SAndrew Thompson 		case UHF_C_PORT_CONNECTION:
267702ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
267802ac6454SAndrew Thompson 			UWRITE2(sc, port, x | UHCI_PORTSC_CSC);
267902ac6454SAndrew Thompson 			break;
268002ac6454SAndrew Thompson 		case UHF_C_PORT_ENABLE:
268102ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
268202ac6454SAndrew Thompson 			UWRITE2(sc, port, x | UHCI_PORTSC_POEDC);
268302ac6454SAndrew Thompson 			break;
268402ac6454SAndrew Thompson 		case UHF_C_PORT_OVER_CURRENT:
268502ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
268602ac6454SAndrew Thompson 			UWRITE2(sc, port, x | UHCI_PORTSC_OCIC);
268702ac6454SAndrew Thompson 			break;
268802ac6454SAndrew Thompson 		case UHF_C_PORT_RESET:
268902ac6454SAndrew Thompson 			sc->sc_isreset = 0;
2690459d369eSAndrew Thompson 			err = USB_ERR_NORMAL_COMPLETION;
269102ac6454SAndrew Thompson 			goto done;
269202ac6454SAndrew Thompson 		case UHF_C_PORT_SUSPEND:
269302ac6454SAndrew Thompson 			sc->sc_isresumed &= ~(1 << index);
269402ac6454SAndrew Thompson 			break;
269502ac6454SAndrew Thompson 		case UHF_PORT_CONNECTION:
269602ac6454SAndrew Thompson 		case UHF_PORT_OVER_CURRENT:
269702ac6454SAndrew Thompson 		case UHF_PORT_POWER:
269802ac6454SAndrew Thompson 		case UHF_PORT_LOW_SPEED:
269902ac6454SAndrew Thompson 		default:
2700459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
270102ac6454SAndrew Thompson 			goto done;
270202ac6454SAndrew Thompson 		}
270302ac6454SAndrew Thompson 		break;
270402ac6454SAndrew Thompson 	case C(UR_GET_BUS_STATE, UT_READ_CLASS_OTHER):
270502ac6454SAndrew Thompson 		if (index == 1)
270602ac6454SAndrew Thompson 			port = UHCI_PORTSC1;
270702ac6454SAndrew Thompson 		else if (index == 2)
270802ac6454SAndrew Thompson 			port = UHCI_PORTSC2;
270902ac6454SAndrew Thompson 		else {
2710459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
271102ac6454SAndrew Thompson 			goto done;
271202ac6454SAndrew Thompson 		}
2713459d369eSAndrew Thompson 		len = 1;
271402ac6454SAndrew Thompson 		sc->sc_hub_desc.temp[0] =
271502ac6454SAndrew Thompson 		    ((UREAD2(sc, port) & UHCI_PORTSC_LS) >>
271602ac6454SAndrew Thompson 		    UHCI_PORTSC_LS_SHIFT);
271702ac6454SAndrew Thompson 		break;
271802ac6454SAndrew Thompson 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
271902ac6454SAndrew Thompson 		if ((value & 0xff) != 0) {
2720459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
272102ac6454SAndrew Thompson 			goto done;
272202ac6454SAndrew Thompson 		}
2723459d369eSAndrew Thompson 		len = sizeof(uhci_hubd_piix);
2724459d369eSAndrew Thompson 		ptr = (const void *)&uhci_hubd_piix;
272502ac6454SAndrew Thompson 		break;
272602ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
2727459d369eSAndrew Thompson 		len = 16;
272802ac6454SAndrew Thompson 		bzero(sc->sc_hub_desc.temp, 16);
272902ac6454SAndrew Thompson 		break;
273002ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
273102ac6454SAndrew Thompson 		if (index == 1)
273202ac6454SAndrew Thompson 			port = UHCI_PORTSC1;
273302ac6454SAndrew Thompson 		else if (index == 2)
273402ac6454SAndrew Thompson 			port = UHCI_PORTSC2;
273502ac6454SAndrew Thompson 		else {
2736459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
273702ac6454SAndrew Thompson 			goto done;
273802ac6454SAndrew Thompson 		}
273902ac6454SAndrew Thompson 		x = UREAD2(sc, port);
274002ac6454SAndrew Thompson 		status = change = 0;
274102ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_CCS)
274202ac6454SAndrew Thompson 			status |= UPS_CURRENT_CONNECT_STATUS;
274302ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_CSC)
274402ac6454SAndrew Thompson 			change |= UPS_C_CONNECT_STATUS;
274502ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_PE)
274602ac6454SAndrew Thompson 			status |= UPS_PORT_ENABLED;
274702ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_POEDC)
274802ac6454SAndrew Thompson 			change |= UPS_C_PORT_ENABLED;
274902ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_OCI)
275002ac6454SAndrew Thompson 			status |= UPS_OVERCURRENT_INDICATOR;
275102ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_OCIC)
275202ac6454SAndrew Thompson 			change |= UPS_C_OVERCURRENT_INDICATOR;
275302ac6454SAndrew Thompson 		if (x & UHCI_PORTSC_LSDA)
275402ac6454SAndrew Thompson 			status |= UPS_LOW_SPEED;
275502ac6454SAndrew Thompson 		if ((x & UHCI_PORTSC_PE) && (x & UHCI_PORTSC_RD)) {
275602ac6454SAndrew Thompson 			/* need to do a write back */
275702ac6454SAndrew Thompson 			UWRITE2(sc, port, URWMASK(x));
275802ac6454SAndrew Thompson 
275902ac6454SAndrew Thompson 			/* wait 20ms for resume sequence to complete */
2760a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 50);
276102ac6454SAndrew Thompson 
276202ac6454SAndrew Thompson 			/* clear suspend and resume detect */
276302ac6454SAndrew Thompson 			UWRITE2(sc, port, URWMASK(x) & ~(UHCI_PORTSC_RD |
276402ac6454SAndrew Thompson 			    UHCI_PORTSC_SUSP));
276502ac6454SAndrew Thompson 
276602ac6454SAndrew Thompson 			/* wait a little bit */
2767a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 500);
276802ac6454SAndrew Thompson 
276902ac6454SAndrew Thompson 			sc->sc_isresumed |= (1 << index);
277002ac6454SAndrew Thompson 
277102ac6454SAndrew Thompson 		} else if (x & UHCI_PORTSC_SUSP) {
277202ac6454SAndrew Thompson 			status |= UPS_SUSPEND;
277302ac6454SAndrew Thompson 		}
277402ac6454SAndrew Thompson 		status |= UPS_PORT_POWER;
277502ac6454SAndrew Thompson 		if (sc->sc_isresumed & (1 << index))
277602ac6454SAndrew Thompson 			change |= UPS_C_SUSPEND;
277702ac6454SAndrew Thompson 		if (sc->sc_isreset)
277802ac6454SAndrew Thompson 			change |= UPS_C_PORT_RESET;
277902ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.ps.wPortStatus, status);
278002ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.ps.wPortChange, change);
2781459d369eSAndrew Thompson 		len = sizeof(sc->sc_hub_desc.ps);
278202ac6454SAndrew Thompson 		break;
278302ac6454SAndrew Thompson 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
2784459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
278502ac6454SAndrew Thompson 		goto done;
278602ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
278702ac6454SAndrew Thompson 		break;
278802ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
278902ac6454SAndrew Thompson 		if (index == 1)
279002ac6454SAndrew Thompson 			port = UHCI_PORTSC1;
279102ac6454SAndrew Thompson 		else if (index == 2)
279202ac6454SAndrew Thompson 			port = UHCI_PORTSC2;
279302ac6454SAndrew Thompson 		else {
2794459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
279502ac6454SAndrew Thompson 			goto done;
279602ac6454SAndrew Thompson 		}
279702ac6454SAndrew Thompson 		switch (value) {
279802ac6454SAndrew Thompson 		case UHF_PORT_ENABLE:
279902ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
280002ac6454SAndrew Thompson 			UWRITE2(sc, port, x | UHCI_PORTSC_PE);
280102ac6454SAndrew Thompson 			break;
280202ac6454SAndrew Thompson 		case UHF_PORT_SUSPEND:
280302ac6454SAndrew Thompson 			x = URWMASK(UREAD2(sc, port));
280402ac6454SAndrew Thompson 			UWRITE2(sc, port, x | UHCI_PORTSC_SUSP);
280502ac6454SAndrew Thompson 			break;
280602ac6454SAndrew Thompson 		case UHF_PORT_RESET:
2807459d369eSAndrew Thompson 			err = uhci_portreset(sc, index);
280802ac6454SAndrew Thompson 			goto done;
280902ac6454SAndrew Thompson 		case UHF_PORT_POWER:
281002ac6454SAndrew Thompson 			/* pretend we turned on power */
2811459d369eSAndrew Thompson 			err = USB_ERR_NORMAL_COMPLETION;
281202ac6454SAndrew Thompson 			goto done;
281302ac6454SAndrew Thompson 		case UHF_C_PORT_CONNECTION:
281402ac6454SAndrew Thompson 		case UHF_C_PORT_ENABLE:
281502ac6454SAndrew Thompson 		case UHF_C_PORT_OVER_CURRENT:
281602ac6454SAndrew Thompson 		case UHF_PORT_CONNECTION:
281702ac6454SAndrew Thompson 		case UHF_PORT_OVER_CURRENT:
281802ac6454SAndrew Thompson 		case UHF_PORT_LOW_SPEED:
281902ac6454SAndrew Thompson 		case UHF_C_PORT_SUSPEND:
282002ac6454SAndrew Thompson 		case UHF_C_PORT_RESET:
282102ac6454SAndrew Thompson 		default:
2822459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
282302ac6454SAndrew Thompson 			goto done;
282402ac6454SAndrew Thompson 		}
282502ac6454SAndrew Thompson 		break;
282602ac6454SAndrew Thompson 	default:
2827459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
282802ac6454SAndrew Thompson 		goto done;
282902ac6454SAndrew Thompson 	}
283002ac6454SAndrew Thompson done:
2831459d369eSAndrew Thompson 	*plength = len;
2832459d369eSAndrew Thompson 	*pptr = ptr;
2833459d369eSAndrew Thompson 	return (err);
283402ac6454SAndrew Thompson }
283502ac6454SAndrew Thompson 
283602ac6454SAndrew Thompson /*
283739307315SAndrew Thompson  * This routine is executed periodically and simulates interrupts from
283839307315SAndrew Thompson  * the root controller interrupt pipe for port status change:
283902ac6454SAndrew Thompson  */
284002ac6454SAndrew Thompson static void
284139307315SAndrew Thompson uhci_root_intr(uhci_softc_t *sc)
284202ac6454SAndrew Thompson {
284302ac6454SAndrew Thompson 	DPRINTFN(21, "\n");
284402ac6454SAndrew Thompson 
284502ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
284602ac6454SAndrew Thompson 
284702ac6454SAndrew Thompson 	sc->sc_hub_idata[0] = 0;
284802ac6454SAndrew Thompson 
284902ac6454SAndrew Thompson 	if (UREAD2(sc, UHCI_PORTSC1) & (UHCI_PORTSC_CSC |
285002ac6454SAndrew Thompson 	    UHCI_PORTSC_OCIC | UHCI_PORTSC_RD)) {
285102ac6454SAndrew Thompson 		sc->sc_hub_idata[0] |= 1 << 1;
285202ac6454SAndrew Thompson 	}
285302ac6454SAndrew Thompson 	if (UREAD2(sc, UHCI_PORTSC2) & (UHCI_PORTSC_CSC |
285402ac6454SAndrew Thompson 	    UHCI_PORTSC_OCIC | UHCI_PORTSC_RD)) {
285502ac6454SAndrew Thompson 		sc->sc_hub_idata[0] |= 1 << 2;
285602ac6454SAndrew Thompson 	}
285702ac6454SAndrew Thompson 
285839307315SAndrew Thompson 	/* restart timer */
2859a593f6b8SAndrew Thompson 	usb_callout_reset(&sc->sc_root_intr, hz,
286039307315SAndrew Thompson 	    (void *)&uhci_root_intr, sc);
286139307315SAndrew Thompson 
286239307315SAndrew Thompson 	if (sc->sc_hub_idata[0] != 0) {
286339307315SAndrew Thompson 		uhub_root_intr(&sc->sc_bus, sc->sc_hub_idata,
286439307315SAndrew Thompson 		    sizeof(sc->sc_hub_idata));
286539307315SAndrew Thompson 	}
286639307315SAndrew Thompson }
286702ac6454SAndrew Thompson 
286802ac6454SAndrew Thompson static void
2869760bc48eSAndrew Thompson uhci_xfer_setup(struct usb_setup_params *parm)
287002ac6454SAndrew Thompson {
2871760bc48eSAndrew Thompson 	struct usb_page_search page_info;
2872760bc48eSAndrew Thompson 	struct usb_page_cache *pc;
287302ac6454SAndrew Thompson 	uhci_softc_t *sc;
2874760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
287502ac6454SAndrew Thompson 	void *last_obj;
287602ac6454SAndrew Thompson 	uint32_t ntd;
287702ac6454SAndrew Thompson 	uint32_t nqh;
287802ac6454SAndrew Thompson 	uint32_t nfixup;
287902ac6454SAndrew Thompson 	uint32_t n;
288002ac6454SAndrew Thompson 	uint16_t align;
288102ac6454SAndrew Thompson 
288202ac6454SAndrew Thompson 	sc = UHCI_BUS2SC(parm->udev->bus);
288302ac6454SAndrew Thompson 	xfer = parm->curr_xfer;
288402ac6454SAndrew Thompson 
288502ac6454SAndrew Thompson 	parm->hc_max_packet_size = 0x500;
288602ac6454SAndrew Thompson 	parm->hc_max_packet_count = 1;
288702ac6454SAndrew Thompson 	parm->hc_max_frame_size = 0x500;
288802ac6454SAndrew Thompson 
288902ac6454SAndrew Thompson 	/*
289002ac6454SAndrew Thompson 	 * compute ntd and nqh
289102ac6454SAndrew Thompson 	 */
289202ac6454SAndrew Thompson 	if (parm->methods == &uhci_device_ctrl_methods) {
289302ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
289402ac6454SAndrew Thompson 		xfer->flags_int.bdma_no_post_sync = 1;
289502ac6454SAndrew Thompson 
2896a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
289702ac6454SAndrew Thompson 
289802ac6454SAndrew Thompson 		/* see EHCI HC driver for proof of "ntd" formula */
289902ac6454SAndrew Thompson 
290002ac6454SAndrew Thompson 		nqh = 1;
290102ac6454SAndrew Thompson 		ntd = ((2 * xfer->nframes) + 1	/* STATUS */
290202ac6454SAndrew Thompson 		    + (xfer->max_data_length / xfer->max_frame_size));
290302ac6454SAndrew Thompson 
290402ac6454SAndrew Thompson 	} else if (parm->methods == &uhci_device_bulk_methods) {
290502ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
290602ac6454SAndrew Thompson 		xfer->flags_int.bdma_no_post_sync = 1;
290702ac6454SAndrew Thompson 
2908a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
290902ac6454SAndrew Thompson 
291002ac6454SAndrew Thompson 		nqh = 1;
291102ac6454SAndrew Thompson 		ntd = ((2 * xfer->nframes)
291202ac6454SAndrew Thompson 		    + (xfer->max_data_length / xfer->max_frame_size));
291302ac6454SAndrew Thompson 
291402ac6454SAndrew Thompson 	} else if (parm->methods == &uhci_device_intr_methods) {
291502ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
291602ac6454SAndrew Thompson 		xfer->flags_int.bdma_no_post_sync = 1;
291702ac6454SAndrew Thompson 
2918a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
291902ac6454SAndrew Thompson 
292002ac6454SAndrew Thompson 		nqh = 1;
292102ac6454SAndrew Thompson 		ntd = ((2 * xfer->nframes)
292202ac6454SAndrew Thompson 		    + (xfer->max_data_length / xfer->max_frame_size));
292302ac6454SAndrew Thompson 
292402ac6454SAndrew Thompson 	} else if (parm->methods == &uhci_device_isoc_methods) {
292502ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
292602ac6454SAndrew Thompson 		xfer->flags_int.bdma_no_post_sync = 1;
292702ac6454SAndrew Thompson 
2928a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
292902ac6454SAndrew Thompson 
293002ac6454SAndrew Thompson 		nqh = 0;
293102ac6454SAndrew Thompson 		ntd = xfer->nframes;
293202ac6454SAndrew Thompson 
293302ac6454SAndrew Thompson 	} else {
293402ac6454SAndrew Thompson 
2935a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
293602ac6454SAndrew Thompson 
293702ac6454SAndrew Thompson 		nqh = 0;
293802ac6454SAndrew Thompson 		ntd = 0;
293902ac6454SAndrew Thompson 	}
294002ac6454SAndrew Thompson 
294102ac6454SAndrew Thompson 	if (parm->err) {
294202ac6454SAndrew Thompson 		return;
294302ac6454SAndrew Thompson 	}
294402ac6454SAndrew Thompson 	/*
294502ac6454SAndrew Thompson 	 * NOTE: the UHCI controller requires that
294602ac6454SAndrew Thompson 	 * every packet must be contiguous on
294702ac6454SAndrew Thompson 	 * the same USB memory page !
294802ac6454SAndrew Thompson 	 */
294902ac6454SAndrew Thompson 	nfixup = (parm->bufsize / USB_PAGE_SIZE) + 1;
295002ac6454SAndrew Thompson 
295102ac6454SAndrew Thompson 	/*
295202ac6454SAndrew Thompson 	 * Compute a suitable power of two alignment
295302ac6454SAndrew Thompson 	 * for our "max_frame_size" fixup buffer(s):
295402ac6454SAndrew Thompson 	 */
295502ac6454SAndrew Thompson 	align = xfer->max_frame_size;
295602ac6454SAndrew Thompson 	n = 0;
295702ac6454SAndrew Thompson 	while (align) {
295802ac6454SAndrew Thompson 		align >>= 1;
295902ac6454SAndrew Thompson 		n++;
296002ac6454SAndrew Thompson 	}
296102ac6454SAndrew Thompson 
296202ac6454SAndrew Thompson 	/* check for power of two */
296302ac6454SAndrew Thompson 	if (!(xfer->max_frame_size &
296402ac6454SAndrew Thompson 	    (xfer->max_frame_size - 1))) {
296502ac6454SAndrew Thompson 		n--;
296602ac6454SAndrew Thompson 	}
296702ac6454SAndrew Thompson 	/*
296802ac6454SAndrew Thompson 	 * We don't allow alignments of
296902ac6454SAndrew Thompson 	 * less than 8 bytes:
297002ac6454SAndrew Thompson 	 *
297102ac6454SAndrew Thompson 	 * NOTE: Allocating using an aligment
297202ac6454SAndrew Thompson 	 * of 1 byte has special meaning!
297302ac6454SAndrew Thompson 	 */
297402ac6454SAndrew Thompson 	if (n < 3) {
297502ac6454SAndrew Thompson 		n = 3;
297602ac6454SAndrew Thompson 	}
297702ac6454SAndrew Thompson 	align = (1 << n);
297802ac6454SAndrew Thompson 
2979a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
298002ac6454SAndrew Thompson 	    parm, &pc, xfer->max_frame_size,
298102ac6454SAndrew Thompson 	    align, nfixup)) {
298202ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
298302ac6454SAndrew Thompson 		return;
298402ac6454SAndrew Thompson 	}
298502ac6454SAndrew Thompson 	xfer->buf_fixup = pc;
298602ac6454SAndrew Thompson 
298702ac6454SAndrew Thompson alloc_dma_set:
298802ac6454SAndrew Thompson 
298902ac6454SAndrew Thompson 	if (parm->err) {
299002ac6454SAndrew Thompson 		return;
299102ac6454SAndrew Thompson 	}
299202ac6454SAndrew Thompson 	last_obj = NULL;
299302ac6454SAndrew Thompson 
2994a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
299502ac6454SAndrew Thompson 	    parm, &pc, sizeof(uhci_td_t),
299602ac6454SAndrew Thompson 	    UHCI_TD_ALIGN, ntd)) {
299702ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
299802ac6454SAndrew Thompson 		return;
299902ac6454SAndrew Thompson 	}
300002ac6454SAndrew Thompson 	if (parm->buf) {
300102ac6454SAndrew Thompson 		for (n = 0; n != ntd; n++) {
300202ac6454SAndrew Thompson 			uhci_td_t *td;
300302ac6454SAndrew Thompson 
3004a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
300502ac6454SAndrew Thompson 
300602ac6454SAndrew Thompson 			td = page_info.buffer;
300702ac6454SAndrew Thompson 
300802ac6454SAndrew Thompson 			/* init TD */
300902ac6454SAndrew Thompson 			if ((parm->methods == &uhci_device_bulk_methods) ||
301002ac6454SAndrew Thompson 			    (parm->methods == &uhci_device_ctrl_methods) ||
301102ac6454SAndrew Thompson 			    (parm->methods == &uhci_device_intr_methods)) {
301202ac6454SAndrew Thompson 				/* set depth first bit */
301302ac6454SAndrew Thompson 				td->td_self = htole32(page_info.physaddr |
301402ac6454SAndrew Thompson 				    UHCI_PTR_TD | UHCI_PTR_VF);
301502ac6454SAndrew Thompson 			} else {
301602ac6454SAndrew Thompson 				td->td_self = htole32(page_info.physaddr |
301702ac6454SAndrew Thompson 				    UHCI_PTR_TD);
301802ac6454SAndrew Thompson 			}
301902ac6454SAndrew Thompson 
302002ac6454SAndrew Thompson 			td->obj_next = last_obj;
302102ac6454SAndrew Thompson 			td->page_cache = pc + n;
302202ac6454SAndrew Thompson 
302302ac6454SAndrew Thompson 			last_obj = td;
302402ac6454SAndrew Thompson 
3025a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
302602ac6454SAndrew Thompson 		}
302702ac6454SAndrew Thompson 	}
302802ac6454SAndrew Thompson 	xfer->td_start[xfer->flags_int.curr_dma_set] = last_obj;
302902ac6454SAndrew Thompson 
303002ac6454SAndrew Thompson 	last_obj = NULL;
303102ac6454SAndrew Thompson 
3032a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
303302ac6454SAndrew Thompson 	    parm, &pc, sizeof(uhci_qh_t),
303402ac6454SAndrew Thompson 	    UHCI_QH_ALIGN, nqh)) {
303502ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
303602ac6454SAndrew Thompson 		return;
303702ac6454SAndrew Thompson 	}
303802ac6454SAndrew Thompson 	if (parm->buf) {
303902ac6454SAndrew Thompson 		for (n = 0; n != nqh; n++) {
304002ac6454SAndrew Thompson 			uhci_qh_t *qh;
304102ac6454SAndrew Thompson 
3042a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
304302ac6454SAndrew Thompson 
304402ac6454SAndrew Thompson 			qh = page_info.buffer;
304502ac6454SAndrew Thompson 
304602ac6454SAndrew Thompson 			/* init QH */
304702ac6454SAndrew Thompson 			qh->qh_self = htole32(page_info.physaddr | UHCI_PTR_QH);
304802ac6454SAndrew Thompson 			qh->obj_next = last_obj;
304902ac6454SAndrew Thompson 			qh->page_cache = pc + n;
305002ac6454SAndrew Thompson 
305102ac6454SAndrew Thompson 			last_obj = qh;
305202ac6454SAndrew Thompson 
3053a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
305402ac6454SAndrew Thompson 		}
305502ac6454SAndrew Thompson 	}
305602ac6454SAndrew Thompson 	xfer->qh_start[xfer->flags_int.curr_dma_set] = last_obj;
305702ac6454SAndrew Thompson 
305802ac6454SAndrew Thompson 	if (!xfer->flags_int.curr_dma_set) {
305902ac6454SAndrew Thompson 		xfer->flags_int.curr_dma_set = 1;
306002ac6454SAndrew Thompson 		goto alloc_dma_set;
306102ac6454SAndrew Thompson 	}
306202ac6454SAndrew Thompson }
306302ac6454SAndrew Thompson 
306402ac6454SAndrew Thompson static void
3065ae60fdfbSAndrew Thompson uhci_ep_init(struct usb_device *udev, struct usb_endpoint_descriptor *edesc,
3066ae60fdfbSAndrew Thompson     struct usb_endpoint *ep)
306702ac6454SAndrew Thompson {
306802ac6454SAndrew Thompson 	uhci_softc_t *sc = UHCI_BUS2SC(udev->bus);
306902ac6454SAndrew Thompson 
3070ae60fdfbSAndrew Thompson 	DPRINTFN(2, "endpoint=%p, addr=%d, endpt=%d, mode=%d (%d)\n",
3071ae60fdfbSAndrew Thompson 	    ep, udev->address,
3072f29a0724SAndrew Thompson 	    edesc->bEndpointAddress, udev->flags.usb_mode,
307302ac6454SAndrew Thompson 	    sc->sc_addr);
307402ac6454SAndrew Thompson 
3075f29a0724SAndrew Thompson 	if (udev->flags.usb_mode != USB_MODE_HOST) {
307602ac6454SAndrew Thompson 		/* not supported */
307702ac6454SAndrew Thompson 		return;
307802ac6454SAndrew Thompson 	}
307939307315SAndrew Thompson 	if (udev->device_index != sc->sc_addr) {
308002ac6454SAndrew Thompson 		switch (edesc->bmAttributes & UE_XFERTYPE) {
308102ac6454SAndrew Thompson 		case UE_CONTROL:
3082ae60fdfbSAndrew Thompson 			ep->methods = &uhci_device_ctrl_methods;
308302ac6454SAndrew Thompson 			break;
308402ac6454SAndrew Thompson 		case UE_INTERRUPT:
3085ae60fdfbSAndrew Thompson 			ep->methods = &uhci_device_intr_methods;
308602ac6454SAndrew Thompson 			break;
308702ac6454SAndrew Thompson 		case UE_ISOCHRONOUS:
308802ac6454SAndrew Thompson 			if (udev->speed == USB_SPEED_FULL) {
3089ae60fdfbSAndrew Thompson 				ep->methods = &uhci_device_isoc_methods;
309002ac6454SAndrew Thompson 			}
309102ac6454SAndrew Thompson 			break;
309202ac6454SAndrew Thompson 		case UE_BULK:
309302ac6454SAndrew Thompson 			if (udev->speed != USB_SPEED_LOW) {
3094ae60fdfbSAndrew Thompson 				ep->methods = &uhci_device_bulk_methods;
309502ac6454SAndrew Thompson 			}
309602ac6454SAndrew Thompson 			break;
309702ac6454SAndrew Thompson 		default:
309802ac6454SAndrew Thompson 			/* do nothing */
309902ac6454SAndrew Thompson 			break;
310002ac6454SAndrew Thompson 		}
310102ac6454SAndrew Thompson 	}
310202ac6454SAndrew Thompson }
310302ac6454SAndrew Thompson 
310402ac6454SAndrew Thompson static void
3105760bc48eSAndrew Thompson uhci_xfer_unsetup(struct usb_xfer *xfer)
310602ac6454SAndrew Thompson {
310702ac6454SAndrew Thompson 	return;
310802ac6454SAndrew Thompson }
310902ac6454SAndrew Thompson 
311002ac6454SAndrew Thompson static void
3111760bc48eSAndrew Thompson uhci_get_dma_delay(struct usb_bus *bus, uint32_t *pus)
311202ac6454SAndrew Thompson {
311302ac6454SAndrew Thompson 	/*
311402ac6454SAndrew Thompson 	 * Wait until hardware has finished any possible use of the
311502ac6454SAndrew Thompson 	 * transfer descriptor(s) and QH
311602ac6454SAndrew Thompson 	 */
311702ac6454SAndrew Thompson 	*pus = (1125);			/* microseconds */
311802ac6454SAndrew Thompson }
311902ac6454SAndrew Thompson 
312002ac6454SAndrew Thompson static void
3121760bc48eSAndrew Thompson uhci_device_resume(struct usb_device *udev)
312202ac6454SAndrew Thompson {
312302ac6454SAndrew Thompson 	struct uhci_softc *sc = UHCI_BUS2SC(udev->bus);
3124760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
3125760bc48eSAndrew Thompson 	struct usb_pipe_methods *methods;
312602ac6454SAndrew Thompson 	uhci_qh_t *qh;
312702ac6454SAndrew Thompson 
312802ac6454SAndrew Thompson 	DPRINTF("\n");
312902ac6454SAndrew Thompson 
313002ac6454SAndrew Thompson 	USB_BUS_LOCK(udev->bus);
313102ac6454SAndrew Thompson 
313202ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
313302ac6454SAndrew Thompson 
313402ac6454SAndrew Thompson 		if (xfer->xroot->udev == udev) {
313502ac6454SAndrew Thompson 
3136ae60fdfbSAndrew Thompson 			methods = xfer->endpoint->methods;
313702ac6454SAndrew Thompson 			qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
313802ac6454SAndrew Thompson 
313902ac6454SAndrew Thompson 			if (methods == &uhci_device_bulk_methods) {
314002ac6454SAndrew Thompson 				UHCI_APPEND_QH(qh, sc->sc_bulk_p_last);
314102ac6454SAndrew Thompson 				uhci_add_loop(sc);
314202ac6454SAndrew Thompson 				xfer->flags_int.bandwidth_reclaimed = 1;
314302ac6454SAndrew Thompson 			}
314402ac6454SAndrew Thompson 			if (methods == &uhci_device_ctrl_methods) {
314502ac6454SAndrew Thompson 				if (xfer->xroot->udev->speed == USB_SPEED_LOW) {
314602ac6454SAndrew Thompson 					UHCI_APPEND_QH(qh, sc->sc_ls_ctl_p_last);
314702ac6454SAndrew Thompson 				} else {
314802ac6454SAndrew Thompson 					UHCI_APPEND_QH(qh, sc->sc_fs_ctl_p_last);
314902ac6454SAndrew Thompson 				}
315002ac6454SAndrew Thompson 			}
315102ac6454SAndrew Thompson 			if (methods == &uhci_device_intr_methods) {
315202ac6454SAndrew Thompson 				UHCI_APPEND_QH(qh, sc->sc_intr_p_last[xfer->qh_pos]);
315302ac6454SAndrew Thompson 			}
315402ac6454SAndrew Thompson 		}
315502ac6454SAndrew Thompson 	}
315602ac6454SAndrew Thompson 
315702ac6454SAndrew Thompson 	USB_BUS_UNLOCK(udev->bus);
315802ac6454SAndrew Thompson 
315902ac6454SAndrew Thompson 	return;
316002ac6454SAndrew Thompson }
316102ac6454SAndrew Thompson 
316202ac6454SAndrew Thompson static void
3163760bc48eSAndrew Thompson uhci_device_suspend(struct usb_device *udev)
316402ac6454SAndrew Thompson {
316502ac6454SAndrew Thompson 	struct uhci_softc *sc = UHCI_BUS2SC(udev->bus);
3166760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
3167760bc48eSAndrew Thompson 	struct usb_pipe_methods *methods;
316802ac6454SAndrew Thompson 	uhci_qh_t *qh;
316902ac6454SAndrew Thompson 
317002ac6454SAndrew Thompson 	DPRINTF("\n");
317102ac6454SAndrew Thompson 
317202ac6454SAndrew Thompson 	USB_BUS_LOCK(udev->bus);
317302ac6454SAndrew Thompson 
317402ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
317502ac6454SAndrew Thompson 
317602ac6454SAndrew Thompson 		if (xfer->xroot->udev == udev) {
317702ac6454SAndrew Thompson 
3178ae60fdfbSAndrew Thompson 			methods = xfer->endpoint->methods;
317902ac6454SAndrew Thompson 			qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
318002ac6454SAndrew Thompson 
318102ac6454SAndrew Thompson 			if (xfer->flags_int.bandwidth_reclaimed) {
318202ac6454SAndrew Thompson 				xfer->flags_int.bandwidth_reclaimed = 0;
318302ac6454SAndrew Thompson 				uhci_rem_loop(sc);
318402ac6454SAndrew Thompson 			}
318502ac6454SAndrew Thompson 			if (methods == &uhci_device_bulk_methods) {
318602ac6454SAndrew Thompson 				UHCI_REMOVE_QH(qh, sc->sc_bulk_p_last);
318702ac6454SAndrew Thompson 			}
318802ac6454SAndrew Thompson 			if (methods == &uhci_device_ctrl_methods) {
318902ac6454SAndrew Thompson 				if (xfer->xroot->udev->speed == USB_SPEED_LOW) {
319002ac6454SAndrew Thompson 					UHCI_REMOVE_QH(qh, sc->sc_ls_ctl_p_last);
319102ac6454SAndrew Thompson 				} else {
319202ac6454SAndrew Thompson 					UHCI_REMOVE_QH(qh, sc->sc_fs_ctl_p_last);
319302ac6454SAndrew Thompson 				}
319402ac6454SAndrew Thompson 			}
319502ac6454SAndrew Thompson 			if (methods == &uhci_device_intr_methods) {
319602ac6454SAndrew Thompson 				UHCI_REMOVE_QH(qh, sc->sc_intr_p_last[xfer->qh_pos]);
319702ac6454SAndrew Thompson 			}
319802ac6454SAndrew Thompson 		}
319902ac6454SAndrew Thompson 	}
320002ac6454SAndrew Thompson 
320102ac6454SAndrew Thompson 	USB_BUS_UNLOCK(udev->bus);
320202ac6454SAndrew Thompson 
320302ac6454SAndrew Thompson 	return;
320402ac6454SAndrew Thompson }
320502ac6454SAndrew Thompson 
320602ac6454SAndrew Thompson static void
3207760bc48eSAndrew Thompson uhci_set_hw_power(struct usb_bus *bus)
320802ac6454SAndrew Thompson {
320902ac6454SAndrew Thompson 	struct uhci_softc *sc = UHCI_BUS2SC(bus);
321002ac6454SAndrew Thompson 	uint32_t flags;
321102ac6454SAndrew Thompson 
321202ac6454SAndrew Thompson 	DPRINTF("\n");
321302ac6454SAndrew Thompson 
321402ac6454SAndrew Thompson 	USB_BUS_LOCK(bus);
321502ac6454SAndrew Thompson 
321602ac6454SAndrew Thompson 	flags = bus->hw_power_state;
321702ac6454SAndrew Thompson 
321802ac6454SAndrew Thompson 	/*
321902ac6454SAndrew Thompson 	 * WARNING: Some FULL speed USB devices require periodic SOF
322002ac6454SAndrew Thompson 	 * messages! If any USB devices are connected through the
322102ac6454SAndrew Thompson 	 * UHCI, power save will be disabled!
322202ac6454SAndrew Thompson 	 */
322302ac6454SAndrew Thompson 	if (flags & (USB_HW_POWER_CONTROL |
322402ac6454SAndrew Thompson 	    USB_HW_POWER_NON_ROOT_HUB |
322502ac6454SAndrew Thompson 	    USB_HW_POWER_BULK |
322602ac6454SAndrew Thompson 	    USB_HW_POWER_INTERRUPT |
322702ac6454SAndrew Thompson 	    USB_HW_POWER_ISOC)) {
322802ac6454SAndrew Thompson 		DPRINTF("Some USB transfer is "
3229b9c81a5dSAndrew Thompson 		    "active on unit %u.\n",
323002ac6454SAndrew Thompson 		    device_get_unit(sc->sc_bus.bdev));
3231b9c81a5dSAndrew Thompson 		uhci_restart(sc);
323202ac6454SAndrew Thompson 	} else {
3233b9c81a5dSAndrew Thompson 		DPRINTF("Power save on unit %u.\n",
323402ac6454SAndrew Thompson 		    device_get_unit(sc->sc_bus.bdev));
323502ac6454SAndrew Thompson 		UHCICMD(sc, UHCI_CMD_MAXP);
323602ac6454SAndrew Thompson 	}
323702ac6454SAndrew Thompson 
323802ac6454SAndrew Thompson 	USB_BUS_UNLOCK(bus);
323902ac6454SAndrew Thompson 
324002ac6454SAndrew Thompson 	return;
324102ac6454SAndrew Thompson }
324202ac6454SAndrew Thompson 
324302ac6454SAndrew Thompson 
3244760bc48eSAndrew Thompson struct usb_bus_methods uhci_bus_methods =
324502ac6454SAndrew Thompson {
3246ae60fdfbSAndrew Thompson 	.endpoint_init = uhci_ep_init,
324702ac6454SAndrew Thompson 	.xfer_setup = uhci_xfer_setup,
324802ac6454SAndrew Thompson 	.xfer_unsetup = uhci_xfer_unsetup,
324902ac6454SAndrew Thompson 	.get_dma_delay = uhci_get_dma_delay,
325002ac6454SAndrew Thompson 	.device_resume = uhci_device_resume,
325102ac6454SAndrew Thompson 	.device_suspend = uhci_device_suspend,
325202ac6454SAndrew Thompson 	.set_hw_power = uhci_set_hw_power,
325339307315SAndrew Thompson 	.roothub_exec = uhci_roothub_exec,
325402ac6454SAndrew Thompson };
3255