ArmPkg/Library/ArmLib: add ArmWriteSctlr

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

diff --git a/ArmPkg/Library/ArmLib/AArch64/ArmLibSupport.S b/ArmPkg/Library/ArmLib/AArch64/ArmLibSupport.S
index 9d3dd66b10eb85f76933981b8654b9b3abb1f3f7..1ef2f61f5979013a63247eafb19b0e87f0d6d894 100644 (file)
--- a/ArmPkg/Library/ArmLib/AArch64/ArmLibSupport.S
+++ b/ArmPkg/Library/ArmLib/AArch64/ArmLibSupport.S
@@ -187,4 +187,13 @@ ASM_FUNC(ArmReadSctlr)
 3:mrs   x0, sctlr_el3\r
 4:ret\r
 \r
+ASM_FUNC(ArmWriteSctlr)\r
+  EL1_OR_EL2_OR_EL3(x1)\r
+1:msr   sctlr_el1, x0\r
+  ret\r
+2:msr   sctlr_el2, x0\r
+  ret\r
+3:msr   sctlr_el3, x0\r
+4:ret\r
+\r
 ASM_FUNCTION_REMOVE_IF_UNREFERENCED\r