powerpc/fsl-booke: Enable L1 cache on e500v1/e500v2/e500mc CPUs

Some boot loaders may not enable L1 instruction/data cache.  Check if
data and instruction caches are enabled, and enable them if needed.

Signed-off-by: Nate Case <ncase@xes-inc.com>
Signed-off-by: Kumar Gala <galak@kernel.crashing.org>

1 files changed, 46 insertions, 3 deletions

diff --git a/arch/powerpc/kernel/cpu_setup_fsl_booke.S b/arch/powerpc/kernel/cpu_setup_fsl_booke.S
index eb4b9adcedb4..0adb50ad8031 100644
--- a/arch/powerpc/kernel/cpu_setup_fsl_booke.S
+++ b/arch/powerpc/kernel/cpu_setup_fsl_booke.S
@@ -17,6 +17,40 @@
 #include <asm/cputable.h>
 #include <asm/ppc_asm.h>
 
+_GLOBAL(__e500_icache_setup)
+        mfspr   r0, SPRN_L1CSR1
+        andi.   r3, r0, L1CSR1_ICE
+        bnelr                           /* Already enabled */
+        oris    r0, r0, L1CSR1_CPE@h
+        ori     r0, r0, (L1CSR1_ICFI | L1CSR1_ICLFR |  L1CSR1_ICE)
+        mtspr   SPRN_L1CSR1, r0         /* Enable I-Cache */
+        isync
+        blr
+
+_GLOBAL(__e500_dcache_setup)
+        mfspr   r0, SPRN_L1CSR0
+        andi.   r3, r0, L1CSR0_DCE
+        bnelr                           /* Already enabled */
+        msync
+        isync
+        li      r0, 0
+        mtspr   SPRN_L1CSR0, r0         /* Disable */
+        msync
+        isync
+        li      r0, (L1CSR0_DCFI | L1CSR0_CLFC)
+        mtspr   SPRN_L1CSR0, r0         /* Invalidate */
+        isync
+1:      mfspr   r0, SPRN_L1CSR0
+        andi.   r3, r0, L1CSR0_CLFC
+        bne+    1b                      /* Wait for lock bits reset */
+        oris    r0, r0, L1CSR0_CPE@h
+        ori     r0, r0, L1CSR0_DCE
+        msync
+        isync
+        mtspr   SPRN_L1CSR0, r0         /* Enable */
+        isync
+        blr
+
 _GLOBAL(__setup_cpu_e200)
         /* enable dedicated debug exception handling resources (Debug APU) */
         mfspr   r3,SPRN_HID0
@@ -25,7 +59,16 @@ _GLOBAL(__setup_cpu_e200)
         b       __setup_e200_ivors
 _GLOBAL(__setup_cpu_e500v1)
 _GLOBAL(__setup_cpu_e500v2)
-        b       __setup_e500_ivors
+        mflr    r4
+        bl      __e500_icache_setup
+        bl      __e500_dcache_setup
+        bl      __setup_e500_ivors
+        mtlr    r4
+        blr
 _GLOBAL(__setup_cpu_e500mc)
-        b       __setup_e500mc_ivors
-
+        mflr    r4
+        bl      __e500_icache_setup
+        bl      __e500_dcache_setup
+        bl      __setup_e500mc_ivors
+        mtlr    r4
+        blr