From: Hou Zhiqiang <b48...@freescale.com>

Expose this API to make it reuseable when u-boot turn into other EL
from EL3.

Signed-off-by: Hou Zhiqiang <b48...@freescale.com>
---
 arch/arm/cpu/armv8/fsl-layerscape/cpu.c | 24 ++++++++++++++++++++++++
 include/common.h                        |  1 +
 2 files changed, 25 insertions(+)

diff --git a/arch/arm/cpu/armv8/fsl-layerscape/cpu.c 
b/arch/arm/cpu/armv8/fsl-layerscape/cpu.c
index 6ea28ed..df5670f 100644
--- a/arch/arm/cpu/armv8/fsl-layerscape/cpu.c
+++ b/arch/arm/cpu/armv8/fsl-layerscape/cpu.c
@@ -403,6 +403,30 @@ void enable_caches(void)
        final_mmu_setup();
        __asm_invalidate_tlb_all();
 }
+
+static void mmu_disable(void)
+{
+       if (get_sctlr() & CR_M)
+               set_sctlr(get_sctlr() & ~CR_M);
+}
+
+static void mmu_enable(void)
+{
+       if (!(get_sctlr() & CR_M))
+               set_sctlr(get_sctlr() | CR_M);
+}
+
+void mmu_init(void)
+{
+       mmu_disable();
+       dcache_disable();
+       icache_disable();
+       final_mmu_setup();
+       __asm_invalidate_tlb_all();
+       mmu_enable();
+       icache_enable();
+       set_sctlr(get_sctlr() | CR_C);
+}
 #endif
 
 static inline u32 initiator_type(u32 cluster, int init_id)
diff --git a/include/common.h b/include/common.h
index 75c78d5..57a9b30 100644
--- a/include/common.h
+++ b/include/common.h
@@ -757,6 +757,7 @@ void        flush_dcache_range(unsigned long start, 
unsigned long stop);
 void   invalidate_dcache_range(unsigned long start, unsigned long stop);
 void   invalidate_dcache_all(void);
 void   invalidate_icache_all(void);
+void   mmu_init(void);
 
 enum {
        /* Disable caches (else flush caches but leave them active) */
-- 
2.1.0.27.g96db324

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to