2 * Copyright (C) 2014-2016 Stefan Roese <sr@denx.de>
4 * SPDX-License-Identifier: GPL-2.0+
9 #include <linux/mbus.h>
11 #include <asm/pl310.h>
12 #include <asm/arch/cpu.h>
13 #include <asm/arch/soc.h>
16 #define DDR_BASE_CS_OFF(n) (0x0000 + ((n) << 3))
17 #define DDR_SIZE_CS_OFF(n) (0x0004 + ((n) << 3))
19 static struct mbus_win windows
[] = {
21 { MBUS_SPI_BASE
, MBUS_SPI_SIZE
,
22 CPU_TARGET_DEVICEBUS_BOOTROM_SPI
, CPU_ATTR_SPIFLASH
},
25 { MBUS_BOOTROM_BASE
, MBUS_BOOTROM_SIZE
,
26 CPU_TARGET_DEVICEBUS_BOOTROM_SPI
, CPU_ATTR_BOOTROM
},
29 void lowlevel_init(void)
32 * Dummy implementation, we only need LOWLEVEL_INIT
33 * on Armada to configure CP15 in start.S / cpu_init_cp15()
37 void reset_cpu(unsigned long ignored
)
39 struct mvebu_system_registers
*reg
=
40 (struct mvebu_system_registers
*)MVEBU_SYSTEM_REG_BASE
;
42 writel(readl(®
->rstoutn_mask
) | 1, ®
->rstoutn_mask
);
43 writel(readl(®
->sys_soft_rst
) | 1, ®
->sys_soft_rst
);
48 int mvebu_soc_family(void)
50 u16 devid
= (readl(MVEBU_REG_PCIE_DEVID
) >> 16) & 0xffff;
59 return MVEBU_SOC_A375
;
64 return MVEBU_SOC_A38X
;
69 return MVEBU_SOC_MSYS
;
72 return MVEBU_SOC_UNKNOWN
;
75 #if defined(CONFIG_DISPLAY_CPUINFO)
77 #if defined(CONFIG_ARMADA_375)
78 /* SAR frequency values for Armada 375 */
79 static const struct sar_freq_modes sar_freq_tab
[] = {
80 { 0, 0x0, 266, 133, 266 },
81 { 1, 0x0, 333, 167, 167 },
82 { 2, 0x0, 333, 167, 222 },
83 { 3, 0x0, 333, 167, 333 },
84 { 4, 0x0, 400, 200, 200 },
85 { 5, 0x0, 400, 200, 267 },
86 { 6, 0x0, 400, 200, 400 },
87 { 7, 0x0, 500, 250, 250 },
88 { 8, 0x0, 500, 250, 334 },
89 { 9, 0x0, 500, 250, 500 },
90 { 10, 0x0, 533, 267, 267 },
91 { 11, 0x0, 533, 267, 356 },
92 { 12, 0x0, 533, 267, 533 },
93 { 13, 0x0, 600, 300, 300 },
94 { 14, 0x0, 600, 300, 400 },
95 { 15, 0x0, 600, 300, 600 },
96 { 16, 0x0, 666, 333, 333 },
97 { 17, 0x0, 666, 333, 444 },
98 { 18, 0x0, 666, 333, 666 },
99 { 19, 0x0, 800, 400, 267 },
100 { 20, 0x0, 800, 400, 400 },
101 { 21, 0x0, 800, 400, 534 },
102 { 22, 0x0, 900, 450, 300 },
103 { 23, 0x0, 900, 450, 450 },
104 { 24, 0x0, 900, 450, 600 },
105 { 25, 0x0, 1000, 500, 500 },
106 { 26, 0x0, 1000, 500, 667 },
107 { 27, 0x0, 1000, 333, 500 },
108 { 28, 0x0, 400, 400, 400 },
109 { 29, 0x0, 1100, 550, 550 },
110 { 0xff, 0xff, 0, 0, 0 } /* 0xff marks end of array */
112 #elif defined(CONFIG_ARMADA_38X)
113 /* SAR frequency values for Armada 38x */
114 static const struct sar_freq_modes sar_freq_tab
[] = {
115 { 0x0, 0x0, 666, 333, 333 },
116 { 0x2, 0x0, 800, 400, 400 },
117 { 0x4, 0x0, 1066, 533, 533 },
118 { 0x6, 0x0, 1200, 600, 600 },
119 { 0x8, 0x0, 1332, 666, 666 },
120 { 0xc, 0x0, 1600, 800, 800 },
121 { 0xff, 0xff, 0, 0, 0 } /* 0xff marks end of array */
124 /* SAR frequency values for Armada XP */
125 static const struct sar_freq_modes sar_freq_tab
[] = {
126 { 0xa, 0x5, 800, 400, 400 },
127 { 0x1, 0x5, 1066, 533, 533 },
128 { 0x2, 0x5, 1200, 600, 600 },
129 { 0x2, 0x9, 1200, 600, 400 },
130 { 0x3, 0x5, 1333, 667, 667 },
131 { 0x4, 0x5, 1500, 750, 750 },
132 { 0x4, 0x9, 1500, 750, 500 },
133 { 0xb, 0x9, 1600, 800, 533 },
134 { 0xb, 0xa, 1600, 800, 640 },
135 { 0xb, 0x5, 1600, 800, 800 },
136 { 0xff, 0xff, 0, 0, 0 } /* 0xff marks end of array */
140 void get_sar_freq(struct sar_freq_modes
*sar_freq
)
146 #if defined(CONFIG_ARMADA_375)
147 val
= readl(CONFIG_SAR2_REG
); /* SAR - Sample At Reset */
149 val
= readl(CONFIG_SAR_REG
); /* SAR - Sample At Reset */
151 freq
= (val
& SAR_CPU_FREQ_MASK
) >> SAR_CPU_FREQ_OFFS
;
152 #if defined(SAR2_CPU_FREQ_MASK)
154 * Shift CPU0 clock frequency select bit from SAR2 register
155 * into correct position
157 freq
|= ((readl(CONFIG_SAR2_REG
) & SAR2_CPU_FREQ_MASK
)
158 >> SAR2_CPU_FREQ_OFFS
) << 3;
160 for (i
= 0; sar_freq_tab
[i
].val
!= 0xff; i
++) {
161 if (sar_freq_tab
[i
].val
== freq
) {
162 #if defined(CONFIG_ARMADA_375) || defined(CONFIG_ARMADA_38X)
163 *sar_freq
= sar_freq_tab
[i
];
169 ffc
= (val
& SAR_FFC_FREQ_MASK
) >>
171 for (k
= i
; sar_freq_tab
[k
].ffc
!= 0xff; k
++) {
172 if (sar_freq_tab
[k
].ffc
== ffc
) {
173 *sar_freq
= sar_freq_tab
[k
];
182 /* SAR value not found, return 0 for frequencies */
183 *sar_freq
= sar_freq_tab
[i
- 1];
186 int print_cpuinfo(void)
188 u16 devid
= (readl(MVEBU_REG_PCIE_DEVID
) >> 16) & 0xffff;
189 u8 revid
= readl(MVEBU_REG_PCIE_REVID
) & 0xff;
190 struct sar_freq_modes sar_freq
;
216 case SOC_98DX3236_ID
:
219 case SOC_98DX3336_ID
:
222 case SOC_98DX4251_ID
:
230 if (mvebu_soc_family() == MVEBU_SOC_AXP
) {
239 printf("?? (%x)", revid
);
244 if (mvebu_soc_family() == MVEBU_SOC_A375
) {
246 case MV_88F67XX_A0_ID
:
250 printf("?? (%x)", revid
);
255 if (mvebu_soc_family() == MVEBU_SOC_A38X
) {
257 case MV_88F68XX_Z1_ID
:
260 case MV_88F68XX_A0_ID
:
264 printf("?? (%x)", revid
);
269 get_sar_freq(&sar_freq
);
270 printf(" at %d MHz\n", sar_freq
.p_clk
);
274 #endif /* CONFIG_DISPLAY_CPUINFO */
277 * This function initialize Controller DRAM Fastpath windows.
278 * It takes the CS size information from the 0x1500 scratch registers
279 * and sets the correct windows sizes and base addresses accordingly.
281 * These values are set in the scratch registers by the Marvell
282 * DDR3 training code, which is executed by the BootROM before the
283 * main payload (U-Boot) is executed. This training code is currently
284 * only available in the Marvell U-Boot version. It needs to be
285 * ported to mainline U-Boot SPL at some point.
287 static void update_sdram_window_sizes(void)
293 for (i
= 0; i
< SDRAM_MAX_CS
; i
++) {
294 size
= readl((MVEBU_SDRAM_SCRATCH
+ (i
* 8))) & SDRAM_ADDR_MASK
;
296 size
|= ~(SDRAM_ADDR_MASK
);
298 /* Set Base Address */
299 temp
= (base
& 0xFF000000ll
) | ((base
>> 32) & 0xF);
300 writel(temp
, MVEBU_SDRAM_BASE
+ DDR_BASE_CS_OFF(i
));
303 * Check if out of max window size and resize
306 temp
= (readl(MVEBU_SDRAM_BASE
+ DDR_SIZE_CS_OFF(i
)) &
307 ~(SDRAM_ADDR_MASK
)) | 1;
308 temp
|= (size
& SDRAM_ADDR_MASK
);
309 writel(temp
, MVEBU_SDRAM_BASE
+ DDR_SIZE_CS_OFF(i
));
311 base
+= ((u64
)size
+ 1);
314 * Disable window if not used, otherwise this
315 * leads to overlapping enabled windows with
316 * pretty strange results
318 clrbits_le32(MVEBU_SDRAM_BASE
+ DDR_SIZE_CS_OFF(i
), 1);
323 void mmu_disable(void)
326 "mrc p15, 0, r0, c1, c0, 0\n"
328 "mcr p15, 0, r0, c1, c0, 0\n");
331 #ifdef CONFIG_ARCH_CPU_INIT
332 static void set_cbar(u32 addr
)
334 asm("mcr p15, 4, %0, c15, c0" : : "r" (addr
));
337 #define MV_USB_PHY_BASE (MVEBU_AXP_USB_BASE + 0x800)
338 #define MV_USB_PHY_PLL_REG(reg) (MV_USB_PHY_BASE | (((reg) & 0xF) << 2))
339 #define MV_USB_X3_BASE(addr) (MVEBU_AXP_USB_BASE | BIT(11) | \
340 (((addr) & 0xF) << 6))
341 #define MV_USB_X3_PHY_CHANNEL(dev, reg) (MV_USB_X3_BASE((dev) + 1) | \
342 (((reg) & 0xF) << 2))
344 static void setup_usb_phys(void)
352 /* Setup PLL frequency */
353 /* USB REF frequency = 25 MHz */
354 clrsetbits_le32(MV_USB_PHY_PLL_REG(1), 0x3ff, 0x605);
356 /* Power up PLL and PHY channel */
357 setbits_le32(MV_USB_PHY_PLL_REG(2), BIT(9));
359 /* Assert VCOCAL_START */
360 setbits_le32(MV_USB_PHY_PLL_REG(1), BIT(21));
365 * USB PHY init (change from defaults) specific for 40nm (78X30 78X60)
368 for (dev
= 0; dev
< 3; dev
++) {
369 setbits_le32(MV_USB_X3_PHY_CHANNEL(dev
, 3), BIT(15));
371 /* Assert REG_RCAL_START in channel REG 1 */
372 setbits_le32(MV_USB_X3_PHY_CHANNEL(dev
, 1), BIT(12));
374 clrbits_le32(MV_USB_X3_PHY_CHANNEL(dev
, 1), BIT(12));
379 * This function is not called from the SPL U-Boot version
381 int arch_cpu_init(void)
383 struct pl310_regs
*const pl310
=
384 (struct pl310_regs
*)CONFIG_SYS_PL310_BASE
;
387 * Only with disabled MMU its possible to switch the base
388 * register address on Armada 38x. Without this the SDRAM
389 * located at >= 0x4000.0000 is also not accessible, as its
390 * still locked to cache.
394 /* Linux expects the internal registers to be at 0xf1000000 */
395 writel(SOC_REGS_PHY_BASE
, INTREG_BASE_ADDR_REG
);
396 set_cbar(SOC_REGS_PHY_BASE
+ 0xC000);
399 * From this stage on, the SoC detection is working. As we have
400 * configured the internal register base to the value used
401 * in the macros / defines in the U-Boot header (soc.h).
404 if (mvebu_soc_family() == MVEBU_SOC_A38X
) {
406 * To fully release / unlock this area from cache, we need
407 * to flush all caches and disable the L2 cache.
411 clrbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);
415 * We need to call mvebu_mbus_probe() before calling
416 * update_sdram_window_sizes() as it disables all previously
417 * configured mbus windows and then configures them as
418 * required for U-Boot. Calling update_sdram_window_sizes()
419 * without this configuration will not work, as the internal
420 * registers can't be accessed reliably because of potenial
422 * After updating the SDRAM access windows we need to call
423 * mvebu_mbus_probe() again, as this now correctly configures
424 * the SDRAM areas that are later used by the MVEBU drivers
429 * First disable all windows
431 mvebu_mbus_probe(NULL
, 0);
433 if (mvebu_soc_family() == MVEBU_SOC_AXP
) {
435 * Now the SDRAM access windows can be reconfigured using
436 * the information in the SDRAM scratch pad registers
438 update_sdram_window_sizes();
442 * Finally the mbus windows can be configured with the
443 * updated SDRAM sizes
445 mvebu_mbus_probe(windows
, ARRAY_SIZE(windows
));
447 if (mvebu_soc_family() == MVEBU_SOC_AXP
) {
448 /* Enable GBE0, GBE1, LCD and NFC PUP */
449 clrsetbits_le32(ARMADA_XP_PUP_ENABLE
, 0,
450 GE0_PUP_EN
| GE1_PUP_EN
| LCD_PUP_EN
|
451 NAND_PUP_EN
| SPI_PUP_EN
);
453 /* Configure USB PLL and PHYs on AXP */
457 /* Enable NAND and NAND arbiter */
458 clrsetbits_le32(MVEBU_SOC_DEV_MUX_REG
, 0, NAND_EN
| NAND_ARBITER_EN
);
460 /* Disable MBUS error propagation */
461 clrsetbits_le32(SOC_COHERENCY_FABRIC_CTRL_REG
, MBUS_ERR_PROP_EN
, 0);
465 #endif /* CONFIG_ARCH_CPU_INIT */
467 u32
mvebu_get_nand_clock(void)
471 if (mvebu_soc_family() == MVEBU_SOC_A38X
)
472 reg
= MVEBU_DFX_DIV_CLK_CTRL(1);
474 reg
= MVEBU_CORE_DIV_CLK_CTRL(1);
476 return CONFIG_SYS_MVEBU_PLL_CLOCK
/
478 NAND_ECC_DIVCKL_RATIO_MASK
) >> NAND_ECC_DIVCKL_RATIO_OFFS
);
482 * SOC specific misc init
484 #if defined(CONFIG_ARCH_MISC_INIT)
485 int arch_misc_init(void)
487 /* Nothing yet, perhaps we need something here later */
490 #endif /* CONFIG_ARCH_MISC_INIT */
492 #ifdef CONFIG_MMC_SDHCI_MV
493 int board_mmc_init(bd_t
*bis
)
495 mv_sdh_init(MVEBU_SDIO_BASE
, 0, 0,
496 SDHCI_QUIRK_32BIT_DMA_ADDR
| SDHCI_QUIRK_WAIT_SEND_CMD
);
502 #ifdef CONFIG_SCSI_AHCI_PLAT
503 #define AHCI_VENDOR_SPECIFIC_0_ADDR 0xa0
504 #define AHCI_VENDOR_SPECIFIC_0_DATA 0xa4
506 #define AHCI_WINDOW_CTRL(win) (0x60 + ((win) << 4))
507 #define AHCI_WINDOW_BASE(win) (0x64 + ((win) << 4))
508 #define AHCI_WINDOW_SIZE(win) (0x68 + ((win) << 4))
510 static void ahci_mvebu_mbus_config(void __iomem
*base
)
512 const struct mbus_dram_target_info
*dram
;
515 dram
= mvebu_mbus_dram_info();
517 for (i
= 0; i
< 4; i
++) {
518 writel(0, base
+ AHCI_WINDOW_CTRL(i
));
519 writel(0, base
+ AHCI_WINDOW_BASE(i
));
520 writel(0, base
+ AHCI_WINDOW_SIZE(i
));
523 for (i
= 0; i
< dram
->num_cs
; i
++) {
524 const struct mbus_dram_window
*cs
= dram
->cs
+ i
;
526 writel((cs
->mbus_attr
<< 8) |
527 (dram
->mbus_dram_target_id
<< 4) | 1,
528 base
+ AHCI_WINDOW_CTRL(i
));
529 writel(cs
->base
>> 16, base
+ AHCI_WINDOW_BASE(i
));
530 writel(((cs
->size
- 1) & 0xffff0000),
531 base
+ AHCI_WINDOW_SIZE(i
));
535 static void ahci_mvebu_regret_option(void __iomem
*base
)
538 * Enable the regret bit to allow the SATA unit to regret a
539 * request that didn't receive an acknowlegde and avoid a
542 writel(0x4, base
+ AHCI_VENDOR_SPECIFIC_0_ADDR
);
543 writel(0x80, base
+ AHCI_VENDOR_SPECIFIC_0_DATA
);
548 printf("MVEBU SATA INIT\n");
549 ahci_mvebu_mbus_config((void __iomem
*)MVEBU_SATA0_BASE
);
550 ahci_mvebu_regret_option((void __iomem
*)MVEBU_SATA0_BASE
);
551 ahci_init((void __iomem
*)MVEBU_SATA0_BASE
);
555 void enable_caches(void)
557 /* Avoid problem with e.g. neta ethernet driver */
558 invalidate_dcache_all();
561 * Armada 375 still has some problems with d-cache enabled in the
562 * ethernet driver (mvpp2). So lets keep the d-cache disabled
563 * until this is solved.
565 if (mvebu_soc_family() != MVEBU_SOC_A375
) {
566 /* Enable D-cache. I-cache is already enabled in start.S */
571 void v7_outer_cache_enable(void)
573 if (mvebu_soc_family() == MVEBU_SOC_AXP
) {
574 struct pl310_regs
*const pl310
=
575 (struct pl310_regs
*)CONFIG_SYS_PL310_BASE
;
578 /* The L2 cache is already disabled at this point */
581 * For Aurora cache in no outer mode, enable via the CP15
582 * coprocessor broadcasting of cache commands to L2.
584 asm volatile("mrc p15, 1, %0, c15, c2, 0" : "=r" (u
));
585 u
|= BIT(8); /* Set the FW bit */
586 asm volatile("mcr p15, 1, %0, c15, c2, 0" : : "r" (u
));
590 /* Enable the L2 cache */
591 setbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);
595 void v7_outer_cache_disable(void)
597 struct pl310_regs
*const pl310
=
598 (struct pl310_regs
*)CONFIG_SYS_PL310_BASE
;
600 clrbits_le32(&pl310
->pl310_ctrl
, L2X0_CTRL_EN
);