imx: imx8qm/qxp: check whether m4 partition booted
[oweals/u-boot.git] / drivers / pci / pcie_imx.c
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Freescale i.MX6 PCI Express Root-Complex driver
4  *
5  * Copyright (C) 2013 Marek Vasut <marex@denx.de>
6  *
7  * Based on upstream Linux kernel driver:
8  * pci-imx6.c:          Sean Cross <xobs@kosagi.com>
9  * pcie-designware.c:   Jingoo Han <jg1.han@samsung.com>
10  */
11
12 #include <common.h>
13 #include <init.h>
14 #include <malloc.h>
15 #include <pci.h>
16 #include <asm/arch/clock.h>
17 #include <asm/arch/iomux.h>
18 #include <asm/arch/crm_regs.h>
19 #include <asm/gpio.h>
20 #include <asm/io.h>
21 #include <dm.h>
22 #include <linux/sizes.h>
23 #include <errno.h>
24 #include <asm/arch/sys_proto.h>
25
26 #define PCI_ACCESS_READ  0
27 #define PCI_ACCESS_WRITE 1
28
29 #ifdef CONFIG_MX6SX
30 #define MX6_DBI_ADDR    0x08ffc000
31 #define MX6_IO_ADDR     0x08000000
32 #define MX6_MEM_ADDR    0x08100000
33 #define MX6_ROOT_ADDR   0x08f00000
34 #else
35 #define MX6_DBI_ADDR    0x01ffc000
36 #define MX6_IO_ADDR     0x01000000
37 #define MX6_MEM_ADDR    0x01100000
38 #define MX6_ROOT_ADDR   0x01f00000
39 #endif
40 #define MX6_DBI_SIZE    0x4000
41 #define MX6_IO_SIZE     0x100000
42 #define MX6_MEM_SIZE    0xe00000
43 #define MX6_ROOT_SIZE   0xfc000
44
45 /* PCIe Port Logic registers (memory-mapped) */
46 #define PL_OFFSET 0x700
47 #define PCIE_PL_PFLR (PL_OFFSET + 0x08)
48 #define PCIE_PL_PFLR_LINK_STATE_MASK            (0x3f << 16)
49 #define PCIE_PL_PFLR_FORCE_LINK                 (1 << 15)
50 #define PCIE_PHY_DEBUG_R0 (PL_OFFSET + 0x28)
51 #define PCIE_PHY_DEBUG_R1 (PL_OFFSET + 0x2c)
52 #define PCIE_PHY_DEBUG_R1_LINK_UP               (1 << 4)
53 #define PCIE_PHY_DEBUG_R1_LINK_IN_TRAINING      (1 << 29)
54
55 #define PCIE_PHY_CTRL (PL_OFFSET + 0x114)
56 #define PCIE_PHY_CTRL_DATA_LOC 0
57 #define PCIE_PHY_CTRL_CAP_ADR_LOC 16
58 #define PCIE_PHY_CTRL_CAP_DAT_LOC 17
59 #define PCIE_PHY_CTRL_WR_LOC 18
60 #define PCIE_PHY_CTRL_RD_LOC 19
61
62 #define PCIE_PHY_STAT (PL_OFFSET + 0x110)
63 #define PCIE_PHY_STAT_DATA_LOC 0
64 #define PCIE_PHY_STAT_ACK_LOC 16
65
66 /* PHY registers (not memory-mapped) */
67 #define PCIE_PHY_RX_ASIC_OUT 0x100D
68
69 #define PHY_RX_OVRD_IN_LO 0x1005
70 #define PHY_RX_OVRD_IN_LO_RX_DATA_EN (1 << 5)
71 #define PHY_RX_OVRD_IN_LO_RX_PLL_EN (1 << 3)
72
73 #define PCIE_PHY_PUP_REQ                (1 << 7)
74
75 /* iATU registers */
76 #define PCIE_ATU_VIEWPORT               0x900
77 #define PCIE_ATU_REGION_INBOUND         (0x1 << 31)
78 #define PCIE_ATU_REGION_OUTBOUND        (0x0 << 31)
79 #define PCIE_ATU_REGION_INDEX1          (0x1 << 0)
80 #define PCIE_ATU_REGION_INDEX0          (0x0 << 0)
81 #define PCIE_ATU_CR1                    0x904
82 #define PCIE_ATU_TYPE_MEM               (0x0 << 0)
83 #define PCIE_ATU_TYPE_IO                (0x2 << 0)
84 #define PCIE_ATU_TYPE_CFG0              (0x4 << 0)
85 #define PCIE_ATU_TYPE_CFG1              (0x5 << 0)
86 #define PCIE_ATU_CR2                    0x908
87 #define PCIE_ATU_ENABLE                 (0x1 << 31)
88 #define PCIE_ATU_BAR_MODE_ENABLE        (0x1 << 30)
89 #define PCIE_ATU_LOWER_BASE             0x90C
90 #define PCIE_ATU_UPPER_BASE             0x910
91 #define PCIE_ATU_LIMIT                  0x914
92 #define PCIE_ATU_LOWER_TARGET           0x918
93 #define PCIE_ATU_BUS(x)                 (((x) & 0xff) << 24)
94 #define PCIE_ATU_DEV(x)                 (((x) & 0x1f) << 19)
95 #define PCIE_ATU_FUNC(x)                (((x) & 0x7) << 16)
96 #define PCIE_ATU_UPPER_TARGET           0x91C
97
98 struct imx_pcie_priv {
99         void __iomem            *dbi_base;
100         void __iomem            *cfg_base;
101 };
102
103 /*
104  * PHY access functions
105  */
106 static int pcie_phy_poll_ack(void __iomem *dbi_base, int exp_val)
107 {
108         u32 val;
109         u32 max_iterations = 10;
110         u32 wait_counter = 0;
111
112         do {
113                 val = readl(dbi_base + PCIE_PHY_STAT);
114                 val = (val >> PCIE_PHY_STAT_ACK_LOC) & 0x1;
115                 wait_counter++;
116
117                 if (val == exp_val)
118                         return 0;
119
120                 udelay(1);
121         } while (wait_counter < max_iterations);
122
123         return -ETIMEDOUT;
124 }
125
126 static int pcie_phy_wait_ack(void __iomem *dbi_base, int addr)
127 {
128         u32 val;
129         int ret;
130
131         val = addr << PCIE_PHY_CTRL_DATA_LOC;
132         writel(val, dbi_base + PCIE_PHY_CTRL);
133
134         val |= (0x1 << PCIE_PHY_CTRL_CAP_ADR_LOC);
135         writel(val, dbi_base + PCIE_PHY_CTRL);
136
137         ret = pcie_phy_poll_ack(dbi_base, 1);
138         if (ret)
139                 return ret;
140
141         val = addr << PCIE_PHY_CTRL_DATA_LOC;
142         writel(val, dbi_base + PCIE_PHY_CTRL);
143
144         ret = pcie_phy_poll_ack(dbi_base, 0);
145         if (ret)
146                 return ret;
147
148         return 0;
149 }
150
151 /* Read from the 16-bit PCIe PHY control registers (not memory-mapped) */
152 static int pcie_phy_read(void __iomem *dbi_base, int addr , int *data)
153 {
154         u32 val, phy_ctl;
155         int ret;
156
157         ret = pcie_phy_wait_ack(dbi_base, addr);
158         if (ret)
159                 return ret;
160
161         /* assert Read signal */
162         phy_ctl = 0x1 << PCIE_PHY_CTRL_RD_LOC;
163         writel(phy_ctl, dbi_base + PCIE_PHY_CTRL);
164
165         ret = pcie_phy_poll_ack(dbi_base, 1);
166         if (ret)
167                 return ret;
168
169         val = readl(dbi_base + PCIE_PHY_STAT);
170         *data = val & 0xffff;
171
172         /* deassert Read signal */
173         writel(0x00, dbi_base + PCIE_PHY_CTRL);
174
175         ret = pcie_phy_poll_ack(dbi_base, 0);
176         if (ret)
177                 return ret;
178
179         return 0;
180 }
181
182 static int pcie_phy_write(void __iomem *dbi_base, int addr, int data)
183 {
184         u32 var;
185         int ret;
186
187         /* write addr */
188         /* cap addr */
189         ret = pcie_phy_wait_ack(dbi_base, addr);
190         if (ret)
191                 return ret;
192
193         var = data << PCIE_PHY_CTRL_DATA_LOC;
194         writel(var, dbi_base + PCIE_PHY_CTRL);
195
196         /* capture data */
197         var |= (0x1 << PCIE_PHY_CTRL_CAP_DAT_LOC);
198         writel(var, dbi_base + PCIE_PHY_CTRL);
199
200         ret = pcie_phy_poll_ack(dbi_base, 1);
201         if (ret)
202                 return ret;
203
204         /* deassert cap data */
205         var = data << PCIE_PHY_CTRL_DATA_LOC;
206         writel(var, dbi_base + PCIE_PHY_CTRL);
207
208         /* wait for ack de-assertion */
209         ret = pcie_phy_poll_ack(dbi_base, 0);
210         if (ret)
211                 return ret;
212
213         /* assert wr signal */
214         var = 0x1 << PCIE_PHY_CTRL_WR_LOC;
215         writel(var, dbi_base + PCIE_PHY_CTRL);
216
217         /* wait for ack */
218         ret = pcie_phy_poll_ack(dbi_base, 1);
219         if (ret)
220                 return ret;
221
222         /* deassert wr signal */
223         var = data << PCIE_PHY_CTRL_DATA_LOC;
224         writel(var, dbi_base + PCIE_PHY_CTRL);
225
226         /* wait for ack de-assertion */
227         ret = pcie_phy_poll_ack(dbi_base, 0);
228         if (ret)
229                 return ret;
230
231         writel(0x0, dbi_base + PCIE_PHY_CTRL);
232
233         return 0;
234 }
235
236 static int imx6_pcie_link_up(struct imx_pcie_priv *priv)
237 {
238         u32 rc, ltssm;
239         int rx_valid, temp;
240
241         /* link is debug bit 36, debug register 1 starts at bit 32 */
242         rc = readl(priv->dbi_base + PCIE_PHY_DEBUG_R1);
243         if ((rc & PCIE_PHY_DEBUG_R1_LINK_UP) &&
244             !(rc & PCIE_PHY_DEBUG_R1_LINK_IN_TRAINING))
245                 return -EAGAIN;
246
247         /*
248          * From L0, initiate MAC entry to gen2 if EP/RC supports gen2.
249          * Wait 2ms (LTSSM timeout is 24ms, PHY lock is ~5us in gen2).
250          * If (MAC/LTSSM.state == Recovery.RcvrLock)
251          * && (PHY/rx_valid==0) then pulse PHY/rx_reset. Transition
252          * to gen2 is stuck
253          */
254         pcie_phy_read(priv->dbi_base, PCIE_PHY_RX_ASIC_OUT, &rx_valid);
255         ltssm = readl(priv->dbi_base + PCIE_PHY_DEBUG_R0) & 0x3F;
256
257         if (rx_valid & 0x01)
258                 return 0;
259
260         if (ltssm != 0x0d)
261                 return 0;
262
263         printf("transition to gen2 is stuck, reset PHY!\n");
264
265         pcie_phy_read(priv->dbi_base, PHY_RX_OVRD_IN_LO, &temp);
266         temp |= (PHY_RX_OVRD_IN_LO_RX_DATA_EN | PHY_RX_OVRD_IN_LO_RX_PLL_EN);
267         pcie_phy_write(priv->dbi_base, PHY_RX_OVRD_IN_LO, temp);
268
269         udelay(3000);
270
271         pcie_phy_read(priv->dbi_base, PHY_RX_OVRD_IN_LO, &temp);
272         temp &= ~(PHY_RX_OVRD_IN_LO_RX_DATA_EN | PHY_RX_OVRD_IN_LO_RX_PLL_EN);
273         pcie_phy_write(priv->dbi_base, PHY_RX_OVRD_IN_LO, temp);
274
275         return 0;
276 }
277
278 /*
279  * iATU region setup
280  */
281 static int imx_pcie_regions_setup(struct imx_pcie_priv *priv)
282 {
283         /*
284          * i.MX6 defines 16MB in the AXI address map for PCIe.
285          *
286          * That address space excepted the pcie registers is
287          * split and defined into different regions by iATU,
288          * with sizes and offsets as follows:
289          *
290          * 0x0100_0000 --- 0x010F_FFFF 1MB IORESOURCE_IO
291          * 0x0110_0000 --- 0x01EF_FFFF 14MB IORESOURCE_MEM
292          * 0x01F0_0000 --- 0x01FF_FFFF 1MB Cfg + Registers
293          */
294
295         /* CMD reg:I/O space, MEM space, and Bus Master Enable */
296         setbits_le32(priv->dbi_base + PCI_COMMAND,
297                      PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER);
298
299         /* Set the CLASS_REV of RC CFG header to PCI_CLASS_BRIDGE_PCI */
300         setbits_le32(priv->dbi_base + PCI_CLASS_REVISION,
301                      PCI_CLASS_BRIDGE_PCI << 16);
302
303         /* Region #0 is used for Outbound CFG space access. */
304         writel(0, priv->dbi_base + PCIE_ATU_VIEWPORT);
305
306         writel(lower_32_bits((uintptr_t)priv->cfg_base),
307                priv->dbi_base + PCIE_ATU_LOWER_BASE);
308         writel(upper_32_bits((uintptr_t)priv->cfg_base),
309                priv->dbi_base + PCIE_ATU_UPPER_BASE);
310         writel(lower_32_bits((uintptr_t)priv->cfg_base + MX6_ROOT_SIZE),
311                priv->dbi_base + PCIE_ATU_LIMIT);
312
313         writel(0, priv->dbi_base + PCIE_ATU_LOWER_TARGET);
314         writel(0, priv->dbi_base + PCIE_ATU_UPPER_TARGET);
315         writel(PCIE_ATU_TYPE_CFG0, priv->dbi_base + PCIE_ATU_CR1);
316         writel(PCIE_ATU_ENABLE, priv->dbi_base + PCIE_ATU_CR2);
317
318         return 0;
319 }
320
321 /*
322  * PCI Express accessors
323  */
324 static void __iomem *get_bus_address(struct imx_pcie_priv *priv,
325                                      pci_dev_t d, int where)
326 {
327         void __iomem *va_address;
328
329         /* Reconfigure Region #0 */
330         writel(0, priv->dbi_base + PCIE_ATU_VIEWPORT);
331
332         if (PCI_BUS(d) < 2)
333                 writel(PCIE_ATU_TYPE_CFG0, priv->dbi_base + PCIE_ATU_CR1);
334         else
335                 writel(PCIE_ATU_TYPE_CFG1, priv->dbi_base + PCIE_ATU_CR1);
336
337         if (PCI_BUS(d) == 0) {
338                 va_address = priv->dbi_base;
339         } else {
340                 writel(d << 8, priv->dbi_base + PCIE_ATU_LOWER_TARGET);
341                 va_address = priv->cfg_base;
342         }
343
344         va_address += (where & ~0x3);
345
346         return va_address;
347 }
348
349 static int imx_pcie_addr_valid(pci_dev_t d)
350 {
351         if ((PCI_BUS(d) == 0) && (PCI_DEV(d) > 1))
352                 return -EINVAL;
353         if ((PCI_BUS(d) == 1) && (PCI_DEV(d) > 0))
354                 return -EINVAL;
355         return 0;
356 }
357
358 /*
359  * Replace the original ARM DABT handler with a simple jump-back one.
360  *
361  * The problem here is that if we have a PCIe bridge attached to this PCIe
362  * controller, but no PCIe device is connected to the bridges' downstream
363  * port, the attempt to read/write from/to the config space will produce
364  * a DABT. This is a behavior of the controller and can not be disabled
365  * unfortuatelly.
366  *
367  * To work around the problem, we backup the current DABT handler address
368  * and replace it with our own DABT handler, which only bounces right back
369  * into the code.
370  */
371 static void imx_pcie_fix_dabt_handler(bool set)
372 {
373         extern uint32_t *_data_abort;
374         uint32_t *data_abort_addr = (uint32_t *)&_data_abort;
375
376         static const uint32_t data_abort_bounce_handler = 0xe25ef004;
377         uint32_t data_abort_bounce_addr = (uint32_t)&data_abort_bounce_handler;
378
379         static uint32_t data_abort_backup;
380
381         if (set) {
382                 data_abort_backup = *data_abort_addr;
383                 *data_abort_addr = data_abort_bounce_addr;
384         } else {
385                 *data_abort_addr = data_abort_backup;
386         }
387 }
388
389 static int imx_pcie_read_cfg(struct imx_pcie_priv *priv, pci_dev_t d,
390                              int where, u32 *val)
391 {
392         void __iomem *va_address;
393         int ret;
394
395         ret = imx_pcie_addr_valid(d);
396         if (ret) {
397                 *val = 0xffffffff;
398                 return 0;
399         }
400
401         va_address = get_bus_address(priv, d, where);
402
403         /*
404          * Read the PCIe config space. We must replace the DABT handler
405          * here in case we got data abort from the PCIe controller, see
406          * imx_pcie_fix_dabt_handler() description. Note that writing the
407          * "val" with valid value is also imperative here as in case we
408          * did got DABT, the val would contain random value.
409          */
410         imx_pcie_fix_dabt_handler(true);
411         writel(0xffffffff, val);
412         *val = readl(va_address);
413         imx_pcie_fix_dabt_handler(false);
414
415         return 0;
416 }
417
418 static int imx_pcie_write_cfg(struct imx_pcie_priv *priv, pci_dev_t d,
419                               int where, u32 val)
420 {
421         void __iomem *va_address = NULL;
422         int ret;
423
424         ret = imx_pcie_addr_valid(d);
425         if (ret)
426                 return ret;
427
428         va_address = get_bus_address(priv, d, where);
429
430         /*
431          * Write the PCIe config space. We must replace the DABT handler
432          * here in case we got data abort from the PCIe controller, see
433          * imx_pcie_fix_dabt_handler() description.
434          */
435         imx_pcie_fix_dabt_handler(true);
436         writel(val, va_address);
437         imx_pcie_fix_dabt_handler(false);
438
439         return 0;
440 }
441
442 /*
443  * Initial bus setup
444  */
445 static int imx6_pcie_assert_core_reset(struct imx_pcie_priv *priv,
446                                        bool prepare_for_boot)
447 {
448         struct iomuxc *iomuxc_regs = (struct iomuxc *)IOMUXC_BASE_ADDR;
449
450         if (is_mx6dqp())
451                 setbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_PCIE_SW_RST);
452
453 #if defined(CONFIG_MX6SX)
454         struct gpc *gpc_regs = (struct gpc *)GPC_BASE_ADDR;
455
456         /* SSP_EN is not used on MX6SX anymore */
457         setbits_le32(&iomuxc_regs->gpr[12], IOMUXC_GPR12_TEST_POWERDOWN);
458         /* Force PCIe PHY reset */
459         setbits_le32(&iomuxc_regs->gpr[5], IOMUXC_GPR5_PCIE_BTNRST);
460         /* Power up PCIe PHY */
461         setbits_le32(&gpc_regs->cntr, PCIE_PHY_PUP_REQ);
462 #else
463         /*
464          * If the bootloader already enabled the link we need some special
465          * handling to get the core back into a state where it is safe to
466          * touch it for configuration.  As there is no dedicated reset signal
467          * wired up for MX6QDL, we need to manually force LTSSM into "detect"
468          * state before completely disabling LTSSM, which is a prerequisite
469          * for core configuration.
470          *
471          * If both LTSSM_ENABLE and REF_SSP_ENABLE are active we have a strong
472          * indication that the bootloader activated the link.
473          */
474         if (is_mx6dq() && prepare_for_boot) {
475                 u32 val, gpr1, gpr12;
476
477                 gpr1 = readl(&iomuxc_regs->gpr[1]);
478                 gpr12 = readl(&iomuxc_regs->gpr[12]);
479                 if ((gpr1 & IOMUXC_GPR1_PCIE_REF_CLK_EN) &&
480                     (gpr12 & IOMUXC_GPR12_PCIE_CTL_2)) {
481                         val = readl(priv->dbi_base + PCIE_PL_PFLR);
482                         val &= ~PCIE_PL_PFLR_LINK_STATE_MASK;
483                         val |= PCIE_PL_PFLR_FORCE_LINK;
484
485                         imx_pcie_fix_dabt_handler(true);
486                         writel(val, priv->dbi_base + PCIE_PL_PFLR);
487                         imx_pcie_fix_dabt_handler(false);
488
489                         gpr12 &= ~IOMUXC_GPR12_PCIE_CTL_2;
490                         writel(val, &iomuxc_regs->gpr[12]);
491                 }
492         }
493         setbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_TEST_POWERDOWN);
494         clrbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_REF_SSP_EN);
495 #endif
496
497         return 0;
498 }
499
500 static int imx6_pcie_init_phy(void)
501 {
502         struct iomuxc *iomuxc_regs = (struct iomuxc *)IOMUXC_BASE_ADDR;
503
504         clrbits_le32(&iomuxc_regs->gpr[12], IOMUXC_GPR12_APPS_LTSSM_ENABLE);
505
506         clrsetbits_le32(&iomuxc_regs->gpr[12],
507                         IOMUXC_GPR12_DEVICE_TYPE_MASK,
508                         IOMUXC_GPR12_DEVICE_TYPE_RC);
509         clrsetbits_le32(&iomuxc_regs->gpr[12],
510                         IOMUXC_GPR12_LOS_LEVEL_MASK,
511                         IOMUXC_GPR12_LOS_LEVEL_9);
512
513 #ifdef CONFIG_MX6SX
514         clrsetbits_le32(&iomuxc_regs->gpr[12],
515                         IOMUXC_GPR12_RX_EQ_MASK,
516                         IOMUXC_GPR12_RX_EQ_2);
517 #endif
518
519         writel((0x0 << IOMUXC_GPR8_PCS_TX_DEEMPH_GEN1_OFFSET) |
520                (0x0 << IOMUXC_GPR8_PCS_TX_DEEMPH_GEN2_3P5DB_OFFSET) |
521                (20 << IOMUXC_GPR8_PCS_TX_DEEMPH_GEN2_6DB_OFFSET) |
522                (127 << IOMUXC_GPR8_PCS_TX_SWING_FULL_OFFSET) |
523                (127 << IOMUXC_GPR8_PCS_TX_SWING_LOW_OFFSET),
524                &iomuxc_regs->gpr[8]);
525
526         return 0;
527 }
528
529 __weak int imx6_pcie_toggle_power(void)
530 {
531 #ifdef CONFIG_PCIE_IMX_POWER_GPIO
532         gpio_request(CONFIG_PCIE_IMX_POWER_GPIO, "pcie_power");
533         gpio_direction_output(CONFIG_PCIE_IMX_POWER_GPIO, 0);
534         mdelay(20);
535         gpio_set_value(CONFIG_PCIE_IMX_POWER_GPIO, 1);
536         mdelay(20);
537         gpio_free(CONFIG_PCIE_IMX_POWER_GPIO);
538 #endif
539         return 0;
540 }
541
542 __weak int imx6_pcie_toggle_reset(void)
543 {
544         /*
545          * See 'PCI EXPRESS BASE SPECIFICATION, REV 3.0, SECTION 6.6.1'
546          * for detailed understanding of the PCIe CR reset logic.
547          *
548          * The PCIe #PERST reset line _MUST_ be connected, otherwise your
549          * design does not conform to the specification. You must wait at
550          * least 20 ms after de-asserting the #PERST so the EP device can
551          * do self-initialisation.
552          *
553          * In case your #PERST pin is connected to a plain GPIO pin of the
554          * CPU, you can define CONFIG_PCIE_IMX_PERST_GPIO in your board's
555          * configuration file and the condition below will handle the rest
556          * of the reset toggling.
557          *
558          * In case your #PERST toggling logic is more complex, for example
559          * connected via CPLD or somesuch, you can override this function
560          * in your board file and implement reset logic as needed. You must
561          * not forget to wait at least 20 ms after de-asserting #PERST in
562          * this case either though.
563          *
564          * In case your #PERST line of the PCIe EP device is not connected
565          * at all, your design is broken and you should fix your design,
566          * otherwise you will observe problems like for example the link
567          * not coming up after rebooting the system back from running Linux
568          * that uses the PCIe as well OR the PCIe link might not come up in
569          * Linux at all in the first place since it's in some non-reset
570          * state due to being previously used in U-Boot.
571          */
572 #ifdef CONFIG_PCIE_IMX_PERST_GPIO
573         gpio_request(CONFIG_PCIE_IMX_PERST_GPIO, "pcie_reset");
574         gpio_direction_output(CONFIG_PCIE_IMX_PERST_GPIO, 0);
575         mdelay(20);
576         gpio_set_value(CONFIG_PCIE_IMX_PERST_GPIO, 1);
577         mdelay(20);
578         gpio_free(CONFIG_PCIE_IMX_PERST_GPIO);
579 #else
580         puts("WARNING: Make sure the PCIe #PERST line is connected!\n");
581 #endif
582         return 0;
583 }
584
585 static int imx6_pcie_deassert_core_reset(void)
586 {
587         struct iomuxc *iomuxc_regs = (struct iomuxc *)IOMUXC_BASE_ADDR;
588
589         imx6_pcie_toggle_power();
590
591         enable_pcie_clock();
592
593         if (is_mx6dqp())
594                 clrbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_PCIE_SW_RST);
595
596         /*
597          * Wait for the clock to settle a bit, when the clock are sourced
598          * from the CPU, we need about 30 ms to settle.
599          */
600         mdelay(50);
601
602 #if defined(CONFIG_MX6SX)
603         /* SSP_EN is not used on MX6SX anymore */
604         clrbits_le32(&iomuxc_regs->gpr[12], IOMUXC_GPR12_TEST_POWERDOWN);
605         /* Clear PCIe PHY reset bit */
606         clrbits_le32(&iomuxc_regs->gpr[5], IOMUXC_GPR5_PCIE_BTNRST);
607 #else
608         /* Enable PCIe */
609         clrbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_TEST_POWERDOWN);
610         setbits_le32(&iomuxc_regs->gpr[1], IOMUXC_GPR1_REF_SSP_EN);
611 #endif
612
613         imx6_pcie_toggle_reset();
614
615         return 0;
616 }
617
618 static int imx_pcie_link_up(struct imx_pcie_priv *priv)
619 {
620         struct iomuxc *iomuxc_regs = (struct iomuxc *)IOMUXC_BASE_ADDR;
621         uint32_t tmp;
622         int count = 0;
623
624         imx6_pcie_assert_core_reset(priv, false);
625         imx6_pcie_init_phy();
626         imx6_pcie_deassert_core_reset();
627
628         imx_pcie_regions_setup(priv);
629
630         /*
631          * By default, the subordinate is set equally to the secondary
632          * bus (0x01) when the RC boots.
633          * This means that theoretically, only bus 1 is reachable from the RC.
634          * Force the PCIe RC subordinate to 0xff, otherwise no downstream
635          * devices will be detected if the enumeration is applied strictly.
636          */
637         tmp = readl(priv->dbi_base + 0x18);
638         tmp |= (0xff << 16);
639         writel(tmp, priv->dbi_base + 0x18);
640
641         /*
642          * FIXME: Force the PCIe RC to Gen1 operation
643          * The RC must be forced into Gen1 mode before bringing the link
644          * up, otherwise no downstream devices are detected. After the
645          * link is up, a managed Gen1->Gen2 transition can be initiated.
646          */
647         tmp = readl(priv->dbi_base + 0x7c);
648         tmp &= ~0xf;
649         tmp |= 0x1;
650         writel(tmp, priv->dbi_base + 0x7c);
651
652         /* LTSSM enable, starting link. */
653         setbits_le32(&iomuxc_regs->gpr[12], IOMUXC_GPR12_APPS_LTSSM_ENABLE);
654
655         while (!imx6_pcie_link_up(priv)) {
656                 udelay(10);
657                 count++;
658                 if (count >= 4000) {
659 #ifdef CONFIG_PCI_SCAN_SHOW
660                         puts("PCI:   pcie phy link never came up\n");
661 #endif
662                         debug("DEBUG_R0: 0x%08x, DEBUG_R1: 0x%08x\n",
663                               readl(priv->dbi_base + PCIE_PHY_DEBUG_R0),
664                               readl(priv->dbi_base + PCIE_PHY_DEBUG_R1));
665                         return -EINVAL;
666                 }
667         }
668
669         return 0;
670 }
671
672 #if !CONFIG_IS_ENABLED(DM_PCI)
673 static struct imx_pcie_priv imx_pcie_priv = {
674         .dbi_base       = (void __iomem *)MX6_DBI_ADDR,
675         .cfg_base       = (void __iomem *)MX6_ROOT_ADDR,
676 };
677
678 static struct imx_pcie_priv *priv = &imx_pcie_priv;
679
680 static int imx_pcie_read_config(struct pci_controller *hose, pci_dev_t d,
681                                 int where, u32 *val)
682 {
683         struct imx_pcie_priv *priv = hose->priv_data;
684
685         return imx_pcie_read_cfg(priv, d, where, val);
686 }
687
688 static int imx_pcie_write_config(struct pci_controller *hose, pci_dev_t d,
689                                  int where, u32 val)
690 {
691         struct imx_pcie_priv *priv = hose->priv_data;
692
693         return imx_pcie_write_cfg(priv, d, where, val);
694 }
695
696 void imx_pcie_init(void)
697 {
698         /* Static instance of the controller. */
699         static struct pci_controller    pcc;
700         struct pci_controller           *hose = &pcc;
701         int ret;
702
703         memset(&pcc, 0, sizeof(pcc));
704
705         hose->priv_data = priv;
706
707         /* PCI I/O space */
708         pci_set_region(&hose->regions[0],
709                        MX6_IO_ADDR, MX6_IO_ADDR,
710                        MX6_IO_SIZE, PCI_REGION_IO);
711
712         /* PCI memory space */
713         pci_set_region(&hose->regions[1],
714                        MX6_MEM_ADDR, MX6_MEM_ADDR,
715                        MX6_MEM_SIZE, PCI_REGION_MEM);
716
717         /* System memory space */
718         pci_set_region(&hose->regions[2],
719                        MMDC0_ARB_BASE_ADDR, MMDC0_ARB_BASE_ADDR,
720                        0xefffffff, PCI_REGION_MEM | PCI_REGION_SYS_MEMORY);
721
722         hose->region_count = 3;
723
724         pci_set_ops(hose,
725                     pci_hose_read_config_byte_via_dword,
726                     pci_hose_read_config_word_via_dword,
727                     imx_pcie_read_config,
728                     pci_hose_write_config_byte_via_dword,
729                     pci_hose_write_config_word_via_dword,
730                     imx_pcie_write_config);
731
732         /* Start the controller. */
733         ret = imx_pcie_link_up(priv);
734
735         if (!ret) {
736                 pci_register_hose(hose);
737                 hose->last_busno = pci_hose_scan(hose);
738         }
739 }
740
741 void imx_pcie_remove(void)
742 {
743         imx6_pcie_assert_core_reset(priv, true);
744 }
745
746 /* Probe function. */
747 void pci_init_board(void)
748 {
749         imx_pcie_init();
750 }
751 #else
752 static int imx_pcie_dm_read_config(const struct udevice *dev, pci_dev_t bdf,
753                                    uint offset, ulong *value,
754                                    enum pci_size_t size)
755 {
756         struct imx_pcie_priv *priv = dev_get_priv(dev);
757         u32 tmpval;
758         int ret;
759
760         ret = imx_pcie_read_cfg(priv, bdf, offset, &tmpval);
761         if (ret)
762                 return ret;
763
764         *value = pci_conv_32_to_size(tmpval, offset, size);
765         return 0;
766 }
767
768 static int imx_pcie_dm_write_config(struct udevice *dev, pci_dev_t bdf,
769                                     uint offset, ulong value,
770                                     enum pci_size_t size)
771 {
772         struct imx_pcie_priv *priv = dev_get_priv(dev);
773         u32 tmpval, newval;
774         int ret;
775
776         ret = imx_pcie_read_cfg(priv, bdf, offset, &tmpval);
777         if (ret)
778                 return ret;
779
780         newval = pci_conv_size_to_32(tmpval, value, offset, size);
781         return imx_pcie_write_cfg(priv, bdf, offset, newval);
782 }
783
784 static int imx_pcie_dm_probe(struct udevice *dev)
785 {
786         struct imx_pcie_priv *priv = dev_get_priv(dev);
787
788         return imx_pcie_link_up(priv);
789 }
790
791 static int imx_pcie_dm_remove(struct udevice *dev)
792 {
793         struct imx_pcie_priv *priv = dev_get_priv(dev);
794
795         imx6_pcie_assert_core_reset(priv, true);
796
797         return 0;
798 }
799
800 static int imx_pcie_ofdata_to_platdata(struct udevice *dev)
801 {
802         struct imx_pcie_priv *priv = dev_get_priv(dev);
803
804         priv->dbi_base = (void __iomem *)devfdt_get_addr_index(dev, 0);
805         priv->cfg_base = (void __iomem *)devfdt_get_addr_index(dev, 1);
806         if (!priv->dbi_base || !priv->cfg_base)
807                 return -EINVAL;
808
809         return 0;
810 }
811
812 static const struct dm_pci_ops imx_pcie_ops = {
813         .read_config    = imx_pcie_dm_read_config,
814         .write_config   = imx_pcie_dm_write_config,
815 };
816
817 static const struct udevice_id imx_pcie_ids[] = {
818         { .compatible = "fsl,imx6q-pcie" },
819         { .compatible = "fsl,imx6sx-pcie" },
820         { }
821 };
822
823 U_BOOT_DRIVER(imx_pcie) = {
824         .name                   = "imx_pcie",
825         .id                     = UCLASS_PCI,
826         .of_match               = imx_pcie_ids,
827         .ops                    = &imx_pcie_ops,
828         .probe                  = imx_pcie_dm_probe,
829         .remove                 = imx_pcie_dm_remove,
830         .ofdata_to_platdata     = imx_pcie_ofdata_to_platdata,
831         .priv_auto_alloc_size   = sizeof(struct imx_pcie_priv),
832         .flags                  = DM_FLAG_OS_PREPARE,
833 };
834 #endif