2022-05-06 09:05:14 +00:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0+ */
|
|
|
|
|
|
|
|
#include <config.h>
|
|
|
|
#include <linux/linkage.h>
|
2022-09-08 14:06:52 +00:00
|
|
|
#include <asm/system.h>
|
2022-09-08 14:06:54 +00:00
|
|
|
#include <asm/pl310.h>
|
2022-05-06 09:05:14 +00:00
|
|
|
|
|
|
|
ENTRY(arch_very_early_init)
|
|
|
|
#ifdef CONFIG_ARMADA_38X
|
|
|
|
/*
|
|
|
|
* Only with disabled MMU its possible to switch the base
|
|
|
|
* register address on Armada 38x. Without this the SDRAM
|
|
|
|
* located at >= 0x4000.0000 is also not accessible, as its
|
|
|
|
* still locked to cache.
|
2022-09-08 14:06:54 +00:00
|
|
|
*
|
|
|
|
* So to fully release / unlock this area from cache, we need
|
|
|
|
* to first flush all caches, then disable the MMU and
|
|
|
|
* disable the L2 cache.
|
2022-05-06 09:05:14 +00:00
|
|
|
*/
|
2022-09-08 14:06:54 +00:00
|
|
|
|
|
|
|
/* Invalidate L1 I/D */
|
|
|
|
mov r0, #0 @ set up for MCR
|
|
|
|
mcr p15, 0, r0, c8, c7, 0 @ invalidate TLBs
|
|
|
|
mcr p15, 0, r0, c7, c5, 0 @ invalidate icache
|
|
|
|
mcr p15, 0, r0, c7, c5, 6 @ invalidate BP array
|
|
|
|
mcr p15, 0, r0, c7, c10, 4 @ DSB
|
|
|
|
mcr p15, 0, r0, c7, c5, 4 @ ISB
|
|
|
|
|
|
|
|
/* Disable MMU */
|
2022-05-06 09:05:14 +00:00
|
|
|
mrc p15, 0, r0, c1, c0, 0
|
2022-09-08 14:06:52 +00:00
|
|
|
bic r0, #CR_M
|
2022-05-06 09:05:14 +00:00
|
|
|
mcr p15, 0, r0, c1, c0, 0
|
2022-09-08 14:06:54 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Disable L2 cache
|
|
|
|
*
|
|
|
|
* NOTE: Internal registers are still at address INTREG_BASE_ADDR_REG
|
2022-11-16 18:10:41 +00:00
|
|
|
* but CFG_SYS_PL310_BASE is already calculated from base
|
2022-09-08 14:06:54 +00:00
|
|
|
* address SOC_REGS_PHY_BASE.
|
|
|
|
*/
|
2022-11-16 18:10:41 +00:00
|
|
|
ldr r1, =(CFG_SYS_PL310_BASE - SOC_REGS_PHY_BASE + INTREG_BASE_ADDR_REG)
|
2022-09-08 14:06:54 +00:00
|
|
|
ldr r0, [r1, #L2X0_CTRL_OFF]
|
|
|
|
bic r0, #L2X0_CTRL_EN
|
|
|
|
str r0, [r1, #L2X0_CTRL_OFF]
|
2022-05-06 09:05:14 +00:00
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Move internal registers from INTREG_BASE_ADDR_REG to SOC_REGS_PHY_BASE */
|
|
|
|
ldr r0, =SOC_REGS_PHY_BASE
|
|
|
|
ldr r1, =INTREG_BASE_ADDR_REG
|
|
|
|
str r0, [r1]
|
|
|
|
add r0, r0, #0xC000
|
|
|
|
mcr p15, 4, r0, c15, c0
|
|
|
|
|
|
|
|
bx lr
|
|
|
|
ENDPROC(arch_very_early_init)
|