xref: /freebsd/sys/dev/usb/controller/ehci.c (revision 883bb300228d7c1741af6a79af154b7ecf3486e2)
102ac6454SAndrew Thompson /*-
202ac6454SAndrew Thompson  * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
302ac6454SAndrew Thompson  * Copyright (c) 2004 The NetBSD Foundation, Inc. All rights reserved.
402ac6454SAndrew Thompson  * Copyright (c) 2004 Lennart Augustsson. All rights reserved.
502ac6454SAndrew Thompson  * Copyright (c) 2004 Charles M. Hannum. All rights reserved.
602ac6454SAndrew Thompson  *
702ac6454SAndrew Thompson  * Redistribution and use in source and binary forms, with or without
802ac6454SAndrew Thompson  * modification, are permitted provided that the following conditions
902ac6454SAndrew Thompson  * are met:
1002ac6454SAndrew Thompson  * 1. Redistributions of source code must retain the above copyright
1102ac6454SAndrew Thompson  *    notice, this list of conditions and the following disclaimer.
1202ac6454SAndrew Thompson  * 2. Redistributions in binary form must reproduce the above copyright
1302ac6454SAndrew Thompson  *    notice, this list of conditions and the following disclaimer in the
1402ac6454SAndrew Thompson  *    documentation and/or other materials provided with the distribution.
1502ac6454SAndrew Thompson  *
1602ac6454SAndrew Thompson  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1702ac6454SAndrew Thompson  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1802ac6454SAndrew Thompson  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1902ac6454SAndrew Thompson  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2002ac6454SAndrew Thompson  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2102ac6454SAndrew Thompson  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2202ac6454SAndrew Thompson  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2302ac6454SAndrew Thompson  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2402ac6454SAndrew Thompson  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2502ac6454SAndrew Thompson  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2602ac6454SAndrew Thompson  * SUCH DAMAGE.
2702ac6454SAndrew Thompson  */
2802ac6454SAndrew Thompson 
2902ac6454SAndrew Thompson /*
3002ac6454SAndrew Thompson  * USB Enhanced Host Controller Driver, a.k.a. USB 2.0 controller.
3102ac6454SAndrew Thompson  *
3202ac6454SAndrew Thompson  * The EHCI 0.96 spec can be found at
3302ac6454SAndrew Thompson  * http://developer.intel.com/technology/usb/download/ehci-r096.pdf
3402ac6454SAndrew Thompson  * The EHCI 1.0 spec can be found at
3502ac6454SAndrew Thompson  * http://developer.intel.com/technology/usb/download/ehci-r10.pdf
3602ac6454SAndrew Thompson  * and the USB 2.0 spec at
3702ac6454SAndrew Thompson  * http://www.usb.org/developers/docs/usb_20.zip
3802ac6454SAndrew Thompson  *
3902ac6454SAndrew Thompson  */
4002ac6454SAndrew Thompson 
4102ac6454SAndrew Thompson /*
4202ac6454SAndrew Thompson  * TODO:
4302ac6454SAndrew Thompson  * 1) command failures are not recovered correctly
4402ac6454SAndrew Thompson  */
4502ac6454SAndrew Thompson 
4602ac6454SAndrew Thompson #include <sys/cdefs.h>
4702ac6454SAndrew Thompson __FBSDID("$FreeBSD$");
4802ac6454SAndrew Thompson 
49ed6d949aSAndrew Thompson #include <sys/stdint.h>
50ed6d949aSAndrew Thompson #include <sys/stddef.h>
51ed6d949aSAndrew Thompson #include <sys/param.h>
52ed6d949aSAndrew Thompson #include <sys/queue.h>
53ed6d949aSAndrew Thompson #include <sys/types.h>
54ed6d949aSAndrew Thompson #include <sys/systm.h>
55ed6d949aSAndrew Thompson #include <sys/kernel.h>
56ed6d949aSAndrew Thompson #include <sys/bus.h>
57ed6d949aSAndrew Thompson #include <sys/linker_set.h>
58ed6d949aSAndrew Thompson #include <sys/module.h>
59ed6d949aSAndrew Thompson #include <sys/lock.h>
60ed6d949aSAndrew Thompson #include <sys/mutex.h>
61ed6d949aSAndrew Thompson #include <sys/condvar.h>
62ed6d949aSAndrew Thompson #include <sys/sysctl.h>
63ed6d949aSAndrew Thompson #include <sys/sx.h>
64ed6d949aSAndrew Thompson #include <sys/unistd.h>
65ed6d949aSAndrew Thompson #include <sys/callout.h>
66ed6d949aSAndrew Thompson #include <sys/malloc.h>
67ed6d949aSAndrew Thompson #include <sys/priv.h>
68ed6d949aSAndrew Thompson 
6902ac6454SAndrew Thompson #include <dev/usb/usb.h>
70ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h>
7102ac6454SAndrew Thompson 
7202ac6454SAndrew Thompson #define	USB_DEBUG_VAR ehcidebug
7302ac6454SAndrew Thompson 
7402ac6454SAndrew Thompson #include <dev/usb/usb_core.h>
7502ac6454SAndrew Thompson #include <dev/usb/usb_debug.h>
7602ac6454SAndrew Thompson #include <dev/usb/usb_busdma.h>
7702ac6454SAndrew Thompson #include <dev/usb/usb_process.h>
7802ac6454SAndrew Thompson #include <dev/usb/usb_transfer.h>
7902ac6454SAndrew Thompson #include <dev/usb/usb_device.h>
8002ac6454SAndrew Thompson #include <dev/usb/usb_hub.h>
8102ac6454SAndrew Thompson #include <dev/usb/usb_util.h>
8202ac6454SAndrew Thompson 
8302ac6454SAndrew Thompson #include <dev/usb/usb_controller.h>
8402ac6454SAndrew Thompson #include <dev/usb/usb_bus.h>
8502ac6454SAndrew Thompson #include <dev/usb/controller/ehci.h>
861def609aSAndrew Thompson #include <dev/usb/controller/ehcireg.h>
8702ac6454SAndrew Thompson 
88578d0effSAndrew Thompson #define	EHCI_BUS2SC(bus) \
89578d0effSAndrew Thompson    ((ehci_softc_t *)(((uint8_t *)(bus)) - \
90578d0effSAndrew Thompson     ((uint8_t *)&(((ehci_softc_t *)0)->sc_bus))))
9102ac6454SAndrew Thompson 
9202ac6454SAndrew Thompson #if USB_DEBUG
9302ac6454SAndrew Thompson static int ehcidebug = 0;
9402ac6454SAndrew Thompson static int ehcinohighspeed = 0;
9502ac6454SAndrew Thompson 
969360ae40SAndrew Thompson SYSCTL_NODE(_hw_usb, OID_AUTO, ehci, CTLFLAG_RW, 0, "USB ehci");
979360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_ehci, OID_AUTO, debug, CTLFLAG_RW,
9802ac6454SAndrew Thompson     &ehcidebug, 0, "Debug level");
999360ae40SAndrew Thompson SYSCTL_INT(_hw_usb_ehci, OID_AUTO, no_hs, CTLFLAG_RW,
10002ac6454SAndrew Thompson     &ehcinohighspeed, 0, "Disable High Speed USB");
10102ac6454SAndrew Thompson 
10202ac6454SAndrew Thompson static void ehci_dump_regs(ehci_softc_t *sc);
10302ac6454SAndrew Thompson static void ehci_dump_sqh(ehci_softc_t *sc, ehci_qh_t *sqh);
10402ac6454SAndrew Thompson 
10502ac6454SAndrew Thompson #endif
10602ac6454SAndrew Thompson 
10702ac6454SAndrew Thompson #define	EHCI_INTR_ENDPT 1
10802ac6454SAndrew Thompson 
109760bc48eSAndrew Thompson extern struct usb_bus_methods ehci_bus_methods;
110760bc48eSAndrew Thompson extern struct usb_pipe_methods ehci_device_bulk_methods;
111760bc48eSAndrew Thompson extern struct usb_pipe_methods ehci_device_ctrl_methods;
112760bc48eSAndrew Thompson extern struct usb_pipe_methods ehci_device_intr_methods;
113760bc48eSAndrew Thompson extern struct usb_pipe_methods ehci_device_isoc_fs_methods;
114760bc48eSAndrew Thompson extern struct usb_pipe_methods ehci_device_isoc_hs_methods;
11502ac6454SAndrew Thompson 
11630b22abeSAndrew Thompson static void ehci_do_poll(struct usb_bus *);
11730b22abeSAndrew Thompson static void ehci_device_done(struct usb_xfer *, usb_error_t);
11830b22abeSAndrew Thompson static uint8_t ehci_check_transfer(struct usb_xfer *);
11930b22abeSAndrew Thompson static void ehci_timeout(void *);
12030b22abeSAndrew Thompson static void ehci_poll_timeout(void *);
12130b22abeSAndrew Thompson 
12239307315SAndrew Thompson static void ehci_root_intr(ehci_softc_t *sc);
12302ac6454SAndrew Thompson 
12402ac6454SAndrew Thompson struct ehci_std_temp {
12502ac6454SAndrew Thompson 	ehci_softc_t *sc;
126760bc48eSAndrew Thompson 	struct usb_page_cache *pc;
12702ac6454SAndrew Thompson 	ehci_qtd_t *td;
12802ac6454SAndrew Thompson 	ehci_qtd_t *td_next;
12902ac6454SAndrew Thompson 	uint32_t average;
13002ac6454SAndrew Thompson 	uint32_t qtd_status;
13102ac6454SAndrew Thompson 	uint32_t len;
13202ac6454SAndrew Thompson 	uint16_t max_frame_size;
13302ac6454SAndrew Thompson 	uint8_t	shortpkt;
13402ac6454SAndrew Thompson 	uint8_t	auto_data_toggle;
13502ac6454SAndrew Thompson 	uint8_t	setup_alt_next;
1360f7d4548SAndrew Thompson 	uint8_t	last_frame;
137c8a14b91SAndrew Thompson 	uint8_t can_use_next;
13802ac6454SAndrew Thompson };
13902ac6454SAndrew Thompson 
14002ac6454SAndrew Thompson void
141e0a69b51SAndrew Thompson ehci_iterate_hw_softc(struct usb_bus *bus, usb_bus_mem_sub_cb_t *cb)
14202ac6454SAndrew Thompson {
14302ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(bus);
14402ac6454SAndrew Thompson 	uint32_t i;
14502ac6454SAndrew Thompson 
14602ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.pframes_pc, &sc->sc_hw.pframes_pg,
14702ac6454SAndrew Thompson 	    sizeof(uint32_t) * EHCI_FRAMELIST_COUNT, EHCI_FRAMELIST_ALIGN);
14802ac6454SAndrew Thompson 
14902ac6454SAndrew Thompson 	cb(bus, &sc->sc_hw.async_start_pc, &sc->sc_hw.async_start_pg,
15002ac6454SAndrew Thompson 	    sizeof(ehci_qh_t), EHCI_QH_ALIGN);
15102ac6454SAndrew Thompson 
15202ac6454SAndrew Thompson 	for (i = 0; i != EHCI_VIRTUAL_FRAMELIST_COUNT; i++) {
15302ac6454SAndrew Thompson 		cb(bus, sc->sc_hw.intr_start_pc + i,
15402ac6454SAndrew Thompson 		    sc->sc_hw.intr_start_pg + i,
15502ac6454SAndrew Thompson 		    sizeof(ehci_qh_t), EHCI_QH_ALIGN);
15602ac6454SAndrew Thompson 	}
15702ac6454SAndrew Thompson 
15802ac6454SAndrew Thompson 	for (i = 0; i != EHCI_VIRTUAL_FRAMELIST_COUNT; i++) {
15902ac6454SAndrew Thompson 		cb(bus, sc->sc_hw.isoc_hs_start_pc + i,
16002ac6454SAndrew Thompson 		    sc->sc_hw.isoc_hs_start_pg + i,
16102ac6454SAndrew Thompson 		    sizeof(ehci_itd_t), EHCI_ITD_ALIGN);
16202ac6454SAndrew Thompson 	}
16302ac6454SAndrew Thompson 
16402ac6454SAndrew Thompson 	for (i = 0; i != EHCI_VIRTUAL_FRAMELIST_COUNT; i++) {
16502ac6454SAndrew Thompson 		cb(bus, sc->sc_hw.isoc_fs_start_pc + i,
16602ac6454SAndrew Thompson 		    sc->sc_hw.isoc_fs_start_pg + i,
16702ac6454SAndrew Thompson 		    sizeof(ehci_sitd_t), EHCI_SITD_ALIGN);
16802ac6454SAndrew Thompson 	}
16902ac6454SAndrew Thompson }
17002ac6454SAndrew Thompson 
171e0a69b51SAndrew Thompson usb_error_t
172e55e1ebcSAndrew Thompson ehci_reset(ehci_softc_t *sc)
17302ac6454SAndrew Thompson {
17402ac6454SAndrew Thompson 	uint32_t hcr;
175e55e1ebcSAndrew Thompson 	int i;
176e55e1ebcSAndrew Thompson 
177e55e1ebcSAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, EHCI_CMD_HCRESET);
178e55e1ebcSAndrew Thompson 	for (i = 0; i < 100; i++) {
179a593f6b8SAndrew Thompson 		usb_pause_mtx(NULL, hz / 1000);
180e55e1ebcSAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBCMD) & EHCI_CMD_HCRESET;
181e55e1ebcSAndrew Thompson 		if (!hcr) {
182e55e1ebcSAndrew Thompson 			if (sc->sc_flags & (EHCI_SCFLG_SETMODE | EHCI_SCFLG_BIGEMMIO)) {
183e55e1ebcSAndrew Thompson 				/*
184e55e1ebcSAndrew Thompson 				 * Force USBMODE as requested.  Controllers
185e55e1ebcSAndrew Thompson 				 * may have multiple operating modes.
186e55e1ebcSAndrew Thompson 				 */
187e55e1ebcSAndrew Thompson 				uint32_t usbmode = EOREAD4(sc, EHCI_USBMODE);
188e55e1ebcSAndrew Thompson 				if (sc->sc_flags & EHCI_SCFLG_SETMODE) {
189e55e1ebcSAndrew Thompson 					usbmode = (usbmode &~ EHCI_UM_CM) | EHCI_UM_CM_HOST;
190e55e1ebcSAndrew Thompson 					device_printf(sc->sc_bus.bdev,
191e55e1ebcSAndrew Thompson 					    "set host controller mode\n");
192e55e1ebcSAndrew Thompson 				}
193e55e1ebcSAndrew Thompson 				if (sc->sc_flags & EHCI_SCFLG_BIGEMMIO) {
194e55e1ebcSAndrew Thompson 					usbmode = (usbmode &~ EHCI_UM_ES) | EHCI_UM_ES_BE;
195e55e1ebcSAndrew Thompson 					device_printf(sc->sc_bus.bdev,
196e55e1ebcSAndrew Thompson 					    "set big-endian mode\n");
197e55e1ebcSAndrew Thompson 				}
198e55e1ebcSAndrew Thompson 				EOWRITE4(sc,  EHCI_USBMODE, usbmode);
199e55e1ebcSAndrew Thompson 			}
200e55e1ebcSAndrew Thompson 			return (0);
201e55e1ebcSAndrew Thompson 		}
202e55e1ebcSAndrew Thompson 	}
203e55e1ebcSAndrew Thompson 	device_printf(sc->sc_bus.bdev, "reset timeout\n");
204e55e1ebcSAndrew Thompson 	return (USB_ERR_IOERROR);
205e55e1ebcSAndrew Thompson }
206e55e1ebcSAndrew Thompson 
207e0a69b51SAndrew Thompson static usb_error_t
208e55e1ebcSAndrew Thompson ehci_hcreset(ehci_softc_t *sc)
209e55e1ebcSAndrew Thompson {
210e55e1ebcSAndrew Thompson 	uint32_t hcr;
211e55e1ebcSAndrew Thompson 	int i;
21202ac6454SAndrew Thompson 
21302ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, 0);	/* Halt controller */
214e55e1ebcSAndrew Thompson 	for (i = 0; i < 100; i++) {
215a593f6b8SAndrew Thompson 		usb_pause_mtx(NULL, hz / 1000);
216e55e1ebcSAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBSTS) & EHCI_STS_HCH;
217e55e1ebcSAndrew Thompson 		if (hcr)
21802ac6454SAndrew Thompson 			break;
21902ac6454SAndrew Thompson 	}
220e55e1ebcSAndrew Thompson 	if (!hcr)
22102ac6454SAndrew Thompson 		/*
22202ac6454SAndrew Thompson                  * Fall through and try reset anyway even though
22302ac6454SAndrew Thompson                  * Table 2-9 in the EHCI spec says this will result
22402ac6454SAndrew Thompson                  * in undefined behavior.
22502ac6454SAndrew Thompson                  */
226e55e1ebcSAndrew Thompson 		device_printf(sc->sc_bus.bdev, "stop timeout\n");
22702ac6454SAndrew Thompson 
228e55e1ebcSAndrew Thompson 	return ehci_reset(sc);
22902ac6454SAndrew Thompson }
23002ac6454SAndrew Thompson 
231e0a69b51SAndrew Thompson usb_error_t
23202ac6454SAndrew Thompson ehci_init(ehci_softc_t *sc)
23302ac6454SAndrew Thompson {
234760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
23502ac6454SAndrew Thompson 	uint32_t version;
23602ac6454SAndrew Thompson 	uint32_t sparams;
23702ac6454SAndrew Thompson 	uint32_t cparams;
23802ac6454SAndrew Thompson 	uint32_t hcr;
23902ac6454SAndrew Thompson 	uint16_t i;
24002ac6454SAndrew Thompson 	uint16_t x;
24102ac6454SAndrew Thompson 	uint16_t y;
24202ac6454SAndrew Thompson 	uint16_t bit;
243e0a69b51SAndrew Thompson 	usb_error_t err = 0;
24402ac6454SAndrew Thompson 
24502ac6454SAndrew Thompson 	DPRINTF("start\n");
24602ac6454SAndrew Thompson 
247a593f6b8SAndrew Thompson 	usb_callout_init_mtx(&sc->sc_tmo_pcd, &sc->sc_bus.bus_mtx, 0);
24830b22abeSAndrew Thompson 	usb_callout_init_mtx(&sc->sc_tmo_poll, &sc->sc_bus.bus_mtx, 0);
24902ac6454SAndrew Thompson 
25002ac6454SAndrew Thompson #if USB_DEBUG
25102ac6454SAndrew Thompson 	if (ehcidebug > 2) {
25202ac6454SAndrew Thompson 		ehci_dump_regs(sc);
25302ac6454SAndrew Thompson 	}
25402ac6454SAndrew Thompson #endif
25502ac6454SAndrew Thompson 
25602ac6454SAndrew Thompson 	sc->sc_offs = EREAD1(sc, EHCI_CAPLENGTH);
25702ac6454SAndrew Thompson 
25802ac6454SAndrew Thompson 	version = EREAD2(sc, EHCI_HCIVERSION);
25902ac6454SAndrew Thompson 	device_printf(sc->sc_bus.bdev, "EHCI version %x.%x\n",
26002ac6454SAndrew Thompson 	    version >> 8, version & 0xff);
26102ac6454SAndrew Thompson 
26202ac6454SAndrew Thompson 	sparams = EREAD4(sc, EHCI_HCSPARAMS);
26302ac6454SAndrew Thompson 	DPRINTF("sparams=0x%x\n", sparams);
26402ac6454SAndrew Thompson 
26502ac6454SAndrew Thompson 	sc->sc_noport = EHCI_HCS_N_PORTS(sparams);
26602ac6454SAndrew Thompson 	cparams = EREAD4(sc, EHCI_HCCPARAMS);
26702ac6454SAndrew Thompson 	DPRINTF("cparams=0x%x\n", cparams);
26802ac6454SAndrew Thompson 
26902ac6454SAndrew Thompson 	if (EHCI_HCC_64BIT(cparams)) {
27002ac6454SAndrew Thompson 		DPRINTF("HCC uses 64-bit structures\n");
27102ac6454SAndrew Thompson 
27202ac6454SAndrew Thompson 		/* MUST clear segment register if 64 bit capable */
27302ac6454SAndrew Thompson 		EWRITE4(sc, EHCI_CTRLDSSEGMENT, 0);
27402ac6454SAndrew Thompson 	}
27502ac6454SAndrew Thompson 	sc->sc_bus.usbrev = USB_REV_2_0;
27602ac6454SAndrew Thompson 
27702ac6454SAndrew Thompson 	/* Reset the controller */
27802ac6454SAndrew Thompson 	DPRINTF("%s: resetting\n", device_get_nameunit(sc->sc_bus.bdev));
27902ac6454SAndrew Thompson 
280e55e1ebcSAndrew Thompson 	err = ehci_hcreset(sc);
28102ac6454SAndrew Thompson 	if (err) {
28202ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev, "reset timeout\n");
28302ac6454SAndrew Thompson 		return (err);
28402ac6454SAndrew Thompson 	}
28502ac6454SAndrew Thompson 	/*
28602ac6454SAndrew Thompson 	 * use current frame-list-size selection 0: 1024*4 bytes 1:  512*4
28702ac6454SAndrew Thompson 	 * bytes 2:  256*4 bytes 3:      unknown
28802ac6454SAndrew Thompson 	 */
28902ac6454SAndrew Thompson 	if (EHCI_CMD_FLS(EOREAD4(sc, EHCI_USBCMD)) == 3) {
29002ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev, "invalid frame-list-size\n");
29102ac6454SAndrew Thompson 		return (USB_ERR_IOERROR);
29202ac6454SAndrew Thompson 	}
29302ac6454SAndrew Thompson 	/* set up the bus struct */
29402ac6454SAndrew Thompson 	sc->sc_bus.methods = &ehci_bus_methods;
29502ac6454SAndrew Thompson 
29602ac6454SAndrew Thompson 	sc->sc_eintrs = EHCI_NORMAL_INTRS;
29702ac6454SAndrew Thompson 
29802ac6454SAndrew Thompson 	for (i = 0; i < EHCI_VIRTUAL_FRAMELIST_COUNT; i++) {
29902ac6454SAndrew Thompson 		ehci_qh_t *qh;
30002ac6454SAndrew Thompson 
301a593f6b8SAndrew Thompson 		usbd_get_page(sc->sc_hw.intr_start_pc + i, 0, &buf_res);
30202ac6454SAndrew Thompson 
30302ac6454SAndrew Thompson 		qh = buf_res.buffer;
30402ac6454SAndrew Thompson 
30502ac6454SAndrew Thompson 		/* initialize page cache pointer */
30602ac6454SAndrew Thompson 
30702ac6454SAndrew Thompson 		qh->page_cache = sc->sc_hw.intr_start_pc + i;
30802ac6454SAndrew Thompson 
30902ac6454SAndrew Thompson 		/* store a pointer to queue head */
31002ac6454SAndrew Thompson 
31102ac6454SAndrew Thompson 		sc->sc_intr_p_last[i] = qh;
31202ac6454SAndrew Thompson 
31302ac6454SAndrew Thompson 		qh->qh_self =
314e55e1ebcSAndrew Thompson 		    htohc32(sc, buf_res.physaddr) |
315e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_QH);
31602ac6454SAndrew Thompson 
31702ac6454SAndrew Thompson 		qh->qh_endp =
318e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_QH_SET_EPS(EHCI_QH_SPEED_HIGH));
31902ac6454SAndrew Thompson 		qh->qh_endphub =
320e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_QH_SET_MULT(1));
32102ac6454SAndrew Thompson 		qh->qh_curqtd = 0;
32202ac6454SAndrew Thompson 
32302ac6454SAndrew Thompson 		qh->qh_qtd.qtd_next =
324e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_TERMINATE);
32502ac6454SAndrew Thompson 		qh->qh_qtd.qtd_altnext =
326e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_TERMINATE);
32702ac6454SAndrew Thompson 		qh->qh_qtd.qtd_status =
328e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_QTD_HALTED);
32902ac6454SAndrew Thompson 	}
33002ac6454SAndrew Thompson 
33102ac6454SAndrew Thompson 	/*
33202ac6454SAndrew Thompson 	 * the QHs are arranged to give poll intervals that are
33302ac6454SAndrew Thompson 	 * powers of 2 times 1ms
33402ac6454SAndrew Thompson 	 */
33502ac6454SAndrew Thompson 	bit = EHCI_VIRTUAL_FRAMELIST_COUNT / 2;
33602ac6454SAndrew Thompson 	while (bit) {
33702ac6454SAndrew Thompson 		x = bit;
33802ac6454SAndrew Thompson 		while (x & bit) {
33902ac6454SAndrew Thompson 			ehci_qh_t *qh_x;
34002ac6454SAndrew Thompson 			ehci_qh_t *qh_y;
34102ac6454SAndrew Thompson 
34202ac6454SAndrew Thompson 			y = (x ^ bit) | (bit / 2);
34302ac6454SAndrew Thompson 
34402ac6454SAndrew Thompson 			qh_x = sc->sc_intr_p_last[x];
34502ac6454SAndrew Thompson 			qh_y = sc->sc_intr_p_last[y];
34602ac6454SAndrew Thompson 
34702ac6454SAndrew Thompson 			/*
34802ac6454SAndrew Thompson 			 * the next QH has half the poll interval
34902ac6454SAndrew Thompson 			 */
35002ac6454SAndrew Thompson 			qh_x->qh_link = qh_y->qh_self;
35102ac6454SAndrew Thompson 
35202ac6454SAndrew Thompson 			x++;
35302ac6454SAndrew Thompson 		}
35402ac6454SAndrew Thompson 		bit >>= 1;
35502ac6454SAndrew Thompson 	}
35602ac6454SAndrew Thompson 
35702ac6454SAndrew Thompson 	if (1) {
35802ac6454SAndrew Thompson 		ehci_qh_t *qh;
35902ac6454SAndrew Thompson 
36002ac6454SAndrew Thompson 		qh = sc->sc_intr_p_last[0];
36102ac6454SAndrew Thompson 
36202ac6454SAndrew Thompson 		/* the last (1ms) QH terminates */
363e55e1ebcSAndrew Thompson 		qh->qh_link = htohc32(sc, EHCI_LINK_TERMINATE);
36402ac6454SAndrew Thompson 	}
36502ac6454SAndrew Thompson 	for (i = 0; i < EHCI_VIRTUAL_FRAMELIST_COUNT; i++) {
36602ac6454SAndrew Thompson 		ehci_sitd_t *sitd;
36702ac6454SAndrew Thompson 		ehci_itd_t *itd;
36802ac6454SAndrew Thompson 
369a593f6b8SAndrew Thompson 		usbd_get_page(sc->sc_hw.isoc_fs_start_pc + i, 0, &buf_res);
37002ac6454SAndrew Thompson 
37102ac6454SAndrew Thompson 		sitd = buf_res.buffer;
37202ac6454SAndrew Thompson 
37302ac6454SAndrew Thompson 		/* initialize page cache pointer */
37402ac6454SAndrew Thompson 
37502ac6454SAndrew Thompson 		sitd->page_cache = sc->sc_hw.isoc_fs_start_pc + i;
37602ac6454SAndrew Thompson 
37702ac6454SAndrew Thompson 		/* store a pointer to the transfer descriptor */
37802ac6454SAndrew Thompson 
37902ac6454SAndrew Thompson 		sc->sc_isoc_fs_p_last[i] = sitd;
38002ac6454SAndrew Thompson 
38102ac6454SAndrew Thompson 		/* initialize full speed isochronous */
38202ac6454SAndrew Thompson 
38302ac6454SAndrew Thompson 		sitd->sitd_self =
384e55e1ebcSAndrew Thompson 		    htohc32(sc, buf_res.physaddr) |
385e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_SITD);
38602ac6454SAndrew Thompson 
38702ac6454SAndrew Thompson 		sitd->sitd_back =
388e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_TERMINATE);
38902ac6454SAndrew Thompson 
39002ac6454SAndrew Thompson 		sitd->sitd_next =
39102ac6454SAndrew Thompson 		    sc->sc_intr_p_last[i | (EHCI_VIRTUAL_FRAMELIST_COUNT / 2)]->qh_self;
39202ac6454SAndrew Thompson 
39302ac6454SAndrew Thompson 
394a593f6b8SAndrew Thompson 		usbd_get_page(sc->sc_hw.isoc_hs_start_pc + i, 0, &buf_res);
39502ac6454SAndrew Thompson 
39602ac6454SAndrew Thompson 		itd = buf_res.buffer;
39702ac6454SAndrew Thompson 
39802ac6454SAndrew Thompson 		/* initialize page cache pointer */
39902ac6454SAndrew Thompson 
40002ac6454SAndrew Thompson 		itd->page_cache = sc->sc_hw.isoc_hs_start_pc + i;
40102ac6454SAndrew Thompson 
40202ac6454SAndrew Thompson 		/* store a pointer to the transfer descriptor */
40302ac6454SAndrew Thompson 
40402ac6454SAndrew Thompson 		sc->sc_isoc_hs_p_last[i] = itd;
40502ac6454SAndrew Thompson 
40602ac6454SAndrew Thompson 		/* initialize high speed isochronous */
40702ac6454SAndrew Thompson 
40802ac6454SAndrew Thompson 		itd->itd_self =
409e55e1ebcSAndrew Thompson 		    htohc32(sc, buf_res.physaddr) |
410e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_ITD);
41102ac6454SAndrew Thompson 
41202ac6454SAndrew Thompson 		itd->itd_next =
41302ac6454SAndrew Thompson 		    sitd->sitd_self;
41402ac6454SAndrew Thompson 	}
41502ac6454SAndrew Thompson 
416a593f6b8SAndrew Thompson 	usbd_get_page(&sc->sc_hw.pframes_pc, 0, &buf_res);
41702ac6454SAndrew Thompson 
41802ac6454SAndrew Thompson 	if (1) {
41902ac6454SAndrew Thompson 		uint32_t *pframes;
42002ac6454SAndrew Thompson 
42102ac6454SAndrew Thompson 		pframes = buf_res.buffer;
42202ac6454SAndrew Thompson 
42302ac6454SAndrew Thompson 		/*
42402ac6454SAndrew Thompson 		 * execution order:
42502ac6454SAndrew Thompson 		 * pframes -> high speed isochronous ->
42602ac6454SAndrew Thompson 		 *    full speed isochronous -> interrupt QH's
42702ac6454SAndrew Thompson 		 */
42802ac6454SAndrew Thompson 		for (i = 0; i < EHCI_FRAMELIST_COUNT; i++) {
42902ac6454SAndrew Thompson 			pframes[i] = sc->sc_isoc_hs_p_last
43002ac6454SAndrew Thompson 			    [i & (EHCI_VIRTUAL_FRAMELIST_COUNT - 1)]->itd_self;
43102ac6454SAndrew Thompson 		}
43202ac6454SAndrew Thompson 	}
43302ac6454SAndrew Thompson 	/* setup sync list pointer */
43402ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_PERIODICLISTBASE, buf_res.physaddr);
43502ac6454SAndrew Thompson 
436a593f6b8SAndrew Thompson 	usbd_get_page(&sc->sc_hw.async_start_pc, 0, &buf_res);
43702ac6454SAndrew Thompson 
43802ac6454SAndrew Thompson 	if (1) {
43902ac6454SAndrew Thompson 
44002ac6454SAndrew Thompson 		ehci_qh_t *qh;
44102ac6454SAndrew Thompson 
44202ac6454SAndrew Thompson 		qh = buf_res.buffer;
44302ac6454SAndrew Thompson 
44402ac6454SAndrew Thompson 		/* initialize page cache pointer */
44502ac6454SAndrew Thompson 
44602ac6454SAndrew Thompson 		qh->page_cache = &sc->sc_hw.async_start_pc;
44702ac6454SAndrew Thompson 
44802ac6454SAndrew Thompson 		/* store a pointer to the queue head */
44902ac6454SAndrew Thompson 
45002ac6454SAndrew Thompson 		sc->sc_async_p_last = qh;
45102ac6454SAndrew Thompson 
45202ac6454SAndrew Thompson 		/* init dummy QH that starts the async list */
45302ac6454SAndrew Thompson 
45402ac6454SAndrew Thompson 		qh->qh_self =
455e55e1ebcSAndrew Thompson 		    htohc32(sc, buf_res.physaddr) |
456e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_LINK_QH);
45702ac6454SAndrew Thompson 
45802ac6454SAndrew Thompson 		/* fill the QH */
45902ac6454SAndrew Thompson 		qh->qh_endp =
460e55e1ebcSAndrew Thompson 		    htohc32(sc, EHCI_QH_SET_EPS(EHCI_QH_SPEED_HIGH) | EHCI_QH_HRECL);
461e55e1ebcSAndrew Thompson 		qh->qh_endphub = htohc32(sc, EHCI_QH_SET_MULT(1));
46202ac6454SAndrew Thompson 		qh->qh_link = qh->qh_self;
46302ac6454SAndrew Thompson 		qh->qh_curqtd = 0;
46402ac6454SAndrew Thompson 
46502ac6454SAndrew Thompson 		/* fill the overlay qTD */
466e55e1ebcSAndrew Thompson 		qh->qh_qtd.qtd_next = htohc32(sc, EHCI_LINK_TERMINATE);
467e55e1ebcSAndrew Thompson 		qh->qh_qtd.qtd_altnext = htohc32(sc, EHCI_LINK_TERMINATE);
468e55e1ebcSAndrew Thompson 		qh->qh_qtd.qtd_status = htohc32(sc, EHCI_QTD_HALTED);
46902ac6454SAndrew Thompson 	}
47002ac6454SAndrew Thompson 	/* flush all cache into memory */
47102ac6454SAndrew Thompson 
472a593f6b8SAndrew Thompson 	usb_bus_mem_flush_all(&sc->sc_bus, &ehci_iterate_hw_softc);
47302ac6454SAndrew Thompson 
47402ac6454SAndrew Thompson #if USB_DEBUG
47502ac6454SAndrew Thompson 	if (ehcidebug) {
47602ac6454SAndrew Thompson 		ehci_dump_sqh(sc, sc->sc_async_p_last);
47702ac6454SAndrew Thompson 	}
47802ac6454SAndrew Thompson #endif
47902ac6454SAndrew Thompson 
48002ac6454SAndrew Thompson 	/* setup async list pointer */
48102ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_ASYNCLISTADDR, buf_res.physaddr | EHCI_LINK_QH);
48202ac6454SAndrew Thompson 
48302ac6454SAndrew Thompson 
48402ac6454SAndrew Thompson 	/* enable interrupts */
48502ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
48602ac6454SAndrew Thompson 
48702ac6454SAndrew Thompson 	/* turn on controller */
48802ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD,
48902ac6454SAndrew Thompson 	    EHCI_CMD_ITC_1 |		/* 1 microframes interrupt delay */
49002ac6454SAndrew Thompson 	    (EOREAD4(sc, EHCI_USBCMD) & EHCI_CMD_FLS_M) |
49102ac6454SAndrew Thompson 	    EHCI_CMD_ASE |
49202ac6454SAndrew Thompson 	    EHCI_CMD_PSE |
49302ac6454SAndrew Thompson 	    EHCI_CMD_RS);
49402ac6454SAndrew Thompson 
49502ac6454SAndrew Thompson 	/* Take over port ownership */
49602ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_CONFIGFLAG, EHCI_CONF_CF);
49702ac6454SAndrew Thompson 
49802ac6454SAndrew Thompson 	for (i = 0; i < 100; i++) {
499a593f6b8SAndrew Thompson 		usb_pause_mtx(NULL, hz / 1000);
50002ac6454SAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBSTS) & EHCI_STS_HCH;
50102ac6454SAndrew Thompson 		if (!hcr) {
50202ac6454SAndrew Thompson 			break;
50302ac6454SAndrew Thompson 		}
50402ac6454SAndrew Thompson 	}
50502ac6454SAndrew Thompson 	if (hcr) {
50602ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev, "run timeout\n");
50702ac6454SAndrew Thompson 		return (USB_ERR_IOERROR);
50802ac6454SAndrew Thompson 	}
50902ac6454SAndrew Thompson 
51002ac6454SAndrew Thompson 	if (!err) {
51102ac6454SAndrew Thompson 		/* catch any lost interrupts */
51202ac6454SAndrew Thompson 		ehci_do_poll(&sc->sc_bus);
51302ac6454SAndrew Thompson 	}
51402ac6454SAndrew Thompson 	return (err);
51502ac6454SAndrew Thompson }
51602ac6454SAndrew Thompson 
51702ac6454SAndrew Thompson /*
51802ac6454SAndrew Thompson  * shut down the controller when the system is going down
51902ac6454SAndrew Thompson  */
52002ac6454SAndrew Thompson void
52102ac6454SAndrew Thompson ehci_detach(ehci_softc_t *sc)
52202ac6454SAndrew Thompson {
52302ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
52402ac6454SAndrew Thompson 
525a593f6b8SAndrew Thompson 	usb_callout_stop(&sc->sc_tmo_pcd);
52630b22abeSAndrew Thompson 	usb_callout_stop(&sc->sc_tmo_poll);
52702ac6454SAndrew Thompson 
52802ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
529e55e1ebcSAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
53002ac6454SAndrew Thompson 
531e55e1ebcSAndrew Thompson 	if (ehci_hcreset(sc)) {
53202ac6454SAndrew Thompson 		DPRINTF("reset failed!\n");
53302ac6454SAndrew Thompson 	}
53402ac6454SAndrew Thompson 
53502ac6454SAndrew Thompson 	/* XXX let stray task complete */
536a593f6b8SAndrew Thompson 	usb_pause_mtx(NULL, hz / 20);
53702ac6454SAndrew Thompson 
538a593f6b8SAndrew Thompson 	usb_callout_drain(&sc->sc_tmo_pcd);
53930b22abeSAndrew Thompson 	usb_callout_drain(&sc->sc_tmo_poll);
54002ac6454SAndrew Thompson }
54102ac6454SAndrew Thompson 
54202ac6454SAndrew Thompson void
54302ac6454SAndrew Thompson ehci_suspend(ehci_softc_t *sc)
54402ac6454SAndrew Thompson {
54502ac6454SAndrew Thompson 	uint32_t cmd;
54602ac6454SAndrew Thompson 	uint32_t hcr;
54702ac6454SAndrew Thompson 	uint8_t i;
54802ac6454SAndrew Thompson 
54902ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
55002ac6454SAndrew Thompson 
55102ac6454SAndrew Thompson 	for (i = 1; i <= sc->sc_noport; i++) {
55202ac6454SAndrew Thompson 		cmd = EOREAD4(sc, EHCI_PORTSC(i));
55302ac6454SAndrew Thompson 		if (((cmd & EHCI_PS_PO) == 0) &&
55402ac6454SAndrew Thompson 		    ((cmd & EHCI_PS_PE) == EHCI_PS_PE)) {
55502ac6454SAndrew Thompson 			EOWRITE4(sc, EHCI_PORTSC(i),
55602ac6454SAndrew Thompson 			    cmd | EHCI_PS_SUSP);
55702ac6454SAndrew Thompson 		}
55802ac6454SAndrew Thompson 	}
55902ac6454SAndrew Thompson 
56002ac6454SAndrew Thompson 	sc->sc_cmd = EOREAD4(sc, EHCI_USBCMD);
56102ac6454SAndrew Thompson 
56202ac6454SAndrew Thompson 	cmd = sc->sc_cmd & ~(EHCI_CMD_ASE | EHCI_CMD_PSE);
56302ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, cmd);
56402ac6454SAndrew Thompson 
56502ac6454SAndrew Thompson 	for (i = 0; i < 100; i++) {
56602ac6454SAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBSTS) &
56702ac6454SAndrew Thompson 		    (EHCI_STS_ASS | EHCI_STS_PSS);
56802ac6454SAndrew Thompson 
56902ac6454SAndrew Thompson 		if (hcr == 0) {
57002ac6454SAndrew Thompson 			break;
57102ac6454SAndrew Thompson 		}
572a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 1000);
57302ac6454SAndrew Thompson 	}
57402ac6454SAndrew Thompson 
57502ac6454SAndrew Thompson 	if (hcr != 0) {
57602ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev, "reset timeout\n");
57702ac6454SAndrew Thompson 	}
57802ac6454SAndrew Thompson 	cmd &= ~EHCI_CMD_RS;
57902ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, cmd);
58002ac6454SAndrew Thompson 
58102ac6454SAndrew Thompson 	for (i = 0; i < 100; i++) {
58202ac6454SAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBSTS) & EHCI_STS_HCH;
58302ac6454SAndrew Thompson 		if (hcr == EHCI_STS_HCH) {
58402ac6454SAndrew Thompson 			break;
58502ac6454SAndrew Thompson 		}
586a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 1000);
58702ac6454SAndrew Thompson 	}
58802ac6454SAndrew Thompson 
58902ac6454SAndrew Thompson 	if (hcr != EHCI_STS_HCH) {
59002ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev,
59102ac6454SAndrew Thompson 		    "config timeout\n");
59202ac6454SAndrew Thompson 	}
59302ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
59402ac6454SAndrew Thompson }
59502ac6454SAndrew Thompson 
59602ac6454SAndrew Thompson void
59702ac6454SAndrew Thompson ehci_resume(ehci_softc_t *sc)
59802ac6454SAndrew Thompson {
599760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
60002ac6454SAndrew Thompson 	uint32_t cmd;
60102ac6454SAndrew Thompson 	uint32_t hcr;
60202ac6454SAndrew Thompson 	uint8_t i;
60302ac6454SAndrew Thompson 
60402ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
60502ac6454SAndrew Thompson 
60602ac6454SAndrew Thompson 	/* restore things in case the bios doesn't */
60702ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_CTRLDSSEGMENT, 0);
60802ac6454SAndrew Thompson 
609a593f6b8SAndrew Thompson 	usbd_get_page(&sc->sc_hw.pframes_pc, 0, &buf_res);
61002ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_PERIODICLISTBASE, buf_res.physaddr);
61102ac6454SAndrew Thompson 
612a593f6b8SAndrew Thompson 	usbd_get_page(&sc->sc_hw.async_start_pc, 0, &buf_res);
61302ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_ASYNCLISTADDR, buf_res.physaddr | EHCI_LINK_QH);
61402ac6454SAndrew Thompson 
61502ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
61602ac6454SAndrew Thompson 
61702ac6454SAndrew Thompson 	hcr = 0;
61802ac6454SAndrew Thompson 	for (i = 1; i <= sc->sc_noport; i++) {
61902ac6454SAndrew Thompson 		cmd = EOREAD4(sc, EHCI_PORTSC(i));
62002ac6454SAndrew Thompson 		if (((cmd & EHCI_PS_PO) == 0) &&
62102ac6454SAndrew Thompson 		    ((cmd & EHCI_PS_SUSP) == EHCI_PS_SUSP)) {
62202ac6454SAndrew Thompson 			EOWRITE4(sc, EHCI_PORTSC(i),
62302ac6454SAndrew Thompson 			    cmd | EHCI_PS_FPR);
62402ac6454SAndrew Thompson 			hcr = 1;
62502ac6454SAndrew Thompson 		}
62602ac6454SAndrew Thompson 	}
62702ac6454SAndrew Thompson 
62802ac6454SAndrew Thompson 	if (hcr) {
629a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx,
63002ac6454SAndrew Thompson 		    USB_MS_TO_TICKS(USB_RESUME_WAIT));
63102ac6454SAndrew Thompson 
63202ac6454SAndrew Thompson 		for (i = 1; i <= sc->sc_noport; i++) {
63302ac6454SAndrew Thompson 			cmd = EOREAD4(sc, EHCI_PORTSC(i));
63402ac6454SAndrew Thompson 			if (((cmd & EHCI_PS_PO) == 0) &&
63502ac6454SAndrew Thompson 			    ((cmd & EHCI_PS_SUSP) == EHCI_PS_SUSP)) {
63602ac6454SAndrew Thompson 				EOWRITE4(sc, EHCI_PORTSC(i),
63702ac6454SAndrew Thompson 				    cmd & ~EHCI_PS_FPR);
63802ac6454SAndrew Thompson 			}
63902ac6454SAndrew Thompson 		}
64002ac6454SAndrew Thompson 	}
64102ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, sc->sc_cmd);
64202ac6454SAndrew Thompson 
64302ac6454SAndrew Thompson 	for (i = 0; i < 100; i++) {
64402ac6454SAndrew Thompson 		hcr = EOREAD4(sc, EHCI_USBSTS) & EHCI_STS_HCH;
64502ac6454SAndrew Thompson 		if (hcr != EHCI_STS_HCH) {
64602ac6454SAndrew Thompson 			break;
64702ac6454SAndrew Thompson 		}
648a593f6b8SAndrew Thompson 		usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 1000);
64902ac6454SAndrew Thompson 	}
65002ac6454SAndrew Thompson 	if (hcr == EHCI_STS_HCH) {
65102ac6454SAndrew Thompson 		device_printf(sc->sc_bus.bdev, "config timeout\n");
65202ac6454SAndrew Thompson 	}
65302ac6454SAndrew Thompson 
65402ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
65502ac6454SAndrew Thompson 
656a593f6b8SAndrew Thompson 	usb_pause_mtx(NULL,
65702ac6454SAndrew Thompson 	    USB_MS_TO_TICKS(USB_RESUME_WAIT));
65802ac6454SAndrew Thompson 
65902ac6454SAndrew Thompson 	/* catch any lost interrupts */
66002ac6454SAndrew Thompson 	ehci_do_poll(&sc->sc_bus);
66102ac6454SAndrew Thompson }
66202ac6454SAndrew Thompson 
66302ac6454SAndrew Thompson void
66402ac6454SAndrew Thompson ehci_shutdown(ehci_softc_t *sc)
66502ac6454SAndrew Thompson {
66602ac6454SAndrew Thompson 	DPRINTF("stopping the HC\n");
66702ac6454SAndrew Thompson 
668e55e1ebcSAndrew Thompson 	if (ehci_hcreset(sc)) {
66902ac6454SAndrew Thompson 		DPRINTF("reset failed!\n");
67002ac6454SAndrew Thompson 	}
67102ac6454SAndrew Thompson }
67202ac6454SAndrew Thompson 
67302ac6454SAndrew Thompson #if USB_DEBUG
67402ac6454SAndrew Thompson static void
67502ac6454SAndrew Thompson ehci_dump_regs(ehci_softc_t *sc)
67602ac6454SAndrew Thompson {
67702ac6454SAndrew Thompson 	uint32_t i;
67802ac6454SAndrew Thompson 
67902ac6454SAndrew Thompson 	i = EOREAD4(sc, EHCI_USBCMD);
68002ac6454SAndrew Thompson 	printf("cmd=0x%08x\n", i);
68102ac6454SAndrew Thompson 
68202ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_1)
68302ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_1\n");
68402ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_2)
68502ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_2\n");
68602ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_4)
68702ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_4\n");
68802ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_8)
68902ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_8\n");
69002ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_16)
69102ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_16\n");
69202ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_32)
69302ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_32\n");
69402ac6454SAndrew Thompson 	if (i & EHCI_CMD_ITC_64)
69502ac6454SAndrew Thompson 		printf(" EHCI_CMD_ITC_64\n");
69602ac6454SAndrew Thompson 	if (i & EHCI_CMD_ASPME)
69702ac6454SAndrew Thompson 		printf(" EHCI_CMD_ASPME\n");
69802ac6454SAndrew Thompson 	if (i & EHCI_CMD_ASPMC)
69902ac6454SAndrew Thompson 		printf(" EHCI_CMD_ASPMC\n");
70002ac6454SAndrew Thompson 	if (i & EHCI_CMD_LHCR)
70102ac6454SAndrew Thompson 		printf(" EHCI_CMD_LHCR\n");
70202ac6454SAndrew Thompson 	if (i & EHCI_CMD_IAAD)
70302ac6454SAndrew Thompson 		printf(" EHCI_CMD_IAAD\n");
70402ac6454SAndrew Thompson 	if (i & EHCI_CMD_ASE)
70502ac6454SAndrew Thompson 		printf(" EHCI_CMD_ASE\n");
70602ac6454SAndrew Thompson 	if (i & EHCI_CMD_PSE)
70702ac6454SAndrew Thompson 		printf(" EHCI_CMD_PSE\n");
70802ac6454SAndrew Thompson 	if (i & EHCI_CMD_FLS_M)
70902ac6454SAndrew Thompson 		printf(" EHCI_CMD_FLS_M\n");
71002ac6454SAndrew Thompson 	if (i & EHCI_CMD_HCRESET)
71102ac6454SAndrew Thompson 		printf(" EHCI_CMD_HCRESET\n");
71202ac6454SAndrew Thompson 	if (i & EHCI_CMD_RS)
71302ac6454SAndrew Thompson 		printf(" EHCI_CMD_RS\n");
71402ac6454SAndrew Thompson 
71502ac6454SAndrew Thompson 	i = EOREAD4(sc, EHCI_USBSTS);
71602ac6454SAndrew Thompson 
71702ac6454SAndrew Thompson 	printf("sts=0x%08x\n", i);
71802ac6454SAndrew Thompson 
71902ac6454SAndrew Thompson 	if (i & EHCI_STS_ASS)
72002ac6454SAndrew Thompson 		printf(" EHCI_STS_ASS\n");
72102ac6454SAndrew Thompson 	if (i & EHCI_STS_PSS)
72202ac6454SAndrew Thompson 		printf(" EHCI_STS_PSS\n");
72302ac6454SAndrew Thompson 	if (i & EHCI_STS_REC)
72402ac6454SAndrew Thompson 		printf(" EHCI_STS_REC\n");
72502ac6454SAndrew Thompson 	if (i & EHCI_STS_HCH)
72602ac6454SAndrew Thompson 		printf(" EHCI_STS_HCH\n");
72702ac6454SAndrew Thompson 	if (i & EHCI_STS_IAA)
72802ac6454SAndrew Thompson 		printf(" EHCI_STS_IAA\n");
72902ac6454SAndrew Thompson 	if (i & EHCI_STS_HSE)
73002ac6454SAndrew Thompson 		printf(" EHCI_STS_HSE\n");
73102ac6454SAndrew Thompson 	if (i & EHCI_STS_FLR)
73202ac6454SAndrew Thompson 		printf(" EHCI_STS_FLR\n");
73302ac6454SAndrew Thompson 	if (i & EHCI_STS_PCD)
73402ac6454SAndrew Thompson 		printf(" EHCI_STS_PCD\n");
73502ac6454SAndrew Thompson 	if (i & EHCI_STS_ERRINT)
73602ac6454SAndrew Thompson 		printf(" EHCI_STS_ERRINT\n");
73702ac6454SAndrew Thompson 	if (i & EHCI_STS_INT)
73802ac6454SAndrew Thompson 		printf(" EHCI_STS_INT\n");
73902ac6454SAndrew Thompson 
74002ac6454SAndrew Thompson 	printf("ien=0x%08x\n",
74102ac6454SAndrew Thompson 	    EOREAD4(sc, EHCI_USBINTR));
74202ac6454SAndrew Thompson 	printf("frindex=0x%08x ctrdsegm=0x%08x periodic=0x%08x async=0x%08x\n",
74302ac6454SAndrew Thompson 	    EOREAD4(sc, EHCI_FRINDEX),
74402ac6454SAndrew Thompson 	    EOREAD4(sc, EHCI_CTRLDSSEGMENT),
74502ac6454SAndrew Thompson 	    EOREAD4(sc, EHCI_PERIODICLISTBASE),
74602ac6454SAndrew Thompson 	    EOREAD4(sc, EHCI_ASYNCLISTADDR));
74702ac6454SAndrew Thompson 	for (i = 1; i <= sc->sc_noport; i++) {
74802ac6454SAndrew Thompson 		printf("port %d status=0x%08x\n", i,
74902ac6454SAndrew Thompson 		    EOREAD4(sc, EHCI_PORTSC(i)));
75002ac6454SAndrew Thompson 	}
75102ac6454SAndrew Thompson }
75202ac6454SAndrew Thompson 
75302ac6454SAndrew Thompson static void
75402ac6454SAndrew Thompson ehci_dump_link(ehci_softc_t *sc, uint32_t link, int type)
75502ac6454SAndrew Thompson {
756e55e1ebcSAndrew Thompson 	link = hc32toh(sc, link);
75702ac6454SAndrew Thompson 	printf("0x%08x", link);
75802ac6454SAndrew Thompson 	if (link & EHCI_LINK_TERMINATE)
75902ac6454SAndrew Thompson 		printf("<T>");
76002ac6454SAndrew Thompson 	else {
76102ac6454SAndrew Thompson 		printf("<");
76202ac6454SAndrew Thompson 		if (type) {
76302ac6454SAndrew Thompson 			switch (EHCI_LINK_TYPE(link)) {
76402ac6454SAndrew Thompson 			case EHCI_LINK_ITD:
76502ac6454SAndrew Thompson 				printf("ITD");
76602ac6454SAndrew Thompson 				break;
76702ac6454SAndrew Thompson 			case EHCI_LINK_QH:
76802ac6454SAndrew Thompson 				printf("QH");
76902ac6454SAndrew Thompson 				break;
77002ac6454SAndrew Thompson 			case EHCI_LINK_SITD:
77102ac6454SAndrew Thompson 				printf("SITD");
77202ac6454SAndrew Thompson 				break;
77302ac6454SAndrew Thompson 			case EHCI_LINK_FSTN:
77402ac6454SAndrew Thompson 				printf("FSTN");
77502ac6454SAndrew Thompson 				break;
77602ac6454SAndrew Thompson 			}
77702ac6454SAndrew Thompson 		}
77802ac6454SAndrew Thompson 		printf(">");
77902ac6454SAndrew Thompson 	}
78002ac6454SAndrew Thompson }
78102ac6454SAndrew Thompson 
78202ac6454SAndrew Thompson static void
78302ac6454SAndrew Thompson ehci_dump_qtd(ehci_softc_t *sc, ehci_qtd_t *qtd)
78402ac6454SAndrew Thompson {
78502ac6454SAndrew Thompson 	uint32_t s;
78602ac6454SAndrew Thompson 
78702ac6454SAndrew Thompson 	printf("  next=");
78802ac6454SAndrew Thompson 	ehci_dump_link(sc, qtd->qtd_next, 0);
78902ac6454SAndrew Thompson 	printf(" altnext=");
79002ac6454SAndrew Thompson 	ehci_dump_link(sc, qtd->qtd_altnext, 0);
79102ac6454SAndrew Thompson 	printf("\n");
792e55e1ebcSAndrew Thompson 	s = hc32toh(sc, qtd->qtd_status);
79302ac6454SAndrew Thompson 	printf("  status=0x%08x: toggle=%d bytes=0x%x ioc=%d c_page=0x%x\n",
79402ac6454SAndrew Thompson 	    s, EHCI_QTD_GET_TOGGLE(s), EHCI_QTD_GET_BYTES(s),
79502ac6454SAndrew Thompson 	    EHCI_QTD_GET_IOC(s), EHCI_QTD_GET_C_PAGE(s));
79602ac6454SAndrew Thompson 	printf("    cerr=%d pid=%d stat=%s%s%s%s%s%s%s%s\n",
79702ac6454SAndrew Thompson 	    EHCI_QTD_GET_CERR(s), EHCI_QTD_GET_PID(s),
79802ac6454SAndrew Thompson 	    (s & EHCI_QTD_ACTIVE) ? "ACTIVE" : "NOT_ACTIVE",
79902ac6454SAndrew Thompson 	    (s & EHCI_QTD_HALTED) ? "-HALTED" : "",
80002ac6454SAndrew Thompson 	    (s & EHCI_QTD_BUFERR) ? "-BUFERR" : "",
80102ac6454SAndrew Thompson 	    (s & EHCI_QTD_BABBLE) ? "-BABBLE" : "",
80202ac6454SAndrew Thompson 	    (s & EHCI_QTD_XACTERR) ? "-XACTERR" : "",
80302ac6454SAndrew Thompson 	    (s & EHCI_QTD_MISSEDMICRO) ? "-MISSED" : "",
80402ac6454SAndrew Thompson 	    (s & EHCI_QTD_SPLITXSTATE) ? "-SPLIT" : "",
80502ac6454SAndrew Thompson 	    (s & EHCI_QTD_PINGSTATE) ? "-PING" : "");
80602ac6454SAndrew Thompson 
80702ac6454SAndrew Thompson 	for (s = 0; s < 5; s++) {
80802ac6454SAndrew Thompson 		printf("  buffer[%d]=0x%08x\n", s,
809e55e1ebcSAndrew Thompson 		    hc32toh(sc, qtd->qtd_buffer[s]));
81002ac6454SAndrew Thompson 	}
81102ac6454SAndrew Thompson 	for (s = 0; s < 5; s++) {
81202ac6454SAndrew Thompson 		printf("  buffer_hi[%d]=0x%08x\n", s,
813e55e1ebcSAndrew Thompson 		    hc32toh(sc, qtd->qtd_buffer_hi[s]));
81402ac6454SAndrew Thompson 	}
81502ac6454SAndrew Thompson }
81602ac6454SAndrew Thompson 
81702ac6454SAndrew Thompson static uint8_t
81802ac6454SAndrew Thompson ehci_dump_sqtd(ehci_softc_t *sc, ehci_qtd_t *sqtd)
81902ac6454SAndrew Thompson {
82002ac6454SAndrew Thompson 	uint8_t temp;
82102ac6454SAndrew Thompson 
822a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(sqtd->page_cache);
823e55e1ebcSAndrew Thompson 	printf("QTD(%p) at 0x%08x:\n", sqtd, hc32toh(sc, sqtd->qtd_self));
82402ac6454SAndrew Thompson 	ehci_dump_qtd(sc, sqtd);
825e55e1ebcSAndrew Thompson 	temp = (sqtd->qtd_next & htohc32(sc, EHCI_LINK_TERMINATE)) ? 1 : 0;
82602ac6454SAndrew Thompson 	return (temp);
82702ac6454SAndrew Thompson }
82802ac6454SAndrew Thompson 
82902ac6454SAndrew Thompson static void
83002ac6454SAndrew Thompson ehci_dump_sqtds(ehci_softc_t *sc, ehci_qtd_t *sqtd)
83102ac6454SAndrew Thompson {
83202ac6454SAndrew Thompson 	uint16_t i;
83302ac6454SAndrew Thompson 	uint8_t stop;
83402ac6454SAndrew Thompson 
83502ac6454SAndrew Thompson 	stop = 0;
83602ac6454SAndrew Thompson 	for (i = 0; sqtd && (i < 20) && !stop; sqtd = sqtd->obj_next, i++) {
83702ac6454SAndrew Thompson 		stop = ehci_dump_sqtd(sc, sqtd);
83802ac6454SAndrew Thompson 	}
83902ac6454SAndrew Thompson 	if (sqtd) {
84002ac6454SAndrew Thompson 		printf("dump aborted, too many TDs\n");
84102ac6454SAndrew Thompson 	}
84202ac6454SAndrew Thompson }
84302ac6454SAndrew Thompson 
84402ac6454SAndrew Thompson static void
84502ac6454SAndrew Thompson ehci_dump_sqh(ehci_softc_t *sc, ehci_qh_t *qh)
84602ac6454SAndrew Thompson {
84702ac6454SAndrew Thompson 	uint32_t endp;
84802ac6454SAndrew Thompson 	uint32_t endphub;
84902ac6454SAndrew Thompson 
850a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(qh->page_cache);
851e55e1ebcSAndrew Thompson 	printf("QH(%p) at 0x%08x:\n", qh, hc32toh(sc, qh->qh_self) & ~0x1F);
85202ac6454SAndrew Thompson 	printf("  link=");
85302ac6454SAndrew Thompson 	ehci_dump_link(sc, qh->qh_link, 1);
85402ac6454SAndrew Thompson 	printf("\n");
855e55e1ebcSAndrew Thompson 	endp = hc32toh(sc, qh->qh_endp);
85602ac6454SAndrew Thompson 	printf("  endp=0x%08x\n", endp);
85702ac6454SAndrew Thompson 	printf("    addr=0x%02x inact=%d endpt=%d eps=%d dtc=%d hrecl=%d\n",
85802ac6454SAndrew Thompson 	    EHCI_QH_GET_ADDR(endp), EHCI_QH_GET_INACT(endp),
85902ac6454SAndrew Thompson 	    EHCI_QH_GET_ENDPT(endp), EHCI_QH_GET_EPS(endp),
86002ac6454SAndrew Thompson 	    EHCI_QH_GET_DTC(endp), EHCI_QH_GET_HRECL(endp));
86102ac6454SAndrew Thompson 	printf("    mpl=0x%x ctl=%d nrl=%d\n",
86202ac6454SAndrew Thompson 	    EHCI_QH_GET_MPL(endp), EHCI_QH_GET_CTL(endp),
86302ac6454SAndrew Thompson 	    EHCI_QH_GET_NRL(endp));
864e55e1ebcSAndrew Thompson 	endphub = hc32toh(sc, qh->qh_endphub);
86502ac6454SAndrew Thompson 	printf("  endphub=0x%08x\n", endphub);
86602ac6454SAndrew Thompson 	printf("    smask=0x%02x cmask=0x%02x huba=0x%02x port=%d mult=%d\n",
86702ac6454SAndrew Thompson 	    EHCI_QH_GET_SMASK(endphub), EHCI_QH_GET_CMASK(endphub),
86802ac6454SAndrew Thompson 	    EHCI_QH_GET_HUBA(endphub), EHCI_QH_GET_PORT(endphub),
86902ac6454SAndrew Thompson 	    EHCI_QH_GET_MULT(endphub));
87002ac6454SAndrew Thompson 	printf("  curqtd=");
87102ac6454SAndrew Thompson 	ehci_dump_link(sc, qh->qh_curqtd, 0);
87202ac6454SAndrew Thompson 	printf("\n");
87302ac6454SAndrew Thompson 	printf("Overlay qTD:\n");
87402ac6454SAndrew Thompson 	ehci_dump_qtd(sc, (void *)&qh->qh_qtd);
87502ac6454SAndrew Thompson }
87602ac6454SAndrew Thompson 
87702ac6454SAndrew Thompson static void
87802ac6454SAndrew Thompson ehci_dump_sitd(ehci_softc_t *sc, ehci_sitd_t *sitd)
87902ac6454SAndrew Thompson {
880a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(sitd->page_cache);
881e55e1ebcSAndrew Thompson 	printf("SITD(%p) at 0x%08x\n", sitd, hc32toh(sc, sitd->sitd_self) & ~0x1F);
882e55e1ebcSAndrew Thompson 	printf(" next=0x%08x\n", hc32toh(sc, sitd->sitd_next));
88302ac6454SAndrew Thompson 	printf(" portaddr=0x%08x dir=%s addr=%d endpt=0x%x port=0x%x huba=0x%x\n",
884e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_portaddr),
885e55e1ebcSAndrew Thompson 	    (sitd->sitd_portaddr & htohc32(sc, EHCI_SITD_SET_DIR_IN))
88602ac6454SAndrew Thompson 	    ? "in" : "out",
887e55e1ebcSAndrew Thompson 	    EHCI_SITD_GET_ADDR(hc32toh(sc, sitd->sitd_portaddr)),
888e55e1ebcSAndrew Thompson 	    EHCI_SITD_GET_ENDPT(hc32toh(sc, sitd->sitd_portaddr)),
889e55e1ebcSAndrew Thompson 	    EHCI_SITD_GET_PORT(hc32toh(sc, sitd->sitd_portaddr)),
890e55e1ebcSAndrew Thompson 	    EHCI_SITD_GET_HUBA(hc32toh(sc, sitd->sitd_portaddr)));
891e55e1ebcSAndrew Thompson 	printf(" mask=0x%08x\n", hc32toh(sc, sitd->sitd_mask));
892e55e1ebcSAndrew Thompson 	printf(" status=0x%08x <%s> len=0x%x\n", hc32toh(sc, sitd->sitd_status),
893e55e1ebcSAndrew Thompson 	    (sitd->sitd_status & htohc32(sc, EHCI_SITD_ACTIVE)) ? "ACTIVE" : "",
894e55e1ebcSAndrew Thompson 	    EHCI_SITD_GET_LEN(hc32toh(sc, sitd->sitd_status)));
89502ac6454SAndrew Thompson 	printf(" back=0x%08x, bp=0x%08x,0x%08x,0x%08x,0x%08x\n",
896e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_back),
897e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_bp[0]),
898e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_bp[1]),
899e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_bp_hi[0]),
900e55e1ebcSAndrew Thompson 	    hc32toh(sc, sitd->sitd_bp_hi[1]));
90102ac6454SAndrew Thompson }
90202ac6454SAndrew Thompson 
90302ac6454SAndrew Thompson static void
90402ac6454SAndrew Thompson ehci_dump_itd(ehci_softc_t *sc, ehci_itd_t *itd)
90502ac6454SAndrew Thompson {
906a593f6b8SAndrew Thompson 	usb_pc_cpu_invalidate(itd->page_cache);
907e55e1ebcSAndrew Thompson 	printf("ITD(%p) at 0x%08x\n", itd, hc32toh(sc, itd->itd_self) & ~0x1F);
908e55e1ebcSAndrew Thompson 	printf(" next=0x%08x\n", hc32toh(sc, itd->itd_next));
909e55e1ebcSAndrew Thompson 	printf(" status[0]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[0]),
910e55e1ebcSAndrew Thompson 	    (itd->itd_status[0] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
911e55e1ebcSAndrew Thompson 	printf(" status[1]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[1]),
912e55e1ebcSAndrew Thompson 	    (itd->itd_status[1] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
913e55e1ebcSAndrew Thompson 	printf(" status[2]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[2]),
914e55e1ebcSAndrew Thompson 	    (itd->itd_status[2] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
915e55e1ebcSAndrew Thompson 	printf(" status[3]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[3]),
916e55e1ebcSAndrew Thompson 	    (itd->itd_status[3] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
917e55e1ebcSAndrew Thompson 	printf(" status[4]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[4]),
918e55e1ebcSAndrew Thompson 	    (itd->itd_status[4] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
919e55e1ebcSAndrew Thompson 	printf(" status[5]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[5]),
920e55e1ebcSAndrew Thompson 	    (itd->itd_status[5] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
921e55e1ebcSAndrew Thompson 	printf(" status[6]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[6]),
922e55e1ebcSAndrew Thompson 	    (itd->itd_status[6] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
923e55e1ebcSAndrew Thompson 	printf(" status[7]=0x%08x; <%s>\n", hc32toh(sc, itd->itd_status[7]),
924e55e1ebcSAndrew Thompson 	    (itd->itd_status[7] & htohc32(sc, EHCI_ITD_ACTIVE)) ? "ACTIVE" : "");
925e55e1ebcSAndrew Thompson 	printf(" bp[0]=0x%08x\n", hc32toh(sc, itd->itd_bp[0]));
92602ac6454SAndrew Thompson 	printf("  addr=0x%02x; endpt=0x%01x\n",
927e55e1ebcSAndrew Thompson 	    EHCI_ITD_GET_ADDR(hc32toh(sc, itd->itd_bp[0])),
928e55e1ebcSAndrew Thompson 	    EHCI_ITD_GET_ENDPT(hc32toh(sc, itd->itd_bp[0])));
929e55e1ebcSAndrew Thompson 	printf(" bp[1]=0x%08x\n", hc32toh(sc, itd->itd_bp[1]));
93002ac6454SAndrew Thompson 	printf(" dir=%s; mpl=0x%02x\n",
931e55e1ebcSAndrew Thompson 	    (hc32toh(sc, itd->itd_bp[1]) & EHCI_ITD_SET_DIR_IN) ? "in" : "out",
932e55e1ebcSAndrew Thompson 	    EHCI_ITD_GET_MPL(hc32toh(sc, itd->itd_bp[1])));
93302ac6454SAndrew Thompson 	printf(" bp[2..6]=0x%08x,0x%08x,0x%08x,0x%08x,0x%08x\n",
934e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp[2]),
935e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp[3]),
936e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp[4]),
937e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp[5]),
938e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp[6]));
93902ac6454SAndrew Thompson 	printf(" bp_hi=0x%08x,0x%08x,0x%08x,0x%08x,\n"
94002ac6454SAndrew Thompson 	    "       0x%08x,0x%08x,0x%08x\n",
941e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[0]),
942e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[1]),
943e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[2]),
944e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[3]),
945e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[4]),
946e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[5]),
947e55e1ebcSAndrew Thompson 	    hc32toh(sc, itd->itd_bp_hi[6]));
94802ac6454SAndrew Thompson }
94902ac6454SAndrew Thompson 
95002ac6454SAndrew Thompson static void
95102ac6454SAndrew Thompson ehci_dump_isoc(ehci_softc_t *sc)
95202ac6454SAndrew Thompson {
95302ac6454SAndrew Thompson 	ehci_itd_t *itd;
95402ac6454SAndrew Thompson 	ehci_sitd_t *sitd;
95502ac6454SAndrew Thompson 	uint16_t max = 1000;
95602ac6454SAndrew Thompson 	uint16_t pos;
95702ac6454SAndrew Thompson 
95802ac6454SAndrew Thompson 	pos = (EOREAD4(sc, EHCI_FRINDEX) / 8) &
95902ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
96002ac6454SAndrew Thompson 
96102ac6454SAndrew Thompson 	printf("%s: isochronous dump from frame 0x%03x:\n",
96202ac6454SAndrew Thompson 	    __FUNCTION__, pos);
96302ac6454SAndrew Thompson 
96402ac6454SAndrew Thompson 	itd = sc->sc_isoc_hs_p_last[pos];
96502ac6454SAndrew Thompson 	sitd = sc->sc_isoc_fs_p_last[pos];
96602ac6454SAndrew Thompson 
96702ac6454SAndrew Thompson 	while (itd && max && max--) {
96802ac6454SAndrew Thompson 		ehci_dump_itd(sc, itd);
96902ac6454SAndrew Thompson 		itd = itd->prev;
97002ac6454SAndrew Thompson 	}
97102ac6454SAndrew Thompson 
97202ac6454SAndrew Thompson 	while (sitd && max && max--) {
97302ac6454SAndrew Thompson 		ehci_dump_sitd(sc, sitd);
97402ac6454SAndrew Thompson 		sitd = sitd->prev;
97502ac6454SAndrew Thompson 	}
97602ac6454SAndrew Thompson }
97702ac6454SAndrew Thompson 
97802ac6454SAndrew Thompson #endif
97902ac6454SAndrew Thompson 
98002ac6454SAndrew Thompson static void
981760bc48eSAndrew Thompson ehci_transfer_intr_enqueue(struct usb_xfer *xfer)
98202ac6454SAndrew Thompson {
98302ac6454SAndrew Thompson 	/* check for early completion */
98402ac6454SAndrew Thompson 	if (ehci_check_transfer(xfer)) {
98502ac6454SAndrew Thompson 		return;
98602ac6454SAndrew Thompson 	}
98702ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
988a593f6b8SAndrew Thompson 	usbd_transfer_enqueue(&xfer->xroot->bus->intr_q, xfer);
98902ac6454SAndrew Thompson 
99002ac6454SAndrew Thompson 	/* start timeout, if any */
99102ac6454SAndrew Thompson 	if (xfer->timeout != 0) {
992a593f6b8SAndrew Thompson 		usbd_transfer_timeout_ms(xfer, &ehci_timeout, xfer->timeout);
99302ac6454SAndrew Thompson 	}
99402ac6454SAndrew Thompson }
99502ac6454SAndrew Thompson 
99602ac6454SAndrew Thompson #define	EHCI_APPEND_FS_TD(std,last) (last) = _ehci_append_fs_td(std,last)
99702ac6454SAndrew Thompson static ehci_sitd_t *
99802ac6454SAndrew Thompson _ehci_append_fs_td(ehci_sitd_t *std, ehci_sitd_t *last)
99902ac6454SAndrew Thompson {
100002ac6454SAndrew Thompson 	DPRINTFN(11, "%p to %p\n", std, last);
100102ac6454SAndrew Thompson 
100202ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
100302ac6454SAndrew Thompson 
100402ac6454SAndrew Thompson 	std->next = last->next;
100502ac6454SAndrew Thompson 	std->sitd_next = last->sitd_next;
100602ac6454SAndrew Thompson 
100702ac6454SAndrew Thompson 	std->prev = last;
100802ac6454SAndrew Thompson 
1009a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->page_cache);
101002ac6454SAndrew Thompson 
101102ac6454SAndrew Thompson 	/*
101202ac6454SAndrew Thompson 	 * the last->next->prev is never followed: std->next->prev = std;
101302ac6454SAndrew Thompson 	 */
101402ac6454SAndrew Thompson 	last->next = std;
101502ac6454SAndrew Thompson 	last->sitd_next = std->sitd_self;
101602ac6454SAndrew Thompson 
1017a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(last->page_cache);
101802ac6454SAndrew Thompson 
101902ac6454SAndrew Thompson 	return (std);
102002ac6454SAndrew Thompson }
102102ac6454SAndrew Thompson 
102202ac6454SAndrew Thompson #define	EHCI_APPEND_HS_TD(std,last) (last) = _ehci_append_hs_td(std,last)
102302ac6454SAndrew Thompson static ehci_itd_t *
102402ac6454SAndrew Thompson _ehci_append_hs_td(ehci_itd_t *std, ehci_itd_t *last)
102502ac6454SAndrew Thompson {
102602ac6454SAndrew Thompson 	DPRINTFN(11, "%p to %p\n", std, last);
102702ac6454SAndrew Thompson 
102802ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
102902ac6454SAndrew Thompson 
103002ac6454SAndrew Thompson 	std->next = last->next;
103102ac6454SAndrew Thompson 	std->itd_next = last->itd_next;
103202ac6454SAndrew Thompson 
103302ac6454SAndrew Thompson 	std->prev = last;
103402ac6454SAndrew Thompson 
1035a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->page_cache);
103602ac6454SAndrew Thompson 
103702ac6454SAndrew Thompson 	/*
103802ac6454SAndrew Thompson 	 * the last->next->prev is never followed: std->next->prev = std;
103902ac6454SAndrew Thompson 	 */
104002ac6454SAndrew Thompson 	last->next = std;
104102ac6454SAndrew Thompson 	last->itd_next = std->itd_self;
104202ac6454SAndrew Thompson 
1043a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(last->page_cache);
104402ac6454SAndrew Thompson 
104502ac6454SAndrew Thompson 	return (std);
104602ac6454SAndrew Thompson }
104702ac6454SAndrew Thompson 
104802ac6454SAndrew Thompson #define	EHCI_APPEND_QH(sqh,last) (last) = _ehci_append_qh(sqh,last)
104902ac6454SAndrew Thompson static ehci_qh_t *
105002ac6454SAndrew Thompson _ehci_append_qh(ehci_qh_t *sqh, ehci_qh_t *last)
105102ac6454SAndrew Thompson {
105202ac6454SAndrew Thompson 	DPRINTFN(11, "%p to %p\n", sqh, last);
105302ac6454SAndrew Thompson 
105402ac6454SAndrew Thompson 	if (sqh->prev != NULL) {
105502ac6454SAndrew Thompson 		/* should not happen */
105602ac6454SAndrew Thompson 		DPRINTFN(0, "QH already linked!\n");
105702ac6454SAndrew Thompson 		return (last);
105802ac6454SAndrew Thompson 	}
105902ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
106002ac6454SAndrew Thompson 
106102ac6454SAndrew Thompson 	sqh->next = last->next;
106202ac6454SAndrew Thompson 	sqh->qh_link = last->qh_link;
106302ac6454SAndrew Thompson 
106402ac6454SAndrew Thompson 	sqh->prev = last;
106502ac6454SAndrew Thompson 
1066a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(sqh->page_cache);
106702ac6454SAndrew Thompson 
106802ac6454SAndrew Thompson 	/*
106902ac6454SAndrew Thompson 	 * the last->next->prev is never followed: sqh->next->prev = sqh;
107002ac6454SAndrew Thompson 	 */
107102ac6454SAndrew Thompson 
107202ac6454SAndrew Thompson 	last->next = sqh;
107302ac6454SAndrew Thompson 	last->qh_link = sqh->qh_self;
107402ac6454SAndrew Thompson 
1075a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(last->page_cache);
107602ac6454SAndrew Thompson 
107702ac6454SAndrew Thompson 	return (sqh);
107802ac6454SAndrew Thompson }
107902ac6454SAndrew Thompson 
108002ac6454SAndrew Thompson #define	EHCI_REMOVE_FS_TD(std,last) (last) = _ehci_remove_fs_td(std,last)
108102ac6454SAndrew Thompson static ehci_sitd_t *
108202ac6454SAndrew Thompson _ehci_remove_fs_td(ehci_sitd_t *std, ehci_sitd_t *last)
108302ac6454SAndrew Thompson {
108402ac6454SAndrew Thompson 	DPRINTFN(11, "%p from %p\n", std, last);
108502ac6454SAndrew Thompson 
108602ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
108702ac6454SAndrew Thompson 
108802ac6454SAndrew Thompson 	std->prev->next = std->next;
108902ac6454SAndrew Thompson 	std->prev->sitd_next = std->sitd_next;
109002ac6454SAndrew Thompson 
1091a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->prev->page_cache);
109202ac6454SAndrew Thompson 
109302ac6454SAndrew Thompson 	if (std->next) {
109402ac6454SAndrew Thompson 		std->next->prev = std->prev;
1095a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(std->next->page_cache);
109602ac6454SAndrew Thompson 	}
109702ac6454SAndrew Thompson 	return ((last == std) ? std->prev : last);
109802ac6454SAndrew Thompson }
109902ac6454SAndrew Thompson 
110002ac6454SAndrew Thompson #define	EHCI_REMOVE_HS_TD(std,last) (last) = _ehci_remove_hs_td(std,last)
110102ac6454SAndrew Thompson static ehci_itd_t *
110202ac6454SAndrew Thompson _ehci_remove_hs_td(ehci_itd_t *std, ehci_itd_t *last)
110302ac6454SAndrew Thompson {
110402ac6454SAndrew Thompson 	DPRINTFN(11, "%p from %p\n", std, last);
110502ac6454SAndrew Thompson 
110602ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
110702ac6454SAndrew Thompson 
110802ac6454SAndrew Thompson 	std->prev->next = std->next;
110902ac6454SAndrew Thompson 	std->prev->itd_next = std->itd_next;
111002ac6454SAndrew Thompson 
1111a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(std->prev->page_cache);
111202ac6454SAndrew Thompson 
111302ac6454SAndrew Thompson 	if (std->next) {
111402ac6454SAndrew Thompson 		std->next->prev = std->prev;
1115a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(std->next->page_cache);
111602ac6454SAndrew Thompson 	}
111702ac6454SAndrew Thompson 	return ((last == std) ? std->prev : last);
111802ac6454SAndrew Thompson }
111902ac6454SAndrew Thompson 
112002ac6454SAndrew Thompson #define	EHCI_REMOVE_QH(sqh,last) (last) = _ehci_remove_qh(sqh,last)
112102ac6454SAndrew Thompson static ehci_qh_t *
112202ac6454SAndrew Thompson _ehci_remove_qh(ehci_qh_t *sqh, ehci_qh_t *last)
112302ac6454SAndrew Thompson {
112402ac6454SAndrew Thompson 	DPRINTFN(11, "%p from %p\n", sqh, last);
112502ac6454SAndrew Thompson 
112602ac6454SAndrew Thompson 	/* (sc->sc_bus.mtx) must be locked */
112702ac6454SAndrew Thompson 
112802ac6454SAndrew Thompson 	/* only remove if not removed from a queue */
112902ac6454SAndrew Thompson 	if (sqh->prev) {
113002ac6454SAndrew Thompson 
113102ac6454SAndrew Thompson 		sqh->prev->next = sqh->next;
113202ac6454SAndrew Thompson 		sqh->prev->qh_link = sqh->qh_link;
113302ac6454SAndrew Thompson 
1134a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(sqh->prev->page_cache);
113502ac6454SAndrew Thompson 
113602ac6454SAndrew Thompson 		if (sqh->next) {
113702ac6454SAndrew Thompson 			sqh->next->prev = sqh->prev;
1138a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(sqh->next->page_cache);
113902ac6454SAndrew Thompson 		}
114002ac6454SAndrew Thompson 		last = ((last == sqh) ? sqh->prev : last);
114102ac6454SAndrew Thompson 
114202ac6454SAndrew Thompson 		sqh->prev = 0;
114302ac6454SAndrew Thompson 
1144a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(sqh->page_cache);
114502ac6454SAndrew Thompson 	}
114602ac6454SAndrew Thompson 	return (last);
114702ac6454SAndrew Thompson }
114802ac6454SAndrew Thompson 
1149e0a69b51SAndrew Thompson static usb_error_t
1150760bc48eSAndrew Thompson ehci_non_isoc_done_sub(struct usb_xfer *xfer)
115102ac6454SAndrew Thompson {
115202ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
115302ac6454SAndrew Thompson 	ehci_qtd_t *td;
115402ac6454SAndrew Thompson 	ehci_qtd_t *td_alt_next;
115502ac6454SAndrew Thompson 	uint32_t status;
115602ac6454SAndrew Thompson 	uint16_t len;
115702ac6454SAndrew Thompson 
115802ac6454SAndrew Thompson 	td = xfer->td_transfer_cache;
115902ac6454SAndrew Thompson 	td_alt_next = td->alt_next;
116002ac6454SAndrew Thompson 
116102ac6454SAndrew Thompson 	if (xfer->aframes != xfer->nframes) {
1162ed6d949aSAndrew Thompson 		usbd_xfer_set_frame_len(xfer, xfer->aframes, 0);
116302ac6454SAndrew Thompson 	}
116402ac6454SAndrew Thompson 	while (1) {
116502ac6454SAndrew Thompson 
1166a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
1167e55e1ebcSAndrew Thompson 		status = hc32toh(sc, td->qtd_status);
116802ac6454SAndrew Thompson 
116902ac6454SAndrew Thompson 		len = EHCI_QTD_GET_BYTES(status);
117002ac6454SAndrew Thompson 
117102ac6454SAndrew Thompson 		/*
117202ac6454SAndrew Thompson 	         * Verify the status length and
117302ac6454SAndrew Thompson 		 * add the length to "frlengths[]":
117402ac6454SAndrew Thompson 	         */
117502ac6454SAndrew Thompson 		if (len > td->len) {
117602ac6454SAndrew Thompson 			/* should not happen */
117702ac6454SAndrew Thompson 			DPRINTF("Invalid status length, "
117802ac6454SAndrew Thompson 			    "0x%04x/0x%04x bytes\n", len, td->len);
117902ac6454SAndrew Thompson 			status |= EHCI_QTD_HALTED;
118002ac6454SAndrew Thompson 		} else if (xfer->aframes != xfer->nframes) {
118102ac6454SAndrew Thompson 			xfer->frlengths[xfer->aframes] += td->len - len;
118202ac6454SAndrew Thompson 		}
118302ac6454SAndrew Thompson 		/* Check for last transfer */
118402ac6454SAndrew Thompson 		if (((void *)td) == xfer->td_transfer_last) {
118502ac6454SAndrew Thompson 			td = NULL;
118602ac6454SAndrew Thompson 			break;
118702ac6454SAndrew Thompson 		}
118802ac6454SAndrew Thompson 		/* Check for transfer error */
118902ac6454SAndrew Thompson 		if (status & EHCI_QTD_HALTED) {
119002ac6454SAndrew Thompson 			/* the transfer is finished */
119102ac6454SAndrew Thompson 			td = NULL;
119202ac6454SAndrew Thompson 			break;
119302ac6454SAndrew Thompson 		}
119402ac6454SAndrew Thompson 		/* Check for short transfer */
119502ac6454SAndrew Thompson 		if (len > 0) {
119602ac6454SAndrew Thompson 			if (xfer->flags_int.short_frames_ok) {
119702ac6454SAndrew Thompson 				/* follow alt next */
119802ac6454SAndrew Thompson 				td = td->alt_next;
119902ac6454SAndrew Thompson 			} else {
120002ac6454SAndrew Thompson 				/* the transfer is finished */
120102ac6454SAndrew Thompson 				td = NULL;
120202ac6454SAndrew Thompson 			}
120302ac6454SAndrew Thompson 			break;
120402ac6454SAndrew Thompson 		}
120502ac6454SAndrew Thompson 		td = td->obj_next;
120602ac6454SAndrew Thompson 
120702ac6454SAndrew Thompson 		if (td->alt_next != td_alt_next) {
120802ac6454SAndrew Thompson 			/* this USB frame is complete */
120902ac6454SAndrew Thompson 			break;
121002ac6454SAndrew Thompson 		}
121102ac6454SAndrew Thompson 	}
121202ac6454SAndrew Thompson 
121302ac6454SAndrew Thompson 	/* update transfer cache */
121402ac6454SAndrew Thompson 
121502ac6454SAndrew Thompson 	xfer->td_transfer_cache = td;
121602ac6454SAndrew Thompson 
121702ac6454SAndrew Thompson #if USB_DEBUG
121802ac6454SAndrew Thompson 	if (status & EHCI_QTD_STATERRS) {
121902ac6454SAndrew Thompson 		DPRINTFN(11, "error, addr=%d, endpt=0x%02x, frame=0x%02x"
122002ac6454SAndrew Thompson 		    "status=%s%s%s%s%s%s%s%s\n",
1221ae60fdfbSAndrew Thompson 		    xfer->address, xfer->endpointno, xfer->aframes,
122202ac6454SAndrew Thompson 		    (status & EHCI_QTD_ACTIVE) ? "[ACTIVE]" : "[NOT_ACTIVE]",
122302ac6454SAndrew Thompson 		    (status & EHCI_QTD_HALTED) ? "[HALTED]" : "",
122402ac6454SAndrew Thompson 		    (status & EHCI_QTD_BUFERR) ? "[BUFERR]" : "",
122502ac6454SAndrew Thompson 		    (status & EHCI_QTD_BABBLE) ? "[BABBLE]" : "",
122602ac6454SAndrew Thompson 		    (status & EHCI_QTD_XACTERR) ? "[XACTERR]" : "",
122702ac6454SAndrew Thompson 		    (status & EHCI_QTD_MISSEDMICRO) ? "[MISSED]" : "",
122802ac6454SAndrew Thompson 		    (status & EHCI_QTD_SPLITXSTATE) ? "[SPLIT]" : "",
122902ac6454SAndrew Thompson 		    (status & EHCI_QTD_PINGSTATE) ? "[PING]" : "");
123002ac6454SAndrew Thompson 	}
123102ac6454SAndrew Thompson #endif
123202ac6454SAndrew Thompson 
123302ac6454SAndrew Thompson 	return ((status & EHCI_QTD_HALTED) ?
123402ac6454SAndrew Thompson 	    USB_ERR_STALLED : USB_ERR_NORMAL_COMPLETION);
123502ac6454SAndrew Thompson }
123602ac6454SAndrew Thompson 
123702ac6454SAndrew Thompson static void
1238760bc48eSAndrew Thompson ehci_non_isoc_done(struct usb_xfer *xfer)
123902ac6454SAndrew Thompson {
1240c8a14b91SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
1241c8a14b91SAndrew Thompson 	ehci_qh_t *qh;
1242c8a14b91SAndrew Thompson 	uint32_t status;
1243e0a69b51SAndrew Thompson 	usb_error_t err = 0;
124402ac6454SAndrew Thompson 
1245ae60fdfbSAndrew Thompson 	DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n",
1246ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint);
124702ac6454SAndrew Thompson 
124802ac6454SAndrew Thompson #if USB_DEBUG
124902ac6454SAndrew Thompson 	if (ehcidebug > 10) {
125002ac6454SAndrew Thompson 		ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
125102ac6454SAndrew Thompson 
125202ac6454SAndrew Thompson 		ehci_dump_sqtds(sc, xfer->td_transfer_first);
125302ac6454SAndrew Thompson 	}
125402ac6454SAndrew Thompson #endif
125502ac6454SAndrew Thompson 
1256c8a14b91SAndrew Thompson 	/* extract data toggle directly from the QH's overlay area */
1257c8a14b91SAndrew Thompson 
1258c8a14b91SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
1259c8a14b91SAndrew Thompson 
1260c8a14b91SAndrew Thompson 	usb_pc_cpu_invalidate(qh->page_cache);
1261c8a14b91SAndrew Thompson 
1262c8a14b91SAndrew Thompson 	status = hc32toh(sc, qh->qh_qtd.qtd_status);
1263c8a14b91SAndrew Thompson 
1264c8a14b91SAndrew Thompson 	xfer->endpoint->toggle_next =
1265c8a14b91SAndrew Thompson 	    (status & EHCI_QTD_TOGGLE_MASK) ? 1 : 0;
1266c8a14b91SAndrew Thompson 
126702ac6454SAndrew Thompson 	/* reset scanner */
126802ac6454SAndrew Thompson 
126902ac6454SAndrew Thompson 	xfer->td_transfer_cache = xfer->td_transfer_first;
127002ac6454SAndrew Thompson 
127102ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr) {
127202ac6454SAndrew Thompson 
127302ac6454SAndrew Thompson 		if (xfer->flags_int.control_hdr) {
127402ac6454SAndrew Thompson 
127502ac6454SAndrew Thompson 			err = ehci_non_isoc_done_sub(xfer);
127602ac6454SAndrew Thompson 		}
127702ac6454SAndrew Thompson 		xfer->aframes = 1;
127802ac6454SAndrew Thompson 
127902ac6454SAndrew Thompson 		if (xfer->td_transfer_cache == NULL) {
128002ac6454SAndrew Thompson 			goto done;
128102ac6454SAndrew Thompson 		}
128202ac6454SAndrew Thompson 	}
128302ac6454SAndrew Thompson 	while (xfer->aframes != xfer->nframes) {
128402ac6454SAndrew Thompson 
128502ac6454SAndrew Thompson 		err = ehci_non_isoc_done_sub(xfer);
128602ac6454SAndrew Thompson 		xfer->aframes++;
128702ac6454SAndrew Thompson 
128802ac6454SAndrew Thompson 		if (xfer->td_transfer_cache == NULL) {
128902ac6454SAndrew Thompson 			goto done;
129002ac6454SAndrew Thompson 		}
129102ac6454SAndrew Thompson 	}
129202ac6454SAndrew Thompson 
129302ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr &&
129402ac6454SAndrew Thompson 	    !xfer->flags_int.control_act) {
129502ac6454SAndrew Thompson 
129602ac6454SAndrew Thompson 		err = ehci_non_isoc_done_sub(xfer);
129702ac6454SAndrew Thompson 	}
129802ac6454SAndrew Thompson done:
129902ac6454SAndrew Thompson 	ehci_device_done(xfer, err);
130002ac6454SAndrew Thompson }
130102ac6454SAndrew Thompson 
130202ac6454SAndrew Thompson /*------------------------------------------------------------------------*
130302ac6454SAndrew Thompson  *	ehci_check_transfer
130402ac6454SAndrew Thompson  *
130502ac6454SAndrew Thompson  * Return values:
130602ac6454SAndrew Thompson  *    0: USB transfer is not finished
130702ac6454SAndrew Thompson  * Else: USB transfer is finished
130802ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
130902ac6454SAndrew Thompson static uint8_t
1310760bc48eSAndrew Thompson ehci_check_transfer(struct usb_xfer *xfer)
131102ac6454SAndrew Thompson {
1312ae60fdfbSAndrew Thompson 	struct usb_pipe_methods *methods = xfer->endpoint->methods;
131302ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
131402ac6454SAndrew Thompson 
131502ac6454SAndrew Thompson 	uint32_t status;
131602ac6454SAndrew Thompson 
131702ac6454SAndrew Thompson 	DPRINTFN(13, "xfer=%p checking transfer\n", xfer);
131802ac6454SAndrew Thompson 
131902ac6454SAndrew Thompson 	if (methods == &ehci_device_isoc_fs_methods) {
132002ac6454SAndrew Thompson 		ehci_sitd_t *td;
132102ac6454SAndrew Thompson 
132202ac6454SAndrew Thompson 		/* isochronous full speed transfer */
132302ac6454SAndrew Thompson 
132402ac6454SAndrew Thompson 		td = xfer->td_transfer_last;
1325a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
1326e55e1ebcSAndrew Thompson 		status = hc32toh(sc, td->sitd_status);
132702ac6454SAndrew Thompson 
132802ac6454SAndrew Thompson 		/* also check if first is complete */
132902ac6454SAndrew Thompson 
133002ac6454SAndrew Thompson 		td = xfer->td_transfer_first;
1331a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
1332e55e1ebcSAndrew Thompson 		status |= hc32toh(sc, td->sitd_status);
133302ac6454SAndrew Thompson 
133402ac6454SAndrew Thompson 		if (!(status & EHCI_SITD_ACTIVE)) {
133502ac6454SAndrew Thompson 			ehci_device_done(xfer, USB_ERR_NORMAL_COMPLETION);
133602ac6454SAndrew Thompson 			goto transferred;
133702ac6454SAndrew Thompson 		}
133802ac6454SAndrew Thompson 	} else if (methods == &ehci_device_isoc_hs_methods) {
133902ac6454SAndrew Thompson 		ehci_itd_t *td;
134002ac6454SAndrew Thompson 
134102ac6454SAndrew Thompson 		/* isochronous high speed transfer */
134202ac6454SAndrew Thompson 
134302ac6454SAndrew Thompson 		td = xfer->td_transfer_last;
1344a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
134502ac6454SAndrew Thompson 		status =
134602ac6454SAndrew Thompson 		    td->itd_status[0] | td->itd_status[1] |
134702ac6454SAndrew Thompson 		    td->itd_status[2] | td->itd_status[3] |
134802ac6454SAndrew Thompson 		    td->itd_status[4] | td->itd_status[5] |
134902ac6454SAndrew Thompson 		    td->itd_status[6] | td->itd_status[7];
135002ac6454SAndrew Thompson 
135102ac6454SAndrew Thompson 		/* also check first transfer */
135202ac6454SAndrew Thompson 		td = xfer->td_transfer_first;
1353a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
135402ac6454SAndrew Thompson 		status |=
135502ac6454SAndrew Thompson 		    td->itd_status[0] | td->itd_status[1] |
135602ac6454SAndrew Thompson 		    td->itd_status[2] | td->itd_status[3] |
135702ac6454SAndrew Thompson 		    td->itd_status[4] | td->itd_status[5] |
135802ac6454SAndrew Thompson 		    td->itd_status[6] | td->itd_status[7];
135902ac6454SAndrew Thompson 
136002ac6454SAndrew Thompson 		/* if no transactions are active we continue */
1361e55e1ebcSAndrew Thompson 		if (!(status & htohc32(sc, EHCI_ITD_ACTIVE))) {
136202ac6454SAndrew Thompson 			ehci_device_done(xfer, USB_ERR_NORMAL_COMPLETION);
136302ac6454SAndrew Thompson 			goto transferred;
136402ac6454SAndrew Thompson 		}
136502ac6454SAndrew Thompson 	} else {
136602ac6454SAndrew Thompson 		ehci_qtd_t *td;
1367c8a14b91SAndrew Thompson 		ehci_qh_t *qh;
136802ac6454SAndrew Thompson 
136902ac6454SAndrew Thompson 		/* non-isochronous transfer */
137002ac6454SAndrew Thompson 
137102ac6454SAndrew Thompson 		/*
137202ac6454SAndrew Thompson 		 * check whether there is an error somewhere in the middle,
137302ac6454SAndrew Thompson 		 * or whether there was a short packet (SPD and not ACTIVE)
137402ac6454SAndrew Thompson 		 */
137502ac6454SAndrew Thompson 		td = xfer->td_transfer_cache;
137602ac6454SAndrew Thompson 
1377c8a14b91SAndrew Thompson 		qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
1378c8a14b91SAndrew Thompson 
1379c8a14b91SAndrew Thompson 		usb_pc_cpu_invalidate(qh->page_cache);
1380c8a14b91SAndrew Thompson 
1381c8a14b91SAndrew Thompson 		status = hc32toh(sc, qh->qh_qtd.qtd_status);
1382c8a14b91SAndrew Thompson 		if (status & EHCI_QTD_ACTIVE) {
1383c8a14b91SAndrew Thompson 			/* transfer is pending */
1384c8a14b91SAndrew Thompson 			goto done;
1385c8a14b91SAndrew Thompson 		}
1386c8a14b91SAndrew Thompson 
138702ac6454SAndrew Thompson 		while (1) {
1388a593f6b8SAndrew Thompson 			usb_pc_cpu_invalidate(td->page_cache);
1389e55e1ebcSAndrew Thompson 			status = hc32toh(sc, td->qtd_status);
139002ac6454SAndrew Thompson 
139102ac6454SAndrew Thompson 			/*
1392c8a14b91SAndrew Thompson 			 * Check if there is an active TD which
1393c8a14b91SAndrew Thompson 			 * indicates that the transfer isn't done.
139402ac6454SAndrew Thompson 			 */
139502ac6454SAndrew Thompson 			if (status & EHCI_QTD_ACTIVE) {
139602ac6454SAndrew Thompson 				/* update cache */
1397c8a14b91SAndrew Thompson 				if (xfer->td_transfer_cache != td) {
139802ac6454SAndrew Thompson 					xfer->td_transfer_cache = td;
1399c8a14b91SAndrew Thompson 					if (qh->qh_qtd.qtd_next &
1400c8a14b91SAndrew Thompson 					    htohc32(sc, EHCI_LINK_TERMINATE)) {
1401c8a14b91SAndrew Thompson 						/* XXX - manually advance to next frame */
1402c8a14b91SAndrew Thompson 						qh->qh_qtd.qtd_next = td->qtd_self;
1403c8a14b91SAndrew Thompson 						usb_pc_cpu_flush(td->page_cache);
1404c8a14b91SAndrew Thompson 					}
1405c8a14b91SAndrew Thompson 				}
140602ac6454SAndrew Thompson 				goto done;
140702ac6454SAndrew Thompson 			}
140802ac6454SAndrew Thompson 			/*
140902ac6454SAndrew Thompson 			 * last transfer descriptor makes the transfer done
141002ac6454SAndrew Thompson 			 */
141102ac6454SAndrew Thompson 			if (((void *)td) == xfer->td_transfer_last) {
141202ac6454SAndrew Thompson 				break;
141302ac6454SAndrew Thompson 			}
141402ac6454SAndrew Thompson 			/*
141502ac6454SAndrew Thompson 			 * any kind of error makes the transfer done
141602ac6454SAndrew Thompson 			 */
141702ac6454SAndrew Thompson 			if (status & EHCI_QTD_HALTED) {
141802ac6454SAndrew Thompson 				break;
141902ac6454SAndrew Thompson 			}
142002ac6454SAndrew Thompson 			/*
142102ac6454SAndrew Thompson 			 * if there is no alternate next transfer, a short
142202ac6454SAndrew Thompson 			 * packet also makes the transfer done
142302ac6454SAndrew Thompson 			 */
142402ac6454SAndrew Thompson 			if (EHCI_QTD_GET_BYTES(status)) {
142502ac6454SAndrew Thompson 				if (xfer->flags_int.short_frames_ok) {
142602ac6454SAndrew Thompson 					/* follow alt next */
142702ac6454SAndrew Thompson 					if (td->alt_next) {
142802ac6454SAndrew Thompson 						td = td->alt_next;
142902ac6454SAndrew Thompson 						continue;
143002ac6454SAndrew Thompson 					}
143102ac6454SAndrew Thompson 				}
143202ac6454SAndrew Thompson 				/* transfer is done */
143302ac6454SAndrew Thompson 				break;
143402ac6454SAndrew Thompson 			}
143502ac6454SAndrew Thompson 			td = td->obj_next;
143602ac6454SAndrew Thompson 		}
143702ac6454SAndrew Thompson 		ehci_non_isoc_done(xfer);
143802ac6454SAndrew Thompson 		goto transferred;
143902ac6454SAndrew Thompson 	}
144002ac6454SAndrew Thompson 
144102ac6454SAndrew Thompson done:
144202ac6454SAndrew Thompson 	DPRINTFN(13, "xfer=%p is still active\n", xfer);
144302ac6454SAndrew Thompson 	return (0);
144402ac6454SAndrew Thompson 
144502ac6454SAndrew Thompson transferred:
144602ac6454SAndrew Thompson 	return (1);
144702ac6454SAndrew Thompson }
144802ac6454SAndrew Thompson 
144902ac6454SAndrew Thompson static void
145002ac6454SAndrew Thompson ehci_pcd_enable(ehci_softc_t *sc)
145102ac6454SAndrew Thompson {
145202ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
145302ac6454SAndrew Thompson 
145402ac6454SAndrew Thompson 	sc->sc_eintrs |= EHCI_STS_PCD;
145502ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
145602ac6454SAndrew Thompson 
145702ac6454SAndrew Thompson 	/* acknowledge any PCD interrupt */
145802ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBSTS, EHCI_STS_PCD);
145902ac6454SAndrew Thompson 
146039307315SAndrew Thompson 	ehci_root_intr(sc);
146102ac6454SAndrew Thompson }
146202ac6454SAndrew Thompson 
146302ac6454SAndrew Thompson static void
146402ac6454SAndrew Thompson ehci_interrupt_poll(ehci_softc_t *sc)
146502ac6454SAndrew Thompson {
1466760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
146702ac6454SAndrew Thompson 
146802ac6454SAndrew Thompson repeat:
146902ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
147002ac6454SAndrew Thompson 		/*
147102ac6454SAndrew Thompson 		 * check if transfer is transferred
147202ac6454SAndrew Thompson 		 */
147302ac6454SAndrew Thompson 		if (ehci_check_transfer(xfer)) {
147402ac6454SAndrew Thompson 			/* queue has been modified */
147502ac6454SAndrew Thompson 			goto repeat;
147602ac6454SAndrew Thompson 		}
147702ac6454SAndrew Thompson 	}
147802ac6454SAndrew Thompson }
147902ac6454SAndrew Thompson 
148030b22abeSAndrew Thompson /*
148130b22abeSAndrew Thompson  * Some EHCI chips from VIA / ATI seem to trigger interrupts before
148230b22abeSAndrew Thompson  * writing back the qTD status, or miss signalling occasionally under
148330b22abeSAndrew Thompson  * heavy load.  If the host machine is too fast, we can miss
148430b22abeSAndrew Thompson  * transaction completion - when we scan the active list the
148530b22abeSAndrew Thompson  * transaction still seems to be active. This generally exhibits
148630b22abeSAndrew Thompson  * itself as a umass stall that never recovers.
148730b22abeSAndrew Thompson  *
148830b22abeSAndrew Thompson  * We work around this behaviour by setting up this callback after any
148930b22abeSAndrew Thompson  * softintr that completes with transactions still pending, giving us
149030b22abeSAndrew Thompson  * another chance to check for completion after the writeback has
149130b22abeSAndrew Thompson  * taken place.
149230b22abeSAndrew Thompson  */
149330b22abeSAndrew Thompson static void
149430b22abeSAndrew Thompson ehci_poll_timeout(void *arg)
149530b22abeSAndrew Thompson {
149630b22abeSAndrew Thompson 	ehci_softc_t *sc = arg;
149730b22abeSAndrew Thompson 
149830b22abeSAndrew Thompson 	DPRINTFN(3, "\n");
149930b22abeSAndrew Thompson 	ehci_interrupt_poll(sc);
150030b22abeSAndrew Thompson }
150130b22abeSAndrew Thompson 
150202ac6454SAndrew Thompson /*------------------------------------------------------------------------*
150302ac6454SAndrew Thompson  *	ehci_interrupt - EHCI interrupt handler
150402ac6454SAndrew Thompson  *
150502ac6454SAndrew Thompson  * NOTE: Do not access "sc->sc_bus.bdev" inside the interrupt handler,
150602ac6454SAndrew Thompson  * hence the interrupt handler will be setup before "sc->sc_bus.bdev"
150702ac6454SAndrew Thompson  * is present !
150802ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
150902ac6454SAndrew Thompson void
151002ac6454SAndrew Thompson ehci_interrupt(ehci_softc_t *sc)
151102ac6454SAndrew Thompson {
151202ac6454SAndrew Thompson 	uint32_t status;
151302ac6454SAndrew Thompson 
151402ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
151502ac6454SAndrew Thompson 
151602ac6454SAndrew Thompson 	DPRINTFN(16, "real interrupt\n");
151702ac6454SAndrew Thompson 
151802ac6454SAndrew Thompson #if USB_DEBUG
151902ac6454SAndrew Thompson 	if (ehcidebug > 15) {
152002ac6454SAndrew Thompson 		ehci_dump_regs(sc);
152102ac6454SAndrew Thompson 	}
152202ac6454SAndrew Thompson #endif
152302ac6454SAndrew Thompson 
152402ac6454SAndrew Thompson 	status = EHCI_STS_INTRS(EOREAD4(sc, EHCI_USBSTS));
152502ac6454SAndrew Thompson 	if (status == 0) {
152602ac6454SAndrew Thompson 		/* the interrupt was not for us */
152702ac6454SAndrew Thompson 		goto done;
152802ac6454SAndrew Thompson 	}
152902ac6454SAndrew Thompson 	if (!(status & sc->sc_eintrs)) {
153002ac6454SAndrew Thompson 		goto done;
153102ac6454SAndrew Thompson 	}
153202ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBSTS, status);	/* acknowledge */
153302ac6454SAndrew Thompson 
153402ac6454SAndrew Thompson 	status &= sc->sc_eintrs;
153502ac6454SAndrew Thompson 
153602ac6454SAndrew Thompson 	if (status & EHCI_STS_HSE) {
153702ac6454SAndrew Thompson 		printf("%s: unrecoverable error, "
153802ac6454SAndrew Thompson 		    "controller halted\n", __FUNCTION__);
153902ac6454SAndrew Thompson #if USB_DEBUG
154002ac6454SAndrew Thompson 		ehci_dump_regs(sc);
154102ac6454SAndrew Thompson 		ehci_dump_isoc(sc);
154202ac6454SAndrew Thompson #endif
154302ac6454SAndrew Thompson 	}
154402ac6454SAndrew Thompson 	if (status & EHCI_STS_PCD) {
154502ac6454SAndrew Thompson 		/*
154602ac6454SAndrew Thompson 		 * Disable PCD interrupt for now, because it will be
154702ac6454SAndrew Thompson 		 * on until the port has been reset.
154802ac6454SAndrew Thompson 		 */
154902ac6454SAndrew Thompson 		sc->sc_eintrs &= ~EHCI_STS_PCD;
155002ac6454SAndrew Thompson 		EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
155102ac6454SAndrew Thompson 
155239307315SAndrew Thompson 		ehci_root_intr(sc);
155302ac6454SAndrew Thompson 
155402ac6454SAndrew Thompson 		/* do not allow RHSC interrupts > 1 per second */
1555a593f6b8SAndrew Thompson 		usb_callout_reset(&sc->sc_tmo_pcd, hz,
155602ac6454SAndrew Thompson 		    (void *)&ehci_pcd_enable, sc);
155702ac6454SAndrew Thompson 	}
155802ac6454SAndrew Thompson 	status &= ~(EHCI_STS_INT | EHCI_STS_ERRINT | EHCI_STS_PCD | EHCI_STS_IAA);
155902ac6454SAndrew Thompson 
156002ac6454SAndrew Thompson 	if (status != 0) {
156102ac6454SAndrew Thompson 		/* block unprocessed interrupts */
156202ac6454SAndrew Thompson 		sc->sc_eintrs &= ~status;
156302ac6454SAndrew Thompson 		EOWRITE4(sc, EHCI_USBINTR, sc->sc_eintrs);
156402ac6454SAndrew Thompson 		printf("%s: blocking interrupts 0x%x\n", __FUNCTION__, status);
156502ac6454SAndrew Thompson 	}
156602ac6454SAndrew Thompson 	/* poll all the USB transfers */
156702ac6454SAndrew Thompson 	ehci_interrupt_poll(sc);
156802ac6454SAndrew Thompson 
156930b22abeSAndrew Thompson 	if (sc->sc_flags & EHCI_SCFLG_LOSTINTRBUG) {
157030b22abeSAndrew Thompson 		usb_callout_reset(&sc->sc_tmo_poll, hz / 128,
157130b22abeSAndrew Thompson 		    (void *)&ehci_poll_timeout, sc);
157230b22abeSAndrew Thompson 	}
157330b22abeSAndrew Thompson 
157402ac6454SAndrew Thompson done:
157502ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
157602ac6454SAndrew Thompson }
157702ac6454SAndrew Thompson 
157802ac6454SAndrew Thompson /*
157902ac6454SAndrew Thompson  * called when a request does not complete
158002ac6454SAndrew Thompson  */
158102ac6454SAndrew Thompson static void
158202ac6454SAndrew Thompson ehci_timeout(void *arg)
158302ac6454SAndrew Thompson {
1584760bc48eSAndrew Thompson 	struct usb_xfer *xfer = arg;
158502ac6454SAndrew Thompson 
158602ac6454SAndrew Thompson 	DPRINTF("xfer=%p\n", xfer);
158702ac6454SAndrew Thompson 
158802ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED);
158902ac6454SAndrew Thompson 
159002ac6454SAndrew Thompson 	/* transfer is transferred */
159102ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_TIMEOUT);
159202ac6454SAndrew Thompson }
159302ac6454SAndrew Thompson 
159402ac6454SAndrew Thompson static void
1595760bc48eSAndrew Thompson ehci_do_poll(struct usb_bus *bus)
159602ac6454SAndrew Thompson {
159702ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(bus);
159802ac6454SAndrew Thompson 
159902ac6454SAndrew Thompson 	USB_BUS_LOCK(&sc->sc_bus);
160002ac6454SAndrew Thompson 	ehci_interrupt_poll(sc);
160102ac6454SAndrew Thompson 	USB_BUS_UNLOCK(&sc->sc_bus);
160202ac6454SAndrew Thompson }
160302ac6454SAndrew Thompson 
160402ac6454SAndrew Thompson static void
160502ac6454SAndrew Thompson ehci_setup_standard_chain_sub(struct ehci_std_temp *temp)
160602ac6454SAndrew Thompson {
1607760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
160802ac6454SAndrew Thompson 	ehci_qtd_t *td;
160902ac6454SAndrew Thompson 	ehci_qtd_t *td_next;
161002ac6454SAndrew Thompson 	ehci_qtd_t *td_alt_next;
161102ac6454SAndrew Thompson 	uint32_t buf_offset;
161202ac6454SAndrew Thompson 	uint32_t average;
161302ac6454SAndrew Thompson 	uint32_t len_old;
16140f7d4548SAndrew Thompson 	uint32_t terminate;
161502ac6454SAndrew Thompson 	uint8_t shortpkt_old;
161602ac6454SAndrew Thompson 	uint8_t precompute;
161702ac6454SAndrew Thompson 
16180f7d4548SAndrew Thompson 	terminate = htohc32(temp->sc, EHCI_LINK_TERMINATE);
161902ac6454SAndrew Thompson 	td_alt_next = NULL;
162002ac6454SAndrew Thompson 	buf_offset = 0;
162102ac6454SAndrew Thompson 	shortpkt_old = temp->shortpkt;
162202ac6454SAndrew Thompson 	len_old = temp->len;
162302ac6454SAndrew Thompson 	precompute = 1;
162402ac6454SAndrew Thompson 
162502ac6454SAndrew Thompson restart:
162602ac6454SAndrew Thompson 
162702ac6454SAndrew Thompson 	td = temp->td;
162802ac6454SAndrew Thompson 	td_next = temp->td_next;
162902ac6454SAndrew Thompson 
163002ac6454SAndrew Thompson 	while (1) {
163102ac6454SAndrew Thompson 
163202ac6454SAndrew Thompson 		if (temp->len == 0) {
163302ac6454SAndrew Thompson 
163402ac6454SAndrew Thompson 			if (temp->shortpkt) {
163502ac6454SAndrew Thompson 				break;
163602ac6454SAndrew Thompson 			}
163702ac6454SAndrew Thompson 			/* send a Zero Length Packet, ZLP, last */
163802ac6454SAndrew Thompson 
163902ac6454SAndrew Thompson 			temp->shortpkt = 1;
164002ac6454SAndrew Thompson 			average = 0;
164102ac6454SAndrew Thompson 
164202ac6454SAndrew Thompson 		} else {
164302ac6454SAndrew Thompson 
164402ac6454SAndrew Thompson 			average = temp->average;
164502ac6454SAndrew Thompson 
164602ac6454SAndrew Thompson 			if (temp->len < average) {
164702ac6454SAndrew Thompson 				if (temp->len % temp->max_frame_size) {
164802ac6454SAndrew Thompson 					temp->shortpkt = 1;
164902ac6454SAndrew Thompson 				}
165002ac6454SAndrew Thompson 				average = temp->len;
165102ac6454SAndrew Thompson 			}
165202ac6454SAndrew Thompson 		}
165302ac6454SAndrew Thompson 
165402ac6454SAndrew Thompson 		if (td_next == NULL) {
165502ac6454SAndrew Thompson 			panic("%s: out of EHCI transfer descriptors!", __FUNCTION__);
165602ac6454SAndrew Thompson 		}
165702ac6454SAndrew Thompson 		/* get next TD */
165802ac6454SAndrew Thompson 
165902ac6454SAndrew Thompson 		td = td_next;
166002ac6454SAndrew Thompson 		td_next = td->obj_next;
166102ac6454SAndrew Thompson 
166202ac6454SAndrew Thompson 		/* check if we are pre-computing */
166302ac6454SAndrew Thompson 
166402ac6454SAndrew Thompson 		if (precompute) {
166502ac6454SAndrew Thompson 
166602ac6454SAndrew Thompson 			/* update remaining length */
166702ac6454SAndrew Thompson 
166802ac6454SAndrew Thompson 			temp->len -= average;
166902ac6454SAndrew Thompson 
167002ac6454SAndrew Thompson 			continue;
167102ac6454SAndrew Thompson 		}
167202ac6454SAndrew Thompson 		/* fill out current TD */
167302ac6454SAndrew Thompson 
167402ac6454SAndrew Thompson 		td->qtd_status =
167502ac6454SAndrew Thompson 		    temp->qtd_status |
1676c8a14b91SAndrew Thompson 		    htohc32(temp->sc, EHCI_QTD_IOC |
1677c8a14b91SAndrew Thompson 			EHCI_QTD_SET_BYTES(average));
167802ac6454SAndrew Thompson 
167902ac6454SAndrew Thompson 		if (average == 0) {
168002ac6454SAndrew Thompson 
168102ac6454SAndrew Thompson 			if (temp->auto_data_toggle == 0) {
168202ac6454SAndrew Thompson 
168302ac6454SAndrew Thompson 				/* update data toggle, ZLP case */
168402ac6454SAndrew Thompson 
168502ac6454SAndrew Thompson 				temp->qtd_status ^=
1686e55e1ebcSAndrew Thompson 				    htohc32(temp->sc, EHCI_QTD_TOGGLE_MASK);
168702ac6454SAndrew Thompson 			}
168802ac6454SAndrew Thompson 			td->len = 0;
168902ac6454SAndrew Thompson 
169002ac6454SAndrew Thompson 			td->qtd_buffer[0] = 0;
169102ac6454SAndrew Thompson 			td->qtd_buffer_hi[0] = 0;
169202ac6454SAndrew Thompson 
169302ac6454SAndrew Thompson 			td->qtd_buffer[1] = 0;
169402ac6454SAndrew Thompson 			td->qtd_buffer_hi[1] = 0;
169502ac6454SAndrew Thompson 
169602ac6454SAndrew Thompson 		} else {
169702ac6454SAndrew Thompson 
169802ac6454SAndrew Thompson 			uint8_t x;
169902ac6454SAndrew Thompson 
170002ac6454SAndrew Thompson 			if (temp->auto_data_toggle == 0) {
170102ac6454SAndrew Thompson 
170202ac6454SAndrew Thompson 				/* update data toggle */
170302ac6454SAndrew Thompson 
170402ac6454SAndrew Thompson 				if (((average + temp->max_frame_size - 1) /
170502ac6454SAndrew Thompson 				    temp->max_frame_size) & 1) {
170602ac6454SAndrew Thompson 					temp->qtd_status ^=
1707e55e1ebcSAndrew Thompson 					    htohc32(temp->sc, EHCI_QTD_TOGGLE_MASK);
170802ac6454SAndrew Thompson 				}
170902ac6454SAndrew Thompson 			}
171002ac6454SAndrew Thompson 			td->len = average;
171102ac6454SAndrew Thompson 
171202ac6454SAndrew Thompson 			/* update remaining length */
171302ac6454SAndrew Thompson 
171402ac6454SAndrew Thompson 			temp->len -= average;
171502ac6454SAndrew Thompson 
171602ac6454SAndrew Thompson 			/* fill out buffer pointers */
171702ac6454SAndrew Thompson 
1718a593f6b8SAndrew Thompson 			usbd_get_page(temp->pc, buf_offset, &buf_res);
171902ac6454SAndrew Thompson 			td->qtd_buffer[0] =
1720e55e1ebcSAndrew Thompson 			    htohc32(temp->sc, buf_res.physaddr);
172102ac6454SAndrew Thompson 			td->qtd_buffer_hi[0] = 0;
172202ac6454SAndrew Thompson 
172302ac6454SAndrew Thompson 			x = 1;
172402ac6454SAndrew Thompson 
172502ac6454SAndrew Thompson 			while (average > EHCI_PAGE_SIZE) {
172602ac6454SAndrew Thompson 				average -= EHCI_PAGE_SIZE;
172702ac6454SAndrew Thompson 				buf_offset += EHCI_PAGE_SIZE;
1728a593f6b8SAndrew Thompson 				usbd_get_page(temp->pc, buf_offset, &buf_res);
172902ac6454SAndrew Thompson 				td->qtd_buffer[x] =
1730e55e1ebcSAndrew Thompson 				    htohc32(temp->sc,
173102ac6454SAndrew Thompson 				    buf_res.physaddr & (~0xFFF));
173202ac6454SAndrew Thompson 				td->qtd_buffer_hi[x] = 0;
173302ac6454SAndrew Thompson 				x++;
173402ac6454SAndrew Thompson 			}
173502ac6454SAndrew Thompson 
173602ac6454SAndrew Thompson 			/*
173702ac6454SAndrew Thompson 			 * NOTE: The "average" variable is never zero after
173802ac6454SAndrew Thompson 			 * exiting the loop above !
173902ac6454SAndrew Thompson 			 *
174002ac6454SAndrew Thompson 			 * NOTE: We have to subtract one from the offset to
174102ac6454SAndrew Thompson 			 * ensure that we are computing the physical address
174202ac6454SAndrew Thompson 			 * of a valid page !
174302ac6454SAndrew Thompson 			 */
174402ac6454SAndrew Thompson 			buf_offset += average;
1745a593f6b8SAndrew Thompson 			usbd_get_page(temp->pc, buf_offset - 1, &buf_res);
174602ac6454SAndrew Thompson 			td->qtd_buffer[x] =
1747e55e1ebcSAndrew Thompson 			    htohc32(temp->sc,
174802ac6454SAndrew Thompson 			    buf_res.physaddr & (~0xFFF));
174902ac6454SAndrew Thompson 			td->qtd_buffer_hi[x] = 0;
175002ac6454SAndrew Thompson 		}
175102ac6454SAndrew Thompson 
1752c8a14b91SAndrew Thompson 		if (temp->can_use_next) {
175302ac6454SAndrew Thompson 			if (td_next) {
175402ac6454SAndrew Thompson 				/* link the current TD with the next one */
175502ac6454SAndrew Thompson 				td->qtd_next = td_next->qtd_self;
175602ac6454SAndrew Thompson 			}
1757c8a14b91SAndrew Thompson 		} else {
1758c8a14b91SAndrew Thompson 			/*
1759c8a14b91SAndrew Thompson 			 * BUG WARNING: The EHCI HW can use the
1760c8a14b91SAndrew Thompson 			 * qtd_next field instead of qtd_altnext when
1761c8a14b91SAndrew Thompson 			 * a short packet is received! We work this
1762c8a14b91SAndrew Thompson 			 * around in software by not queueing more
1763c8a14b91SAndrew Thompson 			 * than one job/TD at a time!
1764c8a14b91SAndrew Thompson 			 */
1765c8a14b91SAndrew Thompson 			td->qtd_next = terminate;
1766c8a14b91SAndrew Thompson 		}
1767c8a14b91SAndrew Thompson 
1768c8a14b91SAndrew Thompson 		td->qtd_altnext = terminate;
176902ac6454SAndrew Thompson 		td->alt_next = td_alt_next;
177002ac6454SAndrew Thompson 
1771a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(td->page_cache);
177202ac6454SAndrew Thompson 	}
177302ac6454SAndrew Thompson 
177402ac6454SAndrew Thompson 	if (precompute) {
177502ac6454SAndrew Thompson 		precompute = 0;
177602ac6454SAndrew Thompson 
177702ac6454SAndrew Thompson 		/* setup alt next pointer, if any */
17780f7d4548SAndrew Thompson 		if (temp->last_frame) {
17790f7d4548SAndrew Thompson 			td_alt_next = NULL;
178002ac6454SAndrew Thompson 		} else {
178102ac6454SAndrew Thompson 			/* we use this field internally */
178202ac6454SAndrew Thompson 			td_alt_next = td_next;
178302ac6454SAndrew Thompson 		}
178402ac6454SAndrew Thompson 
178502ac6454SAndrew Thompson 		/* restore */
178602ac6454SAndrew Thompson 		temp->shortpkt = shortpkt_old;
178702ac6454SAndrew Thompson 		temp->len = len_old;
178802ac6454SAndrew Thompson 		goto restart;
178902ac6454SAndrew Thompson 	}
179002ac6454SAndrew Thompson 	temp->td = td;
179102ac6454SAndrew Thompson 	temp->td_next = td_next;
179202ac6454SAndrew Thompson }
179302ac6454SAndrew Thompson 
179402ac6454SAndrew Thompson static void
1795760bc48eSAndrew Thompson ehci_setup_standard_chain(struct usb_xfer *xfer, ehci_qh_t **qh_last)
179602ac6454SAndrew Thompson {
179702ac6454SAndrew Thompson 	struct ehci_std_temp temp;
1798760bc48eSAndrew Thompson 	struct usb_pipe_methods *methods;
179902ac6454SAndrew Thompson 	ehci_qh_t *qh;
180002ac6454SAndrew Thompson 	ehci_qtd_t *td;
180102ac6454SAndrew Thompson 	uint32_t qh_endp;
180202ac6454SAndrew Thompson 	uint32_t qh_endphub;
180302ac6454SAndrew Thompson 	uint32_t x;
180402ac6454SAndrew Thompson 
180502ac6454SAndrew Thompson 	DPRINTFN(9, "addr=%d endpt=%d sumlen=%d speed=%d\n",
1806ae60fdfbSAndrew Thompson 	    xfer->address, UE_GET_ADDR(xfer->endpointno),
1807a593f6b8SAndrew Thompson 	    xfer->sumlen, usbd_get_speed(xfer->xroot->udev));
180802ac6454SAndrew Thompson 
1809578d0effSAndrew Thompson 	temp.average = xfer->max_hc_frame_size;
181002ac6454SAndrew Thompson 	temp.max_frame_size = xfer->max_frame_size;
181102ac6454SAndrew Thompson 	temp.sc = EHCI_BUS2SC(xfer->xroot->bus);
181202ac6454SAndrew Thompson 
181302ac6454SAndrew Thompson 	/* toggle the DMA set we are using */
181402ac6454SAndrew Thompson 	xfer->flags_int.curr_dma_set ^= 1;
181502ac6454SAndrew Thompson 
181602ac6454SAndrew Thompson 	/* get next DMA set */
181702ac6454SAndrew Thompson 	td = xfer->td_start[xfer->flags_int.curr_dma_set];
181802ac6454SAndrew Thompson 
181902ac6454SAndrew Thompson 	xfer->td_transfer_first = td;
182002ac6454SAndrew Thompson 	xfer->td_transfer_cache = td;
182102ac6454SAndrew Thompson 
182202ac6454SAndrew Thompson 	temp.td = NULL;
182302ac6454SAndrew Thompson 	temp.td_next = td;
182402ac6454SAndrew Thompson 	temp.qtd_status = 0;
18250f7d4548SAndrew Thompson 	temp.last_frame = 0;
182602ac6454SAndrew Thompson 	temp.setup_alt_next = xfer->flags_int.short_frames_ok;
1827c8a14b91SAndrew Thompson 	temp.can_use_next = (xfer->flags_int.control_xfr ||
1828c8a14b91SAndrew Thompson 	    (UE_GET_DIR(xfer->endpointno) == UE_DIR_OUT));
182902ac6454SAndrew Thompson 
183002ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr) {
1831ae60fdfbSAndrew Thompson 		if (xfer->endpoint->toggle_next) {
183202ac6454SAndrew Thompson 			/* DATA1 is next */
183302ac6454SAndrew Thompson 			temp.qtd_status |=
1834e55e1ebcSAndrew Thompson 			    htohc32(temp.sc, EHCI_QTD_SET_TOGGLE(1));
183502ac6454SAndrew Thompson 		}
183602ac6454SAndrew Thompson 		temp.auto_data_toggle = 0;
183702ac6454SAndrew Thompson 	} else {
183802ac6454SAndrew Thompson 		temp.auto_data_toggle = 1;
183902ac6454SAndrew Thompson 	}
184002ac6454SAndrew Thompson 
1841a593f6b8SAndrew Thompson 	if (usbd_get_speed(xfer->xroot->udev) != USB_SPEED_HIGH) {
184202ac6454SAndrew Thompson 		/* max 3 retries */
184302ac6454SAndrew Thompson 		temp.qtd_status |=
1844e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_SET_CERR(3));
184502ac6454SAndrew Thompson 	}
184602ac6454SAndrew Thompson 	/* check if we should prepend a setup message */
184702ac6454SAndrew Thompson 
184802ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr) {
184902ac6454SAndrew Thompson 		if (xfer->flags_int.control_hdr) {
185002ac6454SAndrew Thompson 
185102ac6454SAndrew Thompson 			temp.qtd_status &=
1852e55e1ebcSAndrew Thompson 			    htohc32(temp.sc, EHCI_QTD_SET_CERR(3));
1853e55e1ebcSAndrew Thompson 			temp.qtd_status |= htohc32(temp.sc,
18545f128668SAndrew Thompson 			    EHCI_QTD_ACTIVE |
185502ac6454SAndrew Thompson 			    EHCI_QTD_SET_PID(EHCI_QTD_PID_SETUP) |
185602ac6454SAndrew Thompson 			    EHCI_QTD_SET_TOGGLE(0));
185702ac6454SAndrew Thompson 
185802ac6454SAndrew Thompson 			temp.len = xfer->frlengths[0];
185902ac6454SAndrew Thompson 			temp.pc = xfer->frbuffers + 0;
186002ac6454SAndrew Thompson 			temp.shortpkt = temp.len ? 1 : 0;
18610f7d4548SAndrew Thompson 			/* check for last frame */
18620f7d4548SAndrew Thompson 			if (xfer->nframes == 1) {
18630f7d4548SAndrew Thompson 				/* no STATUS stage yet, SETUP is last */
18640f7d4548SAndrew Thompson 				if (xfer->flags_int.control_act) {
18650f7d4548SAndrew Thompson 					temp.last_frame = 1;
18660f7d4548SAndrew Thompson 					temp.setup_alt_next = 0;
18670f7d4548SAndrew Thompson 				}
18680f7d4548SAndrew Thompson 			}
186902ac6454SAndrew Thompson 			ehci_setup_standard_chain_sub(&temp);
187002ac6454SAndrew Thompson 		}
187102ac6454SAndrew Thompson 		x = 1;
187202ac6454SAndrew Thompson 	} else {
187302ac6454SAndrew Thompson 		x = 0;
187402ac6454SAndrew Thompson 	}
187502ac6454SAndrew Thompson 
187602ac6454SAndrew Thompson 	while (x != xfer->nframes) {
187702ac6454SAndrew Thompson 
187802ac6454SAndrew Thompson 		/* DATA0 / DATA1 message */
187902ac6454SAndrew Thompson 
188002ac6454SAndrew Thompson 		temp.len = xfer->frlengths[x];
188102ac6454SAndrew Thompson 		temp.pc = xfer->frbuffers + x;
188202ac6454SAndrew Thompson 
188302ac6454SAndrew Thompson 		x++;
188402ac6454SAndrew Thompson 
188502ac6454SAndrew Thompson 		if (x == xfer->nframes) {
18860f7d4548SAndrew Thompson 			if (xfer->flags_int.control_xfr) {
18870f7d4548SAndrew Thompson 				/* no STATUS stage yet, DATA is last */
18880f7d4548SAndrew Thompson 				if (xfer->flags_int.control_act) {
18890f7d4548SAndrew Thompson 					temp.last_frame = 1;
189002ac6454SAndrew Thompson 					temp.setup_alt_next = 0;
189102ac6454SAndrew Thompson 				}
18920f7d4548SAndrew Thompson 			} else {
18930f7d4548SAndrew Thompson 				temp.last_frame = 1;
18940f7d4548SAndrew Thompson 				temp.setup_alt_next = 0;
18950f7d4548SAndrew Thompson 			}
18960f7d4548SAndrew Thompson 		}
189702ac6454SAndrew Thompson 		/* keep previous data toggle and error count */
189802ac6454SAndrew Thompson 
189902ac6454SAndrew Thompson 		temp.qtd_status &=
1900e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_SET_CERR(3) |
190102ac6454SAndrew Thompson 		    EHCI_QTD_SET_TOGGLE(1));
190202ac6454SAndrew Thompson 
190302ac6454SAndrew Thompson 		if (temp.len == 0) {
190402ac6454SAndrew Thompson 
190502ac6454SAndrew Thompson 			/* make sure that we send an USB packet */
190602ac6454SAndrew Thompson 
190702ac6454SAndrew Thompson 			temp.shortpkt = 0;
190802ac6454SAndrew Thompson 
190902ac6454SAndrew Thompson 		} else {
191002ac6454SAndrew Thompson 
191102ac6454SAndrew Thompson 			/* regular data transfer */
191202ac6454SAndrew Thompson 
191302ac6454SAndrew Thompson 			temp.shortpkt = (xfer->flags.force_short_xfer) ? 0 : 1;
191402ac6454SAndrew Thompson 		}
191502ac6454SAndrew Thompson 
191602ac6454SAndrew Thompson 		/* set endpoint direction */
191702ac6454SAndrew Thompson 
191802ac6454SAndrew Thompson 		temp.qtd_status |=
1919ae60fdfbSAndrew Thompson 		    (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) ?
1920e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_ACTIVE |
192102ac6454SAndrew Thompson 		    EHCI_QTD_SET_PID(EHCI_QTD_PID_IN)) :
1922e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_ACTIVE |
192302ac6454SAndrew Thompson 		    EHCI_QTD_SET_PID(EHCI_QTD_PID_OUT));
192402ac6454SAndrew Thompson 
192502ac6454SAndrew Thompson 		ehci_setup_standard_chain_sub(&temp);
192602ac6454SAndrew Thompson 	}
192702ac6454SAndrew Thompson 
192802ac6454SAndrew Thompson 	/* check if we should append a status stage */
192902ac6454SAndrew Thompson 
193002ac6454SAndrew Thompson 	if (xfer->flags_int.control_xfr &&
193102ac6454SAndrew Thompson 	    !xfer->flags_int.control_act) {
193202ac6454SAndrew Thompson 
193302ac6454SAndrew Thompson 		/*
193402ac6454SAndrew Thompson 		 * Send a DATA1 message and invert the current endpoint
193502ac6454SAndrew Thompson 		 * direction.
193602ac6454SAndrew Thompson 		 */
193702ac6454SAndrew Thompson 
1938e55e1ebcSAndrew Thompson 		temp.qtd_status &= htohc32(temp.sc, EHCI_QTD_SET_CERR(3) |
193902ac6454SAndrew Thompson 		    EHCI_QTD_SET_TOGGLE(1));
194002ac6454SAndrew Thompson 		temp.qtd_status |=
1941ae60fdfbSAndrew Thompson 		    (UE_GET_DIR(xfer->endpointno) == UE_DIR_OUT) ?
1942e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_ACTIVE |
194302ac6454SAndrew Thompson 		    EHCI_QTD_SET_PID(EHCI_QTD_PID_IN) |
194402ac6454SAndrew Thompson 		    EHCI_QTD_SET_TOGGLE(1)) :
1945e55e1ebcSAndrew Thompson 		    htohc32(temp.sc, EHCI_QTD_ACTIVE |
194602ac6454SAndrew Thompson 		    EHCI_QTD_SET_PID(EHCI_QTD_PID_OUT) |
194702ac6454SAndrew Thompson 		    EHCI_QTD_SET_TOGGLE(1));
194802ac6454SAndrew Thompson 
194902ac6454SAndrew Thompson 		temp.len = 0;
195002ac6454SAndrew Thompson 		temp.pc = NULL;
195102ac6454SAndrew Thompson 		temp.shortpkt = 0;
19520f7d4548SAndrew Thompson 		temp.last_frame = 1;
19530f7d4548SAndrew Thompson 		temp.setup_alt_next = 0;
195402ac6454SAndrew Thompson 
195502ac6454SAndrew Thompson 		ehci_setup_standard_chain_sub(&temp);
195602ac6454SAndrew Thompson 	}
195702ac6454SAndrew Thompson 	td = temp.td;
195802ac6454SAndrew Thompson 
195902ac6454SAndrew Thompson 	/* the last TD terminates the transfer: */
1960e55e1ebcSAndrew Thompson 	td->qtd_next = htohc32(temp.sc, EHCI_LINK_TERMINATE);
1961e55e1ebcSAndrew Thompson 	td->qtd_altnext = htohc32(temp.sc, EHCI_LINK_TERMINATE);
196202ac6454SAndrew Thompson 
1963a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(td->page_cache);
196402ac6454SAndrew Thompson 
196502ac6454SAndrew Thompson 	/* must have at least one frame! */
196602ac6454SAndrew Thompson 
196702ac6454SAndrew Thompson 	xfer->td_transfer_last = td;
196802ac6454SAndrew Thompson 
196902ac6454SAndrew Thompson #if USB_DEBUG
197002ac6454SAndrew Thompson 	if (ehcidebug > 8) {
197102ac6454SAndrew Thompson 		DPRINTF("nexttog=%d; data before transfer:\n",
1972ae60fdfbSAndrew Thompson 		    xfer->endpoint->toggle_next);
197302ac6454SAndrew Thompson 		ehci_dump_sqtds(temp.sc,
197402ac6454SAndrew Thompson 		    xfer->td_transfer_first);
197502ac6454SAndrew Thompson 	}
197602ac6454SAndrew Thompson #endif
197702ac6454SAndrew Thompson 
1978ae60fdfbSAndrew Thompson 	methods = xfer->endpoint->methods;
197902ac6454SAndrew Thompson 
198002ac6454SAndrew Thompson 	qh = xfer->qh_start[xfer->flags_int.curr_dma_set];
198102ac6454SAndrew Thompson 
198202ac6454SAndrew Thompson 	/* the "qh_link" field is filled when the QH is added */
198302ac6454SAndrew Thompson 
198402ac6454SAndrew Thompson 	qh_endp =
198502ac6454SAndrew Thompson 	    (EHCI_QH_SET_ADDR(xfer->address) |
1986ae60fdfbSAndrew Thompson 	    EHCI_QH_SET_ENDPT(UE_GET_ADDR(xfer->endpointno)) |
198702ac6454SAndrew Thompson 	    EHCI_QH_SET_MPL(xfer->max_packet_size));
198802ac6454SAndrew Thompson 
1989a593f6b8SAndrew Thompson 	if (usbd_get_speed(xfer->xroot->udev) == USB_SPEED_HIGH) {
19902094ecdaSAndrew Thompson 		qh_endp |= EHCI_QH_SET_EPS(EHCI_QH_SPEED_HIGH);
199102ac6454SAndrew Thompson 		if (methods != &ehci_device_intr_methods)
199202ac6454SAndrew Thompson 			qh_endp |= EHCI_QH_SET_NRL(8);
199302ac6454SAndrew Thompson 	} else {
199402ac6454SAndrew Thompson 
1995a593f6b8SAndrew Thompson 		if (usbd_get_speed(xfer->xroot->udev) == USB_SPEED_FULL) {
19962094ecdaSAndrew Thompson 			qh_endp |= EHCI_QH_SET_EPS(EHCI_QH_SPEED_FULL);
199702ac6454SAndrew Thompson 		} else {
19982094ecdaSAndrew Thompson 			qh_endp |= EHCI_QH_SET_EPS(EHCI_QH_SPEED_LOW);
199902ac6454SAndrew Thompson 		}
200002ac6454SAndrew Thompson 
200102ac6454SAndrew Thompson 		if (methods == &ehci_device_ctrl_methods) {
200202ac6454SAndrew Thompson 			qh_endp |= EHCI_QH_CTL;
200302ac6454SAndrew Thompson 		}
200402ac6454SAndrew Thompson 		if (methods != &ehci_device_intr_methods) {
200502ac6454SAndrew Thompson 			/* Only try one time per microframe! */
200602ac6454SAndrew Thompson 			qh_endp |= EHCI_QH_SET_NRL(1);
200702ac6454SAndrew Thompson 		}
200802ac6454SAndrew Thompson 	}
200902ac6454SAndrew Thompson 
20102094ecdaSAndrew Thompson 	if (temp.auto_data_toggle == 0) {
20112094ecdaSAndrew Thompson 		/* software computes the data toggle */
20122094ecdaSAndrew Thompson 		qh_endp |= EHCI_QH_DTC;
20132094ecdaSAndrew Thompson 	}
20142094ecdaSAndrew Thompson 
2015e55e1ebcSAndrew Thompson 	qh->qh_endp = htohc32(temp.sc, qh_endp);
201602ac6454SAndrew Thompson 
201702ac6454SAndrew Thompson 	qh_endphub =
201802ac6454SAndrew Thompson 	    (EHCI_QH_SET_MULT(xfer->max_packet_count & 3) |
2019a593f6b8SAndrew Thompson 	    EHCI_QH_SET_CMASK(xfer->usb_cmask) |
2020a593f6b8SAndrew Thompson 	    EHCI_QH_SET_SMASK(xfer->usb_smask) |
202102ac6454SAndrew Thompson 	    EHCI_QH_SET_HUBA(xfer->xroot->udev->hs_hub_addr) |
202202ac6454SAndrew Thompson 	    EHCI_QH_SET_PORT(xfer->xroot->udev->hs_port_no));
202302ac6454SAndrew Thompson 
2024e55e1ebcSAndrew Thompson 	qh->qh_endphub = htohc32(temp.sc, qh_endphub);
20252094ecdaSAndrew Thompson 	qh->qh_curqtd = 0;
202602ac6454SAndrew Thompson 
202702ac6454SAndrew Thompson 	/* fill the overlay qTD */
202802ac6454SAndrew Thompson 
20292094ecdaSAndrew Thompson 	if (temp.auto_data_toggle && xfer->endpoint->toggle_next) {
203002ac6454SAndrew Thompson 		/* DATA1 is next */
20312094ecdaSAndrew Thompson 		qh->qh_qtd.qtd_status = htohc32(temp.sc, EHCI_QTD_SET_TOGGLE(1));
20322094ecdaSAndrew Thompson 	} else {
20332094ecdaSAndrew Thompson 		qh->qh_qtd.qtd_status = 0;
203402ac6454SAndrew Thompson 	}
20352094ecdaSAndrew Thompson 
203602ac6454SAndrew Thompson 	td = xfer->td_transfer_first;
203702ac6454SAndrew Thompson 
203802ac6454SAndrew Thompson 	qh->qh_qtd.qtd_next = td->qtd_self;
203902ac6454SAndrew Thompson 	qh->qh_qtd.qtd_altnext =
2040e55e1ebcSAndrew Thompson 	    htohc32(temp.sc, EHCI_LINK_TERMINATE);
204102ac6454SAndrew Thompson 
2042a593f6b8SAndrew Thompson 	usb_pc_cpu_flush(qh->page_cache);
204302ac6454SAndrew Thompson 
2044ec8f3127SAndrew Thompson 	if (xfer->xroot->udev->flags.self_suspended == 0) {
204502ac6454SAndrew Thompson 		EHCI_APPEND_QH(qh, *qh_last);
204602ac6454SAndrew Thompson 	}
204702ac6454SAndrew Thompson }
204802ac6454SAndrew Thompson 
204902ac6454SAndrew Thompson static void
205039307315SAndrew Thompson ehci_root_intr(ehci_softc_t *sc)
205102ac6454SAndrew Thompson {
205202ac6454SAndrew Thompson 	uint16_t i;
205302ac6454SAndrew Thompson 	uint16_t m;
205402ac6454SAndrew Thompson 
205502ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
205602ac6454SAndrew Thompson 
205702ac6454SAndrew Thompson 	/* clear any old interrupt data */
205839307315SAndrew Thompson 	memset(sc->sc_hub_idata, 0, sizeof(sc->sc_hub_idata));
205902ac6454SAndrew Thompson 
206002ac6454SAndrew Thompson 	/* set bits */
206102ac6454SAndrew Thompson 	m = (sc->sc_noport + 1);
206202ac6454SAndrew Thompson 	if (m > (8 * sizeof(sc->sc_hub_idata))) {
206302ac6454SAndrew Thompson 		m = (8 * sizeof(sc->sc_hub_idata));
206402ac6454SAndrew Thompson 	}
206502ac6454SAndrew Thompson 	for (i = 1; i < m; i++) {
206602ac6454SAndrew Thompson 		/* pick out CHANGE bits from the status register */
206702ac6454SAndrew Thompson 		if (EOREAD4(sc, EHCI_PORTSC(i)) & EHCI_PS_CLEAR) {
206802ac6454SAndrew Thompson 			sc->sc_hub_idata[i / 8] |= 1 << (i % 8);
206902ac6454SAndrew Thompson 			DPRINTF("port %d changed\n", i);
207002ac6454SAndrew Thompson 		}
207102ac6454SAndrew Thompson 	}
207239307315SAndrew Thompson 	uhub_root_intr(&sc->sc_bus, sc->sc_hub_idata,
207339307315SAndrew Thompson 	    sizeof(sc->sc_hub_idata));
207402ac6454SAndrew Thompson }
207502ac6454SAndrew Thompson 
207602ac6454SAndrew Thompson static void
2077760bc48eSAndrew Thompson ehci_isoc_fs_done(ehci_softc_t *sc, struct usb_xfer *xfer)
207802ac6454SAndrew Thompson {
207902ac6454SAndrew Thompson 	uint32_t nframes = xfer->nframes;
208002ac6454SAndrew Thompson 	uint32_t status;
208102ac6454SAndrew Thompson 	uint32_t *plen = xfer->frlengths;
208202ac6454SAndrew Thompson 	uint16_t len = 0;
208302ac6454SAndrew Thompson 	ehci_sitd_t *td = xfer->td_transfer_first;
208402ac6454SAndrew Thompson 	ehci_sitd_t **pp_last = &sc->sc_isoc_fs_p_last[xfer->qh_pos];
208502ac6454SAndrew Thompson 
2086ae60fdfbSAndrew Thompson 	DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n",
2087ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint);
208802ac6454SAndrew Thompson 
208902ac6454SAndrew Thompson 	while (nframes--) {
209002ac6454SAndrew Thompson 		if (td == NULL) {
209102ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
209202ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
209302ac6454SAndrew Thompson 		}
209402ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_fs_p_last[EHCI_VIRTUAL_FRAMELIST_COUNT]) {
209502ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_fs_p_last[0];
209602ac6454SAndrew Thompson 		}
209702ac6454SAndrew Thompson #if USB_DEBUG
209802ac6454SAndrew Thompson 		if (ehcidebug > 15) {
209902ac6454SAndrew Thompson 			DPRINTF("isoc FS-TD\n");
210002ac6454SAndrew Thompson 			ehci_dump_sitd(sc, td);
210102ac6454SAndrew Thompson 		}
210202ac6454SAndrew Thompson #endif
2103a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
2104e55e1ebcSAndrew Thompson 		status = hc32toh(sc, td->sitd_status);
210502ac6454SAndrew Thompson 
210602ac6454SAndrew Thompson 		len = EHCI_SITD_GET_LEN(status);
210702ac6454SAndrew Thompson 
2108c773c254SAndrew Thompson 		DPRINTFN(2, "status=0x%08x, rem=%u\n", status, len);
2109c773c254SAndrew Thompson 
211002ac6454SAndrew Thompson 		if (*plen >= len) {
211102ac6454SAndrew Thompson 			len = *plen - len;
211202ac6454SAndrew Thompson 		} else {
211302ac6454SAndrew Thompson 			len = 0;
211402ac6454SAndrew Thompson 		}
211502ac6454SAndrew Thompson 
211602ac6454SAndrew Thompson 		*plen = len;
211702ac6454SAndrew Thompson 
211802ac6454SAndrew Thompson 		/* remove FS-TD from schedule */
211902ac6454SAndrew Thompson 		EHCI_REMOVE_FS_TD(td, *pp_last);
212002ac6454SAndrew Thompson 
212102ac6454SAndrew Thompson 		pp_last++;
212202ac6454SAndrew Thompson 		plen++;
212302ac6454SAndrew Thompson 		td = td->obj_next;
212402ac6454SAndrew Thompson 	}
212502ac6454SAndrew Thompson 
212602ac6454SAndrew Thompson 	xfer->aframes = xfer->nframes;
212702ac6454SAndrew Thompson }
212802ac6454SAndrew Thompson 
212902ac6454SAndrew Thompson static void
2130760bc48eSAndrew Thompson ehci_isoc_hs_done(ehci_softc_t *sc, struct usb_xfer *xfer)
213102ac6454SAndrew Thompson {
213202ac6454SAndrew Thompson 	uint32_t nframes = xfer->nframes;
213302ac6454SAndrew Thompson 	uint32_t status;
213402ac6454SAndrew Thompson 	uint32_t *plen = xfer->frlengths;
213502ac6454SAndrew Thompson 	uint16_t len = 0;
213602ac6454SAndrew Thompson 	uint8_t td_no = 0;
213702ac6454SAndrew Thompson 	ehci_itd_t *td = xfer->td_transfer_first;
213802ac6454SAndrew Thompson 	ehci_itd_t **pp_last = &sc->sc_isoc_hs_p_last[xfer->qh_pos];
213902ac6454SAndrew Thompson 
2140ae60fdfbSAndrew Thompson 	DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n",
2141ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint);
214202ac6454SAndrew Thompson 
2143883bb300SAndrew Thompson 	while (nframes) {
214402ac6454SAndrew Thompson 		if (td == NULL) {
214502ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
214602ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
214702ac6454SAndrew Thompson 		}
214802ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_hs_p_last[EHCI_VIRTUAL_FRAMELIST_COUNT]) {
214902ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_hs_p_last[0];
215002ac6454SAndrew Thompson 		}
215102ac6454SAndrew Thompson #if USB_DEBUG
215202ac6454SAndrew Thompson 		if (ehcidebug > 15) {
215302ac6454SAndrew Thompson 			DPRINTF("isoc HS-TD\n");
215402ac6454SAndrew Thompson 			ehci_dump_itd(sc, td);
215502ac6454SAndrew Thompson 		}
215602ac6454SAndrew Thompson #endif
215702ac6454SAndrew Thompson 
2158a593f6b8SAndrew Thompson 		usb_pc_cpu_invalidate(td->page_cache);
2159e55e1ebcSAndrew Thompson 		status = hc32toh(sc, td->itd_status[td_no]);
216002ac6454SAndrew Thompson 
216102ac6454SAndrew Thompson 		len = EHCI_ITD_GET_LEN(status);
216202ac6454SAndrew Thompson 
2163c773c254SAndrew Thompson 		DPRINTFN(2, "status=0x%08x, len=%u\n", status, len);
2164c773c254SAndrew Thompson 
2165883bb300SAndrew Thompson 		if (xfer->usb_smask & (1 << td_no)) {
2166883bb300SAndrew Thompson 
216702ac6454SAndrew Thompson 			if (*plen >= len) {
216802ac6454SAndrew Thompson 				/*
2169883bb300SAndrew Thompson 				 * The length is valid. NOTE: The
2170883bb300SAndrew Thompson 				 * complete length is written back
2171883bb300SAndrew Thompson 				 * into the status field, and not the
2172883bb300SAndrew Thompson 				 * remainder like with other transfer
2173883bb300SAndrew Thompson 				 * descriptor types.
217402ac6454SAndrew Thompson 				 */
217502ac6454SAndrew Thompson 			} else {
217602ac6454SAndrew Thompson 				/* Invalid length - truncate */
217702ac6454SAndrew Thompson 				len = 0;
217802ac6454SAndrew Thompson 			}
217902ac6454SAndrew Thompson 
218002ac6454SAndrew Thompson 			*plen = len;
218102ac6454SAndrew Thompson 			plen++;
2182883bb300SAndrew Thompson 			nframes--;
2183883bb300SAndrew Thompson 		}
2184883bb300SAndrew Thompson 
218502ac6454SAndrew Thompson 		td_no++;
218602ac6454SAndrew Thompson 
218702ac6454SAndrew Thompson 		if ((td_no == 8) || (nframes == 0)) {
218802ac6454SAndrew Thompson 			/* remove HS-TD from schedule */
218902ac6454SAndrew Thompson 			EHCI_REMOVE_HS_TD(td, *pp_last);
219002ac6454SAndrew Thompson 			pp_last++;
219102ac6454SAndrew Thompson 
219202ac6454SAndrew Thompson 			td_no = 0;
219302ac6454SAndrew Thompson 			td = td->obj_next;
219402ac6454SAndrew Thompson 		}
219502ac6454SAndrew Thompson 	}
219602ac6454SAndrew Thompson 	xfer->aframes = xfer->nframes;
219702ac6454SAndrew Thompson }
219802ac6454SAndrew Thompson 
219902ac6454SAndrew Thompson /* NOTE: "done" can be run two times in a row,
220002ac6454SAndrew Thompson  * from close and from interrupt
220102ac6454SAndrew Thompson  */
220202ac6454SAndrew Thompson static void
2203e0a69b51SAndrew Thompson ehci_device_done(struct usb_xfer *xfer, usb_error_t error)
220402ac6454SAndrew Thompson {
2205ae60fdfbSAndrew Thompson 	struct usb_pipe_methods *methods = xfer->endpoint->methods;
220602ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
220702ac6454SAndrew Thompson 
220802ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
220902ac6454SAndrew Thompson 
2210ae60fdfbSAndrew Thompson 	DPRINTFN(2, "xfer=%p, endpoint=%p, error=%d\n",
2211ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint, error);
221202ac6454SAndrew Thompson 
221302ac6454SAndrew Thompson 	if ((methods == &ehci_device_bulk_methods) ||
221402ac6454SAndrew Thompson 	    (methods == &ehci_device_ctrl_methods)) {
221502ac6454SAndrew Thompson #if USB_DEBUG
221602ac6454SAndrew Thompson 		if (ehcidebug > 8) {
221702ac6454SAndrew Thompson 			DPRINTF("nexttog=%d; data after transfer:\n",
2218ae60fdfbSAndrew Thompson 			    xfer->endpoint->toggle_next);
221902ac6454SAndrew Thompson 			ehci_dump_sqtds(sc,
222002ac6454SAndrew Thompson 			    xfer->td_transfer_first);
222102ac6454SAndrew Thompson 		}
222202ac6454SAndrew Thompson #endif
222302ac6454SAndrew Thompson 
222402ac6454SAndrew Thompson 		EHCI_REMOVE_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
222502ac6454SAndrew Thompson 		    sc->sc_async_p_last);
222602ac6454SAndrew Thompson 	}
222702ac6454SAndrew Thompson 	if (methods == &ehci_device_intr_methods) {
222802ac6454SAndrew Thompson 		EHCI_REMOVE_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
222902ac6454SAndrew Thompson 		    sc->sc_intr_p_last[xfer->qh_pos]);
223002ac6454SAndrew Thompson 	}
223102ac6454SAndrew Thompson 	/*
223202ac6454SAndrew Thompson 	 * Only finish isochronous transfers once which will update
223302ac6454SAndrew Thompson 	 * "xfer->frlengths".
223402ac6454SAndrew Thompson 	 */
223502ac6454SAndrew Thompson 	if (xfer->td_transfer_first &&
223602ac6454SAndrew Thompson 	    xfer->td_transfer_last) {
223702ac6454SAndrew Thompson 		if (methods == &ehci_device_isoc_fs_methods) {
223802ac6454SAndrew Thompson 			ehci_isoc_fs_done(sc, xfer);
223902ac6454SAndrew Thompson 		}
224002ac6454SAndrew Thompson 		if (methods == &ehci_device_isoc_hs_methods) {
224102ac6454SAndrew Thompson 			ehci_isoc_hs_done(sc, xfer);
224202ac6454SAndrew Thompson 		}
224302ac6454SAndrew Thompson 		xfer->td_transfer_first = NULL;
224402ac6454SAndrew Thompson 		xfer->td_transfer_last = NULL;
224502ac6454SAndrew Thompson 	}
224602ac6454SAndrew Thompson 	/* dequeue transfer and start next transfer */
2247a593f6b8SAndrew Thompson 	usbd_transfer_done(xfer, error);
224802ac6454SAndrew Thompson }
224902ac6454SAndrew Thompson 
225002ac6454SAndrew Thompson /*------------------------------------------------------------------------*
225102ac6454SAndrew Thompson  * ehci bulk support
225202ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
225302ac6454SAndrew Thompson static void
2254760bc48eSAndrew Thompson ehci_device_bulk_open(struct usb_xfer *xfer)
225502ac6454SAndrew Thompson {
225602ac6454SAndrew Thompson 	return;
225702ac6454SAndrew Thompson }
225802ac6454SAndrew Thompson 
225902ac6454SAndrew Thompson static void
2260760bc48eSAndrew Thompson ehci_device_bulk_close(struct usb_xfer *xfer)
226102ac6454SAndrew Thompson {
226202ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_CANCELLED);
226302ac6454SAndrew Thompson }
226402ac6454SAndrew Thompson 
226502ac6454SAndrew Thompson static void
2266760bc48eSAndrew Thompson ehci_device_bulk_enter(struct usb_xfer *xfer)
226702ac6454SAndrew Thompson {
226802ac6454SAndrew Thompson 	return;
226902ac6454SAndrew Thompson }
227002ac6454SAndrew Thompson 
227102ac6454SAndrew Thompson static void
2272760bc48eSAndrew Thompson ehci_device_bulk_start(struct usb_xfer *xfer)
227302ac6454SAndrew Thompson {
227402ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
2275d1864afbSAndrew Thompson 	uint32_t temp;
227602ac6454SAndrew Thompson 
227702ac6454SAndrew Thompson 	/* setup TD's and QH */
227802ac6454SAndrew Thompson 	ehci_setup_standard_chain(xfer, &sc->sc_async_p_last);
227902ac6454SAndrew Thompson 
228002ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
228102ac6454SAndrew Thompson 	ehci_transfer_intr_enqueue(xfer);
2282d1864afbSAndrew Thompson 
2283d1864afbSAndrew Thompson 	/* XXX Performance quirk: Some Host Controllers have a too low
2284d1864afbSAndrew Thompson 	 * interrupt rate. Issue an IAAD to stimulate the Host
2285d1864afbSAndrew Thompson 	 * Controller after queueing the BULK transfer.
2286d1864afbSAndrew Thompson 	 */
2287d1864afbSAndrew Thompson 	temp = EOREAD4(sc, EHCI_USBCMD);
2288d1864afbSAndrew Thompson 	if (!(temp & EHCI_CMD_IAAD))
2289d1864afbSAndrew Thompson 		EOWRITE4(sc, EHCI_USBCMD, temp | EHCI_CMD_IAAD);
229002ac6454SAndrew Thompson }
229102ac6454SAndrew Thompson 
2292760bc48eSAndrew Thompson struct usb_pipe_methods ehci_device_bulk_methods =
229302ac6454SAndrew Thompson {
229402ac6454SAndrew Thompson 	.open = ehci_device_bulk_open,
229502ac6454SAndrew Thompson 	.close = ehci_device_bulk_close,
229602ac6454SAndrew Thompson 	.enter = ehci_device_bulk_enter,
229702ac6454SAndrew Thompson 	.start = ehci_device_bulk_start,
229802ac6454SAndrew Thompson };
229902ac6454SAndrew Thompson 
230002ac6454SAndrew Thompson /*------------------------------------------------------------------------*
230102ac6454SAndrew Thompson  * ehci control support
230202ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
230302ac6454SAndrew Thompson static void
2304760bc48eSAndrew Thompson ehci_device_ctrl_open(struct usb_xfer *xfer)
230502ac6454SAndrew Thompson {
230602ac6454SAndrew Thompson 	return;
230702ac6454SAndrew Thompson }
230802ac6454SAndrew Thompson 
230902ac6454SAndrew Thompson static void
2310760bc48eSAndrew Thompson ehci_device_ctrl_close(struct usb_xfer *xfer)
231102ac6454SAndrew Thompson {
231202ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_CANCELLED);
231302ac6454SAndrew Thompson }
231402ac6454SAndrew Thompson 
231502ac6454SAndrew Thompson static void
2316760bc48eSAndrew Thompson ehci_device_ctrl_enter(struct usb_xfer *xfer)
231702ac6454SAndrew Thompson {
231802ac6454SAndrew Thompson 	return;
231902ac6454SAndrew Thompson }
232002ac6454SAndrew Thompson 
232102ac6454SAndrew Thompson static void
2322760bc48eSAndrew Thompson ehci_device_ctrl_start(struct usb_xfer *xfer)
232302ac6454SAndrew Thompson {
232402ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
232502ac6454SAndrew Thompson 
232602ac6454SAndrew Thompson 	/* setup TD's and QH */
232702ac6454SAndrew Thompson 	ehci_setup_standard_chain(xfer, &sc->sc_async_p_last);
232802ac6454SAndrew Thompson 
232902ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
233002ac6454SAndrew Thompson 	ehci_transfer_intr_enqueue(xfer);
233102ac6454SAndrew Thompson }
233202ac6454SAndrew Thompson 
2333760bc48eSAndrew Thompson struct usb_pipe_methods ehci_device_ctrl_methods =
233402ac6454SAndrew Thompson {
233502ac6454SAndrew Thompson 	.open = ehci_device_ctrl_open,
233602ac6454SAndrew Thompson 	.close = ehci_device_ctrl_close,
233702ac6454SAndrew Thompson 	.enter = ehci_device_ctrl_enter,
233802ac6454SAndrew Thompson 	.start = ehci_device_ctrl_start,
233902ac6454SAndrew Thompson };
234002ac6454SAndrew Thompson 
234102ac6454SAndrew Thompson /*------------------------------------------------------------------------*
234202ac6454SAndrew Thompson  * ehci interrupt support
234302ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
234402ac6454SAndrew Thompson static void
2345760bc48eSAndrew Thompson ehci_device_intr_open(struct usb_xfer *xfer)
234602ac6454SAndrew Thompson {
234702ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
234802ac6454SAndrew Thompson 	uint16_t best;
234902ac6454SAndrew Thompson 	uint16_t bit;
235002ac6454SAndrew Thompson 	uint16_t x;
235102ac6454SAndrew Thompson 	uint8_t slot;
235202ac6454SAndrew Thompson 
235302ac6454SAndrew Thompson 	/* Allocate a microframe slot first: */
235402ac6454SAndrew Thompson 
2355a593f6b8SAndrew Thompson 	slot = usb_intr_schedule_adjust
235602ac6454SAndrew Thompson 	    (xfer->xroot->udev, xfer->max_frame_size, USB_HS_MICRO_FRAMES_MAX);
235702ac6454SAndrew Thompson 
2358a593f6b8SAndrew Thompson 	if (usbd_get_speed(xfer->xroot->udev) == USB_SPEED_HIGH) {
2359a593f6b8SAndrew Thompson 		xfer->usb_uframe = slot;
2360a593f6b8SAndrew Thompson 		xfer->usb_smask = (1 << slot) & 0xFF;
2361a593f6b8SAndrew Thompson 		xfer->usb_cmask = 0;
236202ac6454SAndrew Thompson 	} else {
2363a593f6b8SAndrew Thompson 		xfer->usb_uframe = slot;
2364a593f6b8SAndrew Thompson 		xfer->usb_smask = (1 << slot) & 0x3F;
2365a593f6b8SAndrew Thompson 		xfer->usb_cmask = (-(4 << slot)) & 0xFE;
236602ac6454SAndrew Thompson 	}
236702ac6454SAndrew Thompson 
236802ac6454SAndrew Thompson 	/*
236902ac6454SAndrew Thompson 	 * Find the best QH position corresponding to the given interval:
237002ac6454SAndrew Thompson 	 */
237102ac6454SAndrew Thompson 
237202ac6454SAndrew Thompson 	best = 0;
237302ac6454SAndrew Thompson 	bit = EHCI_VIRTUAL_FRAMELIST_COUNT / 2;
237402ac6454SAndrew Thompson 	while (bit) {
237502ac6454SAndrew Thompson 		if (xfer->interval >= bit) {
237602ac6454SAndrew Thompson 			x = bit;
237702ac6454SAndrew Thompson 			best = bit;
237802ac6454SAndrew Thompson 			while (x & bit) {
237902ac6454SAndrew Thompson 				if (sc->sc_intr_stat[x] <
238002ac6454SAndrew Thompson 				    sc->sc_intr_stat[best]) {
238102ac6454SAndrew Thompson 					best = x;
238202ac6454SAndrew Thompson 				}
238302ac6454SAndrew Thompson 				x++;
238402ac6454SAndrew Thompson 			}
238502ac6454SAndrew Thompson 			break;
238602ac6454SAndrew Thompson 		}
238702ac6454SAndrew Thompson 		bit >>= 1;
238802ac6454SAndrew Thompson 	}
238902ac6454SAndrew Thompson 
239002ac6454SAndrew Thompson 	sc->sc_intr_stat[best]++;
239102ac6454SAndrew Thompson 	xfer->qh_pos = best;
239202ac6454SAndrew Thompson 
239302ac6454SAndrew Thompson 	DPRINTFN(3, "best=%d interval=%d\n",
239402ac6454SAndrew Thompson 	    best, xfer->interval);
239502ac6454SAndrew Thompson }
239602ac6454SAndrew Thompson 
239702ac6454SAndrew Thompson static void
2398760bc48eSAndrew Thompson ehci_device_intr_close(struct usb_xfer *xfer)
239902ac6454SAndrew Thompson {
240002ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
240102ac6454SAndrew Thompson 
2402883bb300SAndrew Thompson 	usb_intr_schedule_adjust(xfer->xroot->udev,
2403883bb300SAndrew Thompson 	    -(xfer->max_frame_size), xfer->usb_uframe);
240402ac6454SAndrew Thompson 
240502ac6454SAndrew Thompson 	sc->sc_intr_stat[xfer->qh_pos]--;
240602ac6454SAndrew Thompson 
240702ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_CANCELLED);
240802ac6454SAndrew Thompson }
240902ac6454SAndrew Thompson 
241002ac6454SAndrew Thompson static void
2411760bc48eSAndrew Thompson ehci_device_intr_enter(struct usb_xfer *xfer)
241202ac6454SAndrew Thompson {
241302ac6454SAndrew Thompson 	return;
241402ac6454SAndrew Thompson }
241502ac6454SAndrew Thompson 
241602ac6454SAndrew Thompson static void
2417760bc48eSAndrew Thompson ehci_device_intr_start(struct usb_xfer *xfer)
241802ac6454SAndrew Thompson {
241902ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
242002ac6454SAndrew Thompson 
242102ac6454SAndrew Thompson 	/* setup TD's and QH */
242202ac6454SAndrew Thompson 	ehci_setup_standard_chain(xfer, &sc->sc_intr_p_last[xfer->qh_pos]);
242302ac6454SAndrew Thompson 
242402ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
242502ac6454SAndrew Thompson 	ehci_transfer_intr_enqueue(xfer);
242602ac6454SAndrew Thompson }
242702ac6454SAndrew Thompson 
2428760bc48eSAndrew Thompson struct usb_pipe_methods ehci_device_intr_methods =
242902ac6454SAndrew Thompson {
243002ac6454SAndrew Thompson 	.open = ehci_device_intr_open,
243102ac6454SAndrew Thompson 	.close = ehci_device_intr_close,
243202ac6454SAndrew Thompson 	.enter = ehci_device_intr_enter,
243302ac6454SAndrew Thompson 	.start = ehci_device_intr_start,
243402ac6454SAndrew Thompson };
243502ac6454SAndrew Thompson 
243602ac6454SAndrew Thompson /*------------------------------------------------------------------------*
243702ac6454SAndrew Thompson  * ehci full speed isochronous support
243802ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
243902ac6454SAndrew Thompson static void
2440760bc48eSAndrew Thompson ehci_device_isoc_fs_open(struct usb_xfer *xfer)
244102ac6454SAndrew Thompson {
244202ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
244302ac6454SAndrew Thompson 	ehci_sitd_t *td;
244402ac6454SAndrew Thompson 	uint32_t sitd_portaddr;
244502ac6454SAndrew Thompson 	uint8_t ds;
244602ac6454SAndrew Thompson 
244702ac6454SAndrew Thompson 	sitd_portaddr =
244802ac6454SAndrew Thompson 	    EHCI_SITD_SET_ADDR(xfer->address) |
2449ae60fdfbSAndrew Thompson 	    EHCI_SITD_SET_ENDPT(UE_GET_ADDR(xfer->endpointno)) |
245002ac6454SAndrew Thompson 	    EHCI_SITD_SET_HUBA(xfer->xroot->udev->hs_hub_addr) |
245102ac6454SAndrew Thompson 	    EHCI_SITD_SET_PORT(xfer->xroot->udev->hs_port_no);
245202ac6454SAndrew Thompson 
2453ae60fdfbSAndrew Thompson 	if (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) {
245402ac6454SAndrew Thompson 		sitd_portaddr |= EHCI_SITD_SET_DIR_IN;
245502ac6454SAndrew Thompson 	}
2456e55e1ebcSAndrew Thompson 	sitd_portaddr = htohc32(sc, sitd_portaddr);
245702ac6454SAndrew Thompson 
245802ac6454SAndrew Thompson 	/* initialize all TD's */
245902ac6454SAndrew Thompson 
246002ac6454SAndrew Thompson 	for (ds = 0; ds != 2; ds++) {
246102ac6454SAndrew Thompson 
246202ac6454SAndrew Thompson 		for (td = xfer->td_start[ds]; td; td = td->obj_next) {
246302ac6454SAndrew Thompson 
246402ac6454SAndrew Thompson 			td->sitd_portaddr = sitd_portaddr;
246502ac6454SAndrew Thompson 
246602ac6454SAndrew Thompson 			/*
246702ac6454SAndrew Thompson 			 * TODO: make some kind of automatic
246802ac6454SAndrew Thompson 			 * SMASK/CMASK selection based on micro-frame
246902ac6454SAndrew Thompson 			 * usage
247002ac6454SAndrew Thompson 			 *
247102ac6454SAndrew Thompson 			 * micro-frame usage (8 microframes per 1ms)
247202ac6454SAndrew Thompson 			 */
2473e55e1ebcSAndrew Thompson 			td->sitd_back = htohc32(sc, EHCI_LINK_TERMINATE);
247402ac6454SAndrew Thompson 
2475a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(td->page_cache);
247602ac6454SAndrew Thompson 		}
247702ac6454SAndrew Thompson 	}
247802ac6454SAndrew Thompson }
247902ac6454SAndrew Thompson 
248002ac6454SAndrew Thompson static void
2481760bc48eSAndrew Thompson ehci_device_isoc_fs_close(struct usb_xfer *xfer)
248202ac6454SAndrew Thompson {
248302ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_CANCELLED);
248402ac6454SAndrew Thompson }
248502ac6454SAndrew Thompson 
248602ac6454SAndrew Thompson static void
2487760bc48eSAndrew Thompson ehci_device_isoc_fs_enter(struct usb_xfer *xfer)
248802ac6454SAndrew Thompson {
2489760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
249002ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
2491760bc48eSAndrew Thompson 	struct usb_fs_isoc_schedule *fss_start;
2492760bc48eSAndrew Thompson 	struct usb_fs_isoc_schedule *fss_end;
2493760bc48eSAndrew Thompson 	struct usb_fs_isoc_schedule *fss;
249402ac6454SAndrew Thompson 	ehci_sitd_t *td;
249502ac6454SAndrew Thompson 	ehci_sitd_t *td_last = NULL;
249602ac6454SAndrew Thompson 	ehci_sitd_t **pp_last;
249702ac6454SAndrew Thompson 	uint32_t *plen;
249802ac6454SAndrew Thompson 	uint32_t buf_offset;
249902ac6454SAndrew Thompson 	uint32_t nframes;
250002ac6454SAndrew Thompson 	uint32_t temp;
250102ac6454SAndrew Thompson 	uint32_t sitd_mask;
250202ac6454SAndrew Thompson 	uint16_t tlen;
250302ac6454SAndrew Thompson 	uint8_t sa;
250402ac6454SAndrew Thompson 	uint8_t sb;
250502ac6454SAndrew Thompson 	uint8_t error;
250602ac6454SAndrew Thompson 
250702ac6454SAndrew Thompson #if USB_DEBUG
250802ac6454SAndrew Thompson 	uint8_t once = 1;
250902ac6454SAndrew Thompson 
251002ac6454SAndrew Thompson #endif
251102ac6454SAndrew Thompson 
251202ac6454SAndrew Thompson 	DPRINTFN(6, "xfer=%p next=%d nframes=%d\n",
2513ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint->isoc_next, xfer->nframes);
251402ac6454SAndrew Thompson 
251502ac6454SAndrew Thompson 	/* get the current frame index */
251602ac6454SAndrew Thompson 
251702ac6454SAndrew Thompson 	nframes = EOREAD4(sc, EHCI_FRINDEX) / 8;
251802ac6454SAndrew Thompson 
251902ac6454SAndrew Thompson 	/*
252002ac6454SAndrew Thompson 	 * check if the frame index is within the window where the frames
252102ac6454SAndrew Thompson 	 * will be inserted
252202ac6454SAndrew Thompson 	 */
2523ae60fdfbSAndrew Thompson 	buf_offset = (nframes - xfer->endpoint->isoc_next) &
252402ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
252502ac6454SAndrew Thompson 
2526ae60fdfbSAndrew Thompson 	if ((xfer->endpoint->is_synced == 0) ||
252702ac6454SAndrew Thompson 	    (buf_offset < xfer->nframes)) {
252802ac6454SAndrew Thompson 		/*
252902ac6454SAndrew Thompson 		 * If there is data underflow or the pipe queue is empty we
253002ac6454SAndrew Thompson 		 * schedule the transfer a few frames ahead of the current
253102ac6454SAndrew Thompson 		 * frame position. Else two isochronous transfers might
253202ac6454SAndrew Thompson 		 * overlap.
253302ac6454SAndrew Thompson 		 */
2534ae60fdfbSAndrew Thompson 		xfer->endpoint->isoc_next = (nframes + 3) &
253502ac6454SAndrew Thompson 		    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
2536ae60fdfbSAndrew Thompson 		xfer->endpoint->is_synced = 1;
2537ae60fdfbSAndrew Thompson 		DPRINTFN(3, "start next=%d\n", xfer->endpoint->isoc_next);
253802ac6454SAndrew Thompson 	}
253902ac6454SAndrew Thompson 	/*
254002ac6454SAndrew Thompson 	 * compute how many milliseconds the insertion is ahead of the
254102ac6454SAndrew Thompson 	 * current frame position:
254202ac6454SAndrew Thompson 	 */
2543ae60fdfbSAndrew Thompson 	buf_offset = (xfer->endpoint->isoc_next - nframes) &
254402ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
254502ac6454SAndrew Thompson 
254602ac6454SAndrew Thompson 	/*
254702ac6454SAndrew Thompson 	 * pre-compute when the isochronous transfer will be finished:
254802ac6454SAndrew Thompson 	 */
254902ac6454SAndrew Thompson 	xfer->isoc_time_complete =
2550a593f6b8SAndrew Thompson 	    usbd_fs_isoc_schedule_isoc_time_expand
255102ac6454SAndrew Thompson 	    (xfer->xroot->udev, &fss_start, &fss_end, nframes) + buf_offset +
255202ac6454SAndrew Thompson 	    xfer->nframes;
255302ac6454SAndrew Thompson 
255402ac6454SAndrew Thompson 	/* get the real number of frames */
255502ac6454SAndrew Thompson 
255602ac6454SAndrew Thompson 	nframes = xfer->nframes;
255702ac6454SAndrew Thompson 
255802ac6454SAndrew Thompson 	buf_offset = 0;
255902ac6454SAndrew Thompson 
256002ac6454SAndrew Thompson 	plen = xfer->frlengths;
256102ac6454SAndrew Thompson 
256202ac6454SAndrew Thompson 	/* toggle the DMA set we are using */
256302ac6454SAndrew Thompson 	xfer->flags_int.curr_dma_set ^= 1;
256402ac6454SAndrew Thompson 
256502ac6454SAndrew Thompson 	/* get next DMA set */
256602ac6454SAndrew Thompson 	td = xfer->td_start[xfer->flags_int.curr_dma_set];
256702ac6454SAndrew Thompson 	xfer->td_transfer_first = td;
256802ac6454SAndrew Thompson 
2569ae60fdfbSAndrew Thompson 	pp_last = &sc->sc_isoc_fs_p_last[xfer->endpoint->isoc_next];
257002ac6454SAndrew Thompson 
257102ac6454SAndrew Thompson 	/* store starting position */
257202ac6454SAndrew Thompson 
2573ae60fdfbSAndrew Thompson 	xfer->qh_pos = xfer->endpoint->isoc_next;
257402ac6454SAndrew Thompson 
257502ac6454SAndrew Thompson 	fss = fss_start + (xfer->qh_pos % USB_ISOC_TIME_MAX);
257602ac6454SAndrew Thompson 
257702ac6454SAndrew Thompson 	while (nframes--) {
257802ac6454SAndrew Thompson 		if (td == NULL) {
257902ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
258002ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
258102ac6454SAndrew Thompson 		}
258202ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_fs_p_last[EHCI_VIRTUAL_FRAMELIST_COUNT]) {
258302ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_fs_p_last[0];
258402ac6454SAndrew Thompson 		}
258502ac6454SAndrew Thompson 		if (fss >= fss_end) {
258602ac6454SAndrew Thompson 			fss = fss_start;
258702ac6454SAndrew Thompson 		}
258802ac6454SAndrew Thompson 		/* reuse sitd_portaddr and sitd_back from last transfer */
258902ac6454SAndrew Thompson 
259002ac6454SAndrew Thompson 		if (*plen > xfer->max_frame_size) {
259102ac6454SAndrew Thompson #if USB_DEBUG
259202ac6454SAndrew Thompson 			if (once) {
259302ac6454SAndrew Thompson 				once = 0;
259402ac6454SAndrew Thompson 				printf("%s: frame length(%d) exceeds %d "
259502ac6454SAndrew Thompson 				    "bytes (frame truncated)\n",
259602ac6454SAndrew Thompson 				    __FUNCTION__, *plen,
259702ac6454SAndrew Thompson 				    xfer->max_frame_size);
259802ac6454SAndrew Thompson 			}
259902ac6454SAndrew Thompson #endif
260002ac6454SAndrew Thompson 			*plen = xfer->max_frame_size;
260102ac6454SAndrew Thompson 		}
260202ac6454SAndrew Thompson 		/*
260302ac6454SAndrew Thompson 		 * We currently don't care if the ISOCHRONOUS schedule is
260402ac6454SAndrew Thompson 		 * full!
260502ac6454SAndrew Thompson 		 */
2606a593f6b8SAndrew Thompson 		error = usbd_fs_isoc_schedule_alloc(fss, &sa, *plen);
260702ac6454SAndrew Thompson 		if (error) {
260802ac6454SAndrew Thompson 			/*
260902ac6454SAndrew Thompson 			 * The FULL speed schedule is FULL! Set length
261002ac6454SAndrew Thompson 			 * to zero.
261102ac6454SAndrew Thompson 			 */
261202ac6454SAndrew Thompson 			*plen = 0;
261302ac6454SAndrew Thompson 		}
261402ac6454SAndrew Thompson 		if (*plen) {
261502ac6454SAndrew Thompson 			/*
2616a593f6b8SAndrew Thompson 			 * only call "usbd_get_page()" when we have a
261702ac6454SAndrew Thompson 			 * non-zero length
261802ac6454SAndrew Thompson 			 */
2619a593f6b8SAndrew Thompson 			usbd_get_page(xfer->frbuffers, buf_offset, &buf_res);
2620e55e1ebcSAndrew Thompson 			td->sitd_bp[0] = htohc32(sc, buf_res.physaddr);
262102ac6454SAndrew Thompson 			buf_offset += *plen;
262202ac6454SAndrew Thompson 			/*
262302ac6454SAndrew Thompson 			 * NOTE: We need to subtract one from the offset so
262402ac6454SAndrew Thompson 			 * that we are on a valid page!
262502ac6454SAndrew Thompson 			 */
2626a593f6b8SAndrew Thompson 			usbd_get_page(xfer->frbuffers, buf_offset - 1,
262702ac6454SAndrew Thompson 			    &buf_res);
262802ac6454SAndrew Thompson 			temp = buf_res.physaddr & ~0xFFF;
262902ac6454SAndrew Thompson 		} else {
263002ac6454SAndrew Thompson 			td->sitd_bp[0] = 0;
263102ac6454SAndrew Thompson 			temp = 0;
263202ac6454SAndrew Thompson 		}
263302ac6454SAndrew Thompson 
2634ae60fdfbSAndrew Thompson 		if (UE_GET_DIR(xfer->endpointno) == UE_DIR_OUT) {
263502ac6454SAndrew Thompson 			tlen = *plen;
263602ac6454SAndrew Thompson 			if (tlen <= 188) {
263702ac6454SAndrew Thompson 				temp |= 1;	/* T-count = 1, TP = ALL */
263802ac6454SAndrew Thompson 				tlen = 1;
263902ac6454SAndrew Thompson 			} else {
264002ac6454SAndrew Thompson 				tlen += 187;
264102ac6454SAndrew Thompson 				tlen /= 188;
264202ac6454SAndrew Thompson 				temp |= tlen;	/* T-count = [1..6] */
264302ac6454SAndrew Thompson 				temp |= 8;	/* TP = Begin */
264402ac6454SAndrew Thompson 			}
264502ac6454SAndrew Thompson 
264602ac6454SAndrew Thompson 			tlen += sa;
264702ac6454SAndrew Thompson 
264802ac6454SAndrew Thompson 			if (tlen >= 8) {
264902ac6454SAndrew Thompson 				sb = 0;
265002ac6454SAndrew Thompson 			} else {
265102ac6454SAndrew Thompson 				sb = (1 << tlen);
265202ac6454SAndrew Thompson 			}
265302ac6454SAndrew Thompson 
265402ac6454SAndrew Thompson 			sa = (1 << sa);
265502ac6454SAndrew Thompson 			sa = (sb - sa) & 0x3F;
265602ac6454SAndrew Thompson 			sb = 0;
265702ac6454SAndrew Thompson 		} else {
265802ac6454SAndrew Thompson 			sb = (-(4 << sa)) & 0xFE;
265902ac6454SAndrew Thompson 			sa = (1 << sa) & 0x3F;
266002ac6454SAndrew Thompson 		}
266102ac6454SAndrew Thompson 
266202ac6454SAndrew Thompson 		sitd_mask = (EHCI_SITD_SET_SMASK(sa) |
266302ac6454SAndrew Thompson 		    EHCI_SITD_SET_CMASK(sb));
266402ac6454SAndrew Thompson 
2665e55e1ebcSAndrew Thompson 		td->sitd_bp[1] = htohc32(sc, temp);
266602ac6454SAndrew Thompson 
2667e55e1ebcSAndrew Thompson 		td->sitd_mask = htohc32(sc, sitd_mask);
266802ac6454SAndrew Thompson 
266902ac6454SAndrew Thompson 		if (nframes == 0) {
2670e55e1ebcSAndrew Thompson 			td->sitd_status = htohc32(sc,
26715f128668SAndrew Thompson 			    EHCI_SITD_IOC |
267202ac6454SAndrew Thompson 			    EHCI_SITD_ACTIVE |
267302ac6454SAndrew Thompson 			    EHCI_SITD_SET_LEN(*plen));
267402ac6454SAndrew Thompson 		} else {
2675e55e1ebcSAndrew Thompson 			td->sitd_status = htohc32(sc,
26765f128668SAndrew Thompson 			    EHCI_SITD_ACTIVE |
267702ac6454SAndrew Thompson 			    EHCI_SITD_SET_LEN(*plen));
267802ac6454SAndrew Thompson 		}
2679a593f6b8SAndrew Thompson 		usb_pc_cpu_flush(td->page_cache);
268002ac6454SAndrew Thompson 
268102ac6454SAndrew Thompson #if USB_DEBUG
268202ac6454SAndrew Thompson 		if (ehcidebug > 15) {
268302ac6454SAndrew Thompson 			DPRINTF("FS-TD %d\n", nframes);
268402ac6454SAndrew Thompson 			ehci_dump_sitd(sc, td);
268502ac6454SAndrew Thompson 		}
268602ac6454SAndrew Thompson #endif
268702ac6454SAndrew Thompson 		/* insert TD into schedule */
268802ac6454SAndrew Thompson 		EHCI_APPEND_FS_TD(td, *pp_last);
268902ac6454SAndrew Thompson 		pp_last++;
269002ac6454SAndrew Thompson 
269102ac6454SAndrew Thompson 		plen++;
269202ac6454SAndrew Thompson 		fss++;
269302ac6454SAndrew Thompson 		td_last = td;
269402ac6454SAndrew Thompson 		td = td->obj_next;
269502ac6454SAndrew Thompson 	}
269602ac6454SAndrew Thompson 
269702ac6454SAndrew Thompson 	xfer->td_transfer_last = td_last;
269802ac6454SAndrew Thompson 
269902ac6454SAndrew Thompson 	/* update isoc_next */
2700ae60fdfbSAndrew Thompson 	xfer->endpoint->isoc_next = (pp_last - &sc->sc_isoc_fs_p_last[0]) &
270102ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
270202ac6454SAndrew Thompson }
270302ac6454SAndrew Thompson 
270402ac6454SAndrew Thompson static void
2705760bc48eSAndrew Thompson ehci_device_isoc_fs_start(struct usb_xfer *xfer)
270602ac6454SAndrew Thompson {
270702ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
270802ac6454SAndrew Thompson 	ehci_transfer_intr_enqueue(xfer);
270902ac6454SAndrew Thompson }
271002ac6454SAndrew Thompson 
2711760bc48eSAndrew Thompson struct usb_pipe_methods ehci_device_isoc_fs_methods =
271202ac6454SAndrew Thompson {
271302ac6454SAndrew Thompson 	.open = ehci_device_isoc_fs_open,
271402ac6454SAndrew Thompson 	.close = ehci_device_isoc_fs_close,
271502ac6454SAndrew Thompson 	.enter = ehci_device_isoc_fs_enter,
271602ac6454SAndrew Thompson 	.start = ehci_device_isoc_fs_start,
271702ac6454SAndrew Thompson };
271802ac6454SAndrew Thompson 
271902ac6454SAndrew Thompson /*------------------------------------------------------------------------*
272002ac6454SAndrew Thompson  * ehci high speed isochronous support
272102ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
272202ac6454SAndrew Thompson static void
2723760bc48eSAndrew Thompson ehci_device_isoc_hs_open(struct usb_xfer *xfer)
272402ac6454SAndrew Thompson {
272502ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
272602ac6454SAndrew Thompson 	ehci_itd_t *td;
272702ac6454SAndrew Thompson 	uint32_t temp;
272802ac6454SAndrew Thompson 	uint8_t ds;
2729883bb300SAndrew Thompson 	uint8_t slot;
2730883bb300SAndrew Thompson 
2731883bb300SAndrew Thompson 	slot = usb_intr_schedule_adjust(xfer->xroot->udev, xfer->max_frame_size,
2732883bb300SAndrew Thompson 	    USB_HS_MICRO_FRAMES_MAX);
2733883bb300SAndrew Thompson 
2734883bb300SAndrew Thompson 	xfer->usb_uframe = slot;
2735883bb300SAndrew Thompson 	xfer->usb_cmask = 0;
2736883bb300SAndrew Thompson 
2737883bb300SAndrew Thompson 	switch (usbd_xfer_get_fps_shift(xfer)) {
2738883bb300SAndrew Thompson 	case 0:
2739883bb300SAndrew Thompson 		xfer->usb_smask = 0xFF;
2740883bb300SAndrew Thompson 		break;
2741883bb300SAndrew Thompson 	case 1:
2742883bb300SAndrew Thompson 		xfer->usb_smask = 0x55 << (slot & 1);
2743883bb300SAndrew Thompson 		break;
2744883bb300SAndrew Thompson 	case 2:
2745883bb300SAndrew Thompson 		xfer->usb_smask = 0x11 << (slot & 3);
2746883bb300SAndrew Thompson 		break;
2747883bb300SAndrew Thompson 	default:
2748883bb300SAndrew Thompson 		xfer->usb_smask = 0x01 << (slot & 7);
2749883bb300SAndrew Thompson 		break;
2750883bb300SAndrew Thompson 	}
275102ac6454SAndrew Thompson 
275202ac6454SAndrew Thompson 	/* initialize all TD's */
275302ac6454SAndrew Thompson 
275402ac6454SAndrew Thompson 	for (ds = 0; ds != 2; ds++) {
275502ac6454SAndrew Thompson 
275602ac6454SAndrew Thompson 		for (td = xfer->td_start[ds]; td; td = td->obj_next) {
275702ac6454SAndrew Thompson 
275802ac6454SAndrew Thompson 			/* set TD inactive */
275902ac6454SAndrew Thompson 			td->itd_status[0] = 0;
276002ac6454SAndrew Thompson 			td->itd_status[1] = 0;
276102ac6454SAndrew Thompson 			td->itd_status[2] = 0;
276202ac6454SAndrew Thompson 			td->itd_status[3] = 0;
276302ac6454SAndrew Thompson 			td->itd_status[4] = 0;
276402ac6454SAndrew Thompson 			td->itd_status[5] = 0;
276502ac6454SAndrew Thompson 			td->itd_status[6] = 0;
276602ac6454SAndrew Thompson 			td->itd_status[7] = 0;
276702ac6454SAndrew Thompson 
276802ac6454SAndrew Thompson 			/* set endpoint and address */
2769e55e1ebcSAndrew Thompson 			td->itd_bp[0] = htohc32(sc,
27705f128668SAndrew Thompson 			    EHCI_ITD_SET_ADDR(xfer->address) |
2771ae60fdfbSAndrew Thompson 			    EHCI_ITD_SET_ENDPT(UE_GET_ADDR(xfer->endpointno)));
277202ac6454SAndrew Thompson 
277302ac6454SAndrew Thompson 			temp =
277402ac6454SAndrew Thompson 			    EHCI_ITD_SET_MPL(xfer->max_packet_size & 0x7FF);
277502ac6454SAndrew Thompson 
277602ac6454SAndrew Thompson 			/* set direction */
2777ae60fdfbSAndrew Thompson 			if (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) {
277802ac6454SAndrew Thompson 				temp |= EHCI_ITD_SET_DIR_IN;
277902ac6454SAndrew Thompson 			}
278002ac6454SAndrew Thompson 			/* set maximum packet size */
2781e55e1ebcSAndrew Thompson 			td->itd_bp[1] = htohc32(sc, temp);
278202ac6454SAndrew Thompson 
278302ac6454SAndrew Thompson 			/* set transfer multiplier */
2784e55e1ebcSAndrew Thompson 			td->itd_bp[2] = htohc32(sc, xfer->max_packet_count & 3);
278502ac6454SAndrew Thompson 
2786a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(td->page_cache);
278702ac6454SAndrew Thompson 		}
278802ac6454SAndrew Thompson 	}
278902ac6454SAndrew Thompson }
279002ac6454SAndrew Thompson 
279102ac6454SAndrew Thompson static void
2792760bc48eSAndrew Thompson ehci_device_isoc_hs_close(struct usb_xfer *xfer)
279302ac6454SAndrew Thompson {
2794883bb300SAndrew Thompson 
2795883bb300SAndrew Thompson 	usb_intr_schedule_adjust(xfer->xroot->udev,
2796883bb300SAndrew Thompson 	    -(xfer->max_frame_size), xfer->usb_uframe);
2797883bb300SAndrew Thompson 
279802ac6454SAndrew Thompson 	ehci_device_done(xfer, USB_ERR_CANCELLED);
279902ac6454SAndrew Thompson }
280002ac6454SAndrew Thompson 
280102ac6454SAndrew Thompson static void
2802760bc48eSAndrew Thompson ehci_device_isoc_hs_enter(struct usb_xfer *xfer)
280302ac6454SAndrew Thompson {
2804760bc48eSAndrew Thompson 	struct usb_page_search buf_res;
280502ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(xfer->xroot->bus);
280602ac6454SAndrew Thompson 	ehci_itd_t *td;
280702ac6454SAndrew Thompson 	ehci_itd_t *td_last = NULL;
280802ac6454SAndrew Thompson 	ehci_itd_t **pp_last;
280902ac6454SAndrew Thompson 	bus_size_t page_addr;
281002ac6454SAndrew Thompson 	uint32_t *plen;
281102ac6454SAndrew Thompson 	uint32_t status;
281202ac6454SAndrew Thompson 	uint32_t buf_offset;
281302ac6454SAndrew Thompson 	uint32_t nframes;
281402ac6454SAndrew Thompson 	uint32_t itd_offset[8 + 1];
281502ac6454SAndrew Thompson 	uint8_t x;
281602ac6454SAndrew Thompson 	uint8_t td_no;
281702ac6454SAndrew Thompson 	uint8_t page_no;
281802ac6454SAndrew Thompson 
281902ac6454SAndrew Thompson #if USB_DEBUG
282002ac6454SAndrew Thompson 	uint8_t once = 1;
282102ac6454SAndrew Thompson 
282202ac6454SAndrew Thompson #endif
282302ac6454SAndrew Thompson 
282402ac6454SAndrew Thompson 	DPRINTFN(6, "xfer=%p next=%d nframes=%d\n",
2825ae60fdfbSAndrew Thompson 	    xfer, xfer->endpoint->isoc_next, xfer->nframes);
282602ac6454SAndrew Thompson 
282702ac6454SAndrew Thompson 	/* get the current frame index */
282802ac6454SAndrew Thompson 
282902ac6454SAndrew Thompson 	nframes = EOREAD4(sc, EHCI_FRINDEX) / 8;
283002ac6454SAndrew Thompson 
283102ac6454SAndrew Thompson 	/*
283202ac6454SAndrew Thompson 	 * check if the frame index is within the window where the frames
283302ac6454SAndrew Thompson 	 * will be inserted
283402ac6454SAndrew Thompson 	 */
2835ae60fdfbSAndrew Thompson 	buf_offset = (nframes - xfer->endpoint->isoc_next) &
283602ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
283702ac6454SAndrew Thompson 
2838ae60fdfbSAndrew Thompson 	if ((xfer->endpoint->is_synced == 0) ||
283902ac6454SAndrew Thompson 	    (buf_offset < ((xfer->nframes + 7) / 8))) {
284002ac6454SAndrew Thompson 		/*
284102ac6454SAndrew Thompson 		 * If there is data underflow or the pipe queue is empty we
284202ac6454SAndrew Thompson 		 * schedule the transfer a few frames ahead of the current
284302ac6454SAndrew Thompson 		 * frame position. Else two isochronous transfers might
284402ac6454SAndrew Thompson 		 * overlap.
284502ac6454SAndrew Thompson 		 */
2846ae60fdfbSAndrew Thompson 		xfer->endpoint->isoc_next = (nframes + 3) &
284702ac6454SAndrew Thompson 		    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
2848ae60fdfbSAndrew Thompson 		xfer->endpoint->is_synced = 1;
2849ae60fdfbSAndrew Thompson 		DPRINTFN(3, "start next=%d\n", xfer->endpoint->isoc_next);
285002ac6454SAndrew Thompson 	}
285102ac6454SAndrew Thompson 	/*
285202ac6454SAndrew Thompson 	 * compute how many milliseconds the insertion is ahead of the
285302ac6454SAndrew Thompson 	 * current frame position:
285402ac6454SAndrew Thompson 	 */
2855ae60fdfbSAndrew Thompson 	buf_offset = (xfer->endpoint->isoc_next - nframes) &
285602ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
285702ac6454SAndrew Thompson 
285802ac6454SAndrew Thompson 	/*
285902ac6454SAndrew Thompson 	 * pre-compute when the isochronous transfer will be finished:
286002ac6454SAndrew Thompson 	 */
286102ac6454SAndrew Thompson 	xfer->isoc_time_complete =
2862a593f6b8SAndrew Thompson 	    usb_isoc_time_expand(&sc->sc_bus, nframes) + buf_offset +
286302ac6454SAndrew Thompson 	    ((xfer->nframes + 7) / 8);
286402ac6454SAndrew Thompson 
286502ac6454SAndrew Thompson 	/* get the real number of frames */
286602ac6454SAndrew Thompson 
286702ac6454SAndrew Thompson 	nframes = xfer->nframes;
286802ac6454SAndrew Thompson 
286902ac6454SAndrew Thompson 	buf_offset = 0;
287002ac6454SAndrew Thompson 	td_no = 0;
287102ac6454SAndrew Thompson 
287202ac6454SAndrew Thompson 	plen = xfer->frlengths;
287302ac6454SAndrew Thompson 
287402ac6454SAndrew Thompson 	/* toggle the DMA set we are using */
287502ac6454SAndrew Thompson 	xfer->flags_int.curr_dma_set ^= 1;
287602ac6454SAndrew Thompson 
287702ac6454SAndrew Thompson 	/* get next DMA set */
287802ac6454SAndrew Thompson 	td = xfer->td_start[xfer->flags_int.curr_dma_set];
287902ac6454SAndrew Thompson 	xfer->td_transfer_first = td;
288002ac6454SAndrew Thompson 
2881ae60fdfbSAndrew Thompson 	pp_last = &sc->sc_isoc_hs_p_last[xfer->endpoint->isoc_next];
288202ac6454SAndrew Thompson 
288302ac6454SAndrew Thompson 	/* store starting position */
288402ac6454SAndrew Thompson 
2885ae60fdfbSAndrew Thompson 	xfer->qh_pos = xfer->endpoint->isoc_next;
288602ac6454SAndrew Thompson 
2887883bb300SAndrew Thompson 	while (nframes) {
288802ac6454SAndrew Thompson 		if (td == NULL) {
288902ac6454SAndrew Thompson 			panic("%s:%d: out of TD's\n",
289002ac6454SAndrew Thompson 			    __FUNCTION__, __LINE__);
289102ac6454SAndrew Thompson 		}
289202ac6454SAndrew Thompson 		if (pp_last >= &sc->sc_isoc_hs_p_last[EHCI_VIRTUAL_FRAMELIST_COUNT]) {
289302ac6454SAndrew Thompson 			pp_last = &sc->sc_isoc_hs_p_last[0];
289402ac6454SAndrew Thompson 		}
289502ac6454SAndrew Thompson 		/* range check */
289602ac6454SAndrew Thompson 		if (*plen > xfer->max_frame_size) {
289702ac6454SAndrew Thompson #if USB_DEBUG
289802ac6454SAndrew Thompson 			if (once) {
289902ac6454SAndrew Thompson 				once = 0;
290002ac6454SAndrew Thompson 				printf("%s: frame length(%d) exceeds %d bytes "
290102ac6454SAndrew Thompson 				    "(frame truncated)\n",
290202ac6454SAndrew Thompson 				    __FUNCTION__, *plen, xfer->max_frame_size);
290302ac6454SAndrew Thompson 			}
290402ac6454SAndrew Thompson #endif
290502ac6454SAndrew Thompson 			*plen = xfer->max_frame_size;
290602ac6454SAndrew Thompson 		}
2907883bb300SAndrew Thompson 
2908883bb300SAndrew Thompson 		if (xfer->usb_smask & (1 << td_no)) {
290902ac6454SAndrew Thompson 			status = (EHCI_ITD_SET_LEN(*plen) |
291002ac6454SAndrew Thompson 			    EHCI_ITD_ACTIVE |
291102ac6454SAndrew Thompson 			    EHCI_ITD_SET_PG(0));
2912e55e1ebcSAndrew Thompson 			td->itd_status[td_no] = htohc32(sc, status);
291302ac6454SAndrew Thompson 			itd_offset[td_no] = buf_offset;
291402ac6454SAndrew Thompson 			buf_offset += *plen;
291502ac6454SAndrew Thompson 			plen++;
2916883bb300SAndrew Thompson 			nframes --;
2917883bb300SAndrew Thompson 		} else {
2918883bb300SAndrew Thompson 			td->itd_status[td_no] = 0;	/* not active */
2919883bb300SAndrew Thompson 			itd_offset[td_no] = buf_offset;
2920883bb300SAndrew Thompson 		}
2921883bb300SAndrew Thompson 
292202ac6454SAndrew Thompson 		td_no++;
292302ac6454SAndrew Thompson 
292402ac6454SAndrew Thompson 		if ((td_no == 8) || (nframes == 0)) {
292502ac6454SAndrew Thompson 
292602ac6454SAndrew Thompson 			/* the rest of the transfers are not active, if any */
292702ac6454SAndrew Thompson 			for (x = td_no; x != 8; x++) {
292802ac6454SAndrew Thompson 				td->itd_status[x] = 0;	/* not active */
292902ac6454SAndrew Thompson 			}
293002ac6454SAndrew Thompson 
293102ac6454SAndrew Thompson 			/* check if there is any data to be transferred */
293202ac6454SAndrew Thompson 			if (itd_offset[0] != buf_offset) {
293302ac6454SAndrew Thompson 				page_no = 0;
293402ac6454SAndrew Thompson 				itd_offset[td_no] = buf_offset;
293502ac6454SAndrew Thompson 
293602ac6454SAndrew Thompson 				/* get first page offset */
2937a593f6b8SAndrew Thompson 				usbd_get_page(xfer->frbuffers, itd_offset[0], &buf_res);
293802ac6454SAndrew Thompson 				/* get page address */
293902ac6454SAndrew Thompson 				page_addr = buf_res.physaddr & ~0xFFF;
294002ac6454SAndrew Thompson 				/* update page address */
2941e55e1ebcSAndrew Thompson 				td->itd_bp[0] &= htohc32(sc, 0xFFF);
2942e55e1ebcSAndrew Thompson 				td->itd_bp[0] |= htohc32(sc, page_addr);
294302ac6454SAndrew Thompson 
294402ac6454SAndrew Thompson 				for (x = 0; x != td_no; x++) {
294502ac6454SAndrew Thompson 					/* set page number and page offset */
294602ac6454SAndrew Thompson 					status = (EHCI_ITD_SET_PG(page_no) |
294702ac6454SAndrew Thompson 					    (buf_res.physaddr & 0xFFF));
2948e55e1ebcSAndrew Thompson 					td->itd_status[x] |= htohc32(sc, status);
294902ac6454SAndrew Thompson 
295002ac6454SAndrew Thompson 					/* get next page offset */
295102ac6454SAndrew Thompson 					if (itd_offset[x + 1] == buf_offset) {
295202ac6454SAndrew Thompson 						/*
295302ac6454SAndrew Thompson 						 * We subtract one so that
295402ac6454SAndrew Thompson 						 * we don't go off the last
295502ac6454SAndrew Thompson 						 * page!
295602ac6454SAndrew Thompson 						 */
2957a593f6b8SAndrew Thompson 						usbd_get_page(xfer->frbuffers, buf_offset - 1, &buf_res);
295802ac6454SAndrew Thompson 					} else {
2959a593f6b8SAndrew Thompson 						usbd_get_page(xfer->frbuffers, itd_offset[x + 1], &buf_res);
296002ac6454SAndrew Thompson 					}
296102ac6454SAndrew Thompson 
296202ac6454SAndrew Thompson 					/* check if we need a new page */
296302ac6454SAndrew Thompson 					if ((buf_res.physaddr ^ page_addr) & ~0xFFF) {
296402ac6454SAndrew Thompson 						/* new page needed */
296502ac6454SAndrew Thompson 						page_addr = buf_res.physaddr & ~0xFFF;
296602ac6454SAndrew Thompson 						if (page_no == 6) {
296702ac6454SAndrew Thompson 							panic("%s: too many pages\n", __FUNCTION__);
296802ac6454SAndrew Thompson 						}
296902ac6454SAndrew Thompson 						page_no++;
297002ac6454SAndrew Thompson 						/* update page address */
2971e55e1ebcSAndrew Thompson 						td->itd_bp[page_no] &= htohc32(sc, 0xFFF);
2972e55e1ebcSAndrew Thompson 						td->itd_bp[page_no] |= htohc32(sc, page_addr);
297302ac6454SAndrew Thompson 					}
297402ac6454SAndrew Thompson 				}
297502ac6454SAndrew Thompson 			}
297602ac6454SAndrew Thompson 			/* set IOC bit if we are complete */
297702ac6454SAndrew Thompson 			if (nframes == 0) {
2978883bb300SAndrew Thompson 				td->itd_status[td_no - 1] |= htohc32(sc, EHCI_ITD_IOC);
297902ac6454SAndrew Thompson 			}
2980a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(td->page_cache);
298102ac6454SAndrew Thompson #if USB_DEBUG
298202ac6454SAndrew Thompson 			if (ehcidebug > 15) {
298302ac6454SAndrew Thompson 				DPRINTF("HS-TD %d\n", nframes);
298402ac6454SAndrew Thompson 				ehci_dump_itd(sc, td);
298502ac6454SAndrew Thompson 			}
298602ac6454SAndrew Thompson #endif
298702ac6454SAndrew Thompson 			/* insert TD into schedule */
298802ac6454SAndrew Thompson 			EHCI_APPEND_HS_TD(td, *pp_last);
298902ac6454SAndrew Thompson 			pp_last++;
299002ac6454SAndrew Thompson 
299102ac6454SAndrew Thompson 			td_no = 0;
299202ac6454SAndrew Thompson 			td_last = td;
299302ac6454SAndrew Thompson 			td = td->obj_next;
299402ac6454SAndrew Thompson 		}
299502ac6454SAndrew Thompson 	}
299602ac6454SAndrew Thompson 
299702ac6454SAndrew Thompson 	xfer->td_transfer_last = td_last;
299802ac6454SAndrew Thompson 
299902ac6454SAndrew Thompson 	/* update isoc_next */
3000ae60fdfbSAndrew Thompson 	xfer->endpoint->isoc_next = (pp_last - &sc->sc_isoc_hs_p_last[0]) &
300102ac6454SAndrew Thompson 	    (EHCI_VIRTUAL_FRAMELIST_COUNT - 1);
300202ac6454SAndrew Thompson }
300302ac6454SAndrew Thompson 
300402ac6454SAndrew Thompson static void
3005760bc48eSAndrew Thompson ehci_device_isoc_hs_start(struct usb_xfer *xfer)
300602ac6454SAndrew Thompson {
300702ac6454SAndrew Thompson 	/* put transfer on interrupt queue */
300802ac6454SAndrew Thompson 	ehci_transfer_intr_enqueue(xfer);
300902ac6454SAndrew Thompson }
301002ac6454SAndrew Thompson 
3011760bc48eSAndrew Thompson struct usb_pipe_methods ehci_device_isoc_hs_methods =
301202ac6454SAndrew Thompson {
301302ac6454SAndrew Thompson 	.open = ehci_device_isoc_hs_open,
301402ac6454SAndrew Thompson 	.close = ehci_device_isoc_hs_close,
301502ac6454SAndrew Thompson 	.enter = ehci_device_isoc_hs_enter,
301602ac6454SAndrew Thompson 	.start = ehci_device_isoc_hs_start,
301702ac6454SAndrew Thompson };
301802ac6454SAndrew Thompson 
301902ac6454SAndrew Thompson /*------------------------------------------------------------------------*
302002ac6454SAndrew Thompson  * ehci root control support
302102ac6454SAndrew Thompson  *------------------------------------------------------------------------*
302239307315SAndrew Thompson  * Simulate a hardware hub by handling all the necessary requests.
302302ac6454SAndrew Thompson  *------------------------------------------------------------------------*/
302402ac6454SAndrew Thompson 
302502ac6454SAndrew Thompson static const
3026760bc48eSAndrew Thompson struct usb_device_descriptor ehci_devd =
302702ac6454SAndrew Thompson {
3028760bc48eSAndrew Thompson 	sizeof(struct usb_device_descriptor),
302902ac6454SAndrew Thompson 	UDESC_DEVICE,			/* type */
303002ac6454SAndrew Thompson 	{0x00, 0x02},			/* USB version */
303102ac6454SAndrew Thompson 	UDCLASS_HUB,			/* class */
303202ac6454SAndrew Thompson 	UDSUBCLASS_HUB,			/* subclass */
303302ac6454SAndrew Thompson 	UDPROTO_HSHUBSTT,		/* protocol */
303402ac6454SAndrew Thompson 	64,				/* max packet */
303502ac6454SAndrew Thompson 	{0}, {0}, {0x00, 0x01},		/* device id */
303602ac6454SAndrew Thompson 	1, 2, 0,			/* string indicies */
303702ac6454SAndrew Thompson 	1				/* # of configurations */
303802ac6454SAndrew Thompson };
303902ac6454SAndrew Thompson 
304002ac6454SAndrew Thompson static const
3041760bc48eSAndrew Thompson struct usb_device_qualifier ehci_odevd =
304202ac6454SAndrew Thompson {
3043760bc48eSAndrew Thompson 	sizeof(struct usb_device_qualifier),
304402ac6454SAndrew Thompson 	UDESC_DEVICE_QUALIFIER,		/* type */
304502ac6454SAndrew Thompson 	{0x00, 0x02},			/* USB version */
304602ac6454SAndrew Thompson 	UDCLASS_HUB,			/* class */
304702ac6454SAndrew Thompson 	UDSUBCLASS_HUB,			/* subclass */
304802ac6454SAndrew Thompson 	UDPROTO_FSHUB,			/* protocol */
304902ac6454SAndrew Thompson 	0,				/* max packet */
305002ac6454SAndrew Thompson 	0,				/* # of configurations */
305102ac6454SAndrew Thompson 	0
305202ac6454SAndrew Thompson };
305302ac6454SAndrew Thompson 
305402ac6454SAndrew Thompson static const struct ehci_config_desc ehci_confd = {
305502ac6454SAndrew Thompson 	.confd = {
3056760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_config_descriptor),
305702ac6454SAndrew Thompson 		.bDescriptorType = UDESC_CONFIG,
305802ac6454SAndrew Thompson 		.wTotalLength[0] = sizeof(ehci_confd),
305902ac6454SAndrew Thompson 		.bNumInterface = 1,
306002ac6454SAndrew Thompson 		.bConfigurationValue = 1,
306102ac6454SAndrew Thompson 		.iConfiguration = 0,
306202ac6454SAndrew Thompson 		.bmAttributes = UC_SELF_POWERED,
306302ac6454SAndrew Thompson 		.bMaxPower = 0		/* max power */
306402ac6454SAndrew Thompson 	},
306502ac6454SAndrew Thompson 	.ifcd = {
3066760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_interface_descriptor),
306702ac6454SAndrew Thompson 		.bDescriptorType = UDESC_INTERFACE,
306802ac6454SAndrew Thompson 		.bNumEndpoints = 1,
306902ac6454SAndrew Thompson 		.bInterfaceClass = UICLASS_HUB,
307002ac6454SAndrew Thompson 		.bInterfaceSubClass = UISUBCLASS_HUB,
307102ac6454SAndrew Thompson 		.bInterfaceProtocol = UIPROTO_HSHUBSTT,
307202ac6454SAndrew Thompson 		0
307302ac6454SAndrew Thompson 	},
307402ac6454SAndrew Thompson 	.endpd = {
3075760bc48eSAndrew Thompson 		.bLength = sizeof(struct usb_endpoint_descriptor),
307602ac6454SAndrew Thompson 		.bDescriptorType = UDESC_ENDPOINT,
307702ac6454SAndrew Thompson 		.bEndpointAddress = UE_DIR_IN | EHCI_INTR_ENDPT,
307802ac6454SAndrew Thompson 		.bmAttributes = UE_INTERRUPT,
307902ac6454SAndrew Thompson 		.wMaxPacketSize[0] = 8,	/* max packet (63 ports) */
308002ac6454SAndrew Thompson 		.bInterval = 255,
308102ac6454SAndrew Thompson 	},
308202ac6454SAndrew Thompson };
308302ac6454SAndrew Thompson 
308402ac6454SAndrew Thompson static const
3085760bc48eSAndrew Thompson struct usb_hub_descriptor ehci_hubd =
308602ac6454SAndrew Thompson {
308702ac6454SAndrew Thompson 	0,				/* dynamic length */
308802ac6454SAndrew Thompson 	UDESC_HUB,
308902ac6454SAndrew Thompson 	0,
309002ac6454SAndrew Thompson 	{0, 0},
309102ac6454SAndrew Thompson 	0,
309202ac6454SAndrew Thompson 	0,
309302ac6454SAndrew Thompson 	{0},
309402ac6454SAndrew Thompson };
309502ac6454SAndrew Thompson 
309602ac6454SAndrew Thompson static void
309702ac6454SAndrew Thompson ehci_disown(ehci_softc_t *sc, uint16_t index, uint8_t lowspeed)
309802ac6454SAndrew Thompson {
309902ac6454SAndrew Thompson 	uint32_t port;
310002ac6454SAndrew Thompson 	uint32_t v;
310102ac6454SAndrew Thompson 
310202ac6454SAndrew Thompson 	DPRINTF("index=%d lowspeed=%d\n", index, lowspeed);
310302ac6454SAndrew Thompson 
310402ac6454SAndrew Thompson 	port = EHCI_PORTSC(index);
310502ac6454SAndrew Thompson 	v = EOREAD4(sc, port) & ~EHCI_PS_CLEAR;
310602ac6454SAndrew Thompson 	EOWRITE4(sc, port, v | EHCI_PS_PO);
310702ac6454SAndrew Thompson }
310802ac6454SAndrew Thompson 
3109e0a69b51SAndrew Thompson static usb_error_t
3110760bc48eSAndrew Thompson ehci_roothub_exec(struct usb_device *udev,
3111760bc48eSAndrew Thompson     struct usb_device_request *req, const void **pptr, uint16_t *plength)
311202ac6454SAndrew Thompson {
3113459d369eSAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(udev->bus);
3114459d369eSAndrew Thompson 	const char *str_ptr;
3115459d369eSAndrew Thompson 	const void *ptr;
311602ac6454SAndrew Thompson 	uint32_t port;
311702ac6454SAndrew Thompson 	uint32_t v;
3118459d369eSAndrew Thompson 	uint16_t len;
311902ac6454SAndrew Thompson 	uint16_t i;
312002ac6454SAndrew Thompson 	uint16_t value;
312102ac6454SAndrew Thompson 	uint16_t index;
312202ac6454SAndrew Thompson 	uint8_t l;
3123e0a69b51SAndrew Thompson 	usb_error_t err;
312402ac6454SAndrew Thompson 
312502ac6454SAndrew Thompson 	USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED);
312602ac6454SAndrew Thompson 
312702ac6454SAndrew Thompson 	/* buffer reset */
3128459d369eSAndrew Thompson 	ptr = (const void *)&sc->sc_hub_desc;
3129459d369eSAndrew Thompson 	len = 0;
3130459d369eSAndrew Thompson 	err = 0;
313102ac6454SAndrew Thompson 
3132459d369eSAndrew Thompson 	value = UGETW(req->wValue);
3133459d369eSAndrew Thompson 	index = UGETW(req->wIndex);
313402ac6454SAndrew Thompson 
313502ac6454SAndrew Thompson 	DPRINTFN(3, "type=0x%02x request=0x%02x wLen=0x%04x "
313602ac6454SAndrew Thompson 	    "wValue=0x%04x wIndex=0x%04x\n",
3137459d369eSAndrew Thompson 	    req->bmRequestType, req->bRequest,
3138459d369eSAndrew Thompson 	    UGETW(req->wLength), value, index);
313902ac6454SAndrew Thompson 
314002ac6454SAndrew Thompson #define	C(x,y) ((x) | ((y) << 8))
3141459d369eSAndrew Thompson 	switch (C(req->bRequest, req->bmRequestType)) {
314202ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE):
314302ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE):
314402ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT):
314502ac6454SAndrew Thompson 		/*
314602ac6454SAndrew Thompson 		 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops
314702ac6454SAndrew Thompson 		 * for the integrated root hub.
314802ac6454SAndrew Thompson 		 */
314902ac6454SAndrew Thompson 		break;
315002ac6454SAndrew Thompson 	case C(UR_GET_CONFIG, UT_READ_DEVICE):
3151459d369eSAndrew Thompson 		len = 1;
315202ac6454SAndrew Thompson 		sc->sc_hub_desc.temp[0] = sc->sc_conf;
315302ac6454SAndrew Thompson 		break;
315402ac6454SAndrew Thompson 	case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE):
315502ac6454SAndrew Thompson 		switch (value >> 8) {
315602ac6454SAndrew Thompson 		case UDESC_DEVICE:
315702ac6454SAndrew Thompson 			if ((value & 0xff) != 0) {
3158459d369eSAndrew Thompson 				err = USB_ERR_IOERROR;
315902ac6454SAndrew Thompson 				goto done;
316002ac6454SAndrew Thompson 			}
3161459d369eSAndrew Thompson 			len = sizeof(ehci_devd);
3162459d369eSAndrew Thompson 			ptr = (const void *)&ehci_devd;
316302ac6454SAndrew Thompson 			break;
316402ac6454SAndrew Thompson 			/*
316502ac6454SAndrew Thompson 			 * We can't really operate at another speed,
316602ac6454SAndrew Thompson 			 * but the specification says we need this
316702ac6454SAndrew Thompson 			 * descriptor:
316802ac6454SAndrew Thompson 			 */
316902ac6454SAndrew Thompson 		case UDESC_DEVICE_QUALIFIER:
317002ac6454SAndrew Thompson 			if ((value & 0xff) != 0) {
3171459d369eSAndrew Thompson 				err = USB_ERR_IOERROR;
317202ac6454SAndrew Thompson 				goto done;
317302ac6454SAndrew Thompson 			}
3174459d369eSAndrew Thompson 			len = sizeof(ehci_odevd);
3175459d369eSAndrew Thompson 			ptr = (const void *)&ehci_odevd;
317602ac6454SAndrew Thompson 			break;
317702ac6454SAndrew Thompson 
317802ac6454SAndrew Thompson 		case UDESC_CONFIG:
317902ac6454SAndrew Thompson 			if ((value & 0xff) != 0) {
3180459d369eSAndrew Thompson 				err = USB_ERR_IOERROR;
318102ac6454SAndrew Thompson 				goto done;
318202ac6454SAndrew Thompson 			}
3183459d369eSAndrew Thompson 			len = sizeof(ehci_confd);
3184459d369eSAndrew Thompson 			ptr = (const void *)&ehci_confd;
318502ac6454SAndrew Thompson 			break;
318602ac6454SAndrew Thompson 
318702ac6454SAndrew Thompson 		case UDESC_STRING:
318802ac6454SAndrew Thompson 			switch (value & 0xff) {
318902ac6454SAndrew Thompson 			case 0:	/* Language table */
3190459d369eSAndrew Thompson 				str_ptr = "\001";
319102ac6454SAndrew Thompson 				break;
319202ac6454SAndrew Thompson 
319302ac6454SAndrew Thompson 			case 1:	/* Vendor */
3194459d369eSAndrew Thompson 				str_ptr = sc->sc_vendor;
319502ac6454SAndrew Thompson 				break;
319602ac6454SAndrew Thompson 
319702ac6454SAndrew Thompson 			case 2:	/* Product */
3198459d369eSAndrew Thompson 				str_ptr = "EHCI root HUB";
319902ac6454SAndrew Thompson 				break;
320002ac6454SAndrew Thompson 
320102ac6454SAndrew Thompson 			default:
3202459d369eSAndrew Thompson 				str_ptr = "";
320302ac6454SAndrew Thompson 				break;
320402ac6454SAndrew Thompson 			}
320502ac6454SAndrew Thompson 
3206a593f6b8SAndrew Thompson 			len = usb_make_str_desc(
3207459d369eSAndrew Thompson 			    sc->sc_hub_desc.temp,
320802ac6454SAndrew Thompson 			    sizeof(sc->sc_hub_desc.temp),
3209459d369eSAndrew Thompson 			    str_ptr);
321002ac6454SAndrew Thompson 			break;
321102ac6454SAndrew Thompson 		default:
3212459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
321302ac6454SAndrew Thompson 			goto done;
321402ac6454SAndrew Thompson 		}
321502ac6454SAndrew Thompson 		break;
321602ac6454SAndrew Thompson 	case C(UR_GET_INTERFACE, UT_READ_INTERFACE):
3217459d369eSAndrew Thompson 		len = 1;
321802ac6454SAndrew Thompson 		sc->sc_hub_desc.temp[0] = 0;
321902ac6454SAndrew Thompson 		break;
322002ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_DEVICE):
3221459d369eSAndrew Thompson 		len = 2;
322202ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.stat.wStatus, UDS_SELF_POWERED);
322302ac6454SAndrew Thompson 		break;
322402ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_INTERFACE):
322502ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_ENDPOINT):
3226459d369eSAndrew Thompson 		len = 2;
322702ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.stat.wStatus, 0);
322802ac6454SAndrew Thompson 		break;
322902ac6454SAndrew Thompson 	case C(UR_SET_ADDRESS, UT_WRITE_DEVICE):
3230ab42e8b2SAndrew Thompson 		if (value >= EHCI_MAX_DEVICES) {
3231459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
323202ac6454SAndrew Thompson 			goto done;
323302ac6454SAndrew Thompson 		}
323402ac6454SAndrew Thompson 		sc->sc_addr = value;
323502ac6454SAndrew Thompson 		break;
323602ac6454SAndrew Thompson 	case C(UR_SET_CONFIG, UT_WRITE_DEVICE):
323702ac6454SAndrew Thompson 		if ((value != 0) && (value != 1)) {
3238459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
323902ac6454SAndrew Thompson 			goto done;
324002ac6454SAndrew Thompson 		}
324102ac6454SAndrew Thompson 		sc->sc_conf = value;
324202ac6454SAndrew Thompson 		break;
324302ac6454SAndrew Thompson 	case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE):
324402ac6454SAndrew Thompson 		break;
324502ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_DEVICE):
324602ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_INTERFACE):
324702ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT):
3248459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
324902ac6454SAndrew Thompson 		goto done;
325002ac6454SAndrew Thompson 	case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE):
325102ac6454SAndrew Thompson 		break;
325202ac6454SAndrew Thompson 	case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT):
325302ac6454SAndrew Thompson 		break;
325402ac6454SAndrew Thompson 		/* Hub requests */
325502ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE):
325602ac6454SAndrew Thompson 		break;
325702ac6454SAndrew Thompson 	case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER):
325802ac6454SAndrew Thompson 		DPRINTFN(9, "UR_CLEAR_PORT_FEATURE\n");
325902ac6454SAndrew Thompson 
326002ac6454SAndrew Thompson 		if ((index < 1) ||
326102ac6454SAndrew Thompson 		    (index > sc->sc_noport)) {
3262459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
326302ac6454SAndrew Thompson 			goto done;
326402ac6454SAndrew Thompson 		}
326502ac6454SAndrew Thompson 		port = EHCI_PORTSC(index);
326602ac6454SAndrew Thompson 		v = EOREAD4(sc, port) & ~EHCI_PS_CLEAR;
326702ac6454SAndrew Thompson 		switch (value) {
326802ac6454SAndrew Thompson 		case UHF_PORT_ENABLE:
326902ac6454SAndrew Thompson 			EOWRITE4(sc, port, v & ~EHCI_PS_PE);
327002ac6454SAndrew Thompson 			break;
327102ac6454SAndrew Thompson 		case UHF_PORT_SUSPEND:
327202ac6454SAndrew Thompson 			if ((v & EHCI_PS_SUSP) && (!(v & EHCI_PS_FPR))) {
327302ac6454SAndrew Thompson 
327402ac6454SAndrew Thompson 				/*
327502ac6454SAndrew Thompson 				 * waking up a High Speed device is rather
327602ac6454SAndrew Thompson 				 * complicated if
327702ac6454SAndrew Thompson 				 */
327802ac6454SAndrew Thompson 				EOWRITE4(sc, port, v | EHCI_PS_FPR);
327902ac6454SAndrew Thompson 			}
328002ac6454SAndrew Thompson 			/* wait 20ms for resume sequence to complete */
3281a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 50);
328202ac6454SAndrew Thompson 
328302ac6454SAndrew Thompson 			EOWRITE4(sc, port, v & ~(EHCI_PS_SUSP |
328402ac6454SAndrew Thompson 			    EHCI_PS_FPR | (3 << 10) /* High Speed */ ));
328502ac6454SAndrew Thompson 
32864a35cda7SAndrew Thompson 			/* 4ms settle time */
3287a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 250);
328802ac6454SAndrew Thompson 			break;
328902ac6454SAndrew Thompson 		case UHF_PORT_POWER:
329002ac6454SAndrew Thompson 			EOWRITE4(sc, port, v & ~EHCI_PS_PP);
329102ac6454SAndrew Thompson 			break;
329202ac6454SAndrew Thompson 		case UHF_PORT_TEST:
329302ac6454SAndrew Thompson 			DPRINTFN(3, "clear port test "
329402ac6454SAndrew Thompson 			    "%d\n", index);
329502ac6454SAndrew Thompson 			break;
329602ac6454SAndrew Thompson 		case UHF_PORT_INDICATOR:
329702ac6454SAndrew Thompson 			DPRINTFN(3, "clear port ind "
329802ac6454SAndrew Thompson 			    "%d\n", index);
329902ac6454SAndrew Thompson 			EOWRITE4(sc, port, v & ~EHCI_PS_PIC);
330002ac6454SAndrew Thompson 			break;
330102ac6454SAndrew Thompson 		case UHF_C_PORT_CONNECTION:
330202ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_CSC);
330302ac6454SAndrew Thompson 			break;
330402ac6454SAndrew Thompson 		case UHF_C_PORT_ENABLE:
330502ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_PEC);
330602ac6454SAndrew Thompson 			break;
330702ac6454SAndrew Thompson 		case UHF_C_PORT_SUSPEND:
330802ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_SUSP);
330902ac6454SAndrew Thompson 			break;
331002ac6454SAndrew Thompson 		case UHF_C_PORT_OVER_CURRENT:
331102ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_OCC);
331202ac6454SAndrew Thompson 			break;
331302ac6454SAndrew Thompson 		case UHF_C_PORT_RESET:
331402ac6454SAndrew Thompson 			sc->sc_isreset = 0;
331502ac6454SAndrew Thompson 			break;
331602ac6454SAndrew Thompson 		default:
3317459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
331802ac6454SAndrew Thompson 			goto done;
331902ac6454SAndrew Thompson 		}
332002ac6454SAndrew Thompson 		break;
332102ac6454SAndrew Thompson 	case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE):
332202ac6454SAndrew Thompson 		if ((value & 0xff) != 0) {
3323459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
332402ac6454SAndrew Thompson 			goto done;
332502ac6454SAndrew Thompson 		}
332602ac6454SAndrew Thompson 		v = EOREAD4(sc, EHCI_HCSPARAMS);
332702ac6454SAndrew Thompson 
332802ac6454SAndrew Thompson 		sc->sc_hub_desc.hubd = ehci_hubd;
332902ac6454SAndrew Thompson 		sc->sc_hub_desc.hubd.bNbrPorts = sc->sc_noport;
333002ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.hubd.wHubCharacteristics,
333102ac6454SAndrew Thompson 		    (EHCI_HCS_PPC(v) ? UHD_PWR_INDIVIDUAL : UHD_PWR_NO_SWITCH) |
333202ac6454SAndrew Thompson 		    (EHCI_HCS_P_INDICATOR(EREAD4(sc, EHCI_HCSPARAMS)) ?
333302ac6454SAndrew Thompson 		    UHD_PORT_IND : 0));
333402ac6454SAndrew Thompson 		/* XXX can't find out? */
333502ac6454SAndrew Thompson 		sc->sc_hub_desc.hubd.bPwrOn2PwrGood = 200;
333602ac6454SAndrew Thompson 		for (l = 0; l < sc->sc_noport; l++) {
333702ac6454SAndrew Thompson 			/* XXX can't find out? */
333802ac6454SAndrew Thompson 			sc->sc_hub_desc.hubd.DeviceRemovable[l / 8] &= ~(1 << (l % 8));
333902ac6454SAndrew Thompson 		}
334002ac6454SAndrew Thompson 		sc->sc_hub_desc.hubd.bDescLength =
334102ac6454SAndrew Thompson 		    8 + ((sc->sc_noport + 7) / 8);
3342459d369eSAndrew Thompson 		len = sc->sc_hub_desc.hubd.bDescLength;
334302ac6454SAndrew Thompson 		break;
334402ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE):
3345459d369eSAndrew Thompson 		len = 16;
334602ac6454SAndrew Thompson 		bzero(sc->sc_hub_desc.temp, 16);
334702ac6454SAndrew Thompson 		break;
334802ac6454SAndrew Thompson 	case C(UR_GET_STATUS, UT_READ_CLASS_OTHER):
334902ac6454SAndrew Thompson 		DPRINTFN(9, "get port status i=%d\n",
335002ac6454SAndrew Thompson 		    index);
335102ac6454SAndrew Thompson 		if ((index < 1) ||
335202ac6454SAndrew Thompson 		    (index > sc->sc_noport)) {
3353459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
335402ac6454SAndrew Thompson 			goto done;
335502ac6454SAndrew Thompson 		}
335602ac6454SAndrew Thompson 		v = EOREAD4(sc, EHCI_PORTSC(index));
335702ac6454SAndrew Thompson 		DPRINTFN(9, "port status=0x%04x\n", v);
3358e55e1ebcSAndrew Thompson 		if (sc->sc_flags & (EHCI_SCFLG_FORCESPEED | EHCI_SCFLG_TT)) {
335902ac6454SAndrew Thompson 			if ((v & 0xc000000) == 0x8000000)
336002ac6454SAndrew Thompson 				i = UPS_HIGH_SPEED;
336102ac6454SAndrew Thompson 			else if ((v & 0xc000000) == 0x4000000)
336202ac6454SAndrew Thompson 				i = UPS_LOW_SPEED;
336302ac6454SAndrew Thompson 			else
336402ac6454SAndrew Thompson 				i = 0;
336502ac6454SAndrew Thompson 		} else {
336602ac6454SAndrew Thompson 			i = UPS_HIGH_SPEED;
336702ac6454SAndrew Thompson 		}
336802ac6454SAndrew Thompson 		if (v & EHCI_PS_CS)
336902ac6454SAndrew Thompson 			i |= UPS_CURRENT_CONNECT_STATUS;
337002ac6454SAndrew Thompson 		if (v & EHCI_PS_PE)
337102ac6454SAndrew Thompson 			i |= UPS_PORT_ENABLED;
337202ac6454SAndrew Thompson 		if ((v & EHCI_PS_SUSP) && !(v & EHCI_PS_FPR))
337302ac6454SAndrew Thompson 			i |= UPS_SUSPEND;
337402ac6454SAndrew Thompson 		if (v & EHCI_PS_OCA)
337502ac6454SAndrew Thompson 			i |= UPS_OVERCURRENT_INDICATOR;
337602ac6454SAndrew Thompson 		if (v & EHCI_PS_PR)
337702ac6454SAndrew Thompson 			i |= UPS_RESET;
337802ac6454SAndrew Thompson 		if (v & EHCI_PS_PP)
337902ac6454SAndrew Thompson 			i |= UPS_PORT_POWER;
338002ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.ps.wPortStatus, i);
338102ac6454SAndrew Thompson 		i = 0;
338202ac6454SAndrew Thompson 		if (v & EHCI_PS_CSC)
338302ac6454SAndrew Thompson 			i |= UPS_C_CONNECT_STATUS;
338402ac6454SAndrew Thompson 		if (v & EHCI_PS_PEC)
338502ac6454SAndrew Thompson 			i |= UPS_C_PORT_ENABLED;
338602ac6454SAndrew Thompson 		if (v & EHCI_PS_OCC)
338702ac6454SAndrew Thompson 			i |= UPS_C_OVERCURRENT_INDICATOR;
338802ac6454SAndrew Thompson 		if (v & EHCI_PS_FPR)
338902ac6454SAndrew Thompson 			i |= UPS_C_SUSPEND;
339002ac6454SAndrew Thompson 		if (sc->sc_isreset)
339102ac6454SAndrew Thompson 			i |= UPS_C_PORT_RESET;
339202ac6454SAndrew Thompson 		USETW(sc->sc_hub_desc.ps.wPortChange, i);
3393459d369eSAndrew Thompson 		len = sizeof(sc->sc_hub_desc.ps);
339402ac6454SAndrew Thompson 		break;
339502ac6454SAndrew Thompson 	case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE):
3396459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
339702ac6454SAndrew Thompson 		goto done;
339802ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE):
339902ac6454SAndrew Thompson 		break;
340002ac6454SAndrew Thompson 	case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER):
340102ac6454SAndrew Thompson 		if ((index < 1) ||
340202ac6454SAndrew Thompson 		    (index > sc->sc_noport)) {
3403459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
340402ac6454SAndrew Thompson 			goto done;
340502ac6454SAndrew Thompson 		}
340602ac6454SAndrew Thompson 		port = EHCI_PORTSC(index);
340702ac6454SAndrew Thompson 		v = EOREAD4(sc, port) & ~EHCI_PS_CLEAR;
340802ac6454SAndrew Thompson 		switch (value) {
340902ac6454SAndrew Thompson 		case UHF_PORT_ENABLE:
341002ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_PE);
341102ac6454SAndrew Thompson 			break;
341202ac6454SAndrew Thompson 		case UHF_PORT_SUSPEND:
341302ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_SUSP);
341402ac6454SAndrew Thompson 			break;
341502ac6454SAndrew Thompson 		case UHF_PORT_RESET:
341602ac6454SAndrew Thompson 			DPRINTFN(6, "reset port %d\n", index);
341702ac6454SAndrew Thompson #if USB_DEBUG
341802ac6454SAndrew Thompson 			if (ehcinohighspeed) {
341902ac6454SAndrew Thompson 				/*
342002ac6454SAndrew Thompson 				 * Connect USB device to companion
342102ac6454SAndrew Thompson 				 * controller.
342202ac6454SAndrew Thompson 				 */
342302ac6454SAndrew Thompson 				ehci_disown(sc, index, 1);
342402ac6454SAndrew Thompson 				break;
342502ac6454SAndrew Thompson 			}
342602ac6454SAndrew Thompson #endif
3427e55e1ebcSAndrew Thompson 			if (EHCI_PS_IS_LOWSPEED(v) &&
3428e55e1ebcSAndrew Thompson 			    (sc->sc_flags & EHCI_SCFLG_TT) == 0) {
342902ac6454SAndrew Thompson 				/* Low speed device, give up ownership. */
343002ac6454SAndrew Thompson 				ehci_disown(sc, index, 1);
343102ac6454SAndrew Thompson 				break;
343202ac6454SAndrew Thompson 			}
343302ac6454SAndrew Thompson 			/* Start reset sequence. */
343402ac6454SAndrew Thompson 			v &= ~(EHCI_PS_PE | EHCI_PS_PR);
343502ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_PR);
343602ac6454SAndrew Thompson 
343702ac6454SAndrew Thompson 			/* Wait for reset to complete. */
3438a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx,
343902ac6454SAndrew Thompson 			    USB_MS_TO_TICKS(USB_PORT_ROOT_RESET_DELAY));
344002ac6454SAndrew Thompson 
344102ac6454SAndrew Thompson 			/* Terminate reset sequence. */
344202ac6454SAndrew Thompson 			if (!(sc->sc_flags & EHCI_SCFLG_NORESTERM))
344302ac6454SAndrew Thompson 				EOWRITE4(sc, port, v);
344402ac6454SAndrew Thompson 
344502ac6454SAndrew Thompson 			/* Wait for HC to complete reset. */
3446a593f6b8SAndrew Thompson 			usb_pause_mtx(&sc->sc_bus.bus_mtx,
344702ac6454SAndrew Thompson 			    USB_MS_TO_TICKS(EHCI_PORT_RESET_COMPLETE));
344802ac6454SAndrew Thompson 
344902ac6454SAndrew Thompson 			v = EOREAD4(sc, port);
345002ac6454SAndrew Thompson 			DPRINTF("ehci after reset, status=0x%08x\n", v);
345102ac6454SAndrew Thompson 			if (v & EHCI_PS_PR) {
345202ac6454SAndrew Thompson 				device_printf(sc->sc_bus.bdev,
345302ac6454SAndrew Thompson 				    "port reset timeout\n");
3454459d369eSAndrew Thompson 				err = USB_ERR_TIMEOUT;
345502ac6454SAndrew Thompson 				goto done;
345602ac6454SAndrew Thompson 			}
3457e55e1ebcSAndrew Thompson 			if (!(v & EHCI_PS_PE) &&
3458e55e1ebcSAndrew Thompson 			    (sc->sc_flags & EHCI_SCFLG_TT) == 0) {
3459e55e1ebcSAndrew Thompson 				/* Not a high speed device, give up ownership.*/
346002ac6454SAndrew Thompson 				ehci_disown(sc, index, 0);
346102ac6454SAndrew Thompson 				break;
346202ac6454SAndrew Thompson 			}
346302ac6454SAndrew Thompson 			sc->sc_isreset = 1;
346402ac6454SAndrew Thompson 			DPRINTF("ehci port %d reset, status = 0x%08x\n",
346502ac6454SAndrew Thompson 			    index, v);
346602ac6454SAndrew Thompson 			break;
346702ac6454SAndrew Thompson 
346802ac6454SAndrew Thompson 		case UHF_PORT_POWER:
346902ac6454SAndrew Thompson 			DPRINTFN(3, "set port power %d\n", index);
347002ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_PP);
347102ac6454SAndrew Thompson 			break;
347202ac6454SAndrew Thompson 
347302ac6454SAndrew Thompson 		case UHF_PORT_TEST:
347402ac6454SAndrew Thompson 			DPRINTFN(3, "set port test %d\n", index);
347502ac6454SAndrew Thompson 			break;
347602ac6454SAndrew Thompson 
347702ac6454SAndrew Thompson 		case UHF_PORT_INDICATOR:
347802ac6454SAndrew Thompson 			DPRINTFN(3, "set port ind %d\n", index);
347902ac6454SAndrew Thompson 			EOWRITE4(sc, port, v | EHCI_PS_PIC);
348002ac6454SAndrew Thompson 			break;
348102ac6454SAndrew Thompson 
348202ac6454SAndrew Thompson 		default:
3483459d369eSAndrew Thompson 			err = USB_ERR_IOERROR;
348402ac6454SAndrew Thompson 			goto done;
348502ac6454SAndrew Thompson 		}
348602ac6454SAndrew Thompson 		break;
348702ac6454SAndrew Thompson 	case C(UR_CLEAR_TT_BUFFER, UT_WRITE_CLASS_OTHER):
348802ac6454SAndrew Thompson 	case C(UR_RESET_TT, UT_WRITE_CLASS_OTHER):
348902ac6454SAndrew Thompson 	case C(UR_GET_TT_STATE, UT_READ_CLASS_OTHER):
349002ac6454SAndrew Thompson 	case C(UR_STOP_TT, UT_WRITE_CLASS_OTHER):
349102ac6454SAndrew Thompson 		break;
349202ac6454SAndrew Thompson 	default:
3493459d369eSAndrew Thompson 		err = USB_ERR_IOERROR;
349402ac6454SAndrew Thompson 		goto done;
349502ac6454SAndrew Thompson 	}
349602ac6454SAndrew Thompson done:
3497459d369eSAndrew Thompson 	*plength = len;
3498459d369eSAndrew Thompson 	*pptr = ptr;
3499459d369eSAndrew Thompson 	return (err);
350002ac6454SAndrew Thompson }
350102ac6454SAndrew Thompson 
350202ac6454SAndrew Thompson static void
3503760bc48eSAndrew Thompson ehci_xfer_setup(struct usb_setup_params *parm)
350402ac6454SAndrew Thompson {
3505760bc48eSAndrew Thompson 	struct usb_page_search page_info;
3506760bc48eSAndrew Thompson 	struct usb_page_cache *pc;
350702ac6454SAndrew Thompson 	ehci_softc_t *sc;
3508760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
350902ac6454SAndrew Thompson 	void *last_obj;
351002ac6454SAndrew Thompson 	uint32_t nqtd;
351102ac6454SAndrew Thompson 	uint32_t nqh;
351202ac6454SAndrew Thompson 	uint32_t nsitd;
351302ac6454SAndrew Thompson 	uint32_t nitd;
351402ac6454SAndrew Thompson 	uint32_t n;
351502ac6454SAndrew Thompson 
351602ac6454SAndrew Thompson 	sc = EHCI_BUS2SC(parm->udev->bus);
351702ac6454SAndrew Thompson 	xfer = parm->curr_xfer;
351802ac6454SAndrew Thompson 
351902ac6454SAndrew Thompson 	nqtd = 0;
352002ac6454SAndrew Thompson 	nqh = 0;
352102ac6454SAndrew Thompson 	nsitd = 0;
352202ac6454SAndrew Thompson 	nitd = 0;
352302ac6454SAndrew Thompson 
352402ac6454SAndrew Thompson 	/*
352502ac6454SAndrew Thompson 	 * compute maximum number of some structures
352602ac6454SAndrew Thompson 	 */
352702ac6454SAndrew Thompson 	if (parm->methods == &ehci_device_ctrl_methods) {
352802ac6454SAndrew Thompson 
352902ac6454SAndrew Thompson 		/*
353002ac6454SAndrew Thompson 		 * The proof for the "nqtd" formula is illustrated like
353102ac6454SAndrew Thompson 		 * this:
353202ac6454SAndrew Thompson 		 *
353302ac6454SAndrew Thompson 		 * +------------------------------------+
353402ac6454SAndrew Thompson 		 * |                                    |
353502ac6454SAndrew Thompson 		 * |         |remainder ->              |
353602ac6454SAndrew Thompson 		 * |   +-----+---+                      |
353702ac6454SAndrew Thompson 		 * |   | xxx | x | frm 0                |
353802ac6454SAndrew Thompson 		 * |   +-----+---++                     |
353902ac6454SAndrew Thompson 		 * |   | xxx | xx | frm 1               |
354002ac6454SAndrew Thompson 		 * |   +-----+----+                     |
354102ac6454SAndrew Thompson 		 * |            ...                     |
354202ac6454SAndrew Thompson 		 * +------------------------------------+
354302ac6454SAndrew Thompson 		 *
354402ac6454SAndrew Thompson 		 * "xxx" means a completely full USB transfer descriptor
354502ac6454SAndrew Thompson 		 *
354602ac6454SAndrew Thompson 		 * "x" and "xx" means a short USB packet
354702ac6454SAndrew Thompson 		 *
354802ac6454SAndrew Thompson 		 * For the remainder of an USB transfer modulo
354902ac6454SAndrew Thompson 		 * "max_data_length" we need two USB transfer descriptors.
355002ac6454SAndrew Thompson 		 * One to transfer the remaining data and one to finalise
355102ac6454SAndrew Thompson 		 * with a zero length packet in case the "force_short_xfer"
355202ac6454SAndrew Thompson 		 * flag is set. We only need two USB transfer descriptors in
355302ac6454SAndrew Thompson 		 * the case where the transfer length of the first one is a
355402ac6454SAndrew Thompson 		 * factor of "max_frame_size". The rest of the needed USB
355502ac6454SAndrew Thompson 		 * transfer descriptors is given by the buffer size divided
355602ac6454SAndrew Thompson 		 * by the maximum data payload.
355702ac6454SAndrew Thompson 		 */
355802ac6454SAndrew Thompson 		parm->hc_max_packet_size = 0x400;
355902ac6454SAndrew Thompson 		parm->hc_max_packet_count = 1;
356002ac6454SAndrew Thompson 		parm->hc_max_frame_size = EHCI_QTD_PAYLOAD_MAX;
356102ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
356202ac6454SAndrew Thompson 
3563a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
356402ac6454SAndrew Thompson 
356502ac6454SAndrew Thompson 		nqh = 1;
356602ac6454SAndrew Thompson 		nqtd = ((2 * xfer->nframes) + 1	/* STATUS */
3567578d0effSAndrew Thompson 		    + (xfer->max_data_length / xfer->max_hc_frame_size));
356802ac6454SAndrew Thompson 
356902ac6454SAndrew Thompson 	} else if (parm->methods == &ehci_device_bulk_methods) {
357002ac6454SAndrew Thompson 
357102ac6454SAndrew Thompson 		parm->hc_max_packet_size = 0x400;
357202ac6454SAndrew Thompson 		parm->hc_max_packet_count = 1;
357302ac6454SAndrew Thompson 		parm->hc_max_frame_size = EHCI_QTD_PAYLOAD_MAX;
357402ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
357502ac6454SAndrew Thompson 
3576a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
357702ac6454SAndrew Thompson 
357802ac6454SAndrew Thompson 		nqh = 1;
357902ac6454SAndrew Thompson 		nqtd = ((2 * xfer->nframes)
3580578d0effSAndrew Thompson 		    + (xfer->max_data_length / xfer->max_hc_frame_size));
358102ac6454SAndrew Thompson 
358202ac6454SAndrew Thompson 	} else if (parm->methods == &ehci_device_intr_methods) {
358302ac6454SAndrew Thompson 
358402ac6454SAndrew Thompson 		if (parm->speed == USB_SPEED_HIGH) {
358502ac6454SAndrew Thompson 			parm->hc_max_packet_size = 0x400;
358602ac6454SAndrew Thompson 			parm->hc_max_packet_count = 3;
358702ac6454SAndrew Thompson 		} else if (parm->speed == USB_SPEED_FULL) {
358802ac6454SAndrew Thompson 			parm->hc_max_packet_size = USB_FS_BYTES_PER_HS_UFRAME;
358902ac6454SAndrew Thompson 			parm->hc_max_packet_count = 1;
359002ac6454SAndrew Thompson 		} else {
359102ac6454SAndrew Thompson 			parm->hc_max_packet_size = USB_FS_BYTES_PER_HS_UFRAME / 8;
359202ac6454SAndrew Thompson 			parm->hc_max_packet_count = 1;
359302ac6454SAndrew Thompson 		}
359402ac6454SAndrew Thompson 
359502ac6454SAndrew Thompson 		parm->hc_max_frame_size = EHCI_QTD_PAYLOAD_MAX;
359602ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
359702ac6454SAndrew Thompson 
3598a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
359902ac6454SAndrew Thompson 
360002ac6454SAndrew Thompson 		nqh = 1;
360102ac6454SAndrew Thompson 		nqtd = ((2 * xfer->nframes)
3602578d0effSAndrew Thompson 		    + (xfer->max_data_length / xfer->max_hc_frame_size));
360302ac6454SAndrew Thompson 
360402ac6454SAndrew Thompson 	} else if (parm->methods == &ehci_device_isoc_fs_methods) {
360502ac6454SAndrew Thompson 
360602ac6454SAndrew Thompson 		parm->hc_max_packet_size = 0x3FF;
360702ac6454SAndrew Thompson 		parm->hc_max_packet_count = 1;
360802ac6454SAndrew Thompson 		parm->hc_max_frame_size = 0x3FF;
360902ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
361002ac6454SAndrew Thompson 
3611a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
361202ac6454SAndrew Thompson 
361302ac6454SAndrew Thompson 		nsitd = xfer->nframes;
361402ac6454SAndrew Thompson 
361502ac6454SAndrew Thompson 	} else if (parm->methods == &ehci_device_isoc_hs_methods) {
361602ac6454SAndrew Thompson 
361702ac6454SAndrew Thompson 		parm->hc_max_packet_size = 0x400;
361802ac6454SAndrew Thompson 		parm->hc_max_packet_count = 3;
361902ac6454SAndrew Thompson 		parm->hc_max_frame_size = 0xC00;
362002ac6454SAndrew Thompson 		xfer->flags_int.bdma_enable = 1;
362102ac6454SAndrew Thompson 
3622a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
362302ac6454SAndrew Thompson 
3624883bb300SAndrew Thompson 		nitd = ((xfer->nframes + 7) / 8) <<
3625883bb300SAndrew Thompson 		    usbd_xfer_get_fps_shift(xfer);
362602ac6454SAndrew Thompson 
362702ac6454SAndrew Thompson 	} else {
362802ac6454SAndrew Thompson 
362902ac6454SAndrew Thompson 		parm->hc_max_packet_size = 0x400;
363002ac6454SAndrew Thompson 		parm->hc_max_packet_count = 1;
363102ac6454SAndrew Thompson 		parm->hc_max_frame_size = 0x400;
363202ac6454SAndrew Thompson 
3633a593f6b8SAndrew Thompson 		usbd_transfer_setup_sub(parm);
363402ac6454SAndrew Thompson 	}
363502ac6454SAndrew Thompson 
363602ac6454SAndrew Thompson alloc_dma_set:
363702ac6454SAndrew Thompson 
363802ac6454SAndrew Thompson 	if (parm->err) {
363902ac6454SAndrew Thompson 		return;
364002ac6454SAndrew Thompson 	}
364102ac6454SAndrew Thompson 	/*
364202ac6454SAndrew Thompson 	 * Allocate queue heads and transfer descriptors
364302ac6454SAndrew Thompson 	 */
364402ac6454SAndrew Thompson 	last_obj = NULL;
364502ac6454SAndrew Thompson 
3646a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
364702ac6454SAndrew Thompson 	    parm, &pc, sizeof(ehci_itd_t),
364802ac6454SAndrew Thompson 	    EHCI_ITD_ALIGN, nitd)) {
364902ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
365002ac6454SAndrew Thompson 		return;
365102ac6454SAndrew Thompson 	}
365202ac6454SAndrew Thompson 	if (parm->buf) {
365302ac6454SAndrew Thompson 		for (n = 0; n != nitd; n++) {
365402ac6454SAndrew Thompson 			ehci_itd_t *td;
365502ac6454SAndrew Thompson 
3656a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
365702ac6454SAndrew Thompson 
365802ac6454SAndrew Thompson 			td = page_info.buffer;
365902ac6454SAndrew Thompson 
366002ac6454SAndrew Thompson 			/* init TD */
3661e55e1ebcSAndrew Thompson 			td->itd_self = htohc32(sc, page_info.physaddr | EHCI_LINK_ITD);
366202ac6454SAndrew Thompson 			td->obj_next = last_obj;
366302ac6454SAndrew Thompson 			td->page_cache = pc + n;
366402ac6454SAndrew Thompson 
366502ac6454SAndrew Thompson 			last_obj = td;
366602ac6454SAndrew Thompson 
3667a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
366802ac6454SAndrew Thompson 		}
366902ac6454SAndrew Thompson 	}
3670a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
367102ac6454SAndrew Thompson 	    parm, &pc, sizeof(ehci_sitd_t),
367202ac6454SAndrew Thompson 	    EHCI_SITD_ALIGN, nsitd)) {
367302ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
367402ac6454SAndrew Thompson 		return;
367502ac6454SAndrew Thompson 	}
367602ac6454SAndrew Thompson 	if (parm->buf) {
367702ac6454SAndrew Thompson 		for (n = 0; n != nsitd; n++) {
367802ac6454SAndrew Thompson 			ehci_sitd_t *td;
367902ac6454SAndrew Thompson 
3680a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
368102ac6454SAndrew Thompson 
368202ac6454SAndrew Thompson 			td = page_info.buffer;
368302ac6454SAndrew Thompson 
368402ac6454SAndrew Thompson 			/* init TD */
3685e55e1ebcSAndrew Thompson 			td->sitd_self = htohc32(sc, page_info.physaddr | EHCI_LINK_SITD);
368602ac6454SAndrew Thompson 			td->obj_next = last_obj;
368702ac6454SAndrew Thompson 			td->page_cache = pc + n;
368802ac6454SAndrew Thompson 
368902ac6454SAndrew Thompson 			last_obj = td;
369002ac6454SAndrew Thompson 
3691a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
369202ac6454SAndrew Thompson 		}
369302ac6454SAndrew Thompson 	}
3694a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
369502ac6454SAndrew Thompson 	    parm, &pc, sizeof(ehci_qtd_t),
369602ac6454SAndrew Thompson 	    EHCI_QTD_ALIGN, nqtd)) {
369702ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
369802ac6454SAndrew Thompson 		return;
369902ac6454SAndrew Thompson 	}
370002ac6454SAndrew Thompson 	if (parm->buf) {
370102ac6454SAndrew Thompson 		for (n = 0; n != nqtd; n++) {
370202ac6454SAndrew Thompson 			ehci_qtd_t *qtd;
370302ac6454SAndrew Thompson 
3704a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
370502ac6454SAndrew Thompson 
370602ac6454SAndrew Thompson 			qtd = page_info.buffer;
370702ac6454SAndrew Thompson 
370802ac6454SAndrew Thompson 			/* init TD */
3709e55e1ebcSAndrew Thompson 			qtd->qtd_self = htohc32(sc, page_info.physaddr);
371002ac6454SAndrew Thompson 			qtd->obj_next = last_obj;
371102ac6454SAndrew Thompson 			qtd->page_cache = pc + n;
371202ac6454SAndrew Thompson 
371302ac6454SAndrew Thompson 			last_obj = qtd;
371402ac6454SAndrew Thompson 
3715a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
371602ac6454SAndrew Thompson 		}
371702ac6454SAndrew Thompson 	}
371802ac6454SAndrew Thompson 	xfer->td_start[xfer->flags_int.curr_dma_set] = last_obj;
371902ac6454SAndrew Thompson 
372002ac6454SAndrew Thompson 	last_obj = NULL;
372102ac6454SAndrew Thompson 
3722a593f6b8SAndrew Thompson 	if (usbd_transfer_setup_sub_malloc(
372302ac6454SAndrew Thompson 	    parm, &pc, sizeof(ehci_qh_t),
372402ac6454SAndrew Thompson 	    EHCI_QH_ALIGN, nqh)) {
372502ac6454SAndrew Thompson 		parm->err = USB_ERR_NOMEM;
372602ac6454SAndrew Thompson 		return;
372702ac6454SAndrew Thompson 	}
372802ac6454SAndrew Thompson 	if (parm->buf) {
372902ac6454SAndrew Thompson 		for (n = 0; n != nqh; n++) {
373002ac6454SAndrew Thompson 			ehci_qh_t *qh;
373102ac6454SAndrew Thompson 
3732a593f6b8SAndrew Thompson 			usbd_get_page(pc + n, 0, &page_info);
373302ac6454SAndrew Thompson 
373402ac6454SAndrew Thompson 			qh = page_info.buffer;
373502ac6454SAndrew Thompson 
373602ac6454SAndrew Thompson 			/* init QH */
3737e55e1ebcSAndrew Thompson 			qh->qh_self = htohc32(sc, page_info.physaddr | EHCI_LINK_QH);
373802ac6454SAndrew Thompson 			qh->obj_next = last_obj;
373902ac6454SAndrew Thompson 			qh->page_cache = pc + n;
374002ac6454SAndrew Thompson 
374102ac6454SAndrew Thompson 			last_obj = qh;
374202ac6454SAndrew Thompson 
3743a593f6b8SAndrew Thompson 			usb_pc_cpu_flush(pc + n);
374402ac6454SAndrew Thompson 		}
374502ac6454SAndrew Thompson 	}
374602ac6454SAndrew Thompson 	xfer->qh_start[xfer->flags_int.curr_dma_set] = last_obj;
374702ac6454SAndrew Thompson 
374802ac6454SAndrew Thompson 	if (!xfer->flags_int.curr_dma_set) {
374902ac6454SAndrew Thompson 		xfer->flags_int.curr_dma_set = 1;
375002ac6454SAndrew Thompson 		goto alloc_dma_set;
375102ac6454SAndrew Thompson 	}
375202ac6454SAndrew Thompson }
375302ac6454SAndrew Thompson 
375402ac6454SAndrew Thompson static void
3755760bc48eSAndrew Thompson ehci_xfer_unsetup(struct usb_xfer *xfer)
375602ac6454SAndrew Thompson {
375702ac6454SAndrew Thompson 	return;
375802ac6454SAndrew Thompson }
375902ac6454SAndrew Thompson 
376002ac6454SAndrew Thompson static void
3761ae60fdfbSAndrew Thompson ehci_ep_init(struct usb_device *udev, struct usb_endpoint_descriptor *edesc,
3762ae60fdfbSAndrew Thompson     struct usb_endpoint *ep)
376302ac6454SAndrew Thompson {
376402ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(udev->bus);
376502ac6454SAndrew Thompson 
3766ae60fdfbSAndrew Thompson 	DPRINTFN(2, "endpoint=%p, addr=%d, endpt=%d, mode=%d (%d)\n",
3767ae60fdfbSAndrew Thompson 	    ep, udev->address,
3768f29a0724SAndrew Thompson 	    edesc->bEndpointAddress, udev->flags.usb_mode,
376902ac6454SAndrew Thompson 	    sc->sc_addr);
377002ac6454SAndrew Thompson 
3771f29a0724SAndrew Thompson 	if (udev->flags.usb_mode != USB_MODE_HOST) {
377202ac6454SAndrew Thompson 		/* not supported */
377302ac6454SAndrew Thompson 		return;
377402ac6454SAndrew Thompson 	}
377539307315SAndrew Thompson 	if (udev->device_index != sc->sc_addr) {
377639307315SAndrew Thompson 
377702ac6454SAndrew Thompson 		if ((udev->speed != USB_SPEED_HIGH) &&
377802ac6454SAndrew Thompson 		    ((udev->hs_hub_addr == 0) ||
377902ac6454SAndrew Thompson 		    (udev->hs_port_no == 0) ||
3780495f25ceSAndrew Thompson 		    (udev->parent_hs_hub == NULL) ||
3781495f25ceSAndrew Thompson 		    (udev->parent_hs_hub->hub == NULL))) {
378202ac6454SAndrew Thompson 			/* We need a transaction translator */
378302ac6454SAndrew Thompson 			goto done;
378402ac6454SAndrew Thompson 		}
378502ac6454SAndrew Thompson 		switch (edesc->bmAttributes & UE_XFERTYPE) {
378602ac6454SAndrew Thompson 		case UE_CONTROL:
3787ae60fdfbSAndrew Thompson 			ep->methods = &ehci_device_ctrl_methods;
378802ac6454SAndrew Thompson 			break;
378902ac6454SAndrew Thompson 		case UE_INTERRUPT:
3790ae60fdfbSAndrew Thompson 			ep->methods = &ehci_device_intr_methods;
379102ac6454SAndrew Thompson 			break;
379202ac6454SAndrew Thompson 		case UE_ISOCHRONOUS:
379302ac6454SAndrew Thompson 			if (udev->speed == USB_SPEED_HIGH) {
3794ae60fdfbSAndrew Thompson 				ep->methods = &ehci_device_isoc_hs_methods;
379502ac6454SAndrew Thompson 			} else if (udev->speed == USB_SPEED_FULL) {
3796ae60fdfbSAndrew Thompson 				ep->methods = &ehci_device_isoc_fs_methods;
379702ac6454SAndrew Thompson 			}
379802ac6454SAndrew Thompson 			break;
379902ac6454SAndrew Thompson 		case UE_BULK:
380002ac6454SAndrew Thompson 			if (udev->speed != USB_SPEED_LOW) {
3801ae60fdfbSAndrew Thompson 				ep->methods = &ehci_device_bulk_methods;
380202ac6454SAndrew Thompson 			}
380302ac6454SAndrew Thompson 			break;
380402ac6454SAndrew Thompson 		default:
380502ac6454SAndrew Thompson 			/* do nothing */
380602ac6454SAndrew Thompson 			break;
380702ac6454SAndrew Thompson 		}
380802ac6454SAndrew Thompson 	}
380902ac6454SAndrew Thompson done:
381002ac6454SAndrew Thompson 	return;
381102ac6454SAndrew Thompson }
381202ac6454SAndrew Thompson 
381302ac6454SAndrew Thompson static void
3814760bc48eSAndrew Thompson ehci_get_dma_delay(struct usb_bus *bus, uint32_t *pus)
381502ac6454SAndrew Thompson {
381602ac6454SAndrew Thompson 	/*
381702ac6454SAndrew Thompson 	 * Wait until the hardware has finished any possible use of
381802ac6454SAndrew Thompson 	 * the transfer descriptor(s) and QH
381902ac6454SAndrew Thompson 	 */
382002ac6454SAndrew Thompson 	*pus = (188);			/* microseconds */
382102ac6454SAndrew Thompson }
382202ac6454SAndrew Thompson 
382302ac6454SAndrew Thompson static void
3824760bc48eSAndrew Thompson ehci_device_resume(struct usb_device *udev)
382502ac6454SAndrew Thompson {
382602ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(udev->bus);
3827760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
3828760bc48eSAndrew Thompson 	struct usb_pipe_methods *methods;
382902ac6454SAndrew Thompson 
383002ac6454SAndrew Thompson 	DPRINTF("\n");
383102ac6454SAndrew Thompson 
383202ac6454SAndrew Thompson 	USB_BUS_LOCK(udev->bus);
383302ac6454SAndrew Thompson 
383402ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
383502ac6454SAndrew Thompson 
383602ac6454SAndrew Thompson 		if (xfer->xroot->udev == udev) {
383702ac6454SAndrew Thompson 
3838ae60fdfbSAndrew Thompson 			methods = xfer->endpoint->methods;
383902ac6454SAndrew Thompson 
384002ac6454SAndrew Thompson 			if ((methods == &ehci_device_bulk_methods) ||
384102ac6454SAndrew Thompson 			    (methods == &ehci_device_ctrl_methods)) {
384202ac6454SAndrew Thompson 				EHCI_APPEND_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
384302ac6454SAndrew Thompson 				    sc->sc_async_p_last);
384402ac6454SAndrew Thompson 			}
384502ac6454SAndrew Thompson 			if (methods == &ehci_device_intr_methods) {
384602ac6454SAndrew Thompson 				EHCI_APPEND_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
384702ac6454SAndrew Thompson 				    sc->sc_intr_p_last[xfer->qh_pos]);
384802ac6454SAndrew Thompson 			}
384902ac6454SAndrew Thompson 		}
385002ac6454SAndrew Thompson 	}
385102ac6454SAndrew Thompson 
385202ac6454SAndrew Thompson 	USB_BUS_UNLOCK(udev->bus);
385302ac6454SAndrew Thompson 
385402ac6454SAndrew Thompson 	return;
385502ac6454SAndrew Thompson }
385602ac6454SAndrew Thompson 
385702ac6454SAndrew Thompson static void
3858760bc48eSAndrew Thompson ehci_device_suspend(struct usb_device *udev)
385902ac6454SAndrew Thompson {
386002ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(udev->bus);
3861760bc48eSAndrew Thompson 	struct usb_xfer *xfer;
3862760bc48eSAndrew Thompson 	struct usb_pipe_methods *methods;
386302ac6454SAndrew Thompson 
386402ac6454SAndrew Thompson 	DPRINTF("\n");
386502ac6454SAndrew Thompson 
386602ac6454SAndrew Thompson 	USB_BUS_LOCK(udev->bus);
386702ac6454SAndrew Thompson 
386802ac6454SAndrew Thompson 	TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) {
386902ac6454SAndrew Thompson 
387002ac6454SAndrew Thompson 		if (xfer->xroot->udev == udev) {
387102ac6454SAndrew Thompson 
3872ae60fdfbSAndrew Thompson 			methods = xfer->endpoint->methods;
387302ac6454SAndrew Thompson 
387402ac6454SAndrew Thompson 			if ((methods == &ehci_device_bulk_methods) ||
387502ac6454SAndrew Thompson 			    (methods == &ehci_device_ctrl_methods)) {
387602ac6454SAndrew Thompson 				EHCI_REMOVE_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
387702ac6454SAndrew Thompson 				    sc->sc_async_p_last);
387802ac6454SAndrew Thompson 			}
387902ac6454SAndrew Thompson 			if (methods == &ehci_device_intr_methods) {
388002ac6454SAndrew Thompson 				EHCI_REMOVE_QH(xfer->qh_start[xfer->flags_int.curr_dma_set],
388102ac6454SAndrew Thompson 				    sc->sc_intr_p_last[xfer->qh_pos]);
388202ac6454SAndrew Thompson 			}
388302ac6454SAndrew Thompson 		}
388402ac6454SAndrew Thompson 	}
388502ac6454SAndrew Thompson 
388602ac6454SAndrew Thompson 	USB_BUS_UNLOCK(udev->bus);
388702ac6454SAndrew Thompson 
388802ac6454SAndrew Thompson 	return;
388902ac6454SAndrew Thompson }
389002ac6454SAndrew Thompson 
389102ac6454SAndrew Thompson static void
3892760bc48eSAndrew Thompson ehci_set_hw_power(struct usb_bus *bus)
389302ac6454SAndrew Thompson {
389402ac6454SAndrew Thompson 	ehci_softc_t *sc = EHCI_BUS2SC(bus);
389502ac6454SAndrew Thompson 	uint32_t temp;
389602ac6454SAndrew Thompson 	uint32_t flags;
389702ac6454SAndrew Thompson 
389802ac6454SAndrew Thompson 	DPRINTF("\n");
389902ac6454SAndrew Thompson 
390002ac6454SAndrew Thompson 	USB_BUS_LOCK(bus);
390102ac6454SAndrew Thompson 
390202ac6454SAndrew Thompson 	flags = bus->hw_power_state;
390302ac6454SAndrew Thompson 
390402ac6454SAndrew Thompson 	temp = EOREAD4(sc, EHCI_USBCMD);
390502ac6454SAndrew Thompson 
390602ac6454SAndrew Thompson 	temp &= ~(EHCI_CMD_ASE | EHCI_CMD_PSE);
390702ac6454SAndrew Thompson 
390802ac6454SAndrew Thompson 	if (flags & (USB_HW_POWER_CONTROL |
390902ac6454SAndrew Thompson 	    USB_HW_POWER_BULK)) {
391002ac6454SAndrew Thompson 		DPRINTF("Async is active\n");
391102ac6454SAndrew Thompson 		temp |= EHCI_CMD_ASE;
391202ac6454SAndrew Thompson 	}
391302ac6454SAndrew Thompson 	if (flags & (USB_HW_POWER_INTERRUPT |
391402ac6454SAndrew Thompson 	    USB_HW_POWER_ISOC)) {
391502ac6454SAndrew Thompson 		DPRINTF("Periodic is active\n");
391602ac6454SAndrew Thompson 		temp |= EHCI_CMD_PSE;
391702ac6454SAndrew Thompson 	}
391802ac6454SAndrew Thompson 	EOWRITE4(sc, EHCI_USBCMD, temp);
391902ac6454SAndrew Thompson 
392002ac6454SAndrew Thompson 	USB_BUS_UNLOCK(bus);
392102ac6454SAndrew Thompson 
392202ac6454SAndrew Thompson 	return;
392302ac6454SAndrew Thompson }
392402ac6454SAndrew Thompson 
3925760bc48eSAndrew Thompson struct usb_bus_methods ehci_bus_methods =
392602ac6454SAndrew Thompson {
3927ae60fdfbSAndrew Thompson 	.endpoint_init = ehci_ep_init,
392802ac6454SAndrew Thompson 	.xfer_setup = ehci_xfer_setup,
392902ac6454SAndrew Thompson 	.xfer_unsetup = ehci_xfer_unsetup,
393002ac6454SAndrew Thompson 	.get_dma_delay = ehci_get_dma_delay,
393102ac6454SAndrew Thompson 	.device_resume = ehci_device_resume,
393202ac6454SAndrew Thompson 	.device_suspend = ehci_device_suspend,
393302ac6454SAndrew Thompson 	.set_hw_power = ehci_set_hw_power,
393439307315SAndrew Thompson 	.roothub_exec = ehci_roothub_exec,
3935dddb25f9SAlfred Perlstein 	.xfer_poll = ehci_do_poll,
393602ac6454SAndrew Thompson };
3937