Home | History | Annotate | Line # | Download | only in imx
imxusb.c revision 1.15.10.1
      1  1.15.10.1  thorpej /*	$NetBSD: imxusb.c,v 1.15.10.1 2021/01/03 16:34:52 thorpej Exp $	*/
      2        1.1      bsh /*
      3        1.1      bsh  * Copyright (c) 2009, 2010  Genetec Corporation.  All rights reserved.
      4        1.1      bsh  * Written by Hashimoto Kenichi and Hiroyuki Bessho for Genetec Corporation.
      5        1.1      bsh  *
      6        1.1      bsh  * Redistribution and use in source and binary forms, with or without
      7        1.1      bsh  * modification, are permitted provided that the following conditions
      8        1.1      bsh  * are met:
      9        1.1      bsh  * 1. Redistributions of source code must retain the above copyright
     10        1.1      bsh  *    notice, this list of conditions and the following disclaimer.
     11        1.1      bsh  * 2. Redistributions in binary form must reproduce the above copyright
     12        1.1      bsh  *    notice, this list of conditions and the following disclaimer in the
     13        1.1      bsh  *    documentation and/or other materials provided with the distribution.
     14        1.1      bsh  *
     15        1.1      bsh  * THIS SOFTWARE IS PROVIDED BY GENETEC CORPORATION ``AS IS'' AND
     16        1.1      bsh  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     17        1.1      bsh  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     18        1.1      bsh  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL GENETEC CORPORATION
     19        1.1      bsh  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     20        1.1      bsh  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     21        1.1      bsh  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     22        1.1      bsh  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     23        1.1      bsh  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     24        1.1      bsh  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25        1.1      bsh  * POSSIBILITY OF SUCH DAMAGE.
     26        1.1      bsh  */
     27        1.1      bsh #include <sys/cdefs.h>
     28  1.15.10.1  thorpej __KERNEL_RCSID(0, "$NetBSD: imxusb.c,v 1.15.10.1 2021/01/03 16:34:52 thorpej Exp $");
     29        1.6  hkenken 
     30       1.14  hkenken #include "locators.h"
     31  1.15.10.1  thorpej #include "opt_imx.h"
     32        1.1      bsh 
     33        1.1      bsh #include <sys/param.h>
     34        1.1      bsh #include <sys/systm.h>
     35        1.1      bsh #include <sys/conf.h>
     36        1.1      bsh #include <sys/kernel.h>
     37        1.1      bsh #include <sys/device.h>
     38        1.1      bsh #include <sys/intr.h>
     39        1.1      bsh #include <sys/bus.h>
     40        1.1      bsh 
     41        1.1      bsh #include <dev/usb/usb.h>
     42        1.1      bsh #include <dev/usb/usbdi.h>
     43        1.1      bsh #include <dev/usb/usbdivar.h>
     44        1.1      bsh #include <dev/usb/usb_mem.h>
     45        1.1      bsh 
     46        1.1      bsh #include <dev/usb/ehcireg.h>
     47        1.1      bsh #include <dev/usb/ehcivar.h>
     48        1.1      bsh 
     49        1.5     matt #include <arm/pic/picvar.h>	/* XXX: for intr_establish! */
     50        1.5     matt 
     51        1.1      bsh #include <arm/imx/imxusbreg.h>
     52        1.1      bsh #include <arm/imx/imxusbvar.h>
     53        1.1      bsh 
     54        1.1      bsh #include <dev/usb/ulpireg.h>	/* for test */
     55        1.1      bsh 
     56        1.1      bsh static int	imxehci_match(device_t, cfdata_t, void *);
     57        1.1      bsh static void	imxehci_attach(device_t, device_t, void *);
     58       1.10    skrll 
     59        1.1      bsh uint8_t imxusb_ulpi_read(struct imxehci_softc *sc, int addr);
     60        1.1      bsh void imxusb_ulpi_write(struct imxehci_softc *sc, int addr, uint8_t data);
     61        1.1      bsh static void ulpi_reset(struct imxehci_softc *sc);
     62        1.1      bsh 
     63        1.9  hkenken static void imxehci_select_interface(struct imxehci_softc *, enum imx_usb_if);
     64        1.9  hkenken static void imxehci_init(struct ehci_softc *);
     65        1.1      bsh 
     66        1.1      bsh /* attach structures */
     67        1.1      bsh CFATTACH_DECL_NEW(imxehci, sizeof(struct imxehci_softc),
     68        1.1      bsh     imxehci_match, imxehci_attach, NULL, NULL);
     69        1.1      bsh 
     70        1.1      bsh static int
     71        1.1      bsh imxehci_match(device_t parent, cfdata_t cf, void *aux)
     72        1.1      bsh {
     73        1.1      bsh 	struct imxusbc_attach_args *aa = aux;
     74       1.10    skrll 
     75       1.14  hkenken 	if (aa->aa_unit < 0 || 3 < aa->aa_unit)
     76        1.1      bsh 		return 0;
     77       1.10    skrll 
     78        1.1      bsh 	return 1;
     79        1.1      bsh }
     80        1.1      bsh 
     81        1.1      bsh static void
     82        1.1      bsh imxehci_attach(device_t parent, device_t self, void *aux)
     83        1.1      bsh {
     84        1.1      bsh 	struct imxusbc_attach_args *aa = aux;
     85        1.1      bsh 	struct imxusbc_softc *usbc = device_private(parent);
     86        1.1      bsh 	struct imxehci_softc *sc = device_private(self);
     87        1.1      bsh 	ehci_softc_t *hsc = &sc->sc_hsc;
     88        1.1      bsh 	bus_space_tag_t iot;
     89        1.1      bsh 	uint16_t hcirev;
     90        1.1      bsh 	uint32_t id, hwhost, hwdevice;
     91        1.1      bsh 	const char *comma;
     92        1.7      ryo 
     93       1.14  hkenken 	iot = aa->aa_iot;
     94       1.14  hkenken 
     95       1.14  hkenken 	sc->sc_dev = self;
     96        1.1      bsh 	sc->sc_unit = aa->aa_unit;
     97        1.1      bsh 	sc->sc_usbc = usbc;
     98       1.14  hkenken 	sc->sc_iot = iot;
     99       1.14  hkenken 
    100       1.14  hkenken 	hsc->sc_dev = self;
    101       1.14  hkenken 	hsc->iot = iot;
    102       1.11    skrll 	hsc->sc_bus.ub_hcpriv = sc;
    103       1.14  hkenken 	hsc->sc_bus.ub_dmatag = aa->aa_dmat;
    104        1.4     matt 	hsc->sc_flags |= EHCIF_ETTF;
    105        1.9  hkenken 	hsc->sc_vendor_init = imxehci_init;
    106        1.1      bsh 
    107        1.7      ryo 	aprint_naive("\n");
    108        1.7      ryo 	aprint_normal(": i.MX USB Controller\n");
    109        1.1      bsh 
    110       1.12      ryo 	if (usbc->sc_ehci_size == 0)
    111       1.12      ryo 		usbc->sc_ehci_size = IMXUSB_EHCI_SIZE;	/* use default */
    112       1.12      ryo 
    113        1.1      bsh 	/* per unit registers */
    114       1.10    skrll 	if (bus_space_subregion(iot, aa->aa_ioh,
    115       1.14  hkenken 		sc->sc_unit * usbc->sc_ehci_offset, usbc->sc_ehci_size,
    116        1.1      bsh 		&sc->sc_ioh) ||
    117        1.1      bsh 	    bus_space_subregion(iot, aa->aa_ioh,
    118       1.14  hkenken 		sc->sc_unit * usbc->sc_ehci_offset + IMXUSB_EHCIREGS,
    119       1.12      ryo 		usbc->sc_ehci_size - IMXUSB_EHCIREGS,
    120       1.14  hkenken 		&hsc->ioh)) {
    121        1.1      bsh 
    122        1.1      bsh 		aprint_error_dev(self, "can't subregion\n");
    123        1.1      bsh 		return;
    124        1.1      bsh 	}
    125        1.1      bsh 
    126        1.1      bsh 	id = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_ID);
    127       1.14  hkenken 	hcirev = bus_space_read_2(iot, hsc->ioh, EHCI_HCIVERSION);
    128        1.1      bsh 
    129        1.1      bsh 	aprint_normal_dev(self,
    130       1.10    skrll 	    "id=%d revision=%d HCI revision=0x%x\n",
    131        1.6  hkenken 	    (int)__SHIFTOUT(id, IMXUSB_ID_ID),
    132        1.6  hkenken 	    (int)__SHIFTOUT(id, IMXUSB_ID_REVISION),
    133        1.1      bsh 	    hcirev);
    134       1.10    skrll 
    135        1.1      bsh 	hwhost = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_HWHOST);
    136        1.1      bsh 	hwdevice = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_HWDEVICE);
    137        1.1      bsh 
    138        1.1      bsh 	aprint_normal_dev(self, "");
    139        1.1      bsh 
    140        1.1      bsh 	comma = "";
    141        1.1      bsh 	if (hwhost & HWHOST_HC) {
    142        1.6  hkenken 		int n_ports = 1 + __SHIFTOUT(hwhost, HWHOST_NPORT);
    143        1.1      bsh 		aprint_normal("%d host port%s",
    144        1.1      bsh 		    n_ports, n_ports > 1 ? "s" : "");
    145        1.1      bsh 		comma = ", ";
    146        1.1      bsh 	}
    147        1.1      bsh 
    148        1.1      bsh 	if (hwdevice & HWDEVICE_DC) {
    149        1.6  hkenken 		int n_endpoints = __SHIFTOUT(hwdevice, HWDEVICE_DEVEP);
    150        1.1      bsh 		aprint_normal("%sdevice capable, %d endpoint%s",
    151        1.1      bsh 		    comma,
    152        1.1      bsh 		    n_endpoints, n_endpoints > 1 ? "s" : "");
    153        1.1      bsh 	}
    154        1.1      bsh 	aprint_normal("\n");
    155        1.1      bsh 
    156       1.14  hkenken 	hsc->sc_offs = bus_space_read_1(iot, hsc->ioh,
    157        1.1      bsh 	    EHCI_CAPLENGTH);
    158        1.1      bsh 
    159        1.1      bsh 	/* Platform dependent setup */
    160        1.1      bsh 	if (usbc->sc_init_md_hook)
    161        1.1      bsh 		usbc->sc_init_md_hook(sc);
    162       1.11    skrll 
    163        1.1      bsh 	imxehci_reset(sc);
    164        1.1      bsh 	imxehci_select_interface(sc, sc->sc_iftype);
    165        1.1      bsh 
    166        1.1      bsh 	if (sc->sc_iftype == IMXUSBC_IF_ULPI) {
    167        1.1      bsh 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, 0);
    168        1.1      bsh 
    169        1.1      bsh 		aprint_normal_dev(hsc->sc_dev,
    170        1.1      bsh 		    "ULPI phy VID 0x%04x PID 0x%04x\n",
    171        1.1      bsh 		    (imxusb_ulpi_read(sc, ULPI_VENDOR_ID_LOW) |
    172        1.1      bsh 			imxusb_ulpi_read(sc, ULPI_VENDOR_ID_HIGH) << 8),
    173        1.1      bsh 		    (imxusb_ulpi_read(sc, ULPI_PRODUCT_ID_LOW) |
    174        1.1      bsh 			imxusb_ulpi_read(sc, ULPI_PRODUCT_ID_HIGH) << 8));
    175        1.1      bsh 
    176        1.1      bsh 		ulpi_reset(sc);
    177        1.1      bsh 
    178        1.1      bsh 	}
    179        1.1      bsh 
    180        1.1      bsh 	if (usbc->sc_setup_md_hook)
    181        1.1      bsh 		usbc->sc_setup_md_hook(sc, IMXUSB_HOST);
    182        1.6  hkenken 
    183        1.6  hkenken 	if (sc->sc_iftype == IMXUSBC_IF_ULPI) {
    184        1.6  hkenken #if 0
    185       1.11    skrll 		if(hsc->sc_bus.ub_revision == USBREV_2_0)
    186        1.6  hkenken 			ulpi_write(hsc, ULPI_FUNCTION_CONTROL + ULPI_REG_CLEAR, (1 << 0));
    187        1.6  hkenken 		else
    188        1.6  hkenken 			ulpi_write(hsc, ULPI_FUNCTION_CONTROL + ULPI_REG_SET, (1 << 2));
    189        1.6  hkenken #endif
    190        1.6  hkenken 
    191        1.1      bsh 		imxusb_ulpi_write(sc, ULPI_FUNCTION_CONTROL + ULPI_REG_CLEAR,
    192        1.1      bsh 		    OTG_CONTROL_IDPULLUP);
    193        1.1      bsh 
    194        1.1      bsh 		imxusb_ulpi_write(sc, ULPI_OTG_CONTROL + ULPI_REG_SET,
    195        1.1      bsh 		    OTG_CONTROL_USEEXTVBUSIND |
    196        1.1      bsh 		    OTG_CONTROL_DRVVBUSEXT |
    197        1.1      bsh 		    OTG_CONTROL_DRVVBUS |
    198       1.14  hkenken 		    OTG_CONTROL_CHRGVBUS);
    199        1.1      bsh 	}
    200        1.1      bsh 
    201        1.1      bsh 	/* Disable interrupts, so we don't get any spurious ones. */
    202        1.2     matt 	EOWRITE4(hsc, EHCI_USBINTR, 0);
    203        1.1      bsh 
    204       1.14  hkenken 	if (usbc->sc_intr_establish_md_hook)
    205       1.14  hkenken 		sc->sc_ih = usbc->sc_intr_establish_md_hook(sc);
    206       1.14  hkenken 	else if (aa->aa_irq > 0)
    207       1.14  hkenken 		sc->sc_ih = intr_establish(aa->aa_irq, IPL_USB, IST_LEVEL, ehci_intr, hsc);
    208       1.14  hkenken 	KASSERT(sc->sc_ih != NULL);
    209        1.1      bsh 
    210       1.11    skrll 	int err = ehci_init(hsc);
    211       1.11    skrll 	if (err) {
    212       1.11    skrll 		aprint_error_dev(self, "init failed, error=%d\n", err);
    213        1.1      bsh 		return;
    214        1.1      bsh 	}
    215        1.1      bsh 
    216        1.1      bsh 	/* Attach usb device. */
    217        1.1      bsh 	hsc->sc_child = config_found(self, &hsc->sc_bus, usbctlprint);
    218        1.1      bsh }
    219        1.1      bsh 
    220        1.9  hkenken static void
    221        1.1      bsh imxehci_select_interface(struct imxehci_softc *sc, enum imx_usb_if interface)
    222        1.1      bsh {
    223        1.1      bsh 	uint32_t reg;
    224        1.1      bsh 	struct ehci_softc *hsc = &sc->sc_hsc;
    225        1.1      bsh 
    226        1.1      bsh 	reg = EOREAD4(hsc, EHCI_PORTSC(1));
    227       1.12      ryo 	reg &= ~(PORTSC_PTS | PORTSC_PTW | PORTSC_PTS2);
    228        1.6  hkenken 	switch (interface) {
    229        1.6  hkenken 	case IMXUSBC_IF_UTMI_WIDE:
    230        1.6  hkenken 		reg |= PORTSC_PTW_16;
    231        1.6  hkenken 	case IMXUSBC_IF_UTMI:
    232        1.6  hkenken 		reg |= PORTSC_PTS_UTMI;
    233        1.6  hkenken 		break;
    234        1.6  hkenken 	case IMXUSBC_IF_PHILIPS:
    235        1.6  hkenken 		reg |= PORTSC_PTS_PHILIPS;
    236        1.6  hkenken 		break;
    237        1.6  hkenken 	case IMXUSBC_IF_ULPI:
    238        1.6  hkenken 		reg |= PORTSC_PTS_ULPI;
    239        1.6  hkenken 		break;
    240        1.6  hkenken 	case IMXUSBC_IF_SERIAL:
    241        1.6  hkenken 		reg |= PORTSC_PTS_SERIAL;
    242        1.6  hkenken 		break;
    243       1.12      ryo 	case IMXUSBC_IF_HSIC:
    244       1.12      ryo 		reg |= PORTSC_PTS2;
    245       1.12      ryo 		break;
    246        1.6  hkenken 	}
    247        1.1      bsh 	EOWRITE4(hsc, EHCI_PORTSC(1), reg);
    248        1.1      bsh }
    249        1.1      bsh 
    250        1.1      bsh static uint32_t
    251        1.1      bsh ulpi_wakeup(struct imxehci_softc *sc, int tout)
    252        1.1      bsh {
    253       1.14  hkenken 	struct ehci_softc *hsc = &sc->sc_hsc;
    254        1.1      bsh 	uint32_t ulpi_view;
    255       1.14  hkenken 
    256        1.1      bsh 	ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW);
    257        1.1      bsh 
    258       1.14  hkenken 	if (!(ulpi_view & ULPI_SS)) {
    259        1.1      bsh 		bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    260        1.1      bsh 		    IMXUSB_ULPIVIEW, ULPI_WU);
    261       1.14  hkenken 		while (tout-- > 0) {
    262        1.1      bsh 			ulpi_view = bus_space_read_4(sc->sc_iot,
    263        1.1      bsh 			    sc->sc_ioh, IMXUSB_ULPIVIEW);
    264       1.14  hkenken 			if (!(ulpi_view & ULPI_WU))
    265        1.1      bsh 				break;
    266        1.1      bsh 			delay(1);
    267        1.1      bsh 		};
    268        1.1      bsh 	}
    269        1.1      bsh 
    270       1.14  hkenken 	if (tout == 0)
    271       1.14  hkenken 		aprint_error_dev(hsc->sc_dev, "%s: timeout\n", __func__);
    272        1.1      bsh 
    273        1.1      bsh 	return ulpi_view;
    274        1.1      bsh }
    275        1.1      bsh 
    276        1.1      bsh static uint32_t
    277        1.1      bsh ulpi_wait(struct imxehci_softc *sc, int tout)
    278        1.1      bsh {
    279       1.14  hkenken 	struct ehci_softc *hsc = &sc->sc_hsc;
    280        1.1      bsh 	uint32_t ulpi_view;
    281       1.14  hkenken 
    282        1.1      bsh 	ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW);
    283        1.1      bsh 
    284       1.14  hkenken 	while (tout-- > 0) {
    285        1.1      bsh 		ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
    286        1.1      bsh 		    IMXUSB_ULPIVIEW);
    287        1.1      bsh 		if (!(ulpi_view & ULPI_RUN))
    288        1.1      bsh 			break;
    289        1.1      bsh 		delay(1);
    290        1.1      bsh 	}
    291        1.1      bsh 
    292       1.14  hkenken 	if (tout == 0)
    293       1.14  hkenken 		aprint_error_dev(hsc->sc_dev, "%s: timeout\n", __func__);
    294        1.1      bsh 
    295        1.1      bsh 	return ulpi_view;
    296        1.1      bsh }
    297        1.1      bsh 
    298        1.1      bsh #define	TIMEOUT	100000
    299       1.10    skrll 
    300        1.1      bsh uint8_t
    301        1.1      bsh imxusb_ulpi_read(struct imxehci_softc *sc, int addr)
    302        1.1      bsh {
    303       1.14  hkenken 	uint32_t reg;
    304        1.1      bsh 
    305        1.1      bsh 	ulpi_wakeup(sc, TIMEOUT);
    306        1.1      bsh 
    307       1.14  hkenken 	reg = ULPI_RUN | __SHIFTIN(addr, ULPI_ADDR);
    308       1.14  hkenken 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, reg);
    309        1.1      bsh 
    310       1.14  hkenken 	reg = ulpi_wait(sc, TIMEOUT);
    311        1.1      bsh 
    312       1.14  hkenken 	return __SHIFTOUT(reg, ULPI_DATRD);
    313        1.1      bsh }
    314        1.1      bsh 
    315        1.1      bsh void
    316        1.1      bsh imxusb_ulpi_write(struct imxehci_softc *sc, int addr, uint8_t data)
    317        1.1      bsh {
    318        1.1      bsh 	uint32_t reg;
    319        1.1      bsh 
    320        1.1      bsh 	ulpi_wakeup(sc, TIMEOUT);
    321        1.1      bsh 
    322        1.6  hkenken 	reg = ULPI_RUN | ULPI_RW | __SHIFTIN(addr, ULPI_ADDR) | __SHIFTIN(data, ULPI_DATWR);
    323        1.1      bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, reg);
    324        1.1      bsh 
    325        1.1      bsh 	ulpi_wait(sc, TIMEOUT);
    326        1.1      bsh 
    327        1.1      bsh 	return;
    328        1.1      bsh }
    329        1.1      bsh 
    330        1.1      bsh static void
    331        1.1      bsh ulpi_reset(struct imxehci_softc *sc)
    332        1.1      bsh {
    333       1.14  hkenken 	struct ehci_softc *hsc = &sc->sc_hsc;
    334        1.1      bsh 	uint8_t data;
    335        1.1      bsh 	int timo = 1000 * 1000;	/* XXXX: 1sec */
    336        1.1      bsh 
    337        1.1      bsh 	imxusb_ulpi_write(sc, ULPI_FUNCTION_CONTROL + ULPI_REG_SET,
    338        1.1      bsh 	    FUNCTION_CONTROL_RESET /*0x20*/);
    339        1.1      bsh 	do {
    340        1.1      bsh 		data = imxusb_ulpi_read(sc, ULPI_FUNCTION_CONTROL);
    341        1.1      bsh 		if (!(data & FUNCTION_CONTROL_RESET))
    342        1.1      bsh 			break;
    343        1.1      bsh 		delay(100);
    344        1.1      bsh 		timo -= 100;
    345        1.1      bsh 	} while (timo > 0);
    346       1.14  hkenken 
    347        1.1      bsh 	if (timo <= 0) {
    348       1.14  hkenken 		aprint_error_dev(hsc->sc_dev, "%s: reset failed!!\n",
    349        1.1      bsh 		    __func__);
    350        1.1      bsh 		return;
    351        1.1      bsh 	}
    352        1.1      bsh 
    353        1.1      bsh 	return;
    354        1.1      bsh }
    355        1.1      bsh 
    356        1.1      bsh void
    357        1.1      bsh imxehci_reset(struct imxehci_softc *sc)
    358        1.1      bsh {
    359        1.3    skrll 	uint32_t reg;
    360        1.1      bsh 	struct ehci_softc *hsc = &sc->sc_hsc;
    361       1.14  hkenken 	int tout;
    362        1.1      bsh #define	RESET_TIMEOUT 100
    363        1.1      bsh 
    364        1.1      bsh 	reg = EOREAD4(hsc, EHCI_USBCMD);
    365        1.1      bsh 	reg &= ~EHCI_CMD_RS;
    366        1.1      bsh 	EOWRITE4(hsc, EHCI_USBCMD, reg);
    367        1.1      bsh 
    368       1.14  hkenken 	for (tout = RESET_TIMEOUT; tout > 0; tout--) {
    369        1.1      bsh 		reg = EOREAD4(hsc, EHCI_USBCMD);
    370        1.1      bsh 		if ((reg & EHCI_CMD_RS) == 0)
    371        1.1      bsh 			break;
    372        1.1      bsh 		usb_delay_ms(&hsc->sc_bus, 1);
    373        1.1      bsh 	}
    374        1.1      bsh 
    375        1.1      bsh 	EOWRITE4(hsc, EHCI_USBCMD, reg | EHCI_CMD_HCRESET);
    376       1.14  hkenken 
    377       1.14  hkenken 	for (tout = RESET_TIMEOUT; tout > 0; tout--) {
    378        1.1      bsh 		reg = EOREAD4(hsc, EHCI_USBCMD);
    379        1.1      bsh 		if ((reg &  EHCI_CMD_HCRESET) == 0)
    380        1.1      bsh 			break;
    381        1.1      bsh 		usb_delay_ms(&hsc->sc_bus, 1);
    382        1.1      bsh 	}
    383       1.14  hkenken 
    384       1.14  hkenken 	if (tout == 0)
    385        1.1      bsh 		aprint_error_dev(hsc->sc_dev, "reset timeout (%x)\n", reg);
    386        1.1      bsh 
    387        1.1      bsh 	usb_delay_ms(&hsc->sc_bus, 100);
    388        1.1      bsh }
    389        1.1      bsh 
    390        1.9  hkenken static void
    391        1.9  hkenken imxehci_init(struct ehci_softc *hsc)
    392        1.1      bsh {
    393        1.9  hkenken 	struct imxehci_softc *sc = device_private(hsc->sc_dev);
    394        1.1      bsh 	uint32_t reg;
    395        1.1      bsh 
    396        1.1      bsh 	reg = EOREAD4(hsc, EHCI_PORTSC(1));
    397        1.1      bsh 	reg &= ~(EHCI_PS_CSC | EHCI_PS_PEC | EHCI_PS_OCC);
    398        1.1      bsh 	reg |= EHCI_PS_PP | EHCI_PS_PE;
    399        1.1      bsh 	EOWRITE4(hsc, EHCI_PORTSC(1), reg);
    400        1.1      bsh 
    401        1.1      bsh 	reg = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_OTGSC);
    402        1.1      bsh 	reg |= OTGSC_IDPU;
    403        1.5     matt 	/* disable IDIE not to conflict with SSP1_DETECT. */
    404        1.5     matt 	//reg |= OTGSC_DPIE | OTGSC_IDIE;
    405        1.5     matt 	reg |= OTGSC_DPIE;
    406        1.1      bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_OTGSC, reg);
    407        1.1      bsh 
    408        1.8    skrll 	reg = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_USBMODE);
    409        1.9  hkenken 	reg &= ~USBMODE_CM;
    410        1.6  hkenken 	reg |= USBMODE_CM_HOST;
    411        1.8    skrll 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_USBMODE, reg);
    412        1.1      bsh }
    413