ARM: tegra: enable some CPU errata workarounds

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

diff --git a/arch/arm/cpu/armv7/mx6/lowlevel_init.S b/arch/arm/cpu/armv7/mx6/lowlevel_init.S
index 1864356d0bf7b54265a42442f74a3baf756028f2..7b60ca7454b88319aaf832f573087ca0213d2b8b 100644 (file)
--- a/arch/arm/cpu/armv7/mx6/lowlevel_init.S
+++ b/arch/arm/cpu/armv7/mx6/lowlevel_init.S
@@ -18,7 +18,18 @@
  */
 .section ".text.init", "x"
 
-.globl lowlevel_init
-lowlevel_init:
+#include <linux/linkage.h>
 
+.macro init_arm_errata
+       /* ARM erratum ID #743622 */
+       mrc     p15, 0, r10, c15, c0, 1         /* read diagnostic register */
+       orr     r10, r10, #1 << 6               /* set bit #6 */
+       /* ARM erratum ID #751472 */
+       orr     r10, r10, #1 << 11              /* set bit #11 */
+       mcr     p15, 0, r10, c15, c0, 1         /* write diagnostic register */
+.endm
+
+ENTRY(lowlevel_init)
+       init_arm_errata
        mov pc, lr
+ENDPROC(lowlevel_init)