ARM: Introduce erratum workaround for 430973

[karo-tx-uboot.git] / arch / arm / cpu / armv7 / start.S

diff --git a/arch/arm/cpu/armv7/start.S b/arch/arm/cpu/armv7/start.S
index 8483687879ed70054deb33cc4f56e22780ac1544..41fb24cf321b25ed9ff3d6c4cdebea28e380fa0e 100644 (file)
--- a/arch/arm/cpu/armv7/start.S
+++ b/arch/arm/cpu/armv7/start.S
@@ -200,6 +200,19 @@ skip_errata_798870:
        pop     {r1-r5}                 @ Restore the cpu info - fall through
 
 skip_errata_454179:
+#endif
+
+#ifdef CONFIG_ARM_ERRATA_430973
+       cmp     r2, #0x21               @ Only on < r2p1
+       bge     skip_errata_430973
+
+       mrc     p15, 0, r0, c1, c0, 1   @ Read ACR
+       orr     r0, r0, #(0x1 << 6)     @ Set IBE bit
+       push    {r1-r5}                 @ Save the cpu info registers
+       bl      v7_arch_cp15_set_acr
+       pop     {r1-r5}                 @ Restore the cpu info - fall through
+
+skip_errata_430973:
 #endif
 
        mov     pc, r5                  @ back to my caller