Home | History | Annotate | Line # | Download | only in rockchip
rk3399_pcie.c revision 1.6.2.2
      1  1.6.2.2    martin /* $NetBSD: rk3399_pcie.c,v 1.6.2.2 2019/12/09 16:01:12 martin Exp $ */
      2      1.1  jakllsch /*
      3      1.1  jakllsch  * Copyright (c) 2018 Mark Kettenis <kettenis (at) openbsd.org>
      4      1.1  jakllsch  *
      5      1.1  jakllsch  * Permission to use, copy, modify, and distribute this software for any
      6      1.1  jakllsch  * purpose with or without fee is hereby granted, provided that the above
      7      1.1  jakllsch  * copyright notice and this permission notice appear in all copies.
      8      1.1  jakllsch  *
      9      1.1  jakllsch  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     10      1.1  jakllsch  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     11      1.1  jakllsch  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     12      1.1  jakllsch  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     13      1.1  jakllsch  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     14      1.1  jakllsch  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     15      1.1  jakllsch  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     16      1.1  jakllsch  */
     17      1.1  jakllsch 
     18      1.1  jakllsch #include <sys/cdefs.h>
     19      1.1  jakllsch 
     20  1.6.2.2    martin __KERNEL_RCSID(1, "$NetBSD: rk3399_pcie.c,v 1.6.2.2 2019/12/09 16:01:12 martin Exp $");
     21      1.1  jakllsch 
     22      1.1  jakllsch #include <sys/param.h>
     23      1.1  jakllsch #include <sys/systm.h>
     24      1.1  jakllsch #include <sys/bitops.h>
     25      1.1  jakllsch #include <sys/device.h>
     26      1.1  jakllsch #include <sys/extent.h>
     27      1.1  jakllsch #include <sys/kmem.h>
     28      1.1  jakllsch 
     29      1.1  jakllsch #include <machine/intr.h>
     30      1.1  jakllsch #include <sys/bus.h>
     31      1.1  jakllsch #include <dev/fdt/fdtvar.h>
     32      1.1  jakllsch #include <dev/fdt/syscon.h>
     33      1.1  jakllsch #include <arm/cpufunc.h>
     34      1.1  jakllsch 
     35      1.1  jakllsch #include <dev/pci/pcidevs.h>
     36      1.1  jakllsch #include <dev/pci/pcireg.h>
     37      1.1  jakllsch #include <dev/pci/pcivar.h>
     38      1.1  jakllsch #include <dev/pci/pciconf.h>
     39      1.1  jakllsch 
     40      1.1  jakllsch #include <arm/fdt/pcihost_fdtvar.h>
     41      1.1  jakllsch #include <sys/gpio.h>
     42      1.1  jakllsch 
     43      1.1  jakllsch #define SETREG(m, v)			((m)<<16|__SHIFTIN((v), (m)))
     44      1.1  jakllsch #define GETREG(m, v)			(__SHIFTOUT((v), (m)))
     45      1.1  jakllsch 
     46      1.1  jakllsch /* APB region */
     47      1.1  jakllsch #define PCIE_CLIENT_BASE		0x000000
     48      1.1  jakllsch #define PCIE_CLIENT_BASIC_STRAP_CONF	0x0000
     49      1.1  jakllsch #define  PCBSC_PCIE_GEN_SEL		__BIT(7)
     50      1.1  jakllsch #define   PCBSC_PGS_GEN1		SETREG(PCBSC_PCIE_GEN_SEL, 0)
     51      1.1  jakllsch #define   PCBSC_PGS_GEN2		SETREG(PCBSC_PCIE_GEN_SEL, 1)
     52      1.1  jakllsch #define  PCBSC_MODE_SELECT		__BIT(6)
     53      1.1  jakllsch #define   PCBSC_MS_ENDPOINT		SETREG(PCBSC_MODE_SELECT, 0)
     54      1.1  jakllsch #define   PCBSC_MS_ROOTPORT		SETREG(PCBSC_MODE_SELECT, 1)
     55      1.1  jakllsch #define  PCBSC_LANE_COUNT		__BITS(5,4)
     56      1.1  jakllsch #define   PCBSC_LC(x)			SETREG(PCBSC_LANE_COUNT, ilog2(x)) /* valid for x1,2,4 */
     57      1.1  jakllsch #define  PCBSC_ARI_EN			SETREG(__BIT(3), 1) /* Alternate Routing ID Enable */
     58      1.1  jakllsch #define  PCBSC_SR_IOV_EN		SETREG(__BIT(2), 1)
     59      1.1  jakllsch #define  PCBSC_LINK_TRAIN_EN		SETREG(__BIT(1), 1)
     60      1.1  jakllsch #define  PCBSC_CONF_EN			SETREG(__BIT(0), 1) /* Config enable */
     61      1.1  jakllsch #define PCIE_CLIENT_DEBUG_OUT_0		0x003c
     62      1.1  jakllsch #define PCIE_CLIENT_DEBUG_OUT_1		0x0040
     63      1.1  jakllsch #define PCIE_CLIENT_BASIC_STATUS0	0x0044
     64      1.1  jakllsch #define PCIE_CLIENT_BASIC_STATUS1	0x0048
     65      1.1  jakllsch #define  PCBS1_LINK_ST(x)		(u_int)__SHIFTOUT((x), __BITS(21,20))
     66      1.1  jakllsch #define   PCBS1_LS_NO_RECV		0	/* no receivers */
     67      1.1  jakllsch #define   PCBS1_LS_TRAINING		1	/* link training */
     68      1.1  jakllsch #define   PCBS1_LS_DL_INIT		2	/* link up, DL init progressing */
     69      1.1  jakllsch #define   PCBS1_LS_DL_DONE		3	/* link up, DL init complete */
     70      1.1  jakllsch #define PCIE_CLIENT_INT_MASK		0x004c
     71      1.1  jakllsch #define   PCIM_INTx_MASK(x)		SETREG(__BIT((x)+5), 1)
     72      1.1  jakllsch #define   PCIM_INTx_ENAB(x)		SETREG(__BIT((x)+5), 0)
     73      1.1  jakllsch 
     74      1.1  jakllsch #define PCIE_CORE_BASE			0x800000
     75      1.1  jakllsch #define PCIE_RC_NORMAL_BASE		(PCIE_CORE_BASE + 0x00000)
     76      1.1  jakllsch 
     77      1.1  jakllsch #define PCIE_LM_BASE			0x900000
     78      1.1  jakllsch #define PCIE_LM_CORE_CTRL		(PCIE_LM_BASE + 0x00)
     79      1.1  jakllsch #define   PCIE_CORE_PL_CONF_SPEED_5G            0x00000008
     80      1.1  jakllsch #define   PCIE_CORE_PL_CONF_SPEED_MASK          0x00000018
     81      1.1  jakllsch #define   PCIE_CORE_PL_CONF_LANE_MASK           0x00000006
     82      1.1  jakllsch #define   PCIE_CORE_PL_CONF_LANE_SHIFT          1
     83      1.1  jakllsch #define PCIE_LM_PLC1			(PCIE_LM_BASE + 0x04)
     84      1.1  jakllsch #define  PCIE_LM_PLC1_FTS_MASK			__BITS(23, 8)
     85      1.1  jakllsch #define PCIE_LM_VENDOR_ID		(PCIE_LM_BASE + 0x44)
     86      1.1  jakllsch #define PCIE_LM_LINKWIDTH		(PCIE_LM_BASE + 0x50)
     87      1.1  jakllsch #define PCIE_LM_LANEMAP			(PCIE_LM_BASE + 0x200)
     88      1.1  jakllsch #define PCIE_LM_DEBUG_MUX_CONTROL	(PCIE_LM_BASE + 0x208)
     89      1.1  jakllsch #define PCIE_LM_RCBAR			(PCIE_LM_BASE + 0x300)
     90      1.1  jakllsch #define  PCIE_LM_RCBARPME		__BIT(17)
     91      1.1  jakllsch #define  PCIE_LM_RCBARPMS		__BIT(18)
     92      1.1  jakllsch #define  PCIE_LM_RCBARPIE		__BIT(19)
     93      1.1  jakllsch #define  PCIE_LM_RCBARPIS		__BIT(20)
     94      1.1  jakllsch 
     95      1.1  jakllsch #define PCIE_RC_BASE			0xa00000
     96      1.1  jakllsch #define PCIE_RC_CONFIG_DCSR		(PCIE_RC_BASE + 0x0c0 + PCIE_DCSR)
     97      1.1  jakllsch #define PCIE_RC_PCIE_LCAP		(PCIE_RC_BASE + 0x0c0 + PCIE_LCAP)
     98      1.1  jakllsch #define PCIE_RC_CONFIG_LCSR		(PCIE_RC_BASE + 0x0c0 + PCIE_LCSR)
     99      1.1  jakllsch #define PCIE_RC_CONFIG_THP_CAP          (PCIE_RC_BASE + 0x274)
    100      1.1  jakllsch #define   PCIE_RC_CONFIG_THP_CAP_NEXT_MASK      __BITS(31, 20)
    101      1.1  jakllsch 
    102      1.1  jakllsch 
    103      1.1  jakllsch #define PCIE_ATR_BASE			0xc00000
    104      1.1  jakllsch #define PCIE_ATR_OB_ADDR0(i)		(PCIE_ATR_BASE + 0x000 + (i) * 0x20)
    105      1.1  jakllsch #define PCIE_ATR_OB_ADDR1(i)		(PCIE_ATR_BASE + 0x004 + (i) * 0x20)
    106      1.1  jakllsch #define PCIE_ATR_OB_DESC0(i)		(PCIE_ATR_BASE + 0x008 + (i) * 0x20)
    107      1.1  jakllsch #define PCIE_ATR_OB_DESC1(i)		(PCIE_ATR_BASE + 0x00c + (i) * 0x20)
    108      1.1  jakllsch #define PCIE_ATR_IB_ADDR0(i)		(PCIE_ATR_BASE + 0x800 + (i) * 0x8)
    109      1.1  jakllsch #define PCIE_ATR_IB_ADDR1(i)		(PCIE_ATR_BASE + 0x804 + (i) * 0x8)
    110      1.1  jakllsch #define  PCIE_ATR_HDR_MEM		0x2
    111      1.1  jakllsch #define  PCIE_ATR_HDR_IO		0x6
    112      1.1  jakllsch #define  PCIE_ATR_HDR_CFG_TYPE0		0xa
    113      1.1  jakllsch #define  PCIE_ATR_HDR_CFG_TYPE1		0xb
    114      1.1  jakllsch #define  PCIE_ATR_HDR_RID		__BIT(23)
    115      1.1  jakllsch 
    116      1.1  jakllsch /* AXI region */
    117      1.1  jakllsch #define PCIE_ATR_OB_REGION0_SIZE	(32 * 1024 * 1024)
    118      1.1  jakllsch #define PCIE_ATR_OB_REGION_SIZE		(1 * 1024 * 1024)
    119      1.1  jakllsch 
    120      1.1  jakllsch #define HREAD4(sc, reg)							\
    121      1.5       mrg 	bus_space_read_4((sc)->sc_iot, (sc)->sc_ioh, (reg))
    122      1.1  jakllsch #define HWRITE4(sc, reg, val)						\
    123      1.1  jakllsch 	bus_space_write_4((sc)->sc_iot, (sc)->sc_ioh, (reg), (val))
    124  1.6.2.2    martin #define AXIPEEK4(sc, reg, valp)						\
    125  1.6.2.2    martin 	bus_space_peek_4((sc)->sc_iot, (sc)->sc_axi_ioh, (reg), (valp))
    126  1.6.2.2    martin #define AXIPOKE4(sc, reg, val)						\
    127  1.6.2.2    martin 	bus_space_poke_4((sc)->sc_iot, (sc)->sc_axi_ioh, (reg), (val))
    128      1.1  jakllsch 
    129      1.1  jakllsch struct rkpcie_softc {
    130      1.1  jakllsch 	struct pcihost_softc	sc_phsc;
    131      1.1  jakllsch 	bus_space_tag_t		sc_iot;
    132      1.1  jakllsch 	bus_space_handle_t	sc_ioh;
    133      1.3  jmcneill 	bus_space_handle_t	sc_axi_ioh;
    134      1.1  jakllsch 	bus_addr_t		sc_axi_addr;
    135      1.1  jakllsch 	bus_addr_t		sc_apb_addr;
    136      1.1  jakllsch 	bus_size_t		sc_axi_size;
    137      1.1  jakllsch 	bus_size_t		sc_apb_size;
    138      1.2  jmcneill };
    139      1.2  jmcneill 
    140      1.1  jakllsch static int rkpcie_match(device_t, cfdata_t, void *);
    141      1.1  jakllsch static void rkpcie_attach(device_t, device_t, void *);
    142      1.1  jakllsch 
    143      1.1  jakllsch CFATTACH_DECL_NEW(rkpcie, sizeof(struct rkpcie_softc),
    144      1.1  jakllsch         rkpcie_match, rkpcie_attach, NULL, NULL);
    145      1.1  jakllsch 
    146      1.1  jakllsch static int
    147      1.1  jakllsch rkpcie_match(device_t parent, cfdata_t cf, void *aux)
    148      1.1  jakllsch {
    149      1.1  jakllsch         const char * const compatible[] = {
    150      1.1  jakllsch 		"rockchip,rk3399-pcie",
    151      1.1  jakllsch 		NULL
    152      1.1  jakllsch 	};
    153      1.1  jakllsch 	struct fdt_attach_args *faa = aux;
    154      1.1  jakllsch 
    155      1.1  jakllsch 	return of_match_compatible(faa->faa_phandle, compatible);
    156      1.1  jakllsch }
    157      1.1  jakllsch 
    158      1.1  jakllsch static void	rkpcie_atr_init(struct rkpcie_softc *);
    159      1.1  jakllsch 
    160      1.1  jakllsch static int	rkpcie_bus_maxdevs(void *, int);
    161      1.1  jakllsch static pcitag_t rkpcie_make_tag(void *, int, int, int);
    162      1.1  jakllsch static void	rkpcie_decompose_tag(void *, pcitag_t, int *, int *, int *);
    163      1.1  jakllsch static pcireg_t rkpcie_conf_read(void *, pcitag_t, int);
    164      1.1  jakllsch static void	rkpcie_conf_write(void *, pcitag_t, int, pcireg_t);
    165      1.1  jakllsch static int	rkpcie_conf_hook(void *, int, int, int, pcireg_t);
    166      1.1  jakllsch 
    167      1.1  jakllsch static struct fdtbus_interrupt_controller_func rkpcie_intrfuncs;
    168      1.1  jakllsch 
    169      1.1  jakllsch static inline void
    170      1.1  jakllsch clock_enable_all(int phandle)
    171      1.1  jakllsch {
    172      1.1  jakllsch 	for (u_int i = 0; i < 4; i++) {
    173      1.1  jakllsch 		struct clk * clk = fdtbus_clock_get_index(phandle, i);
    174      1.1  jakllsch 		if (clk == NULL)
    175      1.1  jakllsch 			continue;
    176      1.1  jakllsch 		if (clk_enable(clk) != 0)
    177      1.1  jakllsch 			continue;
    178      1.1  jakllsch 	}
    179      1.1  jakllsch }
    180      1.1  jakllsch 
    181      1.1  jakllsch static void
    182      1.1  jakllsch reset_assert(int phandle, const char *name)
    183      1.1  jakllsch {
    184      1.1  jakllsch 	struct fdtbus_reset *rst;
    185      1.1  jakllsch 
    186      1.1  jakllsch 	rst = fdtbus_reset_get(phandle, name);
    187      1.1  jakllsch 	fdtbus_reset_assert(rst);
    188      1.1  jakllsch 	fdtbus_reset_put(rst);
    189      1.1  jakllsch }
    190      1.1  jakllsch 
    191      1.1  jakllsch static void
    192      1.1  jakllsch reset_deassert(int phandle, const char *name)
    193      1.1  jakllsch {
    194      1.1  jakllsch 	struct fdtbus_reset *rst;
    195      1.1  jakllsch 
    196      1.1  jakllsch 	rst = fdtbus_reset_get(phandle, name);
    197      1.1  jakllsch 	fdtbus_reset_deassert(rst);
    198      1.1  jakllsch 	fdtbus_reset_put(rst);
    199      1.1  jakllsch }
    200      1.1  jakllsch 
    201      1.1  jakllsch static void
    202      1.1  jakllsch rkpcie_attach(device_t parent, device_t self, void *aux)
    203      1.1  jakllsch {
    204      1.1  jakllsch 	struct rkpcie_softc *sc = device_private(self);
    205      1.1  jakllsch 	struct pcihost_softc * const phsc = &sc->sc_phsc;
    206      1.1  jakllsch 	struct fdt_attach_args *faa = aux;
    207      1.1  jakllsch 	struct fdtbus_gpio_pin *ep_gpio;
    208      1.4  jmcneill 	u_int max_link_speed, num_lanes;
    209      1.4  jmcneill 	struct fdtbus_phy *phy[4];
    210      1.3  jmcneill 	const u_int *bus_range;
    211      1.1  jakllsch 	uint32_t status;
    212      1.4  jmcneill 	int timo, len;
    213      1.1  jakllsch 
    214      1.1  jakllsch 	phsc->sc_dev = self;
    215      1.1  jakllsch 	phsc->sc_bst = faa->faa_bst;
    216      1.1  jakllsch 	phsc->sc_dmat = faa->faa_dmat;
    217      1.1  jakllsch 	sc->sc_iot = phsc->sc_bst;
    218      1.1  jakllsch 	phsc->sc_phandle = faa->faa_phandle;
    219      1.1  jakllsch 	const int phandle = phsc->sc_phandle;
    220      1.1  jakllsch 
    221      1.1  jakllsch 	if (fdtbus_get_reg_byname(faa->faa_phandle, "axi-base", &sc->sc_axi_addr, &sc->sc_axi_size) != 0) {
    222      1.1  jakllsch 		aprint_error(": couldn't get axi registers\n");
    223      1.1  jakllsch 		return;
    224      1.1  jakllsch 	}
    225      1.1  jakllsch 	if (fdtbus_get_reg_byname(faa->faa_phandle, "apb-base", &sc->sc_apb_addr, &sc->sc_apb_size) != 0) {
    226      1.1  jakllsch 		aprint_error(": couldn't get apb registers\n");
    227      1.1  jakllsch 		sc->sc_axi_size = 0;
    228      1.1  jakllsch 		return;
    229      1.1  jakllsch 	}
    230      1.1  jakllsch 
    231      1.3  jmcneill 	if (bus_space_map(sc->sc_iot, sc->sc_apb_addr, sc->sc_apb_size, 0, &sc->sc_ioh) != 0 ||
    232      1.3  jmcneill 	    bus_space_map(sc->sc_iot, sc->sc_axi_addr, sc->sc_axi_size, 0, &sc->sc_axi_ioh) != 0) {
    233      1.1  jakllsch 		printf(": can't map registers\n");
    234      1.1  jakllsch 		sc->sc_axi_size = 0;
    235      1.1  jakllsch 		sc->sc_apb_size = 0;
    236      1.1  jakllsch 		return;
    237      1.1  jakllsch 	}
    238      1.1  jakllsch 
    239      1.1  jakllsch 	aprint_naive("\n");
    240      1.1  jakllsch 	aprint_normal(": RK3399 PCIe\n");
    241      1.1  jakllsch 
    242      1.1  jakllsch 	struct fdtbus_regulator *regulator;
    243      1.1  jakllsch 	regulator = fdtbus_regulator_acquire(phandle, "vpcie3v3-supply");
    244  1.6.2.1    martin 	if (regulator != NULL) {
    245  1.6.2.1    martin 		fdtbus_regulator_enable(regulator);
    246  1.6.2.1    martin 		fdtbus_regulator_release(regulator);
    247  1.6.2.1    martin 	}
    248      1.1  jakllsch 
    249      1.1  jakllsch 	fdtbus_clock_assign(phandle);
    250      1.1  jakllsch 	clock_enable_all(phandle);
    251      1.1  jakllsch 
    252      1.1  jakllsch 	ep_gpio = fdtbus_gpio_acquire(phandle, "ep-gpios", GPIO_PIN_OUTPUT);
    253      1.4  jmcneill 
    254      1.4  jmcneill 	if (of_getprop_uint32(phandle, "max-link-speed", &max_link_speed) != 0)
    255      1.4  jmcneill 		max_link_speed = 2;
    256      1.4  jmcneill 	if (of_getprop_uint32(phandle, "num-lanes", &num_lanes) != 0)
    257      1.4  jmcneill 		num_lanes = 1;
    258      1.4  jmcneill 
    259      1.1  jakllsch again:
    260      1.1  jakllsch 	fdtbus_gpio_write(ep_gpio, 0);
    261      1.1  jakllsch 
    262      1.1  jakllsch 	reset_assert(phandle, "aclk");
    263      1.1  jakllsch 	reset_assert(phandle, "pclk");
    264      1.1  jakllsch 	reset_assert(phandle, "pm");
    265      1.1  jakllsch 
    266      1.1  jakllsch 	memset(phy, 0, sizeof(phy));
    267      1.1  jakllsch 	phy[0] = fdtbus_phy_get(phandle, "pcie-phy-0");
    268      1.1  jakllsch 	if (phy[0] == NULL) {
    269      1.1  jakllsch 		phy[0] = fdtbus_phy_get(phandle, "pcie-phy");
    270      1.1  jakllsch 	} else {
    271      1.1  jakllsch 		phy[1] = fdtbus_phy_get(phandle, "pcie-phy-1");
    272      1.1  jakllsch 		phy[2] = fdtbus_phy_get(phandle, "pcie-phy-2");
    273      1.1  jakllsch 		phy[3] = fdtbus_phy_get(phandle, "pcie-phy-3");
    274      1.1  jakllsch 	}
    275      1.1  jakllsch 
    276      1.1  jakllsch 	reset_assert(phandle, "core");
    277      1.1  jakllsch 	reset_assert(phandle, "mgmt");
    278      1.1  jakllsch 	reset_assert(phandle, "mgmt-sticky");
    279      1.1  jakllsch 	reset_assert(phandle, "pipe");
    280      1.1  jakllsch 
    281      1.1  jakllsch 	delay(10);
    282      1.1  jakllsch 
    283      1.1  jakllsch 	reset_deassert(phandle, "pm");
    284      1.1  jakllsch 	reset_deassert(phandle, "aclk");
    285      1.1  jakllsch 	reset_deassert(phandle, "pclk");
    286      1.1  jakllsch 
    287      1.4  jmcneill 	if (max_link_speed == 1)
    288      1.1  jakllsch 		HWRITE4(sc, PCIE_CLIENT_BASIC_STRAP_CONF, PCBSC_PGS_GEN1);
    289      1.1  jakllsch 	else
    290      1.1  jakllsch 		HWRITE4(sc, PCIE_CLIENT_BASIC_STRAP_CONF, PCBSC_PGS_GEN2);
    291      1.1  jakllsch 
    292      1.1  jakllsch 	/* Switch into Root Complex mode. */
    293      1.1  jakllsch 	HWRITE4(sc, PCIE_CLIENT_BASIC_STRAP_CONF,
    294      1.4  jmcneill 	    PCBSC_MS_ROOTPORT | PCBSC_CONF_EN | PCBSC_LC(num_lanes));
    295      1.1  jakllsch 
    296      1.1  jakllsch 	if (phy[3] && fdtbus_phy_enable(phy[3], true) != 0) {
    297      1.1  jakllsch 		aprint_error(": couldn't enable phy3\n");
    298      1.1  jakllsch 	}
    299      1.1  jakllsch 	if (phy[2] && fdtbus_phy_enable(phy[2], true) != 0) {
    300      1.1  jakllsch 		aprint_error(": couldn't enable phy2\n");
    301      1.1  jakllsch 	}
    302      1.1  jakllsch 	if (phy[1] && fdtbus_phy_enable(phy[1], true) != 0) {
    303      1.1  jakllsch 		aprint_error(": couldn't enable phy1\n");
    304      1.1  jakllsch 	}
    305      1.1  jakllsch 	if (phy[0] && fdtbus_phy_enable(phy[0], true) != 0) {
    306      1.1  jakllsch 		aprint_error(": couldn't enable phy0\n");
    307      1.1  jakllsch 	}
    308      1.1  jakllsch 
    309      1.1  jakllsch 	reset_deassert(phandle, "mgmt-sticky");
    310      1.1  jakllsch 	reset_deassert(phandle, "core");
    311      1.1  jakllsch 	reset_deassert(phandle, "mgmt");
    312      1.1  jakllsch 	reset_deassert(phandle, "pipe");
    313      1.1  jakllsch 
    314      1.1  jakllsch 	/* Start link training. */
    315      1.1  jakllsch 	HWRITE4(sc, PCIE_CLIENT_BASIC_STRAP_CONF, PCBSC_LINK_TRAIN_EN);
    316      1.1  jakllsch 
    317      1.1  jakllsch 	fdtbus_gpio_write(ep_gpio, 1);
    318      1.1  jakllsch 
    319      1.1  jakllsch 	for (timo = 500; timo > 0; timo--) {
    320      1.1  jakllsch 		status = HREAD4(sc, PCIE_CLIENT_BASIC_STATUS1);
    321      1.1  jakllsch 		if (PCBS1_LINK_ST(status) == PCBS1_LS_DL_DONE)
    322      1.1  jakllsch 			break;
    323      1.1  jakllsch 		delay(1000);
    324      1.1  jakllsch 	}
    325      1.1  jakllsch 	if (timo == 0) {
    326      1.1  jakllsch 		device_printf(self, "link training timeout (link_st %u)\n",
    327      1.1  jakllsch 		    PCBS1_LINK_ST(status));
    328      1.4  jmcneill 		if (max_link_speed > 1) {
    329      1.4  jmcneill 			--max_link_speed;
    330      1.1  jakllsch 			goto again;
    331      1.1  jakllsch 		}
    332      1.1  jakllsch 		return;
    333      1.1  jakllsch 	}
    334      1.1  jakllsch 
    335      1.4  jmcneill 	if (max_link_speed == 2) {
    336      1.1  jakllsch 		HWRITE4(sc, PCIE_RC_CONFIG_LCSR, HREAD4(sc, PCIE_RC_CONFIG_LCSR) | PCIE_LCSR_RETRAIN);
    337      1.1  jakllsch 		for (timo = 500; timo > 0; timo--) {
    338      1.1  jakllsch 			status = HREAD4(sc, PCIE_LM_CORE_CTRL);
    339      1.1  jakllsch 			if ((status & PCIE_CORE_PL_CONF_SPEED_MASK) == PCIE_CORE_PL_CONF_SPEED_5G)
    340      1.1  jakllsch 				break;
    341      1.1  jakllsch 			delay(1000);
    342      1.1  jakllsch 		}
    343      1.1  jakllsch 		if (timo == 0) {
    344      1.1  jakllsch 			device_printf(self, "Gen2 link training timeout\n");
    345      1.4  jmcneill 			--max_link_speed;
    346      1.1  jakllsch 			goto again;
    347      1.1  jakllsch 		}
    348      1.1  jakllsch 	}
    349      1.1  jakllsch 
    350      1.1  jakllsch 	fdtbus_gpio_release(ep_gpio);
    351      1.1  jakllsch 
    352      1.1  jakllsch 	HWRITE4(sc, PCIE_RC_BASE + PCI_CLASS_REG,
    353      1.1  jakllsch 	    PCI_CLASS_BRIDGE << PCI_CLASS_SHIFT |
    354      1.1  jakllsch 	    PCI_SUBCLASS_BRIDGE_PCI << PCI_SUBCLASS_SHIFT);
    355      1.1  jakllsch 
    356      1.1  jakllsch 	/* Initialize Root Complex registers. */
    357      1.1  jakllsch 	HWRITE4(sc, PCIE_LM_VENDOR_ID, PCI_VENDOR_ROCKCHIP);
    358      1.1  jakllsch 	HWRITE4(sc, PCIE_RC_BASE + PCI_CLASS_REG,
    359      1.1  jakllsch 	    PCI_CLASS_BRIDGE << PCI_CLASS_SHIFT |
    360      1.1  jakllsch 	    PCI_SUBCLASS_BRIDGE_PCI << PCI_SUBCLASS_SHIFT);
    361      1.4  jmcneill 	HWRITE4(sc, PCIE_LM_RCBAR, PCIE_LM_RCBARPIE | PCIE_LM_RCBARPIS);
    362      1.1  jakllsch 
    363      1.1  jakllsch 	/* remove L1 substate cap */
    364      1.1  jakllsch 	status = HREAD4(sc, PCIE_RC_CONFIG_THP_CAP);
    365      1.1  jakllsch 	status &= ~PCIE_RC_CONFIG_THP_CAP_NEXT_MASK;
    366      1.1  jakllsch 	HWRITE4(sc, PCIE_RC_CONFIG_THP_CAP, status);
    367      1.1  jakllsch 
    368      1.4  jmcneill 	if (of_hasprop(phandle, "aspm-no-l0s")) {
    369      1.1  jakllsch 		status = HREAD4(sc, PCIE_RC_PCIE_LCAP);
    370      1.1  jakllsch 		status &= ~__SHIFTIN(1, PCIE_LCAP_ASPM);
    371      1.1  jakllsch 		HWRITE4(sc, PCIE_RC_PCIE_LCAP, status);
    372      1.1  jakllsch 	}
    373      1.1  jakllsch 
    374      1.3  jmcneill 	/* Default bus ranges */
    375      1.3  jmcneill 	sc->sc_phsc.sc_bus_min = 0;
    376      1.3  jmcneill 	sc->sc_phsc.sc_bus_max = 31;
    377      1.3  jmcneill 
    378      1.3  jmcneill 	/* Override bus range from DT */
    379      1.3  jmcneill 	bus_range = fdtbus_get_prop(phandle, "bus-range", &len);
    380      1.3  jmcneill 	if (len == 8) {
    381      1.3  jmcneill 		sc->sc_phsc.sc_bus_min = be32dec(&bus_range[0]);
    382      1.3  jmcneill 		sc->sc_phsc.sc_bus_max = be32dec(&bus_range[1]);
    383      1.2  jmcneill 	}
    384      1.1  jakllsch 
    385      1.1  jakllsch 	if (sc->sc_phsc.sc_bus_min != 0) {
    386      1.1  jakllsch 		aprint_error_dev(self, "bus-range doesn't start at 0\n");
    387      1.1  jakllsch 		return;
    388      1.1  jakllsch 	}
    389      1.1  jakllsch 
    390      1.1  jakllsch 	/* Configure Address Translation. */
    391      1.1  jakllsch 	rkpcie_atr_init(sc);
    392      1.1  jakllsch 
    393      1.1  jakllsch 	fdtbus_register_interrupt_controller(self, OF_child(sc->sc_phsc.sc_phandle),
    394      1.1  jakllsch 	            &rkpcie_intrfuncs);
    395      1.1  jakllsch 
    396      1.1  jakllsch 	sc->sc_phsc.sc_type = PCIHOST_ECAM;
    397      1.2  jmcneill 	sc->sc_phsc.sc_pci_flags |= PCI_FLAGS_MSI_OKAY;
    398      1.6  jmcneill 	sc->sc_phsc.sc_pci_flags |= PCI_FLAGS_MSIX_OKAY;
    399      1.1  jakllsch 	pcihost_init(&sc->sc_phsc.sc_pc, sc);
    400      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_bus_maxdevs = rkpcie_bus_maxdevs;
    401      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_make_tag = rkpcie_make_tag;
    402      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_decompose_tag = rkpcie_decompose_tag;
    403      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_conf_read = rkpcie_conf_read;
    404      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_conf_write = rkpcie_conf_write;
    405      1.1  jakllsch 	sc->sc_phsc.sc_pc.pc_conf_hook = rkpcie_conf_hook;
    406      1.1  jakllsch 	pcihost_init2(&sc->sc_phsc);
    407      1.1  jakllsch }
    408      1.1  jakllsch 
    409      1.1  jakllsch static void
    410      1.1  jakllsch rkpcie_atr_init(struct rkpcie_softc *sc)
    411      1.1  jakllsch {
    412      1.3  jmcneill 	const u_int *ranges;
    413      1.1  jakllsch 	bus_addr_t aaddr;
    414      1.1  jakllsch 	bus_addr_t addr;
    415      1.4  jmcneill 	bus_size_t size, resid, offset;
    416      1.1  jakllsch 	uint32_t type;
    417      1.3  jmcneill 	int region, i, ranges_len;
    418      1.1  jakllsch 
    419      1.3  jmcneill 	/* Use region 0 to map PCI configuration space */
    420      1.3  jmcneill 	HWRITE4(sc, PCIE_ATR_OB_ADDR0(0), 25 - 1);
    421      1.3  jmcneill 	HWRITE4(sc, PCIE_ATR_OB_ADDR1(0), 0);
    422      1.4  jmcneill 	HWRITE4(sc, PCIE_ATR_OB_DESC0(0), PCIE_ATR_HDR_CFG_TYPE0 | PCIE_ATR_HDR_RID);
    423      1.3  jmcneill 	HWRITE4(sc, PCIE_ATR_OB_DESC1(0), 0);
    424      1.3  jmcneill 
    425      1.3  jmcneill 	ranges = fdtbus_get_prop(sc->sc_phsc.sc_phandle, "ranges", &ranges_len);
    426      1.3  jmcneill 	if (ranges == NULL)
    427      1.3  jmcneill 		goto fail;
    428      1.3  jmcneill 	const int ranges_cells = ranges_len / 4;
    429      1.1  jakllsch 
    430      1.2  jmcneill 	for (i = 0; i < ranges_cells; i += 7) {
    431      1.1  jakllsch 		/* Handle IO and MMIO. */
    432      1.3  jmcneill 		switch (be32toh(ranges[i]) & 0x03000000) {
    433      1.1  jakllsch 		case 0x01000000:
    434      1.1  jakllsch 			type = PCIE_ATR_HDR_IO;
    435      1.1  jakllsch 			break;
    436      1.1  jakllsch 		case 0x02000000:
    437      1.1  jakllsch 		case 0x03000000:
    438      1.1  jakllsch 			type = PCIE_ATR_HDR_MEM;
    439      1.1  jakllsch 			break;
    440      1.1  jakllsch 		default:
    441      1.1  jakllsch 			continue;
    442      1.1  jakllsch 		}
    443      1.1  jakllsch 
    444      1.3  jmcneill 		addr = ((uint64_t)be32toh(ranges[i + 1]) << 32) + be32toh(ranges[i + 2]);
    445      1.3  jmcneill 		aaddr = ((uint64_t)be32toh(ranges[i + 3]) << 32) + be32toh(ranges[i + 4]);
    446      1.4  jmcneill 		size = be32toh(ranges[i + 6]);
    447      1.1  jakllsch 
    448      1.1  jakllsch 		/* Only support mappings aligned on a region boundary. */
    449      1.1  jakllsch 		if (addr & (PCIE_ATR_OB_REGION_SIZE - 1))
    450      1.1  jakllsch 			goto fail;
    451      1.1  jakllsch 		if (aaddr & (PCIE_ATR_OB_REGION_SIZE - 1))
    452      1.1  jakllsch 			goto fail;
    453      1.1  jakllsch 		if (size & (PCIE_ATR_OB_REGION_SIZE - 1))
    454      1.1  jakllsch 			goto fail;
    455      1.1  jakllsch 
    456      1.1  jakllsch 		/* Mappings should lie in AXI region. */
    457      1.1  jakllsch 		if (aaddr < sc->sc_axi_addr)
    458      1.1  jakllsch 			goto fail;
    459      1.1  jakllsch 		if (aaddr + size > sc->sc_axi_addr + 64*1024*1024)
    460      1.1  jakllsch 			goto fail;
    461      1.3  jmcneill 
    462      1.3  jmcneill 		offset = addr - sc->sc_axi_addr - PCIE_ATR_OB_REGION0_SIZE;
    463      1.3  jmcneill 		region = 1 + (offset / PCIE_ATR_OB_REGION_SIZE);
    464      1.4  jmcneill 		resid = size;
    465      1.4  jmcneill 		while (resid > 0) {
    466      1.3  jmcneill 			HWRITE4(sc, PCIE_ATR_OB_ADDR0(region), 32 - 1);
    467      1.3  jmcneill 			HWRITE4(sc, PCIE_ATR_OB_ADDR1(region), 0);
    468      1.4  jmcneill 			HWRITE4(sc, PCIE_ATR_OB_DESC0(region), type | PCIE_ATR_HDR_RID);
    469      1.1  jakllsch 			HWRITE4(sc, PCIE_ATR_OB_DESC1(region), 0);
    470      1.3  jmcneill 
    471      1.3  jmcneill 			addr += PCIE_ATR_OB_REGION_SIZE;
    472      1.4  jmcneill 			resid -= PCIE_ATR_OB_REGION_SIZE;
    473      1.3  jmcneill 			region++;
    474      1.1  jakllsch 		}
    475      1.1  jakllsch 	}
    476      1.1  jakllsch 
    477      1.1  jakllsch 	/* Passthrought inbound translations unmodified. */
    478      1.1  jakllsch 	HWRITE4(sc, PCIE_ATR_IB_ADDR0(2), 32 - 1);
    479      1.1  jakllsch 	HWRITE4(sc, PCIE_ATR_IB_ADDR1(2), 0);
    480      1.1  jakllsch 
    481      1.1  jakllsch 	return;
    482      1.1  jakllsch 
    483      1.1  jakllsch fail:
    484      1.1  jakllsch 	device_printf(sc->sc_phsc.sc_dev, "can't map ranges\n");
    485      1.1  jakllsch }
    486      1.1  jakllsch 
    487      1.1  jakllsch int
    488      1.1  jakllsch rkpcie_bus_maxdevs(void *v, int bus)
    489      1.1  jakllsch {
    490      1.1  jakllsch 	struct rkpcie_softc *rksc = v;
    491      1.1  jakllsch 	struct pcihost_softc *sc = &rksc->sc_phsc;
    492      1.1  jakllsch 
    493      1.3  jmcneill 	if (bus == sc->sc_bus_min || bus == sc->sc_bus_min + 1)
    494      1.1  jakllsch 		return 1;
    495      1.1  jakllsch 	return 32;
    496      1.1  jakllsch }
    497      1.1  jakllsch 
    498      1.1  jakllsch pcitag_t
    499      1.1  jakllsch rkpcie_make_tag(void *v, int bus, int device, int function)
    500      1.1  jakllsch {
    501      1.1  jakllsch 	/* Return ECAM address. */
    502      1.1  jakllsch 	return ((bus << 20) | (device << 15) | (function << 12));
    503      1.1  jakllsch }
    504      1.1  jakllsch 
    505      1.1  jakllsch void
    506      1.1  jakllsch rkpcie_decompose_tag(void *v, pcitag_t tag, int *bp, int *dp, int *fp)
    507      1.1  jakllsch {
    508      1.1  jakllsch 	if (bp != NULL)
    509      1.1  jakllsch 		*bp = (tag >> 20) & 0xff;
    510      1.1  jakllsch 	if (dp != NULL)
    511      1.1  jakllsch 		*dp = (tag >> 15) & 0x1f;
    512      1.1  jakllsch 	if (fp != NULL)
    513      1.1  jakllsch 		*fp = (tag >> 12) & 0x7;
    514      1.1  jakllsch }
    515      1.1  jakllsch 
    516      1.5       mrg /* Only one device on root port and the first subordinate port. */
    517      1.5       mrg static bool
    518      1.5       mrg rkpcie_conf_ok(int bus, int dev, int fn, int bus_min)
    519      1.5       mrg {
    520      1.5       mrg 	if (dev != 0 && (bus == bus_min || bus == bus_min + 1))
    521      1.5       mrg 		return false;
    522      1.5       mrg 	return true;
    523      1.5       mrg }
    524      1.5       mrg 
    525      1.1  jakllsch pcireg_t
    526      1.3  jmcneill rkpcie_conf_read(void *v, pcitag_t tag, int offset)
    527      1.1  jakllsch {
    528      1.1  jakllsch 	struct rkpcie_softc *sc = v;
    529      1.1  jakllsch 	struct pcihost_softc *phsc = &sc->sc_phsc;
    530      1.1  jakllsch 	int bus, dev, fn;
    531      1.3  jmcneill 	u_int reg;
    532      1.1  jakllsch 
    533      1.3  jmcneill 	KASSERT(offset >= 0);
    534      1.3  jmcneill 	KASSERT(offset < PCI_EXTCONF_SIZE);
    535      1.1  jakllsch 
    536      1.1  jakllsch 	rkpcie_decompose_tag(sc, tag, &bus, &dev, &fn);
    537      1.5       mrg 	if (!rkpcie_conf_ok(bus, dev, fn, phsc->sc_bus_min))
    538      1.5       mrg 		return 0xffffffff;
    539      1.3  jmcneill 	reg = (bus << 20) | (dev << 15) | (fn << 12) | offset;
    540      1.3  jmcneill 
    541      1.5       mrg 	if (bus == phsc->sc_bus_min)
    542      1.3  jmcneill 		return HREAD4(sc, PCIE_RC_NORMAL_BASE + reg);
    543  1.6.2.2    martin 	else {
    544  1.6.2.2    martin 		uint32_t val;
    545  1.6.2.2    martin 		if (AXIPEEK4(sc, reg, &val) != 0)
    546  1.6.2.2    martin 			return 0xffffffff;
    547  1.6.2.2    martin 		return val;
    548  1.6.2.2    martin 	}
    549      1.1  jakllsch }
    550      1.1  jakllsch 
    551      1.1  jakllsch void
    552      1.3  jmcneill rkpcie_conf_write(void *v, pcitag_t tag, int offset, pcireg_t data)
    553      1.1  jakllsch {
    554      1.1  jakllsch 	struct rkpcie_softc *sc = v;
    555      1.1  jakllsch 	struct pcihost_softc *phsc = &sc->sc_phsc;
    556      1.1  jakllsch 	int bus, dev, fn;
    557      1.3  jmcneill 	u_int reg;
    558      1.1  jakllsch 
    559      1.3  jmcneill 	KASSERT(offset >= 0);
    560      1.3  jmcneill 	KASSERT(offset < PCI_EXTCONF_SIZE);
    561      1.1  jakllsch 
    562      1.1  jakllsch 	rkpcie_decompose_tag(sc, tag, &bus, &dev, &fn);
    563      1.5       mrg 	if (!rkpcie_conf_ok(bus, dev, fn, phsc->sc_bus_min))
    564      1.5       mrg 		return;
    565      1.3  jmcneill 	reg = (bus << 20) | (dev << 15) | (fn << 12) | offset;
    566      1.3  jmcneill 
    567      1.5       mrg 	if (bus == phsc->sc_bus_min)
    568      1.3  jmcneill 		HWRITE4(sc, PCIE_RC_NORMAL_BASE + reg, data);
    569      1.5       mrg 	else
    570  1.6.2.2    martin 		AXIPOKE4(sc, reg, data);
    571      1.1  jakllsch }
    572      1.1  jakllsch 
    573      1.1  jakllsch static int
    574      1.1  jakllsch rkpcie_conf_hook(void *v, int b, int d, int f, pcireg_t id)
    575      1.1  jakllsch {
    576      1.1  jakllsch         return (PCI_CONF_DEFAULT & ~PCI_CONF_ENABLE_BM) | PCI_CONF_MAP_ROM;
    577      1.1  jakllsch }
    578      1.1  jakllsch 
    579      1.1  jakllsch /* INTx interrupt controller */
    580      1.1  jakllsch static void *
    581      1.1  jakllsch rkpcie_intx_establish(device_t dev, u_int *specifier, int ipl, int flags,
    582      1.1  jakllsch     int (*func)(void *), void *arg)
    583      1.1  jakllsch {
    584      1.1  jakllsch 	struct rkpcie_softc *sc = device_private(dev);
    585      1.1  jakllsch 	void *cookie;
    586      1.1  jakllsch 
    587      1.4  jmcneill #if notyet
    588      1.1  jakllsch 	const u_int pin = be32toh(specifier[0]);
    589      1.4  jmcneill #endif
    590      1.1  jakllsch 
    591      1.1  jakllsch 	/* Unmask legacy interrupts. */
    592      1.1  jakllsch 	HWRITE4(sc, PCIE_CLIENT_INT_MASK,
    593      1.1  jakllsch 	    PCIM_INTx_ENAB(0) | PCIM_INTx_ENAB(1) |
    594      1.1  jakllsch 	    PCIM_INTx_ENAB(2) | PCIM_INTx_ENAB(3));
    595      1.1  jakllsch 
    596      1.1  jakllsch 	cookie = fdtbus_intr_establish_byname(sc->sc_phsc.sc_phandle, "legacy", ipl, flags, func, arg);
    597      1.1  jakllsch 
    598      1.1  jakllsch 	return cookie;
    599      1.1  jakllsch }
    600      1.1  jakllsch 
    601      1.1  jakllsch static void
    602      1.1  jakllsch rkpcie_intx_disestablish(device_t dev, void *ih)
    603      1.1  jakllsch {
    604      1.1  jakllsch 	struct rkpcie_softc *sc = device_private(dev);
    605      1.1  jakllsch 	device_printf(dev, "%s\n", __func__);
    606      1.1  jakllsch 	fdtbus_intr_disestablish(sc->sc_phsc.sc_phandle, ih);
    607      1.1  jakllsch }
    608      1.1  jakllsch 
    609      1.1  jakllsch static bool
    610      1.1  jakllsch rkpcie_intx_intrstr(device_t dev, u_int *specifier, char *buf, size_t buflen)
    611      1.1  jakllsch {
    612      1.1  jakllsch 	struct rkpcie_softc *sc = device_private(dev);
    613      1.1  jakllsch 
    614      1.1  jakllsch 	fdtbus_intr_str(sc->sc_phsc.sc_phandle, 1, buf, buflen);
    615      1.1  jakllsch 
    616      1.1  jakllsch 	return true;
    617      1.1  jakllsch }
    618      1.1  jakllsch 
    619      1.1  jakllsch static struct fdtbus_interrupt_controller_func rkpcie_intrfuncs = {
    620      1.1  jakllsch 	.establish = rkpcie_intx_establish,
    621      1.1  jakllsch 	.disestablish = rkpcie_intx_disestablish,
    622      1.1  jakllsch 	.intrstr = rkpcie_intx_intrstr,
    623      1.1  jakllsch };
    624