Home | History | Annotate | Line # | Download | only in nvidia
tegra210_xusbpad.c revision 1.8
      1 /* $NetBSD: tegra210_xusbpad.c,v 1.8 2017/09/26 16:12:45 jmcneill Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2017 Jared McNeill <jmcneill (at) invisible.ca>
      5  * All rights reserved.
      6  *
      7  * Redistribution and use in source and binary forms, with or without
      8  * modification, are permitted provided that the following conditions
      9  * are met:
     10  * 1. Redistributions of source code must retain the above copyright
     11  *    notice, this list of conditions and the following disclaimer.
     12  * 2. Redistributions in binary form must reproduce the above copyright
     13  *    notice, this list of conditions and the following disclaimer in the
     14  *    documentation and/or other materials provided with the distribution.
     15  *
     16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  * SUCH DAMAGE.
     27  */
     28 
     29 #include <sys/cdefs.h>
     30 __KERNEL_RCSID(0, "$NetBSD: tegra210_xusbpad.c,v 1.8 2017/09/26 16:12:45 jmcneill Exp $");
     31 
     32 #include <sys/param.h>
     33 #include <sys/bus.h>
     34 #include <sys/device.h>
     35 #include <sys/intr.h>
     36 #include <sys/systm.h>
     37 #include <sys/kernel.h>
     38 
     39 #include <arm/nvidia/tegra_reg.h>
     40 #include <arm/nvidia/tegra_var.h>
     41 #include <arm/nvidia/tegra_xusbpad.h>
     42 
     43 #include <dev/fdt/fdtvar.h>
     44 
     45 #define	XUSB_PADCTL_USB2_PAD_MUX_REG		0x04
     46 #define	 XUSB_PADCTL_USB2_PAD_MUX_USB2_BIAS_PAD			__BITS(19,18)
     47 #define	  XUSB_PADCTL_USB2_PAD_MUX_USB2_BIAS_PAD_XUSB		1
     48 
     49 #define	XUSB_PADCTL_VBUS_OC_MAP_REG		0x18
     50 #define	 XUSB_PADCTL_VBUS_OC_MAP_VBUS_ENABLE(n)			__BIT((n) * 5)
     51 
     52 #define	XUSB_PADCTL_OC_DET_REG			0x1c
     53 #define	 XUSB_PADCTL_OC_DET_OC_DETECTED_VBUS_PAD(n)		__BIT(12 + (n))
     54 #define	 XUSB_PADCTL_OC_DET_OC_DETECTED(n)			__BIT(8 + (n))
     55 #define	 XUSB_PADCTL_OC_DET_SET_OC_DETECTED(n)			__BIT(0 + (n))
     56 
     57 #define	XUSB_PADCTL_ELPG_PROGRAM_1_REG		0x24
     58 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_VCORE_DOWN	__BIT(31)
     59 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_CLAMP_EN_EARLY	__BIT(30)
     60 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_CLAMP_EN	__BIT(29)
     61 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_VCORE_DOWN(n)	__BIT((n) * 3 + 2)
     62 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_CLAMP_EN_EARLY(n)	__BIT((n) * 3 + 1)
     63 #define	 XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_CLAMP_EN(n)	__BIT((n) * 3 + 0)
     64 
     65 #define	XUSB_PADCTL_USB3_PAD_MUX_REG		0x28
     66 #define	 XUSB_PADCTL_USB3_PAD_MUX_FORCE_SATA_PAD_IDDQ_DISABLE		__BIT(8)
     67 #define	 XUSB_PADCTL_USB3_PAD_MUX_FORCE_PCIE_PAD_IDDQ_DISABLE(n)	__BIT(1 + (n))
     68 
     69 #define	XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_REG(n)	(0x84 + (n) * 0x40)
     70 #define	 XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_VREG_LEV	__BITS(8,7)
     71 #define	 XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_VREG_FIX18	__BIT(6)
     72 
     73 #define	XUSB_PADCTL_USB2_OTG_PADn_CTL_0_REG(n)	(0x88 + (n) * 0x40)
     74 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD_ZI			__BIT(29)
     75 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD2			__BIT(27)
     76 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD			__BIT(26)
     77 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_0_HS_CURR_LEVEL		__BITS(5,0)
     78 
     79 #define	XUSB_PADCTL_USB2_OTG_PADn_CTL_1_REG(n)	(0x8c + (n) * 0x40)
     80 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_1_RPD_CTRL		__BITS(30,26)
     81 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_1_TERM_RANGE_ADJ		__BITS(6,3)
     82 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_DR			__BIT(2)
     83 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_DISC_OVRD		__BIT(1)
     84 #define	 XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_CHRP_OVRD		__BIT(0)
     85 
     86 #define	XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_REG	0x284
     87 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_PD			__BIT(11)
     88 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_DISCON_LEVEL	__BITS(5,3)
     89 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_SQUELCH_LEVEL	__BITS(2,0)
     90 
     91 #define	XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_REG	0x288
     92 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_PD_TRK			__BIT(26)
     93 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_DONE_RESET_TIMER	__BITS(25,19)
     94 #define	 XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_START_TIMER	__BITS(18,12)
     95 
     96 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG		0x360
     97 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_PSDIV	__BITS(29,28)
     98 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_NDIV	__BITS(27,20)
     99 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_MDIV	__BITS(17,16)
    100 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_LOCKDET_STATUS	__BIT(15)
    101 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_PWR_OVRD		__BIT(4)
    102 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_ENABLE		__BIT(3)
    103 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_SLEEP		__BITS(2,1)
    104 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_1_IDDQ		__BIT(0)
    105 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG		0x364
    106 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_CTRL		__BITS(27,4)
    107 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_OVRD		__BIT(2)
    108 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_DONE		__BIT(1)
    109 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_EN		__BIT(0)
    110 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_3_REG		0x368
    111 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REG		0x36c
    112 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_4_TXCLKREF_EN	__BIT(15)
    113 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_4_TXCLKREF_SEL	__BITS(13,12)
    114 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REFCLKBUF_EN	__BIT(8)
    115 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REFCLK_SEL	__BITS(7,4)
    116 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_5_REG		0x370
    117 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_5_DCO_CTRL		__BITS(23,16)
    118 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_6_REG		0x374
    119 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_7_REG		0x378
    120 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG		0x37c
    121 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_DONE	__BIT(31)
    122 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_OVRD	__BIT(15)
    123 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_CLK_EN	__BIT(13)
    124 #define	 XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_EN		__BIT(12)
    125 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_9_REG		0x380
    126 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_10_REG		0x384
    127 #define	XUSB_PADCTL_UPHY_PLL_P0_CTL_11_REG		0x388
    128 
    129 #define	XUSB_PADCTL_UPHY_USB3_PADn_ECTL_1_REG(n)	(0xa60 + (n) * 0x40)
    130 #define	 XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_TX_TERM_CTRL		__BITS(19,18)
    131 
    132 #define	XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_REG(n)	(0xa64 + (n) * 0x40)
    133 #define	 XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_RX_CTLE		__BITS(15,0)
    134 
    135 #define	XUSB_PADCTL_UPHY_USB3_PADn_ECTL_3_REG(n)	(0xa68 + (n) * 0x40)
    136 
    137 #define	XUSB_PADCTL_UPHY_USB3_PADn_ECTL_4_REG(n)	(0xa6c + (n) * 0x40)
    138 #define	 XUSB_PADCTL_UPHY_USB3_PADn_ECTL_4_RX_CDR_CTRL		__BITS(31,16)
    139 
    140 #define	XUSB_PADCTL_UPHY_USB3_PADn_ECTL_6_REG(n)	(0xa74 + (n) * 0x40)
    141 
    142 #define	FUSE_SKUCALIB_REG				0xf0
    143 #define	 FUSE_SKUCALIB_HS_CURR_LEVEL(n)			\
    144 	 ((n) == 0 ? __BITS(6,0) : __BITS(((n) - 1) * 6 + 17, ((n) - 1) * 6 + 11))
    145 #define	 FUSE_SKUCALIB_HS_TERM_RANGE_ADJ			__BITS(10,7)
    146 
    147 #define	FUSE_USBCALIB_REG				0x250
    148 #define	 FUSE_USBCALIB_EXT_RPD_CTRL			__BITS(4,0)
    149 
    150 struct tegra210_xusbpad_softc {
    151 	device_t		sc_dev;
    152 	int			sc_phandle;
    153 	bus_space_tag_t		sc_bst;
    154 	bus_space_handle_t	sc_bsh;
    155 
    156 	struct fdtbus_reset	*sc_rst;
    157 
    158 	bool			sc_enabled;
    159 };
    160 
    161 struct tegra210_xusbpad_phy_softc {
    162 	device_t		sc_dev;
    163 	int			sc_phandle;
    164 	struct tegra210_xusbpad_softc *sc_xusbpad;
    165 };
    166 
    167 struct tegra210_xusbpad_phy_attach_args {
    168 	struct tegra210_xusbpad_softc	*paa_xusbpad;
    169 	int			paa_phandle;
    170 };
    171 
    172 #define	RD4(sc, reg)					\
    173 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    174 #define	WR4(sc, reg, val)				\
    175 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    176 #define	SETCLR4(sc, reg, set, clr)			\
    177 	tegra_reg_set_clear((sc)->sc_bst, (sc)->sc_bsh, (reg), (set), (clr))
    178 
    179 static const char * tegra210_xusbpad_usb2_func[] = { "snps", "xusb", "uart" };
    180 static const char * tegra210_xusbpad_hsic_func[] = { "snps", "xusb" };
    181 static const char * tegra210_xusbpad_pcie_func[] = { "pcie-x1", "usb3-ss", "sata", "pcie-x4" };
    182 
    183 static void
    184 tegra210_xusbpad_uphy_enable_pcie(struct tegra210_xusbpad_softc *sc)
    185 {
    186 	uint32_t val;
    187 	int retry;
    188 
    189 	/* UPHY PLLs */
    190 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG,
    191 	    __SHIFTIN(0x136, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_CTRL),
    192 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_CTRL);
    193 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_5_REG,
    194 	    __SHIFTIN(0x2a, XUSB_PADCTL_UPHY_PLL_P0_CTL_5_DCO_CTRL),
    195 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_5_DCO_CTRL);
    196 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    197 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_1_PWR_OVRD, 0);
    198 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG,
    199 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_OVRD, 0);
    200 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    201 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_OVRD, 0);
    202 
    203 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REG,
    204 	    __SHIFTIN(0, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REFCLK_SEL),
    205 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REFCLK_SEL);
    206 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REG,
    207 	    __SHIFTIN(2, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_TXCLKREF_SEL),
    208 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_4_TXCLKREF_SEL);
    209 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REG,
    210 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_4_TXCLKREF_EN, 0);
    211 
    212 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    213 	    __SHIFTIN(0, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_MDIV),
    214 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_MDIV);
    215 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    216 	    __SHIFTIN(0x19, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_NDIV),
    217 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_NDIV);
    218 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    219 	    __SHIFTIN(0, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_PSDIV),
    220 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_1_FREQ_PSDIV);
    221 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    222 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_IDDQ);
    223 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    224 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_SLEEP);
    225 
    226 	delay(20);
    227 
    228 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REG,
    229 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_4_REFCLKBUF_EN, 0);
    230 
    231 	/* Calibration */
    232 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG,
    233 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_EN, 0);
    234 	for (retry = 10000; retry > 0; retry--) {
    235 		delay(2);
    236 		val = RD4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG);
    237 		if ((val & XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_DONE) != 0)
    238 			break;
    239 	}
    240 	if (retry == 0) {
    241 		aprint_error_dev(sc->sc_dev, "timeout calibrating UPHY PLL (1)\n");
    242 		return;
    243 	}
    244 
    245 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG,
    246 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_EN);
    247 	for (retry = 10000; retry > 0; retry--) {
    248 		delay(2);
    249 		val = RD4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG);
    250 		if ((val & XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_DONE) == 0)
    251 			break;
    252 	}
    253 	if (retry == 0) {
    254 		aprint_error_dev(sc->sc_dev, "timeout calibrating UPHY PLL (2)\n");
    255 		return;
    256 	}
    257 
    258 	/* Enable the PLL */
    259 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    260 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_1_ENABLE, 0);
    261 	for (retry = 10000; retry > 0; retry--) {
    262 		delay(2);
    263 		val = RD4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG);
    264 		if ((val & XUSB_PADCTL_UPHY_PLL_P0_CTL_1_LOCKDET_STATUS) != 0)
    265 			break;
    266 	}
    267 	if (retry == 0) {
    268 		aprint_error_dev(sc->sc_dev, "timeout enabling UPHY PLL\n");
    269 		return;
    270 	}
    271 
    272 	/* RCAL */
    273 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    274 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_EN, 0);
    275 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    276 	    XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_CLK_EN, 0);
    277 	for (retry = 10000; retry > 0; retry--) {
    278 		delay(2);
    279 		val = RD4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG);
    280 		if ((val & XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_DONE) != 0)
    281 			break;
    282 	}
    283 	if (retry == 0) {
    284 		aprint_error_dev(sc->sc_dev, "timeout calibrating UPHY PLL (3)\n");
    285 		return;
    286 	}
    287 
    288 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    289 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_EN);
    290 	for (retry = 10000; retry > 0; retry--) {
    291 		delay(2);
    292 		val = RD4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG);
    293 		if ((val & XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_DONE) == 0)
    294 			break;
    295 	}
    296 	if (retry == 0) {
    297 		aprint_error_dev(sc->sc_dev, "timeout calibrating UPHY PLL (4)\n");
    298 		return;
    299 	}
    300 
    301 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    302 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_CLK_EN);
    303 
    304 	tegra210_car_xusbio_enable_hw_control();
    305 
    306 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_REG,
    307 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_1_PWR_OVRD);
    308 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_REG,
    309 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_2_CAL_OVRD);
    310 	SETCLR4(sc, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_REG,
    311 	    0, XUSB_PADCTL_UPHY_PLL_P0_CTL_8_RCAL_OVRD);
    312 
    313 	delay(1);
    314 
    315 	tegra210_car_xusbio_enable_hw_seq();
    316 }
    317 
    318 static void
    319 tegra210_xusbpad_lane_enable_pcie(struct tegra210_xusbpad_softc *sc, int index)
    320 {
    321 	tegra210_xusbpad_uphy_enable_pcie(sc);
    322 
    323 	SETCLR4(sc, XUSB_PADCTL_USB3_PAD_MUX_REG,
    324 	    XUSB_PADCTL_USB3_PAD_MUX_FORCE_PCIE_PAD_IDDQ_DISABLE(index), 0);
    325 }
    326 
    327 static void
    328 tegra210_xusbpad_lane_enable_usb2(struct tegra210_xusbpad_softc *sc, int index)
    329 {
    330 	uint32_t skucalib, usbcalib;
    331 
    332 	skucalib = tegra_fuse_read(FUSE_SKUCALIB_REG);
    333 	const u_int hs_curr_level = __SHIFTOUT(skucalib, FUSE_SKUCALIB_HS_CURR_LEVEL((u_int)index));
    334 	const u_int hs_term_range_adj = __SHIFTOUT(skucalib, FUSE_SKUCALIB_HS_TERM_RANGE_ADJ);
    335 
    336 	usbcalib = tegra_fuse_read(FUSE_USBCALIB_REG);
    337 	const u_int ext_rpd_ctrl = __SHIFTOUT(usbcalib, FUSE_USBCALIB_EXT_RPD_CTRL);
    338 
    339 	SETCLR4(sc, XUSB_PADCTL_USB2_PAD_MUX_REG,
    340 	    __SHIFTIN(XUSB_PADCTL_USB2_PAD_MUX_USB2_BIAS_PAD_XUSB,
    341 		      XUSB_PADCTL_USB2_PAD_MUX_USB2_BIAS_PAD),
    342 	    XUSB_PADCTL_USB2_PAD_MUX_USB2_BIAS_PAD);
    343 
    344 	SETCLR4(sc, XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_REG,
    345 	    __SHIFTIN(0x7, XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_DISCON_LEVEL) |
    346 	    __SHIFTIN(0x0, XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_SQUELCH_LEVEL),
    347 	    XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_DISCON_LEVEL |
    348 	    XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_HS_SQUELCH_LEVEL);
    349 	SETCLR4(sc, XUSB_PADCTL_USB2_OTG_PADn_CTL_0_REG(index),
    350 	    __SHIFTIN(hs_curr_level, XUSB_PADCTL_USB2_OTG_PADn_CTL_0_HS_CURR_LEVEL),
    351 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_0_HS_CURR_LEVEL |
    352 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD |
    353 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD2 |
    354 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_0_PD_ZI);
    355 	SETCLR4(sc, XUSB_PADCTL_USB2_OTG_PADn_CTL_1_REG(index),
    356 	    __SHIFTIN(hs_term_range_adj, XUSB_PADCTL_USB2_OTG_PADn_CTL_1_TERM_RANGE_ADJ) |
    357 	    __SHIFTIN(ext_rpd_ctrl, XUSB_PADCTL_USB2_OTG_PADn_CTL_1_RPD_CTRL),
    358 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_1_TERM_RANGE_ADJ |
    359 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_1_RPD_CTRL |
    360 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_DR |
    361 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_CHRP_OVRD |
    362 	    XUSB_PADCTL_USB2_OTG_PADn_CTL_1_PD_DISC_OVRD);
    363 	SETCLR4(sc, XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_REG(index),
    364 	    XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_VREG_FIX18,
    365 	    XUSB_PADCTL_USB2_BATTERY_CHRG_OTGPADn_CTL_1_VREG_LEV);
    366 
    367 	SETCLR4(sc, XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_REG,
    368 	    __SHIFTIN(0x1e, XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_START_TIMER) |
    369 	    __SHIFTIN(0xa, XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_DONE_RESET_TIMER),
    370 	    XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_START_TIMER |
    371 	    XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_TRK_DONE_RESET_TIMER);
    372 	SETCLR4(sc, XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_REG,
    373 	    0, XUSB_PADCTL_USB2_BIAS_PAD_CTL_0_PD);
    374 	delay(1);
    375 	SETCLR4(sc, XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_REG,
    376 	    0, XUSB_PADCTL_USB2_BIAS_PAD_CTL_1_PD_TRK);
    377 	delay(50);
    378 }
    379 
    380 #define	XUSBPAD_LANE(n, i, r, m, f, ef)		\
    381 	{					\
    382 		.name = (n),			\
    383 		.index = (i),			\
    384 		.reg = (r),			\
    385 		.mask = (m),			\
    386 		.funcs = (f),			\
    387 		.nfuncs = __arraycount(f),	\
    388 		.enable = (ef)			\
    389 	}
    390 
    391 static const struct tegra210_xusbpad_lane {
    392 	const char		*name;
    393 	int			index;
    394 	bus_size_t		reg;
    395 	uint32_t		mask;
    396 	const char		**funcs;
    397 	int			nfuncs;
    398 	void			(*enable)(struct tegra210_xusbpad_softc *, int);
    399 } tegra210_xusbpad_lanes[] = {
    400 	XUSBPAD_LANE("usb2-0", 0, 0x04, __BITS(1,0), tegra210_xusbpad_usb2_func,
    401 		     tegra210_xusbpad_lane_enable_usb2),
    402 	XUSBPAD_LANE("usb2-1", 1, 0x04, __BITS(3,2), tegra210_xusbpad_usb2_func,
    403 		     tegra210_xusbpad_lane_enable_usb2),
    404 	XUSBPAD_LANE("usb2-2", 2, 0x04, __BITS(5,4), tegra210_xusbpad_usb2_func,
    405 		     tegra210_xusbpad_lane_enable_usb2),
    406 	XUSBPAD_LANE("usb2-3", 3, 0x04, __BITS(7,6), tegra210_xusbpad_usb2_func,
    407 		     tegra210_xusbpad_lane_enable_usb2),
    408 
    409 	XUSBPAD_LANE("hsic-0", 0, 0x04, __BIT(14), tegra210_xusbpad_hsic_func,
    410 		     NULL),
    411 	XUSBPAD_LANE("hsic-1", 1, 0x04, __BIT(15), tegra210_xusbpad_hsic_func,
    412 		     NULL),
    413 
    414 	XUSBPAD_LANE("pcie-0", 0, 0x28, __BITS(13,12), tegra210_xusbpad_pcie_func,
    415 		     tegra210_xusbpad_lane_enable_pcie),
    416 	XUSBPAD_LANE("pcie-1", 1, 0x28, __BITS(15,14), tegra210_xusbpad_pcie_func,
    417 		     tegra210_xusbpad_lane_enable_pcie),
    418 	XUSBPAD_LANE("pcie-2", 2, 0x28, __BITS(17,16), tegra210_xusbpad_pcie_func,
    419 		     tegra210_xusbpad_lane_enable_pcie),
    420 	XUSBPAD_LANE("pcie-3", 3, 0x28, __BITS(19,18), tegra210_xusbpad_pcie_func,
    421 		     tegra210_xusbpad_lane_enable_pcie),
    422 	XUSBPAD_LANE("pcie-4", 4, 0x28, __BITS(21,20), tegra210_xusbpad_pcie_func,
    423 		     tegra210_xusbpad_lane_enable_pcie),
    424 	XUSBPAD_LANE("pcie-5", 5, 0x28, __BITS(23,22), tegra210_xusbpad_pcie_func,
    425 		     tegra210_xusbpad_lane_enable_pcie),
    426 	XUSBPAD_LANE("pcie-6", 6, 0x28, __BITS(25,24), tegra210_xusbpad_pcie_func,
    427 		     tegra210_xusbpad_lane_enable_pcie),
    428 
    429 	XUSBPAD_LANE("sata-0", 0, 0x28, __BITS(31,30), tegra210_xusbpad_pcie_func,
    430 		     NULL),
    431 };
    432 
    433 #define	XUSBPAD_PORT(n, i, r, m, im)		\
    434 	{					\
    435 		.name = (n),			\
    436 		.index = (i),			\
    437 		.reg = (r),			\
    438 		.mask = (m),			\
    439 		.internal_mask = (im)		\
    440 	}
    441 
    442 struct tegra210_xusbpad_port {
    443 	const char		*name;
    444 	int			index;
    445 	bus_size_t		reg;
    446 	uint32_t		mask;
    447 	uint32_t		internal_mask;
    448 };
    449 
    450 static const struct tegra210_xusbpad_port tegra210_xusbpad_usb2_ports[] = {
    451 	XUSBPAD_PORT("usb2-0", 0, 0x08, __BITS(1,0), __BIT(2)),
    452 	XUSBPAD_PORT("usb2-1", 1, 0x08, __BITS(5,4), __BIT(6)),
    453 	XUSBPAD_PORT("usb2-2", 2, 0x08, __BITS(9,8), __BIT(10)),
    454 	XUSBPAD_PORT("usb2-3", 3, 0x08, __BITS(13,12), __BIT(14)),
    455 };
    456 
    457 static const struct tegra210_xusbpad_port tegra210_xusbpad_usb3_ports[] = {
    458 	XUSBPAD_PORT("usb3-0", 0, 0x14, __BITS(3,0), __BIT(4)),
    459 	XUSBPAD_PORT("usb3-1", 1, 0x14, __BITS(8,5), __BIT(9)),
    460 	XUSBPAD_PORT("usb3-2", 2, 0x14, __BITS(13,10), __BIT(14)),
    461 	XUSBPAD_PORT("usb3-3", 3, 0x14, __BITS(18,15), __BIT(19)),
    462 };
    463 
    464 static const struct tegra210_xusbpad_port tegra210_xusbpad_hsic_ports[] = {
    465 	XUSBPAD_PORT("hsic-0", 0, 0, 0, 0),
    466 	XUSBPAD_PORT("hsic-1", 1, 0, 0, 0),
    467 };
    468 
    469 static int
    470 tegra210_xusbpad_find_func(const struct tegra210_xusbpad_lane *lane,
    471     const char *func)
    472 {
    473 	for (int n = 0; n < lane->nfuncs; n++)
    474 		if (strcmp(lane->funcs[n], func) == 0)
    475 			return n;
    476 	return -1;
    477 }
    478 
    479 static const struct tegra210_xusbpad_lane *
    480 tegra210_xusbpad_find_lane(const char *name)
    481 {
    482 	for (int n = 0; n < __arraycount(tegra210_xusbpad_lanes); n++)
    483 		if (strcmp(tegra210_xusbpad_lanes[n].name, name) == 0)
    484 			return &tegra210_xusbpad_lanes[n];
    485 	return NULL;
    486 }
    487 
    488 static void
    489 tegra210_xusbpad_configure_lane(struct tegra210_xusbpad_softc *sc,
    490     int phandle)
    491 {
    492 	const struct tegra210_xusbpad_lane *lane;
    493 	const char *name, *function;
    494 	int func;
    495 
    496 	name = fdtbus_get_string(phandle, "name");
    497 	if (name == NULL) {
    498 		aprint_error_dev(sc->sc_dev, "no 'name' property\n");
    499 		return;
    500 	}
    501 	function = fdtbus_get_string(phandle, "nvidia,function");
    502 	if (function == NULL) {
    503 		aprint_error_dev(sc->sc_dev, "no 'nvidia,function' property\n");
    504 		return;
    505 	}
    506 
    507 	lane = tegra210_xusbpad_find_lane(name);
    508 	if (lane == NULL) {
    509 		aprint_error_dev(sc->sc_dev, "unsupported lane '%s'\n", name);
    510 		return;
    511 	}
    512 	func = tegra210_xusbpad_find_func(lane, function);
    513 	if (func == -1) {
    514 		aprint_error_dev(sc->sc_dev, "unsupported function '%s'\n", function);
    515 		return;
    516 	}
    517 
    518 	aprint_normal_dev(sc->sc_dev, "lane %s: set func %s\n", name, function);
    519 	SETCLR4(sc, lane->reg, __SHIFTIN(func, lane->mask), lane->mask);
    520 
    521 	if (lane->enable)
    522 		lane->enable(sc, lane->index);
    523 }
    524 
    525 static void
    526 tegra210_xusbpad_configure_pads(struct tegra210_xusbpad_softc *sc,
    527     const char *name)
    528 {
    529 	struct fdtbus_reset *rst;
    530 	struct clk *clk;
    531 	int phandle, child;
    532 
    533 	/* Search for the pad's node */
    534 	phandle = of_find_firstchild_byname(sc->sc_phandle, "pads");
    535 	if (phandle == -1) {
    536 		aprint_error_dev(sc->sc_dev, "no 'pads' node\n");
    537 		return;
    538 	}
    539 	phandle = of_find_firstchild_byname(phandle, name);
    540 	if (phandle == -1) {
    541 		aprint_error_dev(sc->sc_dev, "no 'pads/%s' node\n", name);
    542 		return;
    543 	}
    544 
    545 	if (!fdtbus_status_okay(phandle))
    546 		return;		/* pad is disabled */
    547 
    548 	/* Enable the pad's resources */
    549 	if (of_hasprop(phandle, "clocks")) {
    550 		clk = fdtbus_clock_get_index(phandle, 0);
    551 		if (clk == NULL || clk_enable(clk) != 0) {
    552 			aprint_error_dev(sc->sc_dev, "couldn't enable %s's clock\n", name);
    553 			return;
    554 		}
    555 	}
    556 	if (of_hasprop(phandle, "resets")) {
    557 		rst = fdtbus_reset_get_index(phandle, 0);
    558 		if (rst == NULL || fdtbus_reset_deassert(rst) != 0) {
    559 			aprint_error_dev(sc->sc_dev, "couldn't de-assert %s's reset\n", name);
    560 			return;
    561 		}
    562 	}
    563 
    564 	/* Attach PHYs */
    565 	phandle = of_find_firstchild_byname(phandle, "lanes");
    566 	if (phandle == -1) {
    567 		aprint_error_dev(sc->sc_dev, "no 'pads/%s/lanes' node\n", name);
    568 		return;
    569 	}
    570 	for (child = OF_child(phandle); child; child = OF_peer(child)) {
    571 		struct tegra210_xusbpad_phy_attach_args paa = {
    572 			.paa_xusbpad = sc,
    573 			.paa_phandle = child
    574 		};
    575 		config_found(sc->sc_dev, &paa, NULL);
    576 	}
    577 }
    578 
    579 static const struct tegra210_xusbpad_port *
    580 tegra210_xusbpad_find_port(const char *name, const struct tegra210_xusbpad_port *ports,
    581     int nports)
    582 {
    583 	for (int n = 0; n < nports; n++)
    584 		if (strcmp(name, ports[n].name) == 0)
    585 			return &ports[n];
    586 	return NULL;
    587 }
    588 
    589 static const struct tegra210_xusbpad_port *
    590 tegra210_xusbpad_find_usb2_port(const char *name)
    591 {
    592 	return tegra210_xusbpad_find_port(name, tegra210_xusbpad_usb2_ports,
    593 	    __arraycount(tegra210_xusbpad_usb2_ports));
    594 }
    595 
    596 static const struct tegra210_xusbpad_port *
    597 tegra210_xusbpad_find_usb3_port(const char *name)
    598 {
    599 	return tegra210_xusbpad_find_port(name, tegra210_xusbpad_usb3_ports,
    600 	    __arraycount(tegra210_xusbpad_usb3_ports));
    601 }
    602 
    603 static const struct tegra210_xusbpad_port *
    604 tegra210_xusbpad_find_hsic_port(const char *name)
    605 {
    606 	return tegra210_xusbpad_find_port(name, tegra210_xusbpad_hsic_ports,
    607 	    __arraycount(tegra210_xusbpad_hsic_ports));
    608 }
    609 
    610 static void
    611 tegra210_xusbpad_enable_vbus(struct tegra210_xusbpad_softc *sc,
    612     const struct tegra210_xusbpad_port *port, int phandle)
    613 {
    614 	struct fdtbus_regulator *vbus_reg;
    615 
    616 	if (!of_hasprop(phandle, "vbus-supply"))
    617 		return;
    618 
    619 	vbus_reg = fdtbus_regulator_acquire(phandle, "vbus-supply");
    620 	if (vbus_reg == NULL || fdtbus_regulator_enable(vbus_reg) != 0) {
    621 		aprint_error_dev(sc->sc_dev,
    622 		    "couldn't enable vbus regulator for port %s\n",
    623 		    port->name);
    624 	}
    625 }
    626 
    627 static void
    628 tegra210_xusbpad_configure_usb2_port(struct tegra210_xusbpad_softc *sc,
    629     int phandle, const struct tegra210_xusbpad_port *port)
    630 {
    631 	u_int modeval, internal;
    632 	const char *mode;
    633 
    634 	mode = fdtbus_get_string(phandle, "mode");
    635 	if (mode == NULL) {
    636 		aprint_error_dev(sc->sc_dev, "no 'mode' property on port %s\n", port->name);
    637 		return;
    638 	}
    639 	if (strcmp(mode, "host") == 0)
    640 		modeval = 1;
    641 	else if (strcmp(mode, "device") == 0)
    642 		modeval = 2;
    643 	else if (strcmp(mode, "otg") == 0)
    644 		modeval = 3;
    645 	else {
    646 		aprint_error_dev(sc->sc_dev, "unsupported mode '%s' on port %s\n", mode, port->name);
    647 		return;
    648 	}
    649 
    650 	internal = of_hasprop(phandle, "nvidia,internal");
    651 
    652 	tegra210_xusbpad_enable_vbus(sc, port, phandle);
    653 
    654 	aprint_normal_dev(sc->sc_dev, "port %s: set mode %s, %s\n", port->name, mode,
    655 	    internal ? "internal" : "external");
    656 	SETCLR4(sc, port->reg, __SHIFTIN(internal, port->internal_mask), port->internal_mask);
    657 	SETCLR4(sc, port->reg, __SHIFTIN(modeval, port->mask), port->mask);
    658 }
    659 
    660 static void
    661 tegra210_xusbpad_configure_usb3_port(struct tegra210_xusbpad_softc *sc,
    662     int phandle, const struct tegra210_xusbpad_port *port)
    663 {
    664 	u_int companion, internal;
    665 
    666 	if (of_getprop_uint32(phandle, "nvidia,usb2-companion", &companion)) {
    667 		aprint_error_dev(sc->sc_dev, "no 'nvidia,usb2-companion' property on port %s\n", port->name);
    668 		return;
    669 	}
    670 	internal = of_hasprop(phandle, "nvidia,internal");
    671 
    672 	tegra210_xusbpad_enable_vbus(sc, port, phandle);
    673 
    674 	aprint_normal_dev(sc->sc_dev, "port %s: set companion usb2-%d, %s\n", port->name,
    675 	    companion, internal ? "internal" : "external");
    676 	SETCLR4(sc, port->reg, __SHIFTIN(internal, port->internal_mask), port->internal_mask);
    677 	SETCLR4(sc, port->reg, __SHIFTIN(companion, port->mask), port->mask);
    678 
    679 	SETCLR4(sc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_1_REG(port->index),
    680 	    __SHIFTIN(2, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_TX_TERM_CTRL),
    681 	    XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_TX_TERM_CTRL);
    682 	SETCLR4(sc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_REG(port->index),
    683 	    __SHIFTIN(0xfc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_RX_CTLE),
    684 	    XUSB_PADCTL_UPHY_USB3_PADn_ECTL_2_RX_CTLE);
    685 	WR4(sc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_3_REG(port->index), 0xc0077f1f);
    686 	SETCLR4(sc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_4_REG(port->index),
    687 	    __SHIFTIN(0x01c7, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_4_RX_CDR_CTRL),
    688 	    XUSB_PADCTL_UPHY_USB3_PADn_ECTL_4_RX_CDR_CTRL);
    689 	WR4(sc, XUSB_PADCTL_UPHY_USB3_PADn_ECTL_6_REG(port->index), 0xfcf01368);
    690 
    691 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG,
    692 	    0, XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_CLAMP_EN(port->index));
    693 	delay(200);
    694 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG,
    695 	    0, XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_CLAMP_EN_EARLY(port->index));
    696 	delay(200);
    697 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG,
    698 	    0, XUSB_PADCTL_ELPG_PROGRAM_1_SSPn_ELPG_VCORE_DOWN(port->index));
    699 
    700 	SETCLR4(sc, XUSB_PADCTL_VBUS_OC_MAP_REG,
    701 	    XUSB_PADCTL_VBUS_OC_MAP_VBUS_ENABLE(port->index), 0);
    702 }
    703 
    704 static void
    705 tegra210_xusbpad_configure_hsic_port(struct tegra210_xusbpad_softc *sc,
    706     int phandle, const struct tegra210_xusbpad_port *port)
    707 {
    708 	tegra210_xusbpad_enable_vbus(sc, port, phandle);
    709 }
    710 
    711 static void
    712 tegra210_xusbpad_configure_ports(struct tegra210_xusbpad_softc *sc)
    713 {
    714 	const struct tegra210_xusbpad_port *port;
    715 	const char *port_name;
    716 	int phandle, child;
    717 
    718 	/* Search for the ports node */
    719 	phandle = of_find_firstchild_byname(sc->sc_phandle, "ports");
    720 
    721 	/* Configure ports */
    722 	for (child = OF_child(phandle); child; child = OF_peer(child)) {
    723 		if (!fdtbus_status_okay(child))
    724 			continue;
    725 		port_name = fdtbus_get_string(child, "name");
    726 
    727 		if ((port = tegra210_xusbpad_find_usb2_port(port_name)) != NULL)
    728 			tegra210_xusbpad_configure_usb2_port(sc, child, port);
    729 		else if ((port = tegra210_xusbpad_find_usb3_port(port_name)) != NULL)
    730 			tegra210_xusbpad_configure_usb3_port(sc, child, port);
    731 		else if ((port = tegra210_xusbpad_find_hsic_port(port_name)) != NULL)
    732 			tegra210_xusbpad_configure_hsic_port(sc, child, port);
    733 		else
    734 			aprint_error_dev(sc->sc_dev, "unsupported port '%s'\n", port_name);
    735 	}
    736 }
    737 
    738 static void
    739 tegra210_xusbpad_enable(struct tegra210_xusbpad_softc *sc)
    740 {
    741 	if (sc->sc_enabled)
    742 		return;
    743 
    744 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG, 0, XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_CLAMP_EN);
    745 	delay(200);
    746 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG, 0, XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_CLAMP_EN_EARLY);
    747 	delay(200);
    748 	SETCLR4(sc, XUSB_PADCTL_ELPG_PROGRAM_1_REG, 0, XUSB_PADCTL_ELPG_PROGRAM_1_AUX_MUX_LP0_VCORE_DOWN);
    749 
    750 	sc->sc_enabled = true;
    751 }
    752 
    753 static void
    754 tegra210_xusbpad_sata_enable(device_t dev)
    755 {
    756 	struct tegra210_xusbpad_softc * const sc = device_private(dev);
    757 
    758 	tegra210_xusbpad_enable(sc);
    759 }
    760 
    761 static void
    762 tegra210_xusbpad_xhci_enable(device_t dev)
    763 {
    764 	struct tegra210_xusbpad_softc * const sc = device_private(dev);
    765 
    766 	tegra210_xusbpad_enable(sc);
    767 }
    768 
    769 static const struct tegra_xusbpad_ops tegra210_xusbpad_ops = {
    770 	.sata_enable = tegra210_xusbpad_sata_enable,
    771 	.xhci_enable = tegra210_xusbpad_xhci_enable,
    772 };
    773 
    774 static int
    775 tegra210_xusbpad_match(device_t parent, cfdata_t cf, void *aux)
    776 {
    777 	const char * const compatible[] = {
    778 		"nvidia,tegra210-xusb-padctl",
    779 		NULL
    780 	};
    781 	struct fdt_attach_args * const faa = aux;
    782 
    783 	return of_match_compatible(faa->faa_phandle, compatible);
    784 }
    785 
    786 static void
    787 tegra210_xusbpad_attach(device_t parent, device_t self, void *aux)
    788 {
    789 	struct tegra210_xusbpad_softc * const sc = device_private(self);
    790 	struct fdt_attach_args * const faa = aux;
    791 	bus_addr_t addr;
    792 	bus_size_t size;
    793 	int error;
    794 
    795 	if (fdtbus_get_reg(faa->faa_phandle, 0, &addr, &size) != 0) {
    796 		aprint_error(": couldn't get registers\n");
    797 		return;
    798 	}
    799 	sc->sc_rst = fdtbus_reset_get(faa->faa_phandle, "padctl");
    800 	if (sc->sc_rst == NULL) {
    801 		aprint_error(": couldn't get reset padctl\n");
    802 		return;
    803 	}
    804 
    805 	sc->sc_dev = self;
    806 	sc->sc_phandle = faa->faa_phandle;
    807 	sc->sc_bst = faa->faa_bst;
    808 	error = bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh);
    809 	if (error) {
    810 		aprint_error(": couldn't map %#llx: %d", (uint64_t)addr, error);
    811 		return;
    812 	}
    813 
    814 	aprint_naive("\n");
    815 	aprint_normal(": XUSB PADCTL\n");
    816 
    817 	fdtbus_reset_deassert(sc->sc_rst);
    818 
    819 	tegra_xusbpad_register(self, &tegra210_xusbpad_ops);
    820 
    821 	tegra210_xusbpad_configure_pads(sc, "usb2");
    822 	tegra210_xusbpad_configure_pads(sc, "hsic");
    823 	tegra210_xusbpad_configure_pads(sc, "pcie");
    824 	tegra210_xusbpad_configure_pads(sc, "sata");
    825 
    826 	tegra210_xusbpad_configure_ports(sc);
    827 }
    828 
    829 static void *
    830 tegra210_xusbpad_phy_acquire(device_t dev, const void *data, size_t len)
    831 {
    832 	struct tegra210_xusbpad_phy_softc * const sc = device_private(dev);
    833 
    834 	if (len != 0)
    835 		return NULL;
    836 
    837 	return sc;
    838 }
    839 
    840 static void
    841 tegra210_xusbpad_phy_release(device_t dev, void *priv)
    842 {
    843 };
    844 
    845 static int
    846 tegra210_xusbpad_phy_enable(device_t dev, void *priv, bool enable)
    847 {
    848 	struct tegra210_xusbpad_phy_softc * const sc = device_private(dev);
    849 
    850 	if (enable == false)
    851 		return ENXIO;	/* not implemented */
    852 
    853 	tegra210_xusbpad_configure_lane(sc->sc_xusbpad, sc->sc_phandle);
    854 
    855 	return 0;
    856 }
    857 
    858 static const struct fdtbus_phy_controller_func tegra210_xusbpad_phy_funcs = {
    859 	.acquire = tegra210_xusbpad_phy_acquire,
    860 	.release = tegra210_xusbpad_phy_release,
    861 	.enable = tegra210_xusbpad_phy_enable,
    862 };
    863 
    864 CFATTACH_DECL_NEW(tegra210_xusbpad, sizeof(struct tegra210_xusbpad_softc),
    865 	tegra210_xusbpad_match, tegra210_xusbpad_attach, NULL, NULL);
    866 
    867 static int
    868 tegra210_xusbpad_phy_match(device_t parent, cfdata_t cf, void *aux)
    869 {
    870 	struct tegra210_xusbpad_phy_attach_args * const paa = aux;
    871 
    872 	if (!fdtbus_status_okay(paa->paa_phandle))
    873 		return 0;
    874 
    875 	return 1;
    876 }
    877 
    878 static void
    879 tegra210_xusbpad_phy_attach(device_t parent, device_t self, void *aux)
    880 {
    881 	struct tegra210_xusbpad_phy_softc * const sc = device_private(self);
    882 	struct tegra210_xusbpad_phy_attach_args * const paa = aux;
    883 
    884 	sc->sc_dev = self;
    885 	sc->sc_phandle = paa->paa_phandle;
    886 	sc->sc_xusbpad = paa->paa_xusbpad;
    887 
    888 	aprint_naive("\n");
    889 	aprint_normal(": %s\n", fdtbus_get_string(sc->sc_phandle, "name"));
    890 
    891 	fdtbus_register_phy_controller(self, sc->sc_phandle, &tegra210_xusbpad_phy_funcs);
    892 }
    893 
    894 CFATTACH_DECL_NEW(tegra210xphy, sizeof(struct tegra210_xusbpad_phy_softc),
    895 	tegra210_xusbpad_phy_match, tegra210_xusbpad_phy_attach, NULL, NULL);
    896