ArmPkg/ArmCpuLib: Added A57 Errata 806969

[mirror_edk2.git] / ArmPkg / Drivers / ArmCpuLib / ArmCortexA5xLib / ArmCortexA5xLib.c

diff --git a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA5xLib/ArmCortexA5xLib.c b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA5xLib/ArmCortexA5xLib.c
index 7cae9f17f314f4adc9ffc9235395a3a907fcc528..99ee51fb6e2d94d3e679e6609dba51ab66ea2d72 100644 (file)
--- a/ArmPkg/Drivers/ArmCpuLib/ArmCortexA5xLib/ArmCortexA5xLib.c
+++ b/ArmPkg/Drivers/ArmCpuLib/ArmCortexA5xLib/ArmCortexA5xLib.c
@@ -40,6 +40,14 @@ ArmCpuSetup (
     ArmSetCpuExCrBit (A5X_FEATURE_SMP);\r
   }\r
 \r
+  //\r
+  // If CPU is CortexA57 r0p0 apply Errata: 806969\r
+  //\r
+  if ((ArmReadMidr () & ((ARM_CPU_TYPE_MASK << 4) | ARM_CPU_REV_MASK)) ==\r
+                         ((ARM_CPU_TYPE_A57 << 4) | ARM_CPU_REV(0,0))) {\r
+    // DisableLoadStoreWB\r
+    ArmSetCpuActlrBit (1ULL << 49);\r
+  }\r
 }\r
 \r
 VOID\r