Home | History | Annotate | Line # | Download | only in imx
imxusb.c revision 1.2.2.4
      1  1.2.2.3       tls /*	$NetBSD: imxusb.c,v 1.2.2.4 2017/12/03 11:35:53 jdolecek 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.2.2.3       tls __KERNEL_RCSID(0, "$NetBSD: imxusb.c,v 1.2.2.4 2017/12/03 11:35:53 jdolecek Exp $");
     29  1.2.2.3       tls 
     30  1.2.2.3       tls #include "opt_imx.h"
     31      1.1       bsh 
     32      1.1       bsh #include <sys/param.h>
     33      1.1       bsh #include <sys/systm.h>
     34      1.1       bsh #include <sys/conf.h>
     35      1.1       bsh #include <sys/kernel.h>
     36      1.1       bsh #include <sys/device.h>
     37      1.1       bsh #include <sys/intr.h>
     38      1.1       bsh #include <sys/bus.h>
     39      1.1       bsh 
     40      1.1       bsh #include <dev/usb/usb.h>
     41      1.1       bsh #include <dev/usb/usbdi.h>
     42      1.1       bsh #include <dev/usb/usbdivar.h>
     43      1.1       bsh #include <dev/usb/usb_mem.h>
     44      1.1       bsh 
     45      1.1       bsh #include <dev/usb/ehcireg.h>
     46      1.1       bsh #include <dev/usb/ehcivar.h>
     47      1.1       bsh 
     48  1.2.2.3       tls #include <arm/pic/picvar.h>	/* XXX: for intr_establish! */
     49  1.2.2.3       tls 
     50      1.1       bsh #include <arm/imx/imxusbreg.h>
     51      1.1       bsh #include <arm/imx/imxusbvar.h>
     52      1.1       bsh #include <arm/imx/imxgpiovar.h>
     53      1.1       bsh #include "locators.h"
     54      1.1       bsh 
     55      1.1       bsh #include <dev/usb/ulpireg.h>	/* for test */
     56      1.1       bsh 
     57      1.1       bsh static int	imxehci_match(device_t, cfdata_t, void *);
     58      1.1       bsh static void	imxehci_attach(device_t, device_t, void *);
     59  1.2.2.4  jdolecek 
     60      1.1       bsh uint8_t imxusb_ulpi_read(struct imxehci_softc *sc, int addr);
     61      1.1       bsh void imxusb_ulpi_write(struct imxehci_softc *sc, int addr, uint8_t data);
     62      1.1       bsh static void ulpi_reset(struct imxehci_softc *sc);
     63      1.1       bsh 
     64  1.2.2.4  jdolecek static void imxehci_select_interface(struct imxehci_softc *, enum imx_usb_if);
     65  1.2.2.4  jdolecek static void imxehci_init(struct ehci_softc *);
     66      1.1       bsh 
     67      1.1       bsh /* attach structures */
     68      1.1       bsh CFATTACH_DECL_NEW(imxehci, sizeof(struct imxehci_softc),
     69      1.1       bsh     imxehci_match, imxehci_attach, NULL, NULL);
     70      1.1       bsh 
     71      1.1       bsh static int
     72      1.1       bsh imxehci_match(device_t parent, cfdata_t cf, void *aux)
     73      1.1       bsh {
     74      1.1       bsh 	struct imxusbc_attach_args *aa = aux;
     75  1.2.2.4  jdolecek 
     76      1.1       bsh 	if (aa->aa_unit < 0 || 3 < aa->aa_unit) {
     77      1.1       bsh 		return 0;
     78      1.1       bsh 	}
     79  1.2.2.4  jdolecek 
     80      1.1       bsh 	return 1;
     81      1.1       bsh }
     82      1.1       bsh 
     83      1.1       bsh static void
     84      1.1       bsh imxehci_attach(device_t parent, device_t self, void *aux)
     85      1.1       bsh {
     86      1.1       bsh 	struct imxusbc_attach_args *aa = aux;
     87      1.1       bsh 	struct imxusbc_softc *usbc = device_private(parent);
     88      1.1       bsh 	struct imxehci_softc *sc = device_private(self);
     89      1.1       bsh 	ehci_softc_t *hsc = &sc->sc_hsc;
     90      1.1       bsh 	bus_space_tag_t iot;
     91      1.1       bsh 	uint16_t hcirev;
     92      1.1       bsh 	uint32_t id, hwhost, hwdevice;
     93      1.1       bsh 	const char *comma;
     94  1.2.2.4  jdolecek 
     95      1.1       bsh 	sc->sc_hsc.sc_dev = self;
     96      1.1       bsh 	iot = sc->sc_iot = sc->sc_hsc.iot = aa->aa_iot;
     97      1.1       bsh 	sc->sc_unit = aa->aa_unit;
     98      1.1       bsh 	sc->sc_usbc = usbc;
     99  1.2.2.4  jdolecek 	hsc->sc_bus.ub_hcpriv = sc;
    100  1.2.2.2       tls 	hsc->sc_flags |= EHCIF_ETTF;
    101  1.2.2.4  jdolecek 	hsc->sc_vendor_init = imxehci_init;
    102      1.1       bsh 
    103  1.2.2.4  jdolecek 	aprint_naive("\n");
    104  1.2.2.4  jdolecek 	aprint_normal(": i.MX USB Controller\n");
    105  1.2.2.4  jdolecek 
    106  1.2.2.4  jdolecek 	if (usbc->sc_ehci_size == 0)
    107  1.2.2.4  jdolecek 		usbc->sc_ehci_size = IMXUSB_EHCI_SIZE;	/* use default */
    108      1.1       bsh 
    109      1.1       bsh 	/* per unit registers */
    110  1.2.2.4  jdolecek 	if (bus_space_subregion(iot, aa->aa_ioh,
    111  1.2.2.4  jdolecek 		aa->aa_unit * usbc->sc_ehci_size, usbc->sc_ehci_size,
    112      1.1       bsh 		&sc->sc_ioh) ||
    113      1.1       bsh 	    bus_space_subregion(iot, aa->aa_ioh,
    114  1.2.2.4  jdolecek 		aa->aa_unit * usbc->sc_ehci_size + IMXUSB_EHCIREGS,
    115  1.2.2.4  jdolecek 		usbc->sc_ehci_size - IMXUSB_EHCIREGS,
    116      1.1       bsh 		&sc->sc_hsc.ioh)) {
    117      1.1       bsh 
    118      1.1       bsh 		aprint_error_dev(self, "can't subregion\n");
    119      1.1       bsh 		return;
    120      1.1       bsh 	}
    121      1.1       bsh 
    122      1.1       bsh 	id = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_ID);
    123      1.1       bsh 	hcirev = bus_space_read_2(iot, sc->sc_hsc.ioh, EHCI_HCIVERSION);
    124      1.1       bsh 
    125      1.1       bsh 	aprint_normal_dev(self,
    126  1.2.2.4  jdolecek 	    "id=%d revision=%d HCI revision=0x%x\n",
    127  1.2.2.3       tls 	    (int)__SHIFTOUT(id, IMXUSB_ID_ID),
    128  1.2.2.3       tls 	    (int)__SHIFTOUT(id, IMXUSB_ID_REVISION),
    129      1.1       bsh 	    hcirev);
    130  1.2.2.4  jdolecek 
    131      1.1       bsh 	hwhost = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_HWHOST);
    132      1.1       bsh 	hwdevice = bus_space_read_4(iot, sc->sc_ioh, IMXUSB_HWDEVICE);
    133      1.1       bsh 
    134      1.1       bsh 	aprint_normal_dev(self, "");
    135      1.1       bsh 
    136      1.1       bsh 	comma = "";
    137      1.1       bsh 	if (hwhost & HWHOST_HC) {
    138  1.2.2.3       tls 		int n_ports = 1 + __SHIFTOUT(hwhost, HWHOST_NPORT);
    139      1.1       bsh 		aprint_normal("%d host port%s",
    140      1.1       bsh 		    n_ports, n_ports > 1 ? "s" : "");
    141      1.1       bsh 		comma = ", ";
    142      1.1       bsh 	}
    143      1.1       bsh 
    144      1.1       bsh 	if (hwdevice & HWDEVICE_DC) {
    145  1.2.2.3       tls 		int n_endpoints = __SHIFTOUT(hwdevice, HWDEVICE_DEVEP);
    146      1.1       bsh 		aprint_normal("%sdevice capable, %d endpoint%s",
    147      1.1       bsh 		    comma,
    148      1.1       bsh 		    n_endpoints, n_endpoints > 1 ? "s" : "");
    149      1.1       bsh 	}
    150      1.1       bsh 	aprint_normal("\n");
    151      1.1       bsh 
    152  1.2.2.4  jdolecek 	sc->sc_hsc.sc_bus.ub_dmatag = aa->aa_dmat;
    153      1.1       bsh 
    154  1.2.2.4  jdolecek 	sc->sc_hsc.sc_offs = bus_space_read_1(iot, sc->sc_hsc.ioh,
    155      1.1       bsh 	    EHCI_CAPLENGTH);
    156      1.1       bsh 
    157      1.1       bsh 	/* Platform dependent setup */
    158      1.1       bsh 	if (usbc->sc_init_md_hook)
    159      1.1       bsh 		usbc->sc_init_md_hook(sc);
    160      1.1       bsh 
    161      1.1       bsh 	imxehci_reset(sc);
    162      1.1       bsh 	imxehci_select_interface(sc, sc->sc_iftype);
    163      1.1       bsh 
    164      1.1       bsh 	if (sc->sc_iftype == IMXUSBC_IF_ULPI) {
    165      1.1       bsh 		bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, 0);
    166      1.1       bsh 
    167      1.1       bsh 		aprint_normal_dev(hsc->sc_dev,
    168      1.1       bsh 		    "ULPI phy VID 0x%04x PID 0x%04x\n",
    169      1.1       bsh 		    (imxusb_ulpi_read(sc, ULPI_VENDOR_ID_LOW) |
    170      1.1       bsh 			imxusb_ulpi_read(sc, ULPI_VENDOR_ID_HIGH) << 8),
    171      1.1       bsh 		    (imxusb_ulpi_read(sc, ULPI_PRODUCT_ID_LOW) |
    172      1.1       bsh 			imxusb_ulpi_read(sc, ULPI_PRODUCT_ID_HIGH) << 8));
    173      1.1       bsh 
    174      1.1       bsh 		ulpi_reset(sc);
    175      1.1       bsh 
    176      1.1       bsh 	}
    177      1.1       bsh 
    178      1.1       bsh 	if (usbc->sc_setup_md_hook)
    179      1.1       bsh 		usbc->sc_setup_md_hook(sc, IMXUSB_HOST);
    180  1.2.2.3       tls 
    181  1.2.2.3       tls 	if (sc->sc_iftype == IMXUSBC_IF_ULPI) {
    182  1.2.2.3       tls #if 0
    183  1.2.2.4  jdolecek 		if(hsc->sc_bus.ub_revision == USBREV_2_0)
    184  1.2.2.3       tls 			ulpi_write(hsc, ULPI_FUNCTION_CONTROL + ULPI_REG_CLEAR, (1 << 0));
    185  1.2.2.3       tls 		else
    186  1.2.2.3       tls 			ulpi_write(hsc, ULPI_FUNCTION_CONTROL + ULPI_REG_SET, (1 << 2));
    187  1.2.2.3       tls #endif
    188  1.2.2.3       tls 
    189      1.1       bsh 		imxusb_ulpi_write(sc, ULPI_FUNCTION_CONTROL + ULPI_REG_CLEAR,
    190      1.1       bsh 		    OTG_CONTROL_IDPULLUP);
    191      1.1       bsh 
    192      1.1       bsh 		imxusb_ulpi_write(sc, ULPI_OTG_CONTROL + ULPI_REG_SET,
    193      1.1       bsh 		    OTG_CONTROL_USEEXTVBUSIND |
    194      1.1       bsh 		    OTG_CONTROL_DRVVBUSEXT |
    195      1.1       bsh 		    OTG_CONTROL_DRVVBUS |
    196      1.1       bsh 		    OTG_CONTROL_CHRGVBUS
    197      1.1       bsh 		    );
    198      1.1       bsh 	}
    199      1.1       bsh 
    200      1.1       bsh 	/* Disable interrupts, so we don't get any spurious ones. */
    201      1.2      matt 	EOWRITE4(hsc, EHCI_USBINTR, 0);
    202      1.1       bsh 
    203      1.1       bsh 	intr_establish(aa->aa_irq, IPL_USB, IST_LEVEL, ehci_intr, hsc);
    204      1.1       bsh 
    205      1.1       bsh 	/* Figure out vendor for root hub descriptor. */
    206      1.1       bsh 	strlcpy(hsc->sc_vendor, "i.MX", sizeof(hsc->sc_vendor));
    207      1.1       bsh 
    208  1.2.2.4  jdolecek 	int err = ehci_init(hsc);
    209  1.2.2.4  jdolecek 	if (err) {
    210  1.2.2.4  jdolecek 		aprint_error_dev(self, "init failed, error=%d\n", err);
    211      1.1       bsh 		return;
    212      1.1       bsh 	}
    213      1.1       bsh 
    214      1.1       bsh 	/* Attach usb device. */
    215      1.1       bsh 	hsc->sc_child = config_found(self, &hsc->sc_bus, usbctlprint);
    216      1.1       bsh }
    217      1.1       bsh 
    218  1.2.2.4  jdolecek static void
    219      1.1       bsh imxehci_select_interface(struct imxehci_softc *sc, enum imx_usb_if interface)
    220      1.1       bsh {
    221      1.1       bsh 	uint32_t reg;
    222      1.1       bsh 	struct ehci_softc *hsc = &sc->sc_hsc;
    223      1.1       bsh 
    224      1.1       bsh 	reg = EOREAD4(hsc, EHCI_PORTSC(1));
    225  1.2.2.4  jdolecek 	reg &= ~(PORTSC_PTS | PORTSC_PTW | PORTSC_PTS2);
    226  1.2.2.3       tls 	switch (interface) {
    227  1.2.2.3       tls 	case IMXUSBC_IF_UTMI_WIDE:
    228  1.2.2.3       tls 		reg |= PORTSC_PTW_16;
    229  1.2.2.3       tls 	case IMXUSBC_IF_UTMI:
    230  1.2.2.3       tls 		reg |= PORTSC_PTS_UTMI;
    231  1.2.2.3       tls 		break;
    232  1.2.2.3       tls 	case IMXUSBC_IF_PHILIPS:
    233  1.2.2.3       tls 		reg |= PORTSC_PTS_PHILIPS;
    234  1.2.2.3       tls 		break;
    235  1.2.2.3       tls 	case IMXUSBC_IF_ULPI:
    236  1.2.2.3       tls 		reg |= PORTSC_PTS_ULPI;
    237  1.2.2.3       tls 		break;
    238  1.2.2.3       tls 	case IMXUSBC_IF_SERIAL:
    239  1.2.2.3       tls 		reg |= PORTSC_PTS_SERIAL;
    240  1.2.2.3       tls 		break;
    241  1.2.2.4  jdolecek 	case IMXUSBC_IF_HSIC:
    242  1.2.2.4  jdolecek 		reg |= PORTSC_PTS2;
    243  1.2.2.4  jdolecek 		break;
    244  1.2.2.3       tls 	}
    245      1.1       bsh 	EOWRITE4(hsc, EHCI_PORTSC(1), reg);
    246      1.1       bsh }
    247      1.1       bsh 
    248      1.1       bsh static uint32_t
    249      1.1       bsh ulpi_wakeup(struct imxehci_softc *sc, int tout)
    250      1.1       bsh {
    251      1.1       bsh 	uint32_t ulpi_view;
    252      1.1       bsh 	int i = 0;
    253      1.1       bsh 	ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW);
    254      1.1       bsh 
    255      1.1       bsh 	if ( !(ulpi_view & ULPI_SS) ) {
    256      1.1       bsh 		bus_space_write_4(sc->sc_iot, sc->sc_ioh,
    257      1.1       bsh 		    IMXUSB_ULPIVIEW, ULPI_WU);
    258      1.1       bsh 		for (i = 0; (tout < 0) || (i < tout); i++) {
    259      1.1       bsh 			ulpi_view = bus_space_read_4(sc->sc_iot,
    260      1.1       bsh 			    sc->sc_ioh, IMXUSB_ULPIVIEW);
    261      1.1       bsh 			if ( !(ulpi_view & ULPI_WU) )
    262      1.1       bsh 				break;
    263      1.1       bsh 			delay(1);
    264      1.1       bsh 		};
    265      1.1       bsh 	}
    266      1.1       bsh 
    267      1.1       bsh 	if ((tout > 0) && (i >= tout)) {
    268      1.1       bsh 		aprint_error_dev(sc->sc_hsc.sc_dev, "%s: timeout\n", __func__);
    269      1.1       bsh 	}
    270      1.1       bsh 
    271      1.1       bsh 	return ulpi_view;
    272      1.1       bsh }
    273      1.1       bsh 
    274      1.1       bsh static uint32_t
    275      1.1       bsh ulpi_wait(struct imxehci_softc *sc, int tout)
    276      1.1       bsh {
    277      1.1       bsh 	uint32_t ulpi_view;
    278      1.1       bsh 	int i;
    279      1.1       bsh 	ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW);
    280      1.1       bsh 
    281      1.1       bsh 	for (i = 0; (tout < 0) | (i < tout); i++) {
    282      1.1       bsh 		ulpi_view = bus_space_read_4(sc->sc_iot, sc->sc_ioh,
    283      1.1       bsh 		    IMXUSB_ULPIVIEW);
    284      1.1       bsh 		if (!(ulpi_view & ULPI_RUN))
    285      1.1       bsh 			break;
    286      1.1       bsh 		delay(1);
    287      1.1       bsh 	}
    288      1.1       bsh 
    289      1.1       bsh 	if ((tout > 0) && (i >= tout)) {
    290      1.1       bsh 		aprint_error_dev(sc->sc_hsc.sc_dev, "%s: timeout\n", __func__);
    291      1.1       bsh 	}
    292      1.1       bsh 
    293      1.1       bsh 	return ulpi_view;
    294      1.1       bsh }
    295      1.1       bsh 
    296      1.1       bsh #define	TIMEOUT	100000
    297  1.2.2.4  jdolecek 
    298      1.1       bsh uint8_t
    299      1.1       bsh imxusb_ulpi_read(struct imxehci_softc *sc, int addr)
    300      1.1       bsh {
    301      1.1       bsh 	uint32_t data;
    302      1.1       bsh 
    303      1.1       bsh 	ulpi_wakeup(sc, TIMEOUT);
    304      1.1       bsh 
    305  1.2.2.3       tls 	data = ULPI_RUN | __SHIFTIN(addr, ULPI_ADDR);
    306      1.1       bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, data);
    307      1.1       bsh 
    308      1.1       bsh 	data = ulpi_wait(sc, TIMEOUT);
    309      1.1       bsh 
    310  1.2.2.3       tls 	return __SHIFTOUT(data, ULPI_DATRD);
    311      1.1       bsh }
    312      1.1       bsh 
    313      1.1       bsh void
    314      1.1       bsh imxusb_ulpi_write(struct imxehci_softc *sc, int addr, uint8_t data)
    315      1.1       bsh {
    316      1.1       bsh 	uint32_t reg;
    317      1.1       bsh 
    318      1.1       bsh 	ulpi_wakeup(sc, TIMEOUT);
    319      1.1       bsh 
    320  1.2.2.3       tls 	reg = ULPI_RUN | ULPI_RW | __SHIFTIN(addr, ULPI_ADDR) | __SHIFTIN(data, ULPI_DATWR);
    321      1.1       bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW, reg);
    322      1.1       bsh 
    323      1.1       bsh 	ulpi_wait(sc, TIMEOUT);
    324      1.1       bsh 
    325      1.1       bsh 	return;
    326      1.1       bsh }
    327      1.1       bsh 
    328      1.1       bsh #if 0
    329      1.1       bsh static int
    330      1.1       bsh ulpi_scratch_test(struct imxehci_softc *sc)
    331      1.1       bsh {
    332      1.1       bsh 	uint32_t ulpi_view;
    333      1.1       bsh 
    334      1.1       bsh 	ulpi_view = ulpi_wakeup(sc, 1000);
    335      1.1       bsh 	if (ulpi_view & ULPI_WU) {
    336      1.1       bsh 		return -1;
    337      1.1       bsh 	}
    338      1.1       bsh 
    339      1.1       bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_ULPIVIEW,
    340      1.1       bsh 		(ULPI_RUN | ULPI_RW |
    341      1.1       bsh 		 (ULPI_SCRATCH << ULPI_ADDR_SHIFT) | 0xAA));
    342      1.1       bsh 
    343      1.1       bsh 	ulpi_view = ulpi_wait(sc, 1000);
    344      1.1       bsh 
    345      1.1       bsh 	if (ulpi_view & ULPI_RUN) {
    346      1.1       bsh 		return -1;
    347      1.1       bsh 	}
    348      1.1       bsh 
    349      1.1       bsh 	return 0;
    350      1.1       bsh }
    351      1.1       bsh #endif
    352      1.1       bsh 
    353      1.1       bsh static void
    354      1.1       bsh ulpi_reset(struct imxehci_softc *sc)
    355      1.1       bsh {
    356      1.1       bsh 	uint8_t data;
    357      1.1       bsh 	int timo = 1000 * 1000;	/* XXXX: 1sec */
    358      1.1       bsh 
    359      1.1       bsh 	imxusb_ulpi_write(sc, ULPI_FUNCTION_CONTROL + ULPI_REG_SET,
    360      1.1       bsh 	    FUNCTION_CONTROL_RESET /*0x20*/);
    361      1.1       bsh 	do {
    362      1.1       bsh 		data = imxusb_ulpi_read(sc, ULPI_FUNCTION_CONTROL);
    363      1.1       bsh 		if (!(data & FUNCTION_CONTROL_RESET))
    364      1.1       bsh 			break;
    365      1.1       bsh 		delay(100);
    366      1.1       bsh 		timo -= 100;
    367      1.1       bsh 	} while (timo > 0);
    368      1.1       bsh 	if (timo <= 0) {
    369      1.1       bsh 		aprint_error_dev(sc->sc_hsc.sc_dev, "%s: reset failed!!\n",
    370      1.1       bsh 		    __func__);
    371      1.1       bsh 		return;
    372      1.1       bsh 	}
    373      1.1       bsh 
    374      1.1       bsh 	return;
    375      1.1       bsh }
    376      1.1       bsh 
    377      1.1       bsh void
    378      1.1       bsh imxehci_reset(struct imxehci_softc *sc)
    379      1.1       bsh {
    380  1.2.2.1       tls 	uint32_t reg;
    381      1.1       bsh 	int i;
    382      1.1       bsh 	struct ehci_softc *hsc = &sc->sc_hsc;
    383      1.1       bsh #define	RESET_TIMEOUT 100
    384      1.1       bsh 
    385      1.1       bsh 	reg = EOREAD4(hsc, EHCI_USBCMD);
    386      1.1       bsh 	reg &= ~EHCI_CMD_RS;
    387      1.1       bsh 	EOWRITE4(hsc, EHCI_USBCMD, reg);
    388      1.1       bsh 
    389      1.1       bsh 	for (i=0; i < RESET_TIMEOUT; ++i) {
    390      1.1       bsh 		reg = EOREAD4(hsc, EHCI_USBCMD);
    391      1.1       bsh 		if ((reg & EHCI_CMD_RS) == 0)
    392      1.1       bsh 			break;
    393      1.1       bsh 		usb_delay_ms(&hsc->sc_bus, 1);
    394      1.1       bsh 	}
    395      1.1       bsh 
    396      1.1       bsh 	EOWRITE4(hsc, EHCI_USBCMD, reg | EHCI_CMD_HCRESET);
    397      1.1       bsh 	for (i = 0; i < RESET_TIMEOUT; i++) {
    398      1.1       bsh 		reg = EOREAD4(hsc, EHCI_USBCMD);
    399      1.1       bsh 		if ((reg &  EHCI_CMD_HCRESET) == 0)
    400      1.1       bsh 			break;
    401      1.1       bsh 		usb_delay_ms(&hsc->sc_bus, 1);
    402      1.1       bsh 	}
    403      1.1       bsh 	if (i >= RESET_TIMEOUT) {
    404      1.1       bsh 		aprint_error_dev(hsc->sc_dev, "reset timeout (%x)\n", reg);
    405      1.1       bsh 	}
    406      1.1       bsh 
    407      1.1       bsh 	usb_delay_ms(&hsc->sc_bus, 100);
    408      1.1       bsh }
    409      1.1       bsh 
    410  1.2.2.4  jdolecek static void
    411  1.2.2.4  jdolecek imxehci_init(struct ehci_softc *hsc)
    412      1.1       bsh {
    413  1.2.2.4  jdolecek 	struct imxehci_softc *sc = device_private(hsc->sc_dev);
    414      1.1       bsh 	uint32_t reg;
    415      1.1       bsh 
    416      1.1       bsh 	reg = EOREAD4(hsc, EHCI_PORTSC(1));
    417      1.1       bsh 	reg &= ~(EHCI_PS_CSC | EHCI_PS_PEC | EHCI_PS_OCC);
    418      1.1       bsh 	reg |= EHCI_PS_PP | EHCI_PS_PE;
    419      1.1       bsh 	EOWRITE4(hsc, EHCI_PORTSC(1), reg);
    420      1.1       bsh 
    421      1.1       bsh 	reg = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_OTGSC);
    422      1.1       bsh 	reg |= OTGSC_IDPU;
    423  1.2.2.3       tls 	/* disable IDIE not to conflict with SSP1_DETECT. */
    424  1.2.2.3       tls 	//reg |= OTGSC_DPIE | OTGSC_IDIE;
    425  1.2.2.3       tls 	reg |= OTGSC_DPIE;
    426      1.1       bsh 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_OTGSC, reg);
    427      1.1       bsh 
    428  1.2.2.4  jdolecek 	reg = bus_space_read_4(sc->sc_iot, sc->sc_ioh, IMXUSB_USBMODE);
    429  1.2.2.4  jdolecek 	reg &= ~USBMODE_CM;
    430  1.2.2.3       tls 	reg |= USBMODE_CM_HOST;
    431  1.2.2.4  jdolecek 	bus_space_write_4(sc->sc_iot, sc->sc_ioh, IMXUSB_USBMODE, reg);
    432      1.1       bsh }
    433