Home | History | Annotate | Line # | Download | only in nvidia
tegra_pcie.c revision 1.21
      1  1.21  jmcneill /* $NetBSD: tegra_pcie.c,v 1.21 2017/09/26 16:12:45 jmcneill Exp $ */
      2   1.1  jmcneill 
      3   1.1  jmcneill /*-
      4   1.1  jmcneill  * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca>
      5   1.1  jmcneill  * All rights reserved.
      6   1.1  jmcneill  *
      7   1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8   1.1  jmcneill  * modification, are permitted provided that the following conditions
      9   1.1  jmcneill  * are met:
     10   1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12   1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15   1.1  jmcneill  *
     16   1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17   1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18   1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19   1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20   1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21   1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22   1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23   1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24   1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25   1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26   1.1  jmcneill  * SUCH DAMAGE.
     27   1.1  jmcneill  */
     28   1.1  jmcneill 
     29   1.1  jmcneill #include <sys/cdefs.h>
     30  1.21  jmcneill __KERNEL_RCSID(0, "$NetBSD: tegra_pcie.c,v 1.21 2017/09/26 16:12:45 jmcneill Exp $");
     31   1.1  jmcneill 
     32   1.1  jmcneill #include <sys/param.h>
     33   1.1  jmcneill #include <sys/bus.h>
     34   1.1  jmcneill #include <sys/device.h>
     35   1.1  jmcneill #include <sys/intr.h>
     36   1.1  jmcneill #include <sys/systm.h>
     37   1.1  jmcneill #include <sys/kernel.h>
     38   1.1  jmcneill #include <sys/extent.h>
     39   1.1  jmcneill #include <sys/queue.h>
     40   1.1  jmcneill #include <sys/mutex.h>
     41   1.1  jmcneill #include <sys/kmem.h>
     42   1.1  jmcneill 
     43   1.1  jmcneill #include <arm/cpufunc.h>
     44   1.1  jmcneill 
     45   1.1  jmcneill #include <dev/pci/pcireg.h>
     46   1.1  jmcneill #include <dev/pci/pcivar.h>
     47   1.1  jmcneill #include <dev/pci/pciconf.h>
     48   1.1  jmcneill 
     49   1.1  jmcneill #include <arm/nvidia/tegra_reg.h>
     50   1.1  jmcneill #include <arm/nvidia/tegra_pciereg.h>
     51  1.21  jmcneill #include <arm/nvidia/tegra_pmcreg.h>
     52   1.1  jmcneill #include <arm/nvidia/tegra_var.h>
     53   1.1  jmcneill 
     54  1.14  jmcneill #include <dev/fdt/fdtvar.h>
     55  1.14  jmcneill 
     56  1.17  jmcneill /* Interrupt handle flags */
     57  1.17  jmcneill #define	IH_MPSAFE	0x80000000
     58  1.17  jmcneill 
     59   1.1  jmcneill static int	tegra_pcie_match(device_t, cfdata_t, void *);
     60   1.1  jmcneill static void	tegra_pcie_attach(device_t, device_t, void *);
     61   1.1  jmcneill 
     62  1.12  jakllsch #define TEGRA_PCIE_NBUS 256
     63  1.12  jakllsch #define TEGRA_PCIE_ECFB (1<<(12 - 8))	/* extended conf frags per bus */
     64  1.12  jakllsch 
     65   1.1  jmcneill struct tegra_pcie_ih {
     66   1.1  jmcneill 	int			(*ih_callback)(void *);
     67   1.1  jmcneill 	void			*ih_arg;
     68   1.1  jmcneill 	int			ih_ipl;
     69  1.16  jmcneill 	int			ih_mpsafe;
     70   1.1  jmcneill 	TAILQ_ENTRY(tegra_pcie_ih) ih_entry;
     71   1.1  jmcneill };
     72   1.1  jmcneill 
     73   1.1  jmcneill struct tegra_pcie_softc {
     74   1.1  jmcneill 	device_t		sc_dev;
     75   1.1  jmcneill 	bus_dma_tag_t		sc_dmat;
     76   1.1  jmcneill 	bus_space_tag_t		sc_bst;
     77   1.1  jmcneill 	bus_space_handle_t	sc_bsh_afi;
     78  1.21  jmcneill 	bus_space_handle_t	sc_bsh_pads;
     79   1.9  jakllsch 	bus_space_handle_t	sc_bsh_rpconf;
     80  1.14  jmcneill 	int			sc_phandle;
     81   1.1  jmcneill 
     82   1.1  jmcneill 	struct arm32_pci_chipset sc_pc;
     83   1.1  jmcneill 
     84   1.1  jmcneill 	void			*sc_ih;
     85   1.1  jmcneill 
     86   1.1  jmcneill 	kmutex_t		sc_lock;
     87   1.1  jmcneill 
     88   1.1  jmcneill 	TAILQ_HEAD(, tegra_pcie_ih) sc_intrs;
     89   1.1  jmcneill 	u_int			sc_intrgen;
     90  1.12  jakllsch 
     91  1.12  jakllsch 	bus_space_handle_t	sc_bsh_extc[TEGRA_PCIE_NBUS-1][TEGRA_PCIE_ECFB];
     92   1.1  jmcneill };
     93   1.1  jmcneill 
     94   1.1  jmcneill static int	tegra_pcie_intr(void *);
     95   1.1  jmcneill static void	tegra_pcie_init(pci_chipset_tag_t, void *);
     96   1.1  jmcneill static void	tegra_pcie_enable(struct tegra_pcie_softc *);
     97  1.21  jmcneill static void	tegra_pcie_enable_ports(struct tegra_pcie_softc *);
     98  1.20  jmcneill static void	tegra_pcie_enable_clocks(struct tegra_pcie_softc *);
     99  1.10  jakllsch static void	tegra_pcie_setup(struct tegra_pcie_softc * const);
    100  1.12  jakllsch static void	tegra_pcie_conf_frag_map(struct tegra_pcie_softc * const,
    101  1.12  jakllsch 					 uint, uint);
    102  1.12  jakllsch static void	tegra_pcie_conf_map_bus(struct tegra_pcie_softc * const, uint);
    103  1.12  jakllsch static void	tegra_pcie_conf_map_buses(struct tegra_pcie_softc * const);
    104   1.1  jmcneill 
    105   1.1  jmcneill static void	tegra_pcie_attach_hook(device_t, device_t,
    106   1.1  jmcneill 				       struct pcibus_attach_args *);
    107   1.1  jmcneill static int	tegra_pcie_bus_maxdevs(void *, int);
    108   1.1  jmcneill static pcitag_t	tegra_pcie_make_tag(void *, int, int, int);
    109   1.1  jmcneill static void	tegra_pcie_decompose_tag(void *, pcitag_t, int *, int *, int *);
    110   1.1  jmcneill static pcireg_t	tegra_pcie_conf_read(void *, pcitag_t, int);
    111   1.1  jmcneill static void	tegra_pcie_conf_write(void *, pcitag_t, int, pcireg_t);
    112   1.1  jmcneill static int	tegra_pcie_conf_hook(void *, int, int, int, pcireg_t);
    113   1.1  jmcneill static void	tegra_pcie_conf_interrupt(void *, int, int, int, int, int *);
    114   1.1  jmcneill 
    115   1.1  jmcneill static int	tegra_pcie_intr_map(const struct pci_attach_args *,
    116   1.1  jmcneill 				    pci_intr_handle_t *);
    117   1.1  jmcneill static const char *tegra_pcie_intr_string(void *, pci_intr_handle_t,
    118   1.1  jmcneill 					  char *, size_t);
    119   1.1  jmcneill const struct evcnt *tegra_pcie_intr_evcnt(void *, pci_intr_handle_t);
    120  1.16  jmcneill static int	tegra_pcie_intr_setattr(void *, pci_intr_handle_t *, int,
    121  1.16  jmcneill 					uint64_t);
    122   1.1  jmcneill static void *	tegra_pcie_intr_establish(void *, pci_intr_handle_t,
    123   1.1  jmcneill 					 int, int (*)(void *), void *);
    124   1.1  jmcneill static void	tegra_pcie_intr_disestablish(void *, void *);
    125   1.1  jmcneill 
    126   1.1  jmcneill CFATTACH_DECL_NEW(tegra_pcie, sizeof(struct tegra_pcie_softc),
    127   1.1  jmcneill 	tegra_pcie_match, tegra_pcie_attach, NULL, NULL);
    128   1.1  jmcneill 
    129   1.1  jmcneill static int
    130   1.1  jmcneill tegra_pcie_match(device_t parent, cfdata_t cf, void *aux)
    131   1.1  jmcneill {
    132  1.18  jmcneill 	const char * const compatible[] = {
    133  1.18  jmcneill 		"nvidia,tegra210-pcie",
    134  1.18  jmcneill 		"nvidia,tegra124-pcie",
    135  1.18  jmcneill 		NULL
    136  1.18  jmcneill 	};
    137  1.14  jmcneill 	struct fdt_attach_args * const faa = aux;
    138  1.14  jmcneill 
    139  1.14  jmcneill 	return of_match_compatible(faa->faa_phandle, compatible);
    140   1.1  jmcneill }
    141   1.1  jmcneill 
    142   1.1  jmcneill static void
    143   1.1  jmcneill tegra_pcie_attach(device_t parent, device_t self, void *aux)
    144   1.1  jmcneill {
    145   1.1  jmcneill 	struct tegra_pcie_softc * const sc = device_private(self);
    146  1.14  jmcneill 	struct fdt_attach_args * const faa = aux;
    147  1.10  jakllsch 	struct extent *ioext, *memext, *pmemext;
    148   1.1  jmcneill 	struct pcibus_attach_args pba;
    149  1.21  jmcneill 	bus_addr_t afi_addr, cs_addr, pads_addr;
    150  1.21  jmcneill 	bus_size_t afi_size, cs_size, pads_size;
    151  1.14  jmcneill 	char intrstr[128];
    152   1.1  jmcneill 	int error;
    153   1.1  jmcneill 
    154  1.21  jmcneill 	if (fdtbus_get_reg_byname(faa->faa_phandle, "afi", &afi_addr, &afi_size) != 0) {
    155  1.14  jmcneill 		aprint_error(": couldn't get afi registers\n");
    156  1.14  jmcneill 		return;
    157  1.14  jmcneill 	}
    158  1.21  jmcneill 	if (fdtbus_get_reg_byname(faa->faa_phandle, "pads", &pads_addr, &pads_size) != 0) {
    159  1.21  jmcneill 		aprint_error(": couldn't get pads registers\n");
    160  1.21  jmcneill 		return;
    161  1.21  jmcneill 	}
    162  1.14  jmcneill #if notyet
    163  1.14  jmcneill 	if (fdtbus_get_reg(faa->faa_phandle, 2, &cs_addr, &cs_size) != 0) {
    164  1.14  jmcneill 		aprint_error(": couldn't get cs registers\n");
    165  1.14  jmcneill 		return;
    166  1.14  jmcneill 	}
    167  1.14  jmcneill #else
    168  1.14  jmcneill 	cs_addr = TEGRA_PCIE_RPCONF_BASE;
    169  1.14  jmcneill 	cs_size = TEGRA_PCIE_RPCONF_SIZE;
    170  1.14  jmcneill #endif
    171  1.14  jmcneill 
    172   1.1  jmcneill 	sc->sc_dev = self;
    173  1.14  jmcneill 	sc->sc_dmat = faa->faa_dmat;
    174  1.14  jmcneill 	sc->sc_bst = faa->faa_bst;
    175  1.14  jmcneill 	sc->sc_phandle = faa->faa_phandle;
    176  1.14  jmcneill 	error = bus_space_map(sc->sc_bst, afi_addr, afi_size, 0,
    177  1.14  jmcneill 	    &sc->sc_bsh_afi);
    178  1.14  jmcneill 	if (error) {
    179  1.14  jmcneill 		aprint_error(": couldn't map afi registers: %d\n", error);
    180  1.14  jmcneill 		return;
    181  1.14  jmcneill 	}
    182  1.21  jmcneill 	error = bus_space_map(sc->sc_bst, pads_addr, pads_size, 0,
    183  1.21  jmcneill 	    &sc->sc_bsh_pads);
    184  1.21  jmcneill 	if (error) {
    185  1.21  jmcneill 		aprint_error(": couldn't map afi registers: %d\n", error);
    186  1.21  jmcneill 		return;
    187  1.21  jmcneill 	}
    188  1.14  jmcneill 	error = bus_space_map(sc->sc_bst, cs_addr, cs_size, 0,
    189  1.14  jmcneill 	    &sc->sc_bsh_rpconf);
    190  1.14  jmcneill 	if (error) {
    191  1.14  jmcneill 		aprint_error(": couldn't map cs registers: %d\n", error);
    192  1.14  jmcneill 		return;
    193  1.14  jmcneill 	}
    194  1.14  jmcneill 
    195  1.12  jakllsch 	tegra_pcie_conf_map_buses(sc);
    196   1.1  jmcneill 
    197   1.1  jmcneill 	TAILQ_INIT(&sc->sc_intrs);
    198   1.1  jmcneill 	mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_VM);
    199   1.1  jmcneill 
    200   1.1  jmcneill 	aprint_naive("\n");
    201   1.1  jmcneill 	aprint_normal(": PCIE\n");
    202   1.1  jmcneill 
    203  1.21  jmcneill 	tegra_pmc_power(PMC_PARTID_PCX, true);
    204  1.21  jmcneill 	tegra_pmc_remove_clamping(PMC_PARTID_PCX);
    205  1.21  jmcneill 
    206  1.20  jmcneill 	tegra_pcie_enable_clocks(sc);
    207  1.20  jmcneill 
    208  1.14  jmcneill 	if (!fdtbus_intr_str(faa->faa_phandle, 0, intrstr, sizeof(intrstr))) {
    209  1.14  jmcneill 		aprint_error_dev(self, "failed to decode interrupt\n");
    210  1.14  jmcneill 		return;
    211  1.14  jmcneill 	}
    212  1.14  jmcneill 
    213  1.16  jmcneill 	sc->sc_ih = fdtbus_intr_establish(faa->faa_phandle, 0, IPL_VM,
    214  1.16  jmcneill 	    FDT_INTR_MPSAFE, tegra_pcie_intr, sc);
    215   1.1  jmcneill 	if (sc->sc_ih == NULL) {
    216  1.14  jmcneill 		aprint_error_dev(self, "failed to establish interrupt on %s\n",
    217  1.14  jmcneill 		    intrstr);
    218   1.1  jmcneill 		return;
    219   1.1  jmcneill 	}
    220  1.14  jmcneill 	aprint_normal_dev(self, "interrupting on %s\n", intrstr);
    221   1.1  jmcneill 
    222  1.10  jakllsch 	tegra_pcie_setup(sc);
    223  1.10  jakllsch 
    224   1.1  jmcneill 	tegra_pcie_init(&sc->sc_pc, sc);
    225   1.1  jmcneill 
    226  1.10  jakllsch 	ioext = extent_create("pciio", TEGRA_PCIE_IO_BASE,
    227  1.10  jakllsch 	    TEGRA_PCIE_IO_BASE + TEGRA_PCIE_IO_SIZE - 1,
    228  1.10  jakllsch 	    NULL, 0, EX_NOWAIT);
    229   1.1  jmcneill 	memext = extent_create("pcimem", TEGRA_PCIE_MEM_BASE,
    230   1.1  jmcneill 	    TEGRA_PCIE_MEM_BASE + TEGRA_PCIE_MEM_SIZE - 1,
    231   1.1  jmcneill 	    NULL, 0, EX_NOWAIT);
    232   1.1  jmcneill 	pmemext = extent_create("pcipmem", TEGRA_PCIE_PMEM_BASE,
    233   1.1  jmcneill 	    TEGRA_PCIE_PMEM_BASE + TEGRA_PCIE_PMEM_SIZE - 1,
    234   1.1  jmcneill 	    NULL, 0, EX_NOWAIT);
    235   1.1  jmcneill 
    236  1.10  jakllsch 	error = pci_configure_bus(&sc->sc_pc, ioext, memext, pmemext, 0,
    237   1.1  jmcneill 	    arm_dcache_align);
    238   1.1  jmcneill 
    239  1.10  jakllsch 	extent_destroy(ioext);
    240   1.1  jmcneill 	extent_destroy(memext);
    241   1.1  jmcneill 	extent_destroy(pmemext);
    242   1.1  jmcneill 
    243   1.1  jmcneill 	if (error) {
    244   1.1  jmcneill 		aprint_error_dev(self, "configuration failed (%d)\n",
    245   1.1  jmcneill 		    error);
    246   1.1  jmcneill 		return;
    247   1.1  jmcneill 	}
    248   1.1  jmcneill 
    249   1.1  jmcneill 	tegra_pcie_enable(sc);
    250   1.1  jmcneill 
    251  1.21  jmcneill 	tegra_pcie_enable_ports(sc);
    252  1.21  jmcneill 
    253   1.1  jmcneill 	memset(&pba, 0, sizeof(pba));
    254   1.1  jmcneill 	pba.pba_flags = PCI_FLAGS_MRL_OKAY |
    255   1.1  jmcneill 			PCI_FLAGS_MRM_OKAY |
    256   1.1  jmcneill 			PCI_FLAGS_MWI_OKAY |
    257  1.10  jakllsch 			PCI_FLAGS_MEM_OKAY |
    258  1.10  jakllsch 			PCI_FLAGS_IO_OKAY;
    259  1.10  jakllsch 	pba.pba_iot = sc->sc_bst;
    260   1.1  jmcneill 	pba.pba_memt = sc->sc_bst;
    261   1.1  jmcneill 	pba.pba_dmat = sc->sc_dmat;
    262   1.1  jmcneill 	pba.pba_pc = &sc->sc_pc;
    263   1.1  jmcneill 	pba.pba_bus = 0;
    264   1.1  jmcneill 
    265   1.1  jmcneill 	config_found_ia(self, "pcibus", &pba, pcibusprint);
    266   1.1  jmcneill }
    267   1.1  jmcneill 
    268   1.1  jmcneill static int
    269   1.4  jmcneill tegra_pcie_legacy_intr(struct tegra_pcie_softc *sc)
    270   1.1  jmcneill {
    271   1.4  jmcneill 	const uint32_t msg = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi,
    272   1.4  jmcneill 	    AFI_MSG_REG);
    273   1.1  jmcneill 	struct tegra_pcie_ih *pcie_ih;
    274   1.4  jmcneill 	int rv = 0;
    275   1.1  jmcneill 
    276   1.4  jmcneill 	if (msg & (AFI_MSG_INT0|AFI_MSG_INT1)) {
    277   1.1  jmcneill 		mutex_enter(&sc->sc_lock);
    278   1.1  jmcneill 		const u_int lastgen = sc->sc_intrgen;
    279   1.1  jmcneill 		TAILQ_FOREACH(pcie_ih, &sc->sc_intrs, ih_entry) {
    280   1.1  jmcneill 			int (*callback)(void *) = pcie_ih->ih_callback;
    281   1.1  jmcneill 			void *arg = pcie_ih->ih_arg;
    282  1.16  jmcneill 			const int mpsafe = pcie_ih->ih_mpsafe;
    283   1.1  jmcneill 			mutex_exit(&sc->sc_lock);
    284  1.16  jmcneill 
    285  1.16  jmcneill 			if (!mpsafe)
    286  1.16  jmcneill 				KERNEL_LOCK(1, curlwp);
    287   1.4  jmcneill 			rv += callback(arg);
    288  1.16  jmcneill 			if (!mpsafe)
    289  1.16  jmcneill 				KERNEL_UNLOCK_ONE(curlwp);
    290  1.16  jmcneill 
    291   1.1  jmcneill 			mutex_enter(&sc->sc_lock);
    292   1.1  jmcneill 			if (lastgen != sc->sc_intrgen)
    293   1.1  jmcneill 				break;
    294   1.1  jmcneill 		}
    295   1.1  jmcneill 		mutex_exit(&sc->sc_lock);
    296   1.4  jmcneill 	} else if (msg & (AFI_MSG_PM_PME0|AFI_MSG_PM_PME1)) {
    297   1.4  jmcneill 		device_printf(sc->sc_dev, "PM PME message; AFI_MSG=%08x\n",
    298   1.4  jmcneill 		    msg);
    299   1.4  jmcneill 	} else {
    300   1.4  jmcneill 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_MSG_REG, msg);
    301   1.4  jmcneill 		rv = 1;
    302   1.4  jmcneill 	}
    303   1.4  jmcneill 
    304   1.4  jmcneill 	return rv;
    305   1.4  jmcneill }
    306   1.4  jmcneill 
    307   1.4  jmcneill static int
    308   1.4  jmcneill tegra_pcie_intr(void *priv)
    309   1.4  jmcneill {
    310   1.4  jmcneill 	struct tegra_pcie_softc *sc = priv;
    311  1.11  jakllsch 	int rv;
    312   1.4  jmcneill 
    313   1.4  jmcneill 	const uint32_t code = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi,
    314   1.4  jmcneill 	    AFI_INTR_CODE_REG);
    315   1.4  jmcneill 	const uint32_t sig = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi,
    316   1.4  jmcneill 	    AFI_INTR_SIGNATURE_REG);
    317   1.4  jmcneill 
    318   1.4  jmcneill 	switch (__SHIFTOUT(code, AFI_INTR_CODE_INT_CODE)) {
    319   1.4  jmcneill 	case AFI_INTR_CODE_SM_MSG:
    320  1.11  jakllsch 		rv = tegra_pcie_legacy_intr(sc);
    321  1.11  jakllsch 		break;
    322   1.1  jmcneill 	default:
    323   1.1  jmcneill 		device_printf(sc->sc_dev, "intr: code %#x sig %#x\n",
    324   1.1  jmcneill 		    code, sig);
    325  1.11  jakllsch 		rv = 1;
    326  1.11  jakllsch 		break;
    327   1.1  jmcneill 	}
    328  1.11  jakllsch 
    329  1.11  jakllsch 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_INTR_CODE_REG, 0);
    330  1.11  jakllsch 
    331  1.11  jakllsch 	return rv;
    332   1.1  jmcneill }
    333   1.1  jmcneill 
    334   1.1  jmcneill static void
    335  1.20  jmcneill tegra_pcie_enable_clocks(struct tegra_pcie_softc * const sc)
    336  1.20  jmcneill {
    337  1.20  jmcneill 	const char *clock_names[] = { "pex", "afi", "pll_e", "cml" };
    338  1.20  jmcneill 	const char *reset_names[] = { "pex", "afi", "pcie_x" };
    339  1.20  jmcneill 	struct fdtbus_reset *rst;
    340  1.20  jmcneill 	struct clk *clk;
    341  1.20  jmcneill 	int n;
    342  1.20  jmcneill 
    343  1.20  jmcneill 	for (n = 0; n < __arraycount(clock_names); n++) {
    344  1.20  jmcneill 		clk = fdtbus_clock_get(sc->sc_phandle, clock_names[n]);
    345  1.20  jmcneill 		if (clk == NULL || clk_enable(clk) != 0)
    346  1.20  jmcneill 			aprint_error_dev(sc->sc_dev, "couldn't enable clock %s\n",
    347  1.20  jmcneill 			    clock_names[n]);
    348  1.20  jmcneill 	}
    349  1.20  jmcneill 
    350  1.20  jmcneill 	for (n = 0; n < __arraycount(reset_names); n++) {
    351  1.20  jmcneill 		rst = fdtbus_reset_get(sc->sc_phandle, reset_names[n]);
    352  1.20  jmcneill 		if (rst == NULL || fdtbus_reset_deassert(rst) != 0)
    353  1.20  jmcneill 			aprint_error_dev(sc->sc_dev, "couldn't de-assert reset %s\n",
    354  1.20  jmcneill 			    reset_names[n]);
    355  1.20  jmcneill 	}
    356  1.20  jmcneill }
    357  1.20  jmcneill 
    358  1.20  jmcneill static void
    359  1.21  jmcneill tegra_pcie_reset_port(struct tegra_pcie_softc * const sc, int index)
    360  1.21  jmcneill {
    361  1.21  jmcneill 	uint32_t val;
    362  1.21  jmcneill 
    363  1.21  jmcneill 	val = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index));
    364  1.21  jmcneill 	val &= ~AFI_PEXn_CTRL_RST_L;
    365  1.21  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index), val);
    366  1.21  jmcneill 
    367  1.21  jmcneill 	delay(2000);
    368  1.21  jmcneill 
    369  1.21  jmcneill 	val = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index));
    370  1.21  jmcneill 	val |= AFI_PEXn_CTRL_RST_L;
    371  1.21  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index), val);
    372  1.21  jmcneill }
    373  1.21  jmcneill 
    374  1.21  jmcneill static void
    375  1.21  jmcneill tegra_pcie_enable_ports(struct tegra_pcie_softc * const sc)
    376  1.21  jmcneill {
    377  1.21  jmcneill 	const u_int *data;
    378  1.21  jmcneill 	int child, len;
    379  1.21  jmcneill 	uint32_t val;
    380  1.21  jmcneill 
    381  1.21  jmcneill 	for (child = OF_child(sc->sc_phandle); child; child = OF_peer(child)) {
    382  1.21  jmcneill 		if (!fdtbus_status_okay(child))
    383  1.21  jmcneill 			continue;
    384  1.21  jmcneill 		data = fdtbus_get_prop(child, "reg", &len);
    385  1.21  jmcneill 		if (data == NULL || len < 4)
    386  1.21  jmcneill 			continue;
    387  1.21  jmcneill 		const u_int index = ((be32toh(data[0]) >> 11) & 0x1f) - 1;
    388  1.21  jmcneill 
    389  1.21  jmcneill 		val = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index));
    390  1.21  jmcneill 		val |= AFI_PEXn_CTRL_CLKREQ_EN;
    391  1.21  jmcneill 		val |= AFI_PEXn_CTRL_REFCLK_EN;
    392  1.21  jmcneill 		val |= AFI_PEXn_CTRL_REFCLK_OVERRIDE_EN;
    393  1.21  jmcneill 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXn_CTRL_REG(index), val);
    394  1.21  jmcneill 
    395  1.21  jmcneill 		tegra_pcie_reset_port(sc, index);
    396  1.21  jmcneill 	}
    397  1.21  jmcneill }
    398  1.21  jmcneill 
    399  1.21  jmcneill static void
    400  1.10  jakllsch tegra_pcie_setup(struct tegra_pcie_softc * const sc)
    401  1.10  jakllsch {
    402  1.21  jmcneill 	uint32_t val, cfg, lanes;
    403  1.21  jmcneill 	int child, len;
    404  1.21  jmcneill 	const u_int *data;
    405  1.10  jakllsch 	size_t i;
    406  1.10  jakllsch 
    407  1.21  jmcneill 	/* Enable PLLE control */
    408  1.21  jmcneill 	val = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PLLE_CONTROL_REG);
    409  1.21  jmcneill 	val &= ~AFI_PLLE_CONTROL_BYPASS_PADS2PLLE_CONTROL;
    410  1.21  jmcneill 	val |= AFI_PLLE_CONTROL_PADS2PLLE_CONTROL_EN;
    411  1.21  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PLLE_CONTROL_REG, val);
    412  1.21  jmcneill 
    413  1.21  jmcneill 	/* Disable PEX clock bias pad power down */
    414  1.21  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PEXBIAS_CTRL_REG, 0);
    415  1.21  jmcneill 
    416  1.21  jmcneill 	/* Configure PCIE mode and enable ports */
    417  1.21  jmcneill 	cfg = bus_space_read_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PCIE_CONFIG_REG);
    418  1.21  jmcneill 	cfg |= AFI_PCIE_CONFIG_PCIECn_DISABLE_DEVICE(0);
    419  1.21  jmcneill 	cfg |= AFI_PCIE_CONFIG_PCIECn_DISABLE_DEVICE(1);
    420  1.21  jmcneill 	cfg &= ~AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG;
    421  1.21  jmcneill 
    422  1.21  jmcneill 	lanes = 0;
    423  1.21  jmcneill 	for (child = OF_child(sc->sc_phandle); child; child = OF_peer(child)) {
    424  1.21  jmcneill 		if (!fdtbus_status_okay(child))
    425  1.21  jmcneill 			continue;
    426  1.21  jmcneill 		data = fdtbus_get_prop(child, "reg", &len);
    427  1.21  jmcneill 		if (data == NULL || len < 4)
    428  1.21  jmcneill 			continue;
    429  1.21  jmcneill 		const u_int index = ((be32toh(data[0]) >> 11) & 0x1f) - 1;
    430  1.21  jmcneill 		if (of_getprop_uint32(child, "nvidia,num-lanes", &val) != 0)
    431  1.21  jmcneill 			continue;
    432  1.21  jmcneill 		lanes |= (val << (index << 3));
    433  1.21  jmcneill 		cfg &= ~AFI_PCIE_CONFIG_PCIECn_DISABLE_DEVICE(index);
    434  1.21  jmcneill 	}
    435  1.21  jmcneill 
    436  1.21  jmcneill 	switch (lanes) {
    437  1.21  jmcneill 	case 0x0104:
    438  1.21  jmcneill 		aprint_normal_dev(sc->sc_dev, "lane config: x4 x1\n");
    439  1.21  jmcneill 		cfg |= __SHIFTIN(AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_4_1,
    440  1.21  jmcneill 				 AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG);
    441  1.21  jmcneill 		break;
    442  1.21  jmcneill 	case 0x0102:
    443  1.21  jmcneill 		aprint_normal_dev(sc->sc_dev, "lane config: x2 x1\n");
    444  1.21  jmcneill 		cfg |= __SHIFTIN(AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_2_1,
    445  1.21  jmcneill 				 AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG);
    446  1.21  jmcneill 		break;
    447  1.21  jmcneill 	}
    448  1.21  jmcneill 
    449  1.21  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_PCIE_CONFIG_REG, cfg);
    450  1.21  jmcneill 
    451  1.21  jmcneill 	/* Configure refclk pad */
    452  1.21  jmcneill 	const char * const tegra124_compat[] = { "nvidia,tegra124-pcie", NULL };
    453  1.21  jmcneill 	if (of_match_compatible(sc->sc_phandle, tegra124_compat))
    454  1.21  jmcneill 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_pads, PADS_REFCLK_CFG0_REG,
    455  1.21  jmcneill 		    0x44ac44ac);
    456  1.21  jmcneill 	const char * const tegra210_compat[] = { "nvidia,tegra210-pcie", NULL };
    457  1.21  jmcneill 	if (of_match_compatible(sc->sc_phandle, tegra210_compat))
    458  1.21  jmcneill 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_pads, PADS_REFCLK_CFG0_REG,
    459  1.21  jmcneill 		    0x90b890b8);
    460  1.21  jmcneill 
    461  1.10  jakllsch 	/*
    462  1.10  jakllsch 	 * Map PCI address spaces into ARM address space via
    463  1.10  jakllsch 	 * HyperTransport-like "FPCI".
    464  1.10  jakllsch 	 */
    465  1.10  jakllsch 	static const struct { uint32_t size, base, fpci; } pcie_init_table[] = {
    466  1.10  jakllsch 		/*
    467  1.10  jakllsch 		 * === BEWARE ===
    468  1.10  jakllsch 		 *
    469  1.10  jakllsch 		 * We depend on our TEGRA_PCIE_IO window overlaping the
    470  1.10  jakllsch 		 * TEGRA_PCIE_A1 window to allow us to use the same
    471  1.10  jakllsch 		 * bus_space_tag for both PCI IO and Memory spaces.
    472  1.10  jakllsch 		 *
    473  1.10  jakllsch 		 * 0xfdfc000000-0xfdfdffffff is the FPCI/HyperTransport
    474  1.10  jakllsch 		 * mapping for 0x0000000-0x1ffffff of PCI IO space.
    475  1.10  jakllsch 		 */
    476  1.10  jakllsch 		{ TEGRA_PCIE_IO_SIZE >> 12, TEGRA_PCIE_IO_BASE,
    477  1.10  jakllsch 		  (0xfdfc000000 + TEGRA_PCIE_IO_BASE) >> 8 | 0, },
    478  1.10  jakllsch 
    479  1.10  jakllsch 		/* HyperTransport Technology Type 1 Address Format */
    480  1.10  jakllsch 		{ TEGRA_PCIE_CONF_SIZE >> 12, TEGRA_PCIE_CONF_BASE,
    481  1.10  jakllsch 		  0xfdff000000 >> 8 | 0, },
    482  1.10  jakllsch 
    483  1.10  jakllsch 		/* 1:1 MMIO mapping */
    484  1.10  jakllsch 		{ TEGRA_PCIE_MEM_SIZE >> 12, TEGRA_PCIE_MEM_BASE,
    485  1.10  jakllsch 		  TEGRA_PCIE_MEM_BASE >> 8 | 1, },
    486  1.10  jakllsch 
    487  1.10  jakllsch 		/* Extended HyperTransport Technology Type 1 Address Format */
    488  1.10  jakllsch 		{ TEGRA_PCIE_EXTC_SIZE >> 12, TEGRA_PCIE_EXTC_BASE,
    489  1.10  jakllsch 		  0xfe10000000 >> 8 | 0, },
    490  1.10  jakllsch 
    491  1.10  jakllsch 		/* 1:1 prefetchable MMIO mapping */
    492  1.10  jakllsch 		{ TEGRA_PCIE_PMEM_SIZE >> 12, TEGRA_PCIE_PMEM_BASE,
    493  1.10  jakllsch 		  TEGRA_PCIE_PMEM_BASE >> 8 | 1, },
    494  1.10  jakllsch 	};
    495  1.10  jakllsch 
    496  1.10  jakllsch 	for (i = 0; i < AFI_AXI_NBAR; i++) {
    497  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    498  1.10  jakllsch 		    AFI_AXI_BARi_SZ(i), 0);
    499  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    500  1.10  jakllsch 		    AFI_AXI_BARi_START(i), 0);
    501  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    502  1.10  jakllsch 		    AFI_FPCI_BARi(i), 0);
    503  1.10  jakllsch 	}
    504  1.10  jakllsch 
    505  1.10  jakllsch 	for (i = 0; i < __arraycount(pcie_init_table); i++) {
    506  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    507  1.10  jakllsch 		    AFI_AXI_BARi_START(i), pcie_init_table[i].base);
    508  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    509  1.10  jakllsch 		    AFI_FPCI_BARi(i), pcie_init_table[i].fpci);
    510  1.10  jakllsch 		bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    511  1.10  jakllsch 		    AFI_AXI_BARi_SZ(i), pcie_init_table[i].size);
    512  1.10  jakllsch 	}
    513  1.10  jakllsch }
    514  1.10  jakllsch 
    515  1.10  jakllsch static void
    516   1.1  jmcneill tegra_pcie_enable(struct tegra_pcie_softc *sc)
    517   1.1  jmcneill {
    518   1.4  jmcneill 	/* disable MSI */
    519   1.4  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    520   1.4  jmcneill 	    AFI_MSI_BAR_SZ_REG, 0);
    521   1.4  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    522   1.4  jmcneill 	    AFI_MSI_FPCI_BAR_ST_REG, 0);
    523   1.4  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    524   1.4  jmcneill 	    AFI_MSI_AXI_BAR_ST_REG, 0);
    525   1.4  jmcneill 
    526   1.1  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    527   1.1  jmcneill 	    AFI_SM_INTR_ENABLE_REG, 0xffffffff);
    528   1.1  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    529   1.1  jmcneill 	    AFI_AFI_INTR_ENABLE_REG, 0);
    530   1.1  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi, AFI_INTR_CODE_REG, 0);
    531   1.1  jmcneill 	bus_space_write_4(sc->sc_bst, sc->sc_bsh_afi,
    532   1.1  jmcneill 	    AFI_INTR_MASK_REG, AFI_INTR_MASK_INT);
    533   1.1  jmcneill }
    534   1.1  jmcneill 
    535  1.12  jakllsch static void
    536  1.12  jakllsch tegra_pcie_conf_frag_map(struct tegra_pcie_softc * const sc, uint bus,
    537  1.12  jakllsch     uint frg)
    538  1.12  jakllsch {
    539  1.12  jakllsch 	bus_addr_t a;
    540  1.12  jakllsch 
    541  1.12  jakllsch 	KASSERT(bus >= 1);
    542  1.12  jakllsch 	KASSERT(bus < TEGRA_PCIE_NBUS);
    543  1.12  jakllsch 	KASSERT(frg < TEGRA_PCIE_ECFB);
    544  1.12  jakllsch 
    545  1.12  jakllsch 	if (sc->sc_bsh_extc[bus-1][frg] != 0) {
    546  1.12  jakllsch 		device_printf(sc->sc_dev, "bus %u fragment %#x already "
    547  1.12  jakllsch 		    "mapped\n", bus, frg);
    548  1.12  jakllsch 		return;
    549  1.12  jakllsch 	}
    550  1.12  jakllsch 
    551  1.12  jakllsch 	a = TEGRA_PCIE_EXTC_BASE + (bus << 16) + (frg << 24);
    552  1.12  jakllsch 	if (bus_space_map(sc->sc_bst, a, 1 << 16, 0,
    553  1.12  jakllsch 	    &sc->sc_bsh_extc[bus-1][frg]) != 0)
    554  1.12  jakllsch 		device_printf(sc->sc_dev, "couldn't map PCIE "
    555  1.12  jakllsch 		    "configuration for bus %u fragment %#x", bus, frg);
    556  1.12  jakllsch }
    557  1.12  jakllsch 
    558  1.12  jakllsch /* map non-non-extended configuration space for full bus range */
    559  1.12  jakllsch static void
    560  1.12  jakllsch tegra_pcie_conf_map_bus(struct tegra_pcie_softc * const sc, uint bus)
    561  1.12  jakllsch {
    562  1.12  jakllsch 	uint i;
    563  1.12  jakllsch 
    564  1.12  jakllsch 	for (i = 1; i < TEGRA_PCIE_ECFB; i++) {
    565  1.12  jakllsch 		tegra_pcie_conf_frag_map(sc, bus, i);
    566  1.12  jakllsch 	}
    567  1.12  jakllsch }
    568  1.12  jakllsch 
    569  1.12  jakllsch /* map non-extended configuration space for full bus range */
    570  1.12  jakllsch static void
    571  1.12  jakllsch tegra_pcie_conf_map_buses(struct tegra_pcie_softc * const sc)
    572  1.12  jakllsch {
    573  1.12  jakllsch 	uint b;
    574  1.12  jakllsch 
    575  1.12  jakllsch 	for (b = 1; b < TEGRA_PCIE_NBUS; b++) {
    576  1.12  jakllsch 		tegra_pcie_conf_frag_map(sc, b, 0);
    577  1.12  jakllsch 	}
    578  1.12  jakllsch }
    579  1.12  jakllsch 
    580   1.1  jmcneill void
    581   1.1  jmcneill tegra_pcie_init(pci_chipset_tag_t pc, void *priv)
    582   1.1  jmcneill {
    583   1.1  jmcneill 	pc->pc_conf_v = priv;
    584   1.1  jmcneill 	pc->pc_attach_hook = tegra_pcie_attach_hook;
    585   1.1  jmcneill 	pc->pc_bus_maxdevs = tegra_pcie_bus_maxdevs;
    586   1.1  jmcneill 	pc->pc_make_tag = tegra_pcie_make_tag;
    587   1.1  jmcneill 	pc->pc_decompose_tag = tegra_pcie_decompose_tag;
    588   1.1  jmcneill 	pc->pc_conf_read = tegra_pcie_conf_read;
    589   1.1  jmcneill 	pc->pc_conf_write = tegra_pcie_conf_write;
    590   1.1  jmcneill 	pc->pc_conf_hook = tegra_pcie_conf_hook;
    591   1.1  jmcneill 	pc->pc_conf_interrupt = tegra_pcie_conf_interrupt;
    592   1.1  jmcneill 
    593   1.1  jmcneill 	pc->pc_intr_v = priv;
    594   1.1  jmcneill 	pc->pc_intr_map = tegra_pcie_intr_map;
    595   1.1  jmcneill 	pc->pc_intr_string = tegra_pcie_intr_string;
    596   1.1  jmcneill 	pc->pc_intr_evcnt = tegra_pcie_intr_evcnt;
    597  1.16  jmcneill 	pc->pc_intr_setattr = tegra_pcie_intr_setattr;
    598   1.1  jmcneill 	pc->pc_intr_establish = tegra_pcie_intr_establish;
    599   1.1  jmcneill 	pc->pc_intr_disestablish = tegra_pcie_intr_disestablish;
    600   1.1  jmcneill }
    601   1.1  jmcneill 
    602   1.1  jmcneill static void
    603   1.1  jmcneill tegra_pcie_attach_hook(device_t parent, device_t self,
    604   1.1  jmcneill     struct pcibus_attach_args *pba)
    605   1.1  jmcneill {
    606  1.12  jakllsch 	const pci_chipset_tag_t pc = pba->pba_pc;
    607  1.12  jakllsch 	struct tegra_pcie_softc * const sc = pc->pc_conf_v;
    608  1.12  jakllsch 
    609  1.12  jakllsch 	if (pba->pba_bus >= 1) {
    610  1.12  jakllsch 		tegra_pcie_conf_map_bus(sc, pba->pba_bus);
    611  1.12  jakllsch 	}
    612   1.1  jmcneill }
    613   1.1  jmcneill 
    614   1.1  jmcneill static int
    615   1.1  jmcneill tegra_pcie_bus_maxdevs(void *v, int busno)
    616   1.1  jmcneill {
    617   1.1  jmcneill 	return busno == 0 ? 2 : 32;
    618   1.1  jmcneill }
    619   1.1  jmcneill 
    620   1.1  jmcneill static pcitag_t
    621   1.1  jmcneill tegra_pcie_make_tag(void *v, int b, int d, int f)
    622   1.1  jmcneill {
    623   1.1  jmcneill 	return (b << 16) | (d << 11) | (f << 8);
    624   1.1  jmcneill }
    625   1.1  jmcneill 
    626   1.1  jmcneill static void
    627   1.1  jmcneill tegra_pcie_decompose_tag(void *v, pcitag_t tag, int *bp, int *dp, int *fp)
    628   1.1  jmcneill {
    629   1.1  jmcneill 	if (bp)
    630   1.1  jmcneill 		*bp = (tag >> 16) & 0xff;
    631   1.1  jmcneill 	if (dp)
    632   1.1  jmcneill 		*dp = (tag >> 11) & 0x1f;
    633   1.1  jmcneill 	if (fp)
    634   1.1  jmcneill 		*fp = (tag >> 8) & 0x7;
    635   1.1  jmcneill }
    636   1.1  jmcneill 
    637   1.1  jmcneill static pcireg_t
    638   1.1  jmcneill tegra_pcie_conf_read(void *v, pcitag_t tag, int offset)
    639   1.1  jmcneill {
    640   1.1  jmcneill 	struct tegra_pcie_softc *sc = v;
    641   1.1  jmcneill 	bus_space_handle_t bsh;
    642   1.1  jmcneill 	int b, d, f;
    643   1.1  jmcneill 	u_int reg;
    644   1.1  jmcneill 
    645   1.3   msaitoh 	if ((unsigned int)offset >= PCI_EXTCONF_SIZE)
    646   1.3   msaitoh 		return (pcireg_t) -1;
    647   1.3   msaitoh 
    648   1.1  jmcneill 	tegra_pcie_decompose_tag(v, tag, &b, &d, &f);
    649   1.1  jmcneill 
    650  1.12  jakllsch 	if (b >= TEGRA_PCIE_NBUS)
    651  1.12  jakllsch 		return (pcireg_t) -1;
    652  1.12  jakllsch 
    653   1.1  jmcneill 	if (b == 0) {
    654   1.6  jakllsch 		if (d >= 2 || f != 0)
    655   1.6  jakllsch 			return (pcireg_t) -1;
    656   1.1  jmcneill 		reg = d * 0x1000 + offset;
    657   1.9  jakllsch 		bsh = sc->sc_bsh_rpconf;
    658   1.1  jmcneill 	} else {
    659  1.12  jakllsch 		reg = (d << 11) | (f << 8) | (offset & 0xff);
    660  1.12  jakllsch 		bsh = sc->sc_bsh_extc[b-1][(offset >> 8) & 0xf];
    661  1.12  jakllsch 		if (bsh == 0)
    662   1.7  jakllsch 			return (pcireg_t) -1;
    663   1.1  jmcneill 	}
    664   1.1  jmcneill 
    665   1.1  jmcneill 	return bus_space_read_4(sc->sc_bst, bsh, reg);
    666   1.1  jmcneill }
    667   1.1  jmcneill 
    668   1.1  jmcneill static void
    669   1.1  jmcneill tegra_pcie_conf_write(void *v, pcitag_t tag, int offset, pcireg_t val)
    670   1.1  jmcneill {
    671   1.1  jmcneill 	struct tegra_pcie_softc *sc = v;
    672   1.1  jmcneill 	bus_space_handle_t bsh;
    673   1.1  jmcneill 	int b, d, f;
    674   1.1  jmcneill 	u_int reg;
    675   1.1  jmcneill 
    676   1.3   msaitoh 	if ((unsigned int)offset >= PCI_EXTCONF_SIZE)
    677   1.3   msaitoh 		return;
    678   1.3   msaitoh 
    679   1.1  jmcneill 	tegra_pcie_decompose_tag(v, tag, &b, &d, &f);
    680   1.1  jmcneill 
    681  1.12  jakllsch 	if (b >= TEGRA_PCIE_NBUS)
    682  1.12  jakllsch 		return;
    683  1.12  jakllsch 
    684   1.1  jmcneill 	if (b == 0) {
    685   1.6  jakllsch 		if (d >= 2 || f != 0)
    686   1.6  jakllsch 			return;
    687   1.1  jmcneill 		reg = d * 0x1000 + offset;
    688   1.9  jakllsch 		bsh = sc->sc_bsh_rpconf;
    689   1.1  jmcneill 	} else {
    690  1.12  jakllsch 		reg = (d << 11) | (f << 8) | (offset & 0xff);
    691  1.12  jakllsch 		bsh = sc->sc_bsh_extc[b-1][(offset >> 8) & 0xf];
    692  1.12  jakllsch 		if (bsh == 0)
    693   1.7  jakllsch 			return;
    694   1.1  jmcneill 	}
    695   1.1  jmcneill 
    696   1.1  jmcneill 	bus_space_write_4(sc->sc_bst, bsh, reg, val);
    697   1.1  jmcneill }
    698   1.1  jmcneill 
    699   1.1  jmcneill static int
    700   1.1  jmcneill tegra_pcie_conf_hook(void *v, int b, int d, int f, pcireg_t id)
    701   1.1  jmcneill {
    702  1.15  jakllsch 	return PCI_CONF_DEFAULT & ~PCI_CONF_ENABLE_BM;
    703   1.1  jmcneill }
    704   1.1  jmcneill 
    705   1.1  jmcneill static void
    706   1.1  jmcneill tegra_pcie_conf_interrupt(void *v, int bus, int dev, int ipin, int swiz,
    707   1.1  jmcneill     int *ilinep)
    708   1.1  jmcneill {
    709  1.14  jmcneill 	*ilinep = 5;
    710   1.1  jmcneill }
    711   1.1  jmcneill 
    712   1.1  jmcneill static int
    713   1.1  jmcneill tegra_pcie_intr_map(const struct pci_attach_args *pa, pci_intr_handle_t *ih)
    714   1.1  jmcneill {
    715   1.1  jmcneill 	if (pa->pa_intrpin == 0)
    716   1.1  jmcneill 		return EINVAL;
    717   1.1  jmcneill 	*ih = pa->pa_intrpin;
    718   1.1  jmcneill 	return 0;
    719   1.1  jmcneill }
    720   1.5  jakllsch 
    721   1.1  jmcneill static const char *
    722   1.1  jmcneill tegra_pcie_intr_string(void *v, pci_intr_handle_t ih, char *buf, size_t len)
    723   1.1  jmcneill {
    724   1.1  jmcneill 	struct tegra_pcie_softc *sc = v;
    725   1.1  jmcneill 
    726   1.1  jmcneill 	if (ih == PCI_INTERRUPT_PIN_NONE)
    727   1.1  jmcneill 		return NULL;
    728   1.1  jmcneill 
    729  1.14  jmcneill 	if (!fdtbus_intr_str(sc->sc_phandle, 0, buf, len))
    730  1.14  jmcneill 		return NULL;
    731  1.14  jmcneill 
    732   1.1  jmcneill 	return buf;
    733   1.1  jmcneill }
    734   1.1  jmcneill 
    735   1.1  jmcneill const struct evcnt *
    736   1.1  jmcneill tegra_pcie_intr_evcnt(void *v, pci_intr_handle_t ih)
    737   1.1  jmcneill {
    738   1.1  jmcneill 	return NULL;
    739   1.1  jmcneill }
    740   1.1  jmcneill 
    741  1.16  jmcneill static int
    742  1.16  jmcneill tegra_pcie_intr_setattr(void *v, pci_intr_handle_t *ih, int attr, uint64_t data)
    743  1.16  jmcneill {
    744  1.16  jmcneill 	switch (attr) {
    745  1.16  jmcneill 	case PCI_INTR_MPSAFE:
    746  1.17  jmcneill 		if (data)
    747  1.17  jmcneill 			*ih |= IH_MPSAFE;
    748  1.17  jmcneill 		else
    749  1.17  jmcneill 			*ih &= ~IH_MPSAFE;
    750  1.16  jmcneill 		return 0;
    751  1.16  jmcneill 	default:
    752  1.16  jmcneill 		return ENODEV;
    753  1.16  jmcneill 	}
    754  1.16  jmcneill }
    755  1.16  jmcneill 
    756   1.1  jmcneill static void *
    757   1.1  jmcneill tegra_pcie_intr_establish(void *v, pci_intr_handle_t ih, int ipl,
    758   1.1  jmcneill     int (*callback)(void *), void *arg)
    759   1.1  jmcneill {
    760   1.1  jmcneill 	struct tegra_pcie_softc *sc = v;
    761   1.1  jmcneill 	struct tegra_pcie_ih *pcie_ih;
    762   1.1  jmcneill 
    763   1.1  jmcneill 	if (ih == 0)
    764   1.1  jmcneill 		return NULL;
    765   1.1  jmcneill 
    766   1.1  jmcneill 	pcie_ih = kmem_alloc(sizeof(*pcie_ih), KM_SLEEP);
    767   1.1  jmcneill 	pcie_ih->ih_callback = callback;
    768   1.1  jmcneill 	pcie_ih->ih_arg = arg;
    769   1.1  jmcneill 	pcie_ih->ih_ipl = ipl;
    770  1.17  jmcneill 	pcie_ih->ih_mpsafe = (ih & IH_MPSAFE) != 0;
    771   1.1  jmcneill 
    772   1.1  jmcneill 	mutex_enter(&sc->sc_lock);
    773   1.1  jmcneill 	TAILQ_INSERT_TAIL(&sc->sc_intrs, pcie_ih, ih_entry);
    774   1.1  jmcneill 	sc->sc_intrgen++;
    775   1.1  jmcneill 	mutex_exit(&sc->sc_lock);
    776   1.1  jmcneill 
    777   1.1  jmcneill 	return pcie_ih;
    778   1.1  jmcneill }
    779   1.1  jmcneill 
    780   1.1  jmcneill static void
    781   1.1  jmcneill tegra_pcie_intr_disestablish(void *v, void *vih)
    782   1.1  jmcneill {
    783   1.1  jmcneill 	struct tegra_pcie_softc *sc = v;
    784   1.1  jmcneill 	struct tegra_pcie_ih *pcie_ih = vih;
    785   1.1  jmcneill 
    786   1.1  jmcneill 	mutex_enter(&sc->sc_lock);
    787   1.1  jmcneill 	TAILQ_REMOVE(&sc->sc_intrs, pcie_ih, ih_entry);
    788   1.1  jmcneill 	mutex_exit(&sc->sc_lock);
    789   1.1  jmcneill 
    790   1.1  jmcneill 	kmem_free(pcie_ih, sizeof(*pcie_ih));
    791   1.1  jmcneill }
    792