ArmPkg/ArmLib: Added helper functions for accessing CPU ACTLR

[mirror_edk2.git] / ArmPkg / Library / ArmLib / Common / AArch64 / ArmLibSupport.S

diff --git a/ArmPkg/Library/ArmLib/Common/AArch64/ArmLibSupport.S b/ArmPkg/Library/ArmLib/Common/AArch64/ArmLibSupport.S
index 12e6d0c82ba636bc500cb5d1408450a285f58df6..f169d02aaace7f3194b9ea0ff63d0adba58e9cac 100644 (file)
--- a/ArmPkg/Library/ArmLib/Common/AArch64/ArmLibSupport.S
+++ b/ArmPkg/Library/ArmLib/Common/AArch64/ArmLibSupport.S
@@ -37,6 +37,10 @@ GCC_ASM_EXPORT (ArmWriteScr)
 GCC_ASM_EXPORT (ArmWriteMVBar)\r
 GCC_ASM_EXPORT (ArmCallWFE)\r
 GCC_ASM_EXPORT (ArmCallSEV)\r
+GCC_ASM_EXPORT (ArmReadCpuExCr)\r
+GCC_ASM_EXPORT (ArmWriteCpuExCr)\r
+GCC_ASM_EXPORT (ArmReadCpuActlr)\r
+GCC_ASM_EXPORT (ArmWriteCpuActlr)\r
 \r
 #------------------------------------------------------------------------------\r
 \r
@@ -196,5 +200,24 @@ ASM_PFX(ArmCallSEV):
   sev\r
   ret\r
 \r
+ASM_PFX(ArmReadCpuExCr):\r
+  mrs   x0, S3_1_c15_c2_1\r
+  ret\r
+\r
+ASM_PFX(ArmWriteCpuExCr):\r
+  msr   S3_1_c15_c2_1, x0\r
+  dsb   sy\r
+  isb\r
+  ret\r
+\r
+ASM_PFX(ArmReadCpuActlr):\r
+  mrs   x0, S3_1_c15_c2_0\r
+  ret\r
+\r
+ASM_PFX(ArmWriteCpuActlr):\r
+  msr   S3_1_c15_c2_0, x0\r
+  dsb   sy\r
+  isb\r
+  ret\r
 \r
 ASM_FUNCTION_REMOVE_IF_UNREFERENCED\r