]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/arm/nvidia/tegra_pcie.c
TEGRA: Prepare Tegra subtree for inclusion into ARM generic kernel.
[FreeBSD/FreeBSD.git] / sys / arm / nvidia / tegra_pcie.c
1 /*-
2  * Copyright (c) 2016 Michal Meloun <mmel@FreeBSD.org>
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions
7  * are met:
8  * 1. Redistributions of source code must retain the above copyright
9  *    notice, this list of conditions and the following disclaimer.
10  * 2. Redistributions in binary form must reproduce the above copyright
11  *    notice, this list of conditions and the following disclaimer in the
12  *    documentation and/or other materials provided with the distribution.
13  *
14  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24  * SUCH DAMAGE.
25  */
26
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29
30 /*
31  * Nvidia Integrated PCI/PCI-Express controller driver.
32  */
33
34 #include <sys/param.h>
35 #include <sys/systm.h>
36 #include <sys/bus.h>
37 #include <sys/devmap.h>
38 #include <sys/proc.h>
39 #include <sys/kernel.h>
40 #include <sys/malloc.h>
41 #include <sys/module.h>
42 #include <sys/mutex.h>
43 #include <sys/rman.h>
44
45 #include <machine/intr.h>
46
47 #include <vm/vm.h>
48 #include <vm/vm_extern.h>
49 #include <vm/vm_kern.h>
50 #include <vm/pmap.h>
51
52 #include <dev/extres/clk/clk.h>
53 #include <dev/extres/hwreset/hwreset.h>
54 #include <dev/extres/phy/phy.h>
55 #include <dev/extres/regulator/regulator.h>
56 #include <dev/fdt/fdt_common.h>
57 #include <dev/ofw/ofw_bus.h>
58 #include <dev/ofw/ofw_bus_subr.h>
59 #include <dev/ofw/ofw_pci.h>
60 #include <dev/ofw/ofwpci.h>
61 #include <dev/pci/pcivar.h>
62 #include <dev/pci/pcireg.h>
63 #include <dev/pci/pcib_private.h>
64
65 #include <machine/resource.h>
66 #include <machine/bus.h>
67
68 #include <arm/nvidia/tegra_pmc.h>
69
70 #include "ofw_bus_if.h"
71 #include "msi_if.h"
72 #include "pcib_if.h"
73 #include "pic_if.h"
74
75
76 #define AFI_AXI_BAR0_SZ                         0x000
77 #define AFI_AXI_BAR1_SZ                         0x004
78 #define AFI_AXI_BAR2_SZ                         0x008
79 #define AFI_AXI_BAR3_SZ                         0x00c
80 #define AFI_AXI_BAR4_SZ                         0x010
81 #define AFI_AXI_BAR5_SZ                         0x014
82 #define AFI_AXI_BAR0_START                      0x018
83 #define AFI_AXI_BAR1_START                      0x01c
84 #define AFI_AXI_BAR2_START                      0x020
85 #define AFI_AXI_BAR3_START                      0x024
86 #define AFI_AXI_BAR4_START                      0x028
87 #define AFI_AXI_BAR5_START                      0x02c
88 #define AFI_FPCI_BAR0                           0x030
89 #define AFI_FPCI_BAR1                           0x034
90 #define AFI_FPCI_BAR2                           0x038
91 #define AFI_FPCI_BAR3                           0x03c
92 #define AFI_FPCI_BAR4                           0x040
93 #define AFI_FPCI_BAR5                           0x044
94 #define AFI_MSI_BAR_SZ                          0x060
95 #define AFI_MSI_FPCI_BAR_ST                     0x064
96 #define AFI_MSI_AXI_BAR_ST                      0x068
97 #define AFI_MSI_VEC(x)                          (0x06c + 4 * (x))
98 #define AFI_MSI_EN_VEC(x)                       (0x08c + 4 * (x))
99 #define  AFI_MSI_INTR_IN_REG                            32
100 #define  AFI_MSI_REGS                                   8
101
102 #define AFI_CONFIGURATION                       0x0ac
103 #define  AFI_CONFIGURATION_EN_FPCI                      (1 << 0)
104
105 #define AFI_FPCI_ERROR_MASKS                    0x0b0
106 #define AFI_INTR_MASK                           0x0b4
107 #define  AFI_INTR_MASK_MSI_MASK                         (1 << 8)
108 #define  AFI_INTR_MASK_INT_MASK                         (1 << 0)
109
110 #define AFI_INTR_CODE                           0x0b8
111 #define  AFI_INTR_CODE_MASK                             0xf
112 #define  AFI_INTR_CODE_INT_CODE_INI_SLVERR              1
113 #define  AFI_INTR_CODE_INT_CODE_INI_DECERR              2
114 #define  AFI_INTR_CODE_INT_CODE_TGT_SLVERR              3
115 #define  AFI_INTR_CODE_INT_CODE_TGT_DECERR              4
116 #define  AFI_INTR_CODE_INT_CODE_TGT_WRERR               5
117 #define  AFI_INTR_CODE_INT_CODE_SM_MSG                  6
118 #define  AFI_INTR_CODE_INT_CODE_DFPCI_DECERR            7
119 #define  AFI_INTR_CODE_INT_CODE_AXI_DECERR              8
120 #define  AFI_INTR_CODE_INT_CODE_FPCI_TIMEOUT            9
121 #define  AFI_INTR_CODE_INT_CODE_PE_PRSNT_SENSE          10
122 #define  AFI_INTR_CODE_INT_CODE_PE_CLKREQ_SENSE         11
123 #define  AFI_INTR_CODE_INT_CODE_CLKCLAMP_SENSE          12
124 #define  AFI_INTR_CODE_INT_CODE_RDY4PD_SENSE            13
125 #define  AFI_INTR_CODE_INT_CODE_P2P_ERROR               14
126
127
128 #define AFI_INTR_SIGNATURE                      0x0bc
129 #define AFI_UPPER_FPCI_ADDRESS                  0x0c0
130 #define AFI_SM_INTR_ENABLE                      0x0c4
131 #define  AFI_SM_INTR_RP_DEASSERT                        (1 << 14)
132 #define  AFI_SM_INTR_RP_ASSERT                          (1 << 13)
133 #define  AFI_SM_INTR_HOTPLUG                            (1 << 12)
134 #define  AFI_SM_INTR_PME                                (1 << 11)
135 #define  AFI_SM_INTR_FATAL_ERROR                        (1 << 10)
136 #define  AFI_SM_INTR_UNCORR_ERROR                       (1 <<  9)
137 #define  AFI_SM_INTR_CORR_ERROR                         (1 <<  8)
138 #define  AFI_SM_INTR_INTD_DEASSERT                      (1 <<  7)
139 #define  AFI_SM_INTR_INTC_DEASSERT                      (1 <<  6)
140 #define  AFI_SM_INTR_INTB_DEASSERT                      (1 <<  5)
141 #define  AFI_SM_INTR_INTA_DEASSERT                      (1 <<  4)
142 #define  AFI_SM_INTR_INTD_ASSERT                        (1 <<  3)
143 #define  AFI_SM_INTR_INTC_ASSERT                        (1 <<  2)
144 #define  AFI_SM_INTR_INTB_ASSERT                        (1 <<  1)
145 #define  AFI_SM_INTR_INTA_ASSERT                        (1 <<  0)
146
147 #define AFI_AFI_INTR_ENABLE                     0x0c8
148 #define  AFI_AFI_INTR_ENABLE_CODE(code)                 (1 << (code))
149
150 #define AFI_PCIE_CONFIG                         0x0f8
151 #define  AFI_PCIE_CONFIG_PCIE_DISABLE(x)                (1 << ((x) + 1))
152 #define  AFI_PCIE_CONFIG_PCIE_DISABLE_ALL               0x6
153 #define  AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_MASK       (0xf << 20)
154 #define  AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_XBAR2_1    (0x0 << 20)
155 #define  AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_XBAR4_1    (0x1 << 20)
156
157 #define AFI_FUSE                                0x104
158 #define  AFI_FUSE_PCIE_T0_GEN2_DIS                      (1 << 2)
159
160 #define AFI_PEX0_CTRL                           0x110
161 #define AFI_PEX1_CTRL                           0x118
162 #define AFI_PEX2_CTRL                           0x128
163 #define  AFI_PEX_CTRL_OVERRIDE_EN                       (1 << 4)
164 #define  AFI_PEX_CTRL_REFCLK_EN                         (1 << 3)
165 #define  AFI_PEX_CTRL_CLKREQ_EN                         (1 << 1)
166 #define  AFI_PEX_CTRL_RST_L                             (1 << 0)
167
168 #define AFI_AXI_BAR6_SZ                         0x134
169 #define AFI_AXI_BAR7_SZ                         0x138
170 #define AFI_AXI_BAR8_SZ                         0x13c
171 #define AFI_AXI_BAR6_START                      0x140
172 #define AFI_AXI_BAR7_START                      0x144
173 #define AFI_AXI_BAR8_START                      0x148
174 #define AFI_FPCI_BAR6                           0x14c
175 #define AFI_FPCI_BAR7                           0x150
176 #define AFI_FPCI_BAR8                           0x154
177 #define AFI_PLLE_CONTROL                        0x160
178 #define  AFI_PLLE_CONTROL_BYPASS_PADS2PLLE_CONTROL      (1 << 9)
179 #define  AFI_PLLE_CONTROL_BYPASS_PCIE2PLLE_CONTROL      (1 << 8)
180 #define  AFI_PLLE_CONTROL_PADS2PLLE_CONTROL_EN          (1 << 1)
181 #define  AFI_PLLE_CONTROL_PCIE2PLLE_CONTROL_EN          (1 << 0)
182
183 #define AFI_PEXBIAS_CTRL                        0x168
184
185 /* FPCI Address space */
186 #define FPCI_MAP_IO                     0xfdfc000000ULL
187 #define FPCI_MAP_TYPE0_CONFIG           0xfdfc000000ULL
188 #define FPCI_MAP_TYPE1_CONFIG           0xfdff000000ULL
189 #define FPCI_MAP_EXT_TYPE0_CONFIG       0xfe00000000ULL
190 #define FPCI_MAP_EXT_TYPE1_CONFIG       0xfe10000000ULL
191
192 /* Configuration space */
193 #define RP_VEND_XP      0x00000F00
194 #define  RP_VEND_XP_DL_UP       (1 << 30)
195
196 #define RP_PRIV_MISC    0x00000FE0
197 #define  RP_PRIV_MISC_PRSNT_MAP_EP_PRSNT (0xE << 0)
198 #define  RP_PRIV_MISC_PRSNT_MAP_EP_ABSNT (0xF << 0)
199
200 #define RP_LINK_CONTROL_STATUS                  0x00000090
201 #define  RP_LINK_CONTROL_STATUS_DL_LINK_ACTIVE  0x20000000
202 #define  RP_LINK_CONTROL_STATUS_LINKSTAT_MASK   0x3fff0000
203
204 #define TEGRA_PCIE_LINKUP_TIMEOUT       200
205
206 #define TEGRA_PCIB_MSI_ENABLE
207
208 #define DEBUG
209 #ifdef DEBUG
210 #define debugf(fmt, args...) do { printf(fmt,##args); } while (0)
211 #else
212 #define debugf(fmt, args...)
213 #endif
214
215 /*
216  * Configuration space format:
217  *    [27:24] extended register
218  *    [23:16] bus
219  *    [15:11] slot (device)
220  *    [10: 8] function
221  *    [ 7: 0] register
222  */
223 #define PCI_CFG_EXT_REG(reg)    ((((reg) >> 8) & 0x0f) << 24)
224 #define PCI_CFG_BUS(bus)        (((bus) & 0xff) << 16)
225 #define PCI_CFG_DEV(dev)        (((dev) & 0x1f) << 11)
226 #define PCI_CFG_FUN(fun)        (((fun) & 0x07) << 8)
227 #define PCI_CFG_BASE_REG(reg)   ((reg)  & 0xff)
228
229 #define PADS_WR4(_sc, _r, _v)   bus_write_4((_sc)-pads_mem_res, (_r), (_v))
230 #define PADS_RD4(_sc, _r)       bus_read_4((_sc)->pads_mem_res, (_r))
231 #define AFI_WR4(_sc, _r, _v)    bus_write_4((_sc)->afi_mem_res, (_r), (_v))
232 #define AFI_RD4(_sc, _r)        bus_read_4((_sc)->afi_mem_res, (_r))
233
234 static struct {
235         bus_size_t      axi_start;
236         bus_size_t      fpci_start;
237         bus_size_t      size;
238 } bars[] = {
239     {AFI_AXI_BAR0_START, AFI_FPCI_BAR0, AFI_AXI_BAR0_SZ},       /* BAR 0 */
240     {AFI_AXI_BAR1_START, AFI_FPCI_BAR1, AFI_AXI_BAR1_SZ},       /* BAR 1 */
241     {AFI_AXI_BAR2_START, AFI_FPCI_BAR2, AFI_AXI_BAR2_SZ},       /* BAR 2 */
242     {AFI_AXI_BAR3_START, AFI_FPCI_BAR3, AFI_AXI_BAR3_SZ},       /* BAR 3 */
243     {AFI_AXI_BAR4_START, AFI_FPCI_BAR4, AFI_AXI_BAR4_SZ},       /* BAR 4 */
244     {AFI_AXI_BAR5_START, AFI_FPCI_BAR5, AFI_AXI_BAR5_SZ},       /* BAR 5 */
245     {AFI_AXI_BAR6_START, AFI_FPCI_BAR6, AFI_AXI_BAR6_SZ},       /* BAR 6 */
246     {AFI_AXI_BAR7_START, AFI_FPCI_BAR7, AFI_AXI_BAR7_SZ},       /* BAR 7 */
247     {AFI_AXI_BAR8_START, AFI_FPCI_BAR8, AFI_AXI_BAR8_SZ},       /* BAR 8 */
248     {AFI_MSI_AXI_BAR_ST, AFI_MSI_FPCI_BAR_ST, AFI_MSI_BAR_SZ},  /* MSI 9 */
249 };
250
251 /* Compatible devices. */
252 static struct ofw_compat_data compat_data[] = {
253         {"nvidia,tegra124-pcie",        1},
254         {NULL,                          0},
255 };
256
257 #define TEGRA_FLAG_MSI_USED     0x0001
258 struct tegra_pcib_irqsrc {
259         struct intr_irqsrc      isrc;
260         u_int                   irq;
261         u_int                   flags;
262 };
263
264 struct tegra_pcib_port {
265         int             enabled;
266         int             port_idx;               /* chip port index */
267         int             num_lanes;              /* number of lanes */
268         bus_size_t      afi_pex_ctrl;           /* offset of afi_pex_ctrl */
269         phy_t           phy;                    /* port phy */
270
271         /* Config space properties. */
272         bus_addr_t      rp_base_addr;           /* PA of config window */
273         bus_size_t      rp_size;                /* size of config window */
274         bus_space_handle_t cfg_handle;          /* handle of config window */
275 };
276
277 #define TEGRA_PCIB_MAX_PORTS    3
278 #define TEGRA_PCIB_MAX_MSI      AFI_MSI_INTR_IN_REG * AFI_MSI_REGS
279 struct tegra_pcib_softc {
280         struct ofw_pci_softc    ofw_pci;
281         device_t                dev;
282         struct mtx              mtx;
283         struct resource         *pads_mem_res;
284         struct resource         *afi_mem_res;
285         struct resource         *cfg_mem_res;
286         struct resource         *irq_res;
287         struct resource         *msi_irq_res;
288         void                    *intr_cookie;
289         void                    *msi_intr_cookie;
290
291         struct ofw_pci_range    mem_range;
292         struct ofw_pci_range    pref_mem_range;
293         struct ofw_pci_range    io_range;
294
295         clk_t                   clk_pex;
296         clk_t                   clk_afi;
297         clk_t                   clk_pll_e;
298         clk_t                   clk_cml;
299         hwreset_t               hwreset_pex;
300         hwreset_t               hwreset_afi;
301         hwreset_t               hwreset_pcie_x;
302         regulator_t             supply_avddio_pex;
303         regulator_t             supply_dvddio_pex;
304         regulator_t             supply_avdd_pex_pll;
305         regulator_t             supply_hvdd_pex;
306         regulator_t             supply_hvdd_pex_pll_e;
307         regulator_t             supply_vddio_pex_ctl;
308         regulator_t             supply_avdd_pll_erefe;
309
310         vm_offset_t             msi_page;       /* VA of MSI page */
311         bus_addr_t              cfg_base_addr;  /* base address of config */
312         bus_size_t              cfg_cur_offs;   /* currently mapped window */
313         bus_space_handle_t      cfg_handle;     /* handle of config window */
314         bus_space_tag_t         bus_tag;        /* tag of config window */
315         int                     lanes_cfg;
316         int                     num_ports;
317         struct tegra_pcib_port *ports[TEGRA_PCIB_MAX_PORTS];
318         struct tegra_pcib_irqsrc *isrcs;
319 };
320
321 static int
322 tegra_pcib_maxslots(device_t dev)
323 {
324         return (16);
325 }
326
327 static int
328 tegra_pcib_route_interrupt(device_t bus, device_t dev, int pin)
329 {
330         struct tegra_pcib_softc *sc;
331         u_int irq;
332
333         sc = device_get_softc(bus);
334         irq = intr_map_clone_irq(rman_get_start(sc->irq_res));
335         device_printf(bus, "route pin %d for device %d.%d to %u\n",
336                       pin, pci_get_slot(dev), pci_get_function(dev),
337                       irq);
338
339         return (irq);
340 }
341
342 static int
343 tegra_pcbib_map_cfg(struct tegra_pcib_softc *sc, u_int bus, u_int slot,
344     u_int func, u_int reg)
345 {
346         bus_size_t offs;
347         int rv;
348
349         offs = sc->cfg_base_addr;
350         offs |= PCI_CFG_BUS(bus) | PCI_CFG_DEV(slot) | PCI_CFG_FUN(func) |
351             PCI_CFG_EXT_REG(reg);
352         if ((sc->cfg_handle != 0) && (sc->cfg_cur_offs == offs))
353                 return (0);
354         if (sc->cfg_handle != 0)
355                 bus_space_unmap(sc->bus_tag, sc->cfg_handle, 0x800);
356
357         rv = bus_space_map(sc->bus_tag, offs, 0x800, 0, &sc->cfg_handle);
358         if (rv != 0)
359                 device_printf(sc->dev, "Cannot map config space\n");
360         else
361                 sc->cfg_cur_offs = offs;
362         return (rv);
363 }
364
365 static uint32_t
366 tegra_pcib_read_config(device_t dev, u_int bus, u_int slot, u_int func,
367     u_int reg, int bytes)
368 {
369         struct tegra_pcib_softc *sc;
370         bus_space_handle_t hndl;
371         uint32_t off;
372         uint32_t val;
373         int rv, i;
374
375         sc = device_get_softc(dev);
376         if (bus == 0) {
377                 if (func != 0)
378                         return (0xFFFFFFFF);
379                 for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
380                         if ((sc->ports[i] != NULL) &&
381                             (sc->ports[i]->port_idx == slot)) {
382                                 hndl = sc->ports[i]->cfg_handle;
383                                 off = reg & 0xFFF;
384                                 break;
385                         }
386                 }
387                 if (i >= TEGRA_PCIB_MAX_PORTS)
388                         return (0xFFFFFFFF);
389         } else {
390                 rv = tegra_pcbib_map_cfg(sc, bus, slot, func, reg);
391                 if (rv != 0)
392                         return (0xFFFFFFFF);
393                 hndl = sc->cfg_handle;
394                 off = PCI_CFG_BASE_REG(reg);
395         }
396
397         val = bus_space_read_4(sc->bus_tag, hndl, off & ~3);
398         switch (bytes) {
399         case 4:
400                 break;
401         case 2:
402                 if (off & 3)
403                         val >>= 16;
404                 val &= 0xffff;
405                 break;
406         case 1:
407                 val >>= ((off & 3) << 3);
408                 val &= 0xff;
409                 break;
410         }
411         return val;
412 }
413
414 static void
415 tegra_pcib_write_config(device_t dev, u_int bus, u_int slot, u_int func,
416     u_int reg, uint32_t val, int bytes)
417 {
418         struct tegra_pcib_softc *sc;
419         bus_space_handle_t hndl;
420         uint32_t off;
421         uint32_t val2;
422         int rv, i;
423
424         sc = device_get_softc(dev);
425         if (bus == 0) {
426                 if (func != 0)
427                         return;
428                 for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
429                         if ((sc->ports[i] != NULL) &&
430                             (sc->ports[i]->port_idx == slot)) {
431                                 hndl = sc->ports[i]->cfg_handle;
432                                 off = reg & 0xFFF;
433                                 break;
434                         }
435                 }
436                 if (i >= TEGRA_PCIB_MAX_PORTS)
437                         return;
438         } else {
439                 rv = tegra_pcbib_map_cfg(sc, bus, slot, func, reg);
440                 if (rv != 0)
441                         return;
442                 hndl = sc->cfg_handle;
443                 off = PCI_CFG_BASE_REG(reg);
444         }
445
446         switch (bytes) {
447         case 4:
448                 bus_space_write_4(sc->bus_tag, hndl, off, val);
449                 break;
450         case 2:
451                 val2 = bus_space_read_4(sc->bus_tag, hndl, off & ~3);
452                 val2 &= ~(0xffff << ((off & 3) << 3));
453                 val2 |= ((val & 0xffff) << ((off & 3) << 3));
454                 bus_space_write_4(sc->bus_tag, hndl, off & ~3, val2);
455                 break;
456         case 1:
457                 val2 = bus_space_read_4(sc->bus_tag, hndl, off & ~3);
458                 val2 &= ~(0xff << ((off & 3) << 3));
459                 val2 |= ((val & 0xff) << ((off & 3) << 3));
460                 bus_space_write_4(sc->bus_tag, hndl, off & ~3, val2);
461                 break;
462         }
463 }
464
465 static int tegra_pci_intr(void *arg)
466 {
467         struct tegra_pcib_softc *sc = arg;
468         uint32_t code, signature;
469
470         code = bus_read_4(sc->afi_mem_res, AFI_INTR_CODE) & AFI_INTR_CODE_MASK;
471         signature = bus_read_4(sc->afi_mem_res, AFI_INTR_SIGNATURE);
472         bus_write_4(sc->afi_mem_res, AFI_INTR_CODE, 0);
473         if (code == AFI_INTR_CODE_INT_CODE_SM_MSG)
474                 return(FILTER_STRAY);
475
476         printf("tegra_pci_intr: code %x sig %x\n", code, signature);
477         return (FILTER_HANDLED);
478 }
479
480 /* -----------------------------------------------------------------------
481  *
482  *      PCI MSI interface
483  */
484 static int
485 tegra_pcib_alloc_msi(device_t pci, device_t child, int count, int maxcount,
486     int *irqs)
487 {
488         phandle_t msi_parent;
489
490         /* XXXX ofw_bus_msimap() don't works for Tegra DT.
491         ofw_bus_msimap(ofw_bus_get_node(pci), pci_get_rid(child), &msi_parent,
492             NULL);
493         */
494         msi_parent = OF_xref_from_node(ofw_bus_get_node(pci));
495         return (intr_alloc_msi(pci, child, msi_parent, count, maxcount,
496             irqs));
497 }
498
499 static int
500 tegra_pcib_release_msi(device_t pci, device_t child, int count, int *irqs)
501 {
502         phandle_t msi_parent;
503
504         /* XXXX ofw_bus_msimap() don't works for Tegra DT.
505         ofw_bus_msimap(ofw_bus_get_node(pci), pci_get_rid(child), &msi_parent,
506             NULL);
507         */
508         msi_parent = OF_xref_from_node(ofw_bus_get_node(pci));
509         return (intr_release_msi(pci, child, msi_parent, count, irqs));
510 }
511
512 static int
513 tegra_pcib_map_msi(device_t pci, device_t child, int irq, uint64_t *addr,
514     uint32_t *data)
515 {
516         phandle_t msi_parent;
517
518         /* XXXX ofw_bus_msimap() don't works for Tegra DT.
519         ofw_bus_msimap(ofw_bus_get_node(pci), pci_get_rid(child), &msi_parent,
520             NULL);
521         */
522         msi_parent = OF_xref_from_node(ofw_bus_get_node(pci));
523         return (intr_map_msi(pci, child, msi_parent, irq, addr, data));
524 }
525
526 #ifdef TEGRA_PCIB_MSI_ENABLE
527
528 /* --------------------------------------------------------------------------
529  *
530  * Interrupts
531  *
532  */
533
534 static inline void
535 tegra_pcib_isrc_mask(struct tegra_pcib_softc *sc,
536      struct tegra_pcib_irqsrc *tgi, uint32_t val)
537 {
538         uint32_t reg;
539         int offs, bit;
540
541         offs = tgi->irq / AFI_MSI_INTR_IN_REG;
542         bit = 1 << (tgi->irq % AFI_MSI_INTR_IN_REG);
543
544         if (val != 0)
545                 AFI_WR4(sc, AFI_MSI_VEC(offs), bit);
546         reg = AFI_RD4(sc, AFI_MSI_EN_VEC(offs));
547         if (val !=  0)
548                 reg |= bit;
549         else
550                 reg &= ~bit;
551         AFI_WR4(sc, AFI_MSI_EN_VEC(offs), reg);
552 }
553
554 static int
555 tegra_pcib_msi_intr(void *arg)
556 {
557         u_int irq, i, bit, reg;
558         struct tegra_pcib_softc *sc;
559         struct trapframe *tf;
560         struct tegra_pcib_irqsrc *tgi;
561
562         sc = (struct tegra_pcib_softc *)arg;
563         tf = curthread->td_intr_frame;
564
565         for (i = 0; i < AFI_MSI_REGS; i++) {
566                 reg = AFI_RD4(sc, AFI_MSI_VEC(i));
567                 /* Handle one vector. */
568                 while (reg != 0) {
569                         bit = ffs(reg) - 1;
570                         /* Send EOI */
571                         AFI_WR4(sc, AFI_MSI_VEC(i), 1 << bit);
572                         irq = i * AFI_MSI_INTR_IN_REG + bit;
573                         tgi = &sc->isrcs[irq];
574                         if (intr_isrc_dispatch(&tgi->isrc, tf) != 0) {
575                                 /* Disable stray. */
576                                 tegra_pcib_isrc_mask(sc, tgi, 0);
577                                 device_printf(sc->dev,
578                                     "Stray irq %u disabled\n", irq);
579                         }
580                         reg = AFI_RD4(sc, AFI_MSI_VEC(i));
581                 }
582         }
583         return (FILTER_HANDLED);
584 }
585
586 static int
587 tegra_pcib_msi_attach(struct tegra_pcib_softc *sc)
588 {
589         int error;
590         uint32_t irq;
591         const char *name;
592
593         sc->isrcs = malloc(sizeof(*sc->isrcs) * TEGRA_PCIB_MAX_MSI, M_DEVBUF,
594             M_WAITOK | M_ZERO);
595
596         name = device_get_nameunit(sc->dev);
597         for (irq = 0; irq < TEGRA_PCIB_MAX_MSI; irq++) {
598                 sc->isrcs[irq].irq = irq;
599                 error = intr_isrc_register(&sc->isrcs[irq].isrc,
600                     sc->dev, 0, "%s,%u", name, irq);
601                 if (error != 0)
602                         return (error); /* XXX deregister ISRCs */
603         }
604         if (intr_msi_register(sc->dev,
605             OF_xref_from_node(ofw_bus_get_node(sc->dev))) != 0)
606                 return (ENXIO);
607
608         return (0);
609 }
610
611 static int
612 tegra_pcib_msi_detach(struct tegra_pcib_softc *sc)
613 {
614
615         /*
616          *  There has not been established any procedure yet
617          *  how to detach PIC from living system correctly.
618          */
619         device_printf(sc->dev, "%s: not implemented yet\n", __func__);
620         return (EBUSY);
621 }
622
623
624 static void
625 tegra_pcib_msi_disable_intr(device_t dev, struct intr_irqsrc *isrc)
626 {
627         struct tegra_pcib_softc *sc;
628         struct tegra_pcib_irqsrc *tgi;
629
630         sc = device_get_softc(dev);
631         tgi = (struct tegra_pcib_irqsrc *)isrc;
632         tegra_pcib_isrc_mask(sc, tgi, 0);
633 }
634
635 static void
636 tegra_pcib_msi_enable_intr(device_t dev, struct intr_irqsrc *isrc)
637 {
638         struct tegra_pcib_softc *sc;
639         struct tegra_pcib_irqsrc *tgi;
640
641         sc = device_get_softc(dev);
642         tgi = (struct tegra_pcib_irqsrc *)isrc;
643         tegra_pcib_isrc_mask(sc, tgi, 1);
644 }
645
646 /* MSI interrupts are edge trigered -> do nothing */
647 static void
648 tegra_pcib_msi_post_filter(device_t dev, struct intr_irqsrc *isrc)
649 {
650 }
651
652 static void
653 tegra_pcib_msi_post_ithread(device_t dev, struct intr_irqsrc *isrc)
654 {
655 }
656
657 static void
658 tegra_pcib_msi_pre_ithread(device_t dev, struct intr_irqsrc *isrc)
659 {
660 }
661
662 static int
663 tegra_pcib_msi_setup_intr(device_t dev, struct intr_irqsrc *isrc,
664     struct resource *res, struct intr_map_data *data)
665 {
666         struct tegra_pcib_softc *sc;
667         struct tegra_pcib_irqsrc *tgi;
668
669         sc = device_get_softc(dev);
670         tgi = (struct tegra_pcib_irqsrc *)isrc;
671
672         if (data == NULL || data->type != INTR_MAP_DATA_MSI)
673                 return (ENOTSUP);
674
675         if (isrc->isrc_handlers == 0)
676                 tegra_pcib_msi_enable_intr(dev, isrc);
677
678         return (0);
679 }
680
681 static int
682 tegra_pcib_msi_teardown_intr(device_t dev, struct intr_irqsrc *isrc,
683     struct resource *res, struct intr_map_data *data)
684 {
685         struct tegra_pcib_softc *sc;
686         struct tegra_pcib_irqsrc *tgi;
687
688         sc = device_get_softc(dev);
689         tgi = (struct tegra_pcib_irqsrc *)isrc;
690
691         if (isrc->isrc_handlers == 0)
692                 tegra_pcib_isrc_mask(sc, tgi, 0);
693         return (0);
694 }
695
696
697 static int
698 tegra_pcib_msi_alloc_msi(device_t dev, device_t child, int count, int maxcount,
699     device_t *pic, struct intr_irqsrc **srcs)
700 {
701         struct tegra_pcib_softc *sc;
702         int i, irq, end_irq;
703         bool found;
704
705         KASSERT(powerof2(count), ("%s: bad count", __func__));
706         KASSERT(powerof2(maxcount), ("%s: bad maxcount", __func__));
707
708         sc = device_get_softc(dev);
709         mtx_lock(&sc->mtx);
710
711         found = false;
712         for (irq = 0; irq < TEGRA_PCIB_MAX_MSI && !found; irq++) {
713                 /* Start on an aligned interrupt */
714                 if ((irq & (maxcount - 1)) != 0)
715                         continue;
716
717                 /* Assume we found a valid range until shown otherwise */
718                 found = true;
719
720                 /* Check this range is valid */
721                 for (end_irq = irq; end_irq != irq + count - 1; end_irq++) {
722                         /* No free interrupts */
723                         if (end_irq == (TEGRA_PCIB_MAX_MSI - 1)) {
724                                 found = false;
725                                 break;
726                         }
727
728                         /* This is already used */
729                         if ((sc->isrcs[irq].flags & TEGRA_FLAG_MSI_USED) ==
730                             TEGRA_FLAG_MSI_USED) {
731                                 found = false;
732                                 break;
733                         }
734                 }
735         }
736
737         /* Not enough interrupts were found */
738         if (!found || irq == (TEGRA_PCIB_MAX_MSI - 1)) {
739                 mtx_unlock(&sc->mtx);
740                 return (ENXIO);
741         }
742
743         for (i = 0; i < count; i++) {
744                 /* Mark the interrupt as used */
745                 sc->isrcs[irq + i].flags |= TEGRA_FLAG_MSI_USED;
746
747         }
748         mtx_unlock(&sc->mtx);
749
750         for (i = 0; i < count; i++)
751                 srcs[i] = (struct intr_irqsrc *)&sc->isrcs[irq + i];
752         *pic = device_get_parent(dev);
753         return (0);
754 }
755
756 static int
757 tegra_pcib_msi_release_msi(device_t dev, device_t child, int count,
758     struct intr_irqsrc **isrc)
759 {
760         struct tegra_pcib_softc *sc;
761         struct tegra_pcib_irqsrc *ti;
762         int i;
763
764         sc = device_get_softc(dev);
765         mtx_lock(&sc->mtx);
766         for (i = 0; i < count; i++) {
767                 ti = (struct tegra_pcib_irqsrc *)isrc;
768
769                 KASSERT((ti->flags & TEGRA_FLAG_MSI_USED) == TEGRA_FLAG_MSI_USED,
770                     ("%s: Trying to release an unused MSI-X interrupt",
771                     __func__));
772
773                 ti->flags &= ~TEGRA_FLAG_MSI_USED;
774                 mtx_unlock(&sc->mtx);
775         }
776         return (0);
777 }
778
779 static int
780 tegra_pcib_msi_map_msi(device_t dev, device_t child, struct intr_irqsrc *isrc,
781     uint64_t *addr, uint32_t *data)
782 {
783         struct tegra_pcib_softc *sc = device_get_softc(dev);
784         struct tegra_pcib_irqsrc *ti = (struct tegra_pcib_irqsrc *)isrc;
785
786         *addr = vtophys(sc->msi_page);
787         *data = ti->irq;
788         return (0);
789 }
790 #endif
791
792 /* ------------------------------------------------------------------- */
793 static bus_size_t
794 tegra_pcib_pex_ctrl(struct tegra_pcib_softc *sc, int port)
795 {
796         if (port >= TEGRA_PCIB_MAX_PORTS)
797                 panic("invalid port number: %d\n", port);
798
799         if (port == 0)
800                 return (AFI_PEX0_CTRL);
801         else if (port == 1)
802                 return (AFI_PEX1_CTRL);
803         else if (port == 2)
804                 return (AFI_PEX2_CTRL);
805         else
806                 panic("invalid port number: %d\n", port);
807 }
808
809 static int
810 tegra_pcib_enable_fdt_resources(struct tegra_pcib_softc *sc)
811 {
812         int rv;
813
814         rv = hwreset_assert(sc->hwreset_pcie_x);
815         if (rv != 0) {
816                 device_printf(sc->dev, "Cannot assert 'pcie_x' reset\n");
817                 return (rv);
818         }
819         rv = hwreset_assert(sc->hwreset_afi);
820         if (rv != 0) {
821                 device_printf(sc->dev, "Cannot assert  'afi' reset\n");
822                 return (rv);
823         }
824         rv = hwreset_assert(sc->hwreset_pex);
825         if (rv != 0) {
826                 device_printf(sc->dev, "Cannot assert  'pex' reset\n");
827                 return (rv);
828         }
829
830         tegra_powergate_power_off(TEGRA_POWERGATE_PCX);
831
832         /* Power supplies. */
833         rv = regulator_enable(sc->supply_avddio_pex);
834         if (rv != 0) {
835                 device_printf(sc->dev,
836                     "Cannot enable 'avddio_pex' regulator\n");
837                 return (rv);
838         }
839         rv = regulator_enable(sc->supply_dvddio_pex);
840         if (rv != 0) {
841                 device_printf(sc->dev,
842                     "Cannot enable 'dvddio_pex' regulator\n");
843                 return (rv);
844         }
845         rv = regulator_enable(sc->supply_avdd_pex_pll);
846         if (rv != 0) {
847                 device_printf(sc->dev,
848                     "Cannot enable 'avdd-pex-pll' regulator\n");
849                 return (rv);
850         }
851         rv = regulator_enable(sc->supply_hvdd_pex);
852         if (rv != 0) {
853                 device_printf(sc->dev,
854                     "Cannot enable 'hvdd-pex-supply' regulator\n");
855                 return (rv);
856         }
857         rv = regulator_enable(sc->supply_hvdd_pex_pll_e);
858         if (rv != 0) {
859                 device_printf(sc->dev,
860                     "Cannot enable 'hvdd-pex-pll-e-supply' regulator\n");
861                 return (rv);
862         }
863         rv = regulator_enable(sc->supply_vddio_pex_ctl);
864         if (rv != 0) {
865                 device_printf(sc->dev,
866                     "Cannot enable 'vddio-pex-ctl' regulator\n");
867                 return (rv);
868         }
869         rv = regulator_enable(sc->supply_avdd_pll_erefe);
870         if (rv != 0) {
871                 device_printf(sc->dev,
872                     "Cannot enable 'avdd-pll-erefe-supply' regulator\n");
873                 return (rv);
874         }
875
876         rv = tegra_powergate_sequence_power_up(TEGRA_POWERGATE_PCX,
877             sc->clk_pex, sc->hwreset_pex);
878         if (rv != 0) {
879                 device_printf(sc->dev, "Cannot enable 'PCX' powergate\n");
880                 return (rv);
881         }
882
883         rv = hwreset_deassert(sc->hwreset_afi);
884         if (rv != 0) {
885                 device_printf(sc->dev, "Cannot unreset 'afi' reset\n");
886                 return (rv);
887         }
888
889         rv = clk_enable(sc->clk_afi);
890         if (rv != 0) {
891                 device_printf(sc->dev, "Cannot enable 'afi' clock\n");
892                 return (rv);
893         }
894         rv = clk_enable(sc->clk_cml);
895         if (rv != 0) {
896                 device_printf(sc->dev, "Cannot enable 'cml' clock\n");
897                 return (rv);
898         }
899         rv = clk_enable(sc->clk_pll_e);
900         if (rv != 0) {
901                 device_printf(sc->dev, "Cannot enable 'pll_e' clock\n");
902                 return (rv);
903         }
904         return (0);
905 }
906
907 static struct tegra_pcib_port *
908 tegra_pcib_parse_port(struct tegra_pcib_softc *sc, phandle_t node)
909 {
910         struct tegra_pcib_port *port;
911         uint32_t tmp[5];
912         char tmpstr[6];
913         int rv;
914
915         port = malloc(sizeof(struct tegra_pcib_port), M_DEVBUF, M_WAITOK);
916
917         rv = OF_getprop(node, "status", tmpstr, sizeof(tmpstr));
918         if (rv <= 0 || strcmp(tmpstr, "okay") == 0 ||
919            strcmp(tmpstr, "ok") == 0)
920                 port->enabled = 1;
921         else
922                 port->enabled = 0;
923
924         rv = OF_getencprop(node, "assigned-addresses", tmp, sizeof(tmp));
925         if (rv != sizeof(tmp)) {
926                 device_printf(sc->dev, "Cannot parse assigned-address: %d\n",
927                     rv);
928                 goto fail;
929         }
930         port->rp_base_addr = tmp[2];
931         port->rp_size = tmp[4];
932         port->port_idx = OFW_PCI_PHYS_HI_DEVICE(tmp[0]) - 1;
933         if (port->port_idx >= TEGRA_PCIB_MAX_PORTS) {
934                 device_printf(sc->dev, "Invalid port index: %d\n",
935                     port->port_idx);
936                 goto fail;
937         }
938         /* XXX - TODO:
939          * Implement proper function for parsing pci "reg" property:
940          *  - it have PCI bus format
941          *  - its relative to matching "assigned-addresses"
942          */
943         rv = OF_getencprop(node, "reg", tmp, sizeof(tmp));
944         if (rv != sizeof(tmp)) {
945                 device_printf(sc->dev, "Cannot parse reg: %d\n", rv);
946                 goto fail;
947         }
948         port->rp_base_addr += tmp[2];
949
950         rv = OF_getencprop(node, "nvidia,num-lanes", &port->num_lanes,
951             sizeof(port->num_lanes));
952         if (rv != sizeof(port->num_lanes)) {
953                 device_printf(sc->dev, "Cannot parse nvidia,num-lanes: %d\n",
954                     rv);
955                 goto fail;
956         }
957         if (port->num_lanes > 4) {
958                 device_printf(sc->dev, "Invalid nvidia,num-lanes: %d\n",
959                     port->num_lanes);
960                 goto fail;
961         }
962
963         port->afi_pex_ctrl = tegra_pcib_pex_ctrl(sc, port->port_idx);
964         sc->lanes_cfg |= port->num_lanes << (4 * port->port_idx);
965
966         /* Phy. */
967         rv = phy_get_by_ofw_name(sc->dev, node, "pcie-0", &port->phy);
968         if (rv != 0) {
969                 device_printf(sc->dev,
970                     "Cannot get 'pcie-0' phy for port %d\n",
971                     port->port_idx);
972                 goto fail;
973         }
974
975         return (port);
976 fail:
977         free(port, M_DEVBUF);
978         return (NULL);
979 }
980
981
982 static int
983 tegra_pcib_parse_fdt_resources(struct tegra_pcib_softc *sc, phandle_t node)
984 {
985         phandle_t child;
986         struct tegra_pcib_port *port;
987         int rv;
988
989         /* Power supplies. */
990         rv = regulator_get_by_ofw_property(sc->dev, 0, "avddio-pex-supply",
991             &sc->supply_avddio_pex);
992         if (rv != 0) {
993                 device_printf(sc->dev,
994                     "Cannot get 'avddio-pex' regulator\n");
995                 return (ENXIO);
996         }
997         rv = regulator_get_by_ofw_property(sc->dev, 0, "dvddio-pex-supply",
998              &sc->supply_dvddio_pex);
999         if (rv != 0) {
1000                 device_printf(sc->dev,
1001                     "Cannot get 'dvddio-pex' regulator\n");
1002                 return (ENXIO);
1003         }
1004         rv = regulator_get_by_ofw_property(sc->dev, 0, "avdd-pex-pll-supply",
1005              &sc->supply_avdd_pex_pll);
1006         if (rv != 0) {
1007                 device_printf(sc->dev,
1008                     "Cannot get 'avdd-pex-pll' regulator\n");
1009                 return (ENXIO);
1010         }
1011         rv = regulator_get_by_ofw_property(sc->dev, 0, "hvdd-pex-supply",
1012              &sc->supply_hvdd_pex);
1013         if (rv != 0) {
1014                 device_printf(sc->dev,
1015                     "Cannot get 'hvdd-pex' regulator\n");
1016                 return (ENXIO);
1017         }
1018         rv = regulator_get_by_ofw_property(sc->dev, 0, "hvdd-pex-pll-e-supply",
1019              &sc->supply_hvdd_pex_pll_e);
1020         if (rv != 0) {
1021                 device_printf(sc->dev,
1022                     "Cannot get 'hvdd-pex-pll-e' regulator\n");
1023                 return (ENXIO);
1024         }
1025         rv = regulator_get_by_ofw_property(sc->dev, 0, "vddio-pex-ctl-supply",
1026             &sc->supply_vddio_pex_ctl);
1027         if (rv != 0) {
1028                 device_printf(sc->dev,
1029                     "Cannot get 'vddio-pex-ctl' regulator\n");
1030                 return (ENXIO);
1031         }
1032         rv = regulator_get_by_ofw_property(sc->dev, 0, "avdd-pll-erefe-supply",
1033              &sc->supply_avdd_pll_erefe);
1034         if (rv != 0) {
1035                 device_printf(sc->dev,
1036                     "Cannot get 'avdd-pll-erefe' regulator\n");
1037                 return (ENXIO);
1038         }
1039
1040         /* Resets. */
1041         rv = hwreset_get_by_ofw_name(sc->dev, 0, "pex", &sc->hwreset_pex);
1042         if (rv != 0) {
1043                 device_printf(sc->dev, "Cannot get 'pex' reset\n");
1044                 return (ENXIO);
1045         }
1046         rv = hwreset_get_by_ofw_name(sc->dev, 0, "afi", &sc->hwreset_afi);
1047         if (rv != 0) {
1048                 device_printf(sc->dev, "Cannot get 'afi' reset\n");
1049                 return (ENXIO);
1050         }
1051         rv = hwreset_get_by_ofw_name(sc->dev, 0, "pcie_x", &sc->hwreset_pcie_x);
1052         if (rv != 0) {
1053                 device_printf(sc->dev, "Cannot get 'pcie_x' reset\n");
1054                 return (ENXIO);
1055         }
1056
1057         /* Clocks. */
1058         rv = clk_get_by_ofw_name(sc->dev, 0, "pex", &sc->clk_pex);
1059         if (rv != 0) {
1060                 device_printf(sc->dev, "Cannot get 'pex' clock\n");
1061                 return (ENXIO);
1062         }
1063         rv = clk_get_by_ofw_name(sc->dev, 0, "afi", &sc->clk_afi);
1064         if (rv != 0) {
1065                 device_printf(sc->dev, "Cannot get 'afi' clock\n");
1066                 return (ENXIO);
1067         }
1068         rv = clk_get_by_ofw_name(sc->dev, 0, "pll_e", &sc->clk_pll_e);
1069         if (rv != 0) {
1070                 device_printf(sc->dev, "Cannot get 'pll_e' clock\n");
1071                 return (ENXIO);
1072         }
1073         rv = clk_get_by_ofw_name(sc->dev, 0, "cml", &sc->clk_cml);
1074         if (rv != 0) {
1075                 device_printf(sc->dev, "Cannot get 'cml' clock\n");
1076                 return (ENXIO);
1077         }
1078
1079         /* Ports */
1080         sc->num_ports = 0;
1081         for (child = OF_child(node); child != 0; child = OF_peer(child)) {
1082                 port = tegra_pcib_parse_port(sc, child);
1083                 if (port == NULL) {
1084                         device_printf(sc->dev, "Cannot parse PCIe port node\n");
1085                         return (ENXIO);
1086                 }
1087                 sc->ports[sc->num_ports++] = port;
1088         }
1089
1090         return (0);
1091 }
1092
1093 static int
1094 tegra_pcib_decode_ranges(struct tegra_pcib_softc *sc,
1095     struct ofw_pci_range *ranges, int nranges)
1096 {
1097         int i;
1098
1099         for (i = 2; i < nranges; i++) {
1100                 if ((ranges[i].pci_hi & OFW_PCI_PHYS_HI_SPACEMASK)  ==
1101                     OFW_PCI_PHYS_HI_SPACE_IO) {
1102                         if (sc->io_range.size != 0) {
1103                                 device_printf(sc->dev,
1104                                     "Duplicated IO range found in DT\n");
1105                                 return (ENXIO);
1106                         }
1107                         sc->io_range = ranges[i];
1108                 }
1109                 if (((ranges[i].pci_hi & OFW_PCI_PHYS_HI_SPACEMASK) ==
1110                     OFW_PCI_PHYS_HI_SPACE_MEM32))  {
1111                         if (ranges[i].pci_hi & OFW_PCI_PHYS_HI_PREFETCHABLE) {
1112                                 if (sc->pref_mem_range.size != 0) {
1113                                         device_printf(sc->dev,
1114                                             "Duplicated memory range found "
1115                                             "in DT\n");
1116                                         return (ENXIO);
1117                                 }
1118                                 sc->pref_mem_range = ranges[i];
1119                         } else {
1120                                 if (sc->mem_range.size != 0) {
1121                                         device_printf(sc->dev,
1122                                             "Duplicated memory range found "
1123                                             "in DT\n");
1124                                         return (ENXIO);
1125                                 }
1126                                 sc->mem_range = ranges[i];
1127                         }
1128                 }
1129         }
1130         if ((sc->io_range.size == 0) || (sc->mem_range.size == 0)
1131             || (sc->pref_mem_range.size == 0)) {
1132                 device_printf(sc->dev,
1133                     " Not all required ranges are found in DT\n");
1134                 return (ENXIO);
1135         }
1136         return (0);
1137 }
1138
1139 /*
1140  * Hardware config.
1141  */
1142 static int
1143 tegra_pcib_wait_for_link(struct tegra_pcib_softc *sc,
1144     struct tegra_pcib_port *port)
1145 {
1146         uint32_t reg;
1147         int i;
1148
1149
1150         /* Setup link detection. */
1151         reg = tegra_pcib_read_config(sc->dev, 0, port->port_idx, 0,
1152             RP_PRIV_MISC, 4);
1153         reg &= ~RP_PRIV_MISC_PRSNT_MAP_EP_ABSNT;
1154         reg |= RP_PRIV_MISC_PRSNT_MAP_EP_PRSNT;
1155         tegra_pcib_write_config(sc->dev, 0, port->port_idx, 0,
1156             RP_PRIV_MISC, reg, 4);
1157
1158         for (i = TEGRA_PCIE_LINKUP_TIMEOUT; i > 0; i--) {
1159                 reg = tegra_pcib_read_config(sc->dev, 0, port->port_idx, 0,
1160                     RP_VEND_XP, 4);
1161                 if (reg & RP_VEND_XP_DL_UP)
1162                                 break;
1163
1164         }
1165         if (i <= 0)
1166                 return (ETIMEDOUT);
1167
1168         for (i = TEGRA_PCIE_LINKUP_TIMEOUT; i > 0; i--) {
1169                 reg = tegra_pcib_read_config(sc->dev, 0, port->port_idx, 0,
1170                     RP_LINK_CONTROL_STATUS, 4);
1171                 if (reg & RP_LINK_CONTROL_STATUS_DL_LINK_ACTIVE)
1172                                 break;
1173
1174         }
1175         if (i <= 0)
1176                 return (ETIMEDOUT);
1177         return (0);
1178 }
1179
1180 static void
1181 tegra_pcib_port_enable(struct tegra_pcib_softc *sc, int port_num)
1182 {
1183         struct tegra_pcib_port *port;
1184         uint32_t reg;
1185         int rv;
1186
1187         port = sc->ports[port_num];
1188
1189         /* Put port to reset. */
1190         reg = AFI_RD4(sc, port->afi_pex_ctrl);
1191         reg &= ~AFI_PEX_CTRL_RST_L;
1192         AFI_WR4(sc, port->afi_pex_ctrl, reg);
1193         AFI_RD4(sc, port->afi_pex_ctrl);
1194         DELAY(10);
1195
1196         /* Enable clocks. */
1197         reg |= AFI_PEX_CTRL_REFCLK_EN;
1198         reg |= AFI_PEX_CTRL_CLKREQ_EN;
1199         reg |= AFI_PEX_CTRL_OVERRIDE_EN;
1200         AFI_WR4(sc, port->afi_pex_ctrl, reg);
1201         AFI_RD4(sc, port->afi_pex_ctrl);
1202         DELAY(100);
1203
1204         /* Release reset. */
1205         reg |= AFI_PEX_CTRL_RST_L;
1206         AFI_WR4(sc, port->afi_pex_ctrl, reg);
1207
1208         rv = tegra_pcib_wait_for_link(sc, port);
1209         if (bootverbose)
1210                 device_printf(sc->dev, " port %d (%d lane%s): Link is %s\n",
1211                          port->port_idx, port->num_lanes,
1212                          port->num_lanes > 1 ? "s": "",
1213                          rv == 0 ? "up": "down");
1214 }
1215
1216
1217 static void
1218 tegra_pcib_port_disable(struct tegra_pcib_softc *sc, uint32_t port_num)
1219 {
1220         struct tegra_pcib_port *port;
1221         uint32_t reg;
1222
1223         port = sc->ports[port_num];
1224
1225         /* Put port to reset. */
1226         reg = AFI_RD4(sc, port->afi_pex_ctrl);
1227         reg &= ~AFI_PEX_CTRL_RST_L;
1228         AFI_WR4(sc, port->afi_pex_ctrl, reg);
1229         AFI_RD4(sc, port->afi_pex_ctrl);
1230         DELAY(10);
1231
1232         /* Disable clocks. */
1233         reg &= ~AFI_PEX_CTRL_CLKREQ_EN;
1234         reg &= ~AFI_PEX_CTRL_REFCLK_EN;
1235         AFI_WR4(sc, port->afi_pex_ctrl, reg);
1236
1237         if (bootverbose)
1238                 device_printf(sc->dev, " port %d (%d lane%s): Disabled\n",
1239                          port->port_idx, port->num_lanes,
1240                          port->num_lanes > 1 ? "s": "");
1241 }
1242
1243 static void
1244 tegra_pcib_set_bar(struct tegra_pcib_softc *sc, int bar, uint32_t axi,
1245     uint64_t fpci, uint32_t size, int is_memory)
1246 {
1247         uint32_t fpci_reg;
1248         uint32_t axi_reg;
1249         uint32_t size_reg;
1250
1251         axi_reg = axi & ~0xFFF;
1252         size_reg = size >> 12;
1253         fpci_reg = (uint32_t)(fpci >> 8) & ~0xF;
1254         fpci_reg |= is_memory ? 0x1 : 0x0;
1255         AFI_WR4(sc, bars[bar].axi_start, axi_reg);
1256         AFI_WR4(sc, bars[bar].size, size_reg);
1257         AFI_WR4(sc, bars[bar].fpci_start, fpci_reg);
1258 }
1259
1260 static int
1261 tegra_pcib_enable(struct tegra_pcib_softc *sc)
1262 {
1263         int rv;
1264         int i;
1265         uint32_t reg;
1266
1267         rv = tegra_pcib_enable_fdt_resources(sc);
1268         if (rv != 0) {
1269                 device_printf(sc->dev, "Cannot enable FDT resources\n");
1270                 return (rv);
1271         }
1272         /* Enable PLLE control. */
1273         reg = AFI_RD4(sc, AFI_PLLE_CONTROL);
1274         reg &= ~AFI_PLLE_CONTROL_BYPASS_PADS2PLLE_CONTROL;
1275         reg |= AFI_PLLE_CONTROL_PADS2PLLE_CONTROL_EN;
1276         AFI_WR4(sc, AFI_PLLE_CONTROL, reg);
1277
1278         /* Set bias pad. */
1279         AFI_WR4(sc, AFI_PEXBIAS_CTRL, 0);
1280
1281         /* Configure mode and ports. */
1282         reg = AFI_RD4(sc, AFI_PCIE_CONFIG);
1283         reg &= ~AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_MASK;
1284         if (sc->lanes_cfg == 0x14) {
1285                 if (bootverbose)
1286                         device_printf(sc->dev,
1287                             "Using x1,x4 configuration\n");
1288                 reg |= AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_XBAR4_1;
1289         } else if (sc->lanes_cfg == 0x12) {
1290                 if (bootverbose)
1291                         device_printf(sc->dev,
1292                             "Using x1,x2 configuration\n");
1293                 reg |= AFI_PCIE_CONFIG_SM2TMS0_XBAR_CONFIG_XBAR2_1;
1294         } else {
1295                 device_printf(sc->dev,
1296                     "Unsupported lanes configuration: 0x%X\n", sc->lanes_cfg);
1297         }
1298         reg |= AFI_PCIE_CONFIG_PCIE_DISABLE_ALL;
1299         for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
1300                 if ((sc->ports[i] != NULL))
1301                         reg &=
1302                          ~AFI_PCIE_CONFIG_PCIE_DISABLE(sc->ports[i]->port_idx);
1303         }
1304         AFI_WR4(sc, AFI_PCIE_CONFIG, reg);
1305
1306         /* Enable Gen2 support. */
1307         reg = AFI_RD4(sc, AFI_FUSE);
1308         reg &= ~AFI_FUSE_PCIE_T0_GEN2_DIS;
1309         AFI_WR4(sc, AFI_FUSE, reg);
1310
1311         for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
1312                 if (sc->ports[i] != NULL) {
1313                         rv = phy_enable(sc->dev, sc->ports[i]->phy);
1314                         if (rv != 0) {
1315                                 device_printf(sc->dev,
1316                                     "Cannot enable phy for port %d\n",
1317                                     sc->ports[i]->port_idx);
1318                                 return (rv);
1319                         }
1320                 }
1321         }
1322
1323
1324         rv = hwreset_deassert(sc->hwreset_pcie_x);
1325         if (rv != 0) {
1326                 device_printf(sc->dev, "Cannot unreset  'pci_x' reset\n");
1327                 return (rv);
1328         }
1329
1330         /* Enable config space. */
1331         reg = AFI_RD4(sc, AFI_CONFIGURATION);
1332         reg |= AFI_CONFIGURATION_EN_FPCI;
1333         AFI_WR4(sc, AFI_CONFIGURATION, reg);
1334
1335         /* Enable AFI errors. */
1336         reg = 0;
1337         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_INI_SLVERR);
1338         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_INI_DECERR);
1339         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_TGT_SLVERR);
1340         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_TGT_DECERR);
1341         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_TGT_WRERR);
1342         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_SM_MSG);
1343         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_DFPCI_DECERR);
1344         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_AXI_DECERR);
1345         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_FPCI_TIMEOUT);
1346         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_PE_PRSNT_SENSE);
1347         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_PE_CLKREQ_SENSE);
1348         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_CLKCLAMP_SENSE);
1349         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_RDY4PD_SENSE);
1350         reg |= AFI_AFI_INTR_ENABLE_CODE(AFI_INTR_CODE_INT_CODE_P2P_ERROR);
1351         AFI_WR4(sc, AFI_AFI_INTR_ENABLE, reg);
1352         AFI_WR4(sc, AFI_SM_INTR_ENABLE, 0xffffffff);
1353
1354         /* Enable INT, disable MSI. */
1355         AFI_WR4(sc, AFI_INTR_MASK, AFI_INTR_MASK_INT_MASK);
1356
1357         /* Mask all FPCI errors. */
1358         AFI_WR4(sc, AFI_FPCI_ERROR_MASKS, 0);
1359
1360         /* Setup AFI translation windows. */
1361         /* BAR 0 - type 1 extended configuration. */
1362         tegra_pcib_set_bar(sc, 0, rman_get_start(sc->cfg_mem_res),
1363            FPCI_MAP_EXT_TYPE1_CONFIG, rman_get_size(sc->cfg_mem_res), 0);
1364
1365         /* BAR 1 - downstream I/O. */
1366         tegra_pcib_set_bar(sc, 1, sc->io_range.host, FPCI_MAP_IO,
1367             sc->io_range.size, 0);
1368
1369         /* BAR 2 - downstream prefetchable memory 1:1. */
1370         tegra_pcib_set_bar(sc, 2, sc->pref_mem_range.host,
1371             sc->pref_mem_range.host, sc->pref_mem_range.size, 1);
1372
1373         /* BAR 3 - downstream not prefetchable memory 1:1 .*/
1374         tegra_pcib_set_bar(sc, 3, sc->mem_range.host,
1375             sc->mem_range.host, sc->mem_range.size, 1);
1376
1377         /* BAR 3-8 clear. */
1378         tegra_pcib_set_bar(sc, 4, 0, 0, 0, 0);
1379         tegra_pcib_set_bar(sc, 5, 0, 0, 0, 0);
1380         tegra_pcib_set_bar(sc, 6, 0, 0, 0, 0);
1381         tegra_pcib_set_bar(sc, 7, 0, 0, 0, 0);
1382         tegra_pcib_set_bar(sc, 8, 0, 0, 0, 0);
1383
1384         /* MSI BAR - clear. */
1385         tegra_pcib_set_bar(sc, 9, 0, 0, 0, 0);
1386         return(0);
1387 }
1388
1389 #ifdef TEGRA_PCIB_MSI_ENABLE
1390 static int
1391 tegra_pcib_attach_msi(device_t dev)
1392 {
1393         struct tegra_pcib_softc *sc;
1394         uint32_t reg;
1395         int i, rv;
1396
1397         sc = device_get_softc(dev);
1398
1399         sc->msi_page = kmem_alloc_contig(kernel_arena, PAGE_SIZE, M_WAITOK,
1400             0, BUS_SPACE_MAXADDR, PAGE_SIZE, 0, VM_MEMATTR_DEFAULT);
1401
1402         /* MSI BAR */
1403         tegra_pcib_set_bar(sc, 9, vtophys(sc->msi_page), vtophys(sc->msi_page),
1404             PAGE_SIZE, 0);
1405
1406         /* Disble and clear all interrupts. */
1407         for (i = 0; i < AFI_MSI_REGS; i++) {
1408                 AFI_WR4(sc, AFI_MSI_EN_VEC(i), 0);
1409                 AFI_WR4(sc, AFI_MSI_VEC(i), 0xFFFFFFFF);
1410         }
1411         rv = bus_setup_intr(dev, sc->msi_irq_res, INTR_TYPE_BIO | INTR_MPSAFE,
1412             tegra_pcib_msi_intr, NULL, sc, &sc->msi_intr_cookie);
1413         if (rv != 0) {
1414                 device_printf(dev, "cannot setup MSI interrupt handler\n");
1415                 rv = ENXIO;
1416                 goto out;
1417         }
1418
1419         if (tegra_pcib_msi_attach(sc) != 0) {
1420                 device_printf(dev, "WARNING: unable to attach PIC\n");
1421                 tegra_pcib_msi_detach(sc);
1422                 goto out;
1423         }
1424
1425         /* Unmask  MSI interrupt. */
1426         reg = AFI_RD4(sc, AFI_INTR_MASK);
1427         reg |= AFI_INTR_MASK_MSI_MASK;
1428         AFI_WR4(sc, AFI_INTR_MASK, reg);
1429
1430 out:
1431         return (rv);
1432 }
1433 #endif
1434
1435 static int
1436 tegra_pcib_probe(device_t dev)
1437 {
1438         if (!ofw_bus_status_okay(dev))
1439                 return (ENXIO);
1440
1441         if (ofw_bus_search_compatible(dev, compat_data)->ocd_data != 0) {
1442                 device_set_desc(dev, "Nvidia Integrated PCI/PCI-E Controller");
1443                 return (BUS_PROBE_DEFAULT);
1444         }
1445         return (ENXIO);
1446 }
1447
1448 static int
1449 tegra_pcib_attach(device_t dev)
1450 {
1451         struct tegra_pcib_softc *sc;
1452         phandle_t node;
1453         int rv;
1454         int rid;
1455         struct tegra_pcib_port *port;
1456         int i;
1457
1458         sc = device_get_softc(dev);
1459         sc->dev = dev;
1460         mtx_init(&sc->mtx, "msi_mtx", NULL, MTX_DEF);
1461
1462         node = ofw_bus_get_node(dev);
1463
1464         rv = tegra_pcib_parse_fdt_resources(sc, node);
1465         if (rv != 0) {
1466                 device_printf(dev, "Cannot get FDT resources\n");
1467                 return (rv);
1468         }
1469
1470         /* Allocate bus_space resources. */
1471         rid = 0;
1472         sc->pads_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
1473             RF_ACTIVE);
1474         if (sc->pads_mem_res == NULL) {
1475                 device_printf(dev, "Cannot allocate PADS register\n");
1476                 rv = ENXIO;
1477                 goto out;
1478         }
1479         /*
1480          * XXX - FIXME
1481          * tag for config space is not filled when RF_ALLOCATED flag is used.
1482          */
1483         sc->bus_tag = rman_get_bustag(sc->pads_mem_res);
1484
1485         rid = 1;
1486         sc->afi_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
1487             RF_ACTIVE);
1488         if (sc->afi_mem_res == NULL) {
1489                 device_printf(dev, "Cannot allocate AFI register\n");
1490                 rv = ENXIO;
1491                 goto out;
1492         }
1493
1494         rid = 2;
1495         sc->cfg_mem_res = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
1496             RF_ALLOCATED);
1497         if (sc->cfg_mem_res == NULL) {
1498                 device_printf(dev, "Cannot allocate config space memory\n");
1499                 rv = ENXIO;
1500                 goto out;
1501         }
1502         sc->cfg_base_addr = rman_get_start(sc->cfg_mem_res);
1503
1504
1505         /* Map RP slots */
1506         for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
1507                 if (sc->ports[i] == NULL)
1508                         continue;
1509                 port = sc->ports[i];
1510                 rv = bus_space_map(sc->bus_tag, port->rp_base_addr,
1511                     port->rp_size, 0, &port->cfg_handle);
1512                 if (rv != 0) {
1513                         device_printf(sc->dev, "Cannot allocate memory for "
1514                             "port: %d\n", i);
1515                         rv = ENXIO;
1516                         goto out;
1517                 }
1518         }
1519
1520         /*
1521          * Get PCI interrupt
1522          */
1523         rid = 0;
1524         sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
1525             RF_ACTIVE | RF_SHAREABLE);
1526         if (sc->irq_res == NULL) {
1527                 device_printf(dev, "Cannot allocate IRQ resources\n");
1528                 rv = ENXIO;
1529                 goto out;
1530         }
1531
1532         rid = 1;
1533         sc->msi_irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &rid,
1534             RF_ACTIVE);
1535         if (sc->irq_res == NULL) {
1536                 device_printf(dev, "Cannot allocate MSI IRQ resources\n");
1537                 rv = ENXIO;
1538                 goto out;
1539         }
1540
1541         sc->ofw_pci.sc_range_mask = 0x3;
1542         rv = ofw_pci_init(dev);
1543         if (rv != 0)
1544                 goto out;
1545
1546         rv = tegra_pcib_decode_ranges(sc, sc->ofw_pci.sc_range,
1547             sc->ofw_pci.sc_nrange);
1548         if (rv != 0)
1549                 goto out;
1550
1551         if (bus_setup_intr(dev, sc->irq_res, INTR_TYPE_BIO | INTR_MPSAFE,
1552                     tegra_pci_intr, NULL, sc, &sc->intr_cookie)) {
1553                 device_printf(dev, "cannot setup interrupt handler\n");
1554                 rv = ENXIO;
1555                 goto out;
1556         }
1557
1558         /*
1559          * Enable PCIE device.
1560          */
1561         rv = tegra_pcib_enable(sc);
1562         if (rv != 0)
1563                 goto out;
1564         for (i = 0; i < TEGRA_PCIB_MAX_PORTS; i++) {
1565                 if (sc->ports[i] == NULL)
1566                         continue;
1567                 if (sc->ports[i]->enabled)
1568                         tegra_pcib_port_enable(sc, i);
1569                 else
1570                         tegra_pcib_port_disable(sc, i);
1571         }
1572
1573 #ifdef TEGRA_PCIB_MSI_ENABLE
1574         rv = tegra_pcib_attach_msi(dev);
1575         if (rv != 0)
1576                  goto out;
1577 #endif
1578         device_add_child(dev, "pci", -1);
1579
1580         return (bus_generic_attach(dev));
1581
1582 out:
1583
1584         return (rv);
1585 }
1586
1587
1588 static device_method_t tegra_pcib_methods[] = {
1589         /* Device interface */
1590         DEVMETHOD(device_probe,                 tegra_pcib_probe),
1591         DEVMETHOD(device_attach,                tegra_pcib_attach),
1592
1593         /* Bus interface */
1594         DEVMETHOD(bus_setup_intr,               bus_generic_setup_intr),
1595         DEVMETHOD(bus_teardown_intr,            bus_generic_teardown_intr),
1596
1597         /* pcib interface */
1598         DEVMETHOD(pcib_maxslots,                tegra_pcib_maxslots),
1599         DEVMETHOD(pcib_read_config,             tegra_pcib_read_config),
1600         DEVMETHOD(pcib_write_config,            tegra_pcib_write_config),
1601         DEVMETHOD(pcib_route_interrupt,         tegra_pcib_route_interrupt),
1602         DEVMETHOD(pcib_alloc_msi,               tegra_pcib_alloc_msi),
1603         DEVMETHOD(pcib_release_msi,             tegra_pcib_release_msi),
1604         DEVMETHOD(pcib_map_msi,                 tegra_pcib_map_msi),
1605
1606 #ifdef TEGRA_PCIB_MSI_ENABLE
1607         /* MSI/MSI-X */
1608         DEVMETHOD(msi_alloc_msi,                tegra_pcib_msi_alloc_msi),
1609         DEVMETHOD(msi_release_msi,              tegra_pcib_msi_release_msi),
1610         DEVMETHOD(msi_map_msi,                  tegra_pcib_msi_map_msi),
1611
1612         /* Interrupt controller interface */
1613         DEVMETHOD(pic_disable_intr,             tegra_pcib_msi_disable_intr),
1614         DEVMETHOD(pic_enable_intr,              tegra_pcib_msi_enable_intr),
1615         DEVMETHOD(pic_setup_intr,               tegra_pcib_msi_setup_intr),
1616         DEVMETHOD(pic_teardown_intr,            tegra_pcib_msi_teardown_intr),
1617         DEVMETHOD(pic_post_filter,              tegra_pcib_msi_post_filter),
1618         DEVMETHOD(pic_post_ithread,             tegra_pcib_msi_post_ithread),
1619         DEVMETHOD(pic_pre_ithread,              tegra_pcib_msi_pre_ithread),
1620 #endif
1621
1622         /* OFW bus interface */
1623         DEVMETHOD(ofw_bus_get_compat,           ofw_bus_gen_get_compat),
1624         DEVMETHOD(ofw_bus_get_model,            ofw_bus_gen_get_model),
1625         DEVMETHOD(ofw_bus_get_name,             ofw_bus_gen_get_name),
1626         DEVMETHOD(ofw_bus_get_node,             ofw_bus_gen_get_node),
1627         DEVMETHOD(ofw_bus_get_type,             ofw_bus_gen_get_type),
1628
1629         DEVMETHOD_END
1630 };
1631
1632 static devclass_t pcib_devclass;
1633 DEFINE_CLASS_1(pcib, tegra_pcib_driver, tegra_pcib_methods,
1634     sizeof(struct tegra_pcib_softc), ofw_pci_driver);
1635 DRIVER_MODULE(pcib, simplebus, tegra_pcib_driver, pcib_devclass,
1636     NULL, NULL);