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