ArmPkg/ArmV7Lib: add function to test for presence of MP extensions

[mirror_edk2.git] / ArmPkg / Library / ArmLib / ArmV7 / ArmLibSupportV7.S

diff --git a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupportV7.S b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupportV7.S
index b94239f785c7f72c4d141f5ce634e16755b57e6c..d9e3c86b690748b6e0db01878de52917218584a8 100644 (file)
--- a/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupportV7.S
+++ b/ArmPkg/Library/ArmLib/ArmV7/ArmLibSupportV7.S
@@ -19,6 +19,7 @@
 .align 2\r
 \r
 GCC_ASM_EXPORT(ArmIsMpCore)\r
+GCC_ASM_EXPORT(ArmHasMpExtensions)\r
 GCC_ASM_EXPORT(ArmEnableAsynchronousAbort)\r
 GCC_ASM_EXPORT(ArmDisableAsynchronousAbort)\r
 GCC_ASM_EXPORT(ArmEnableIrq)\r
@@ -44,6 +45,12 @@ ASM_PFX(ArmIsMpCore):
   movne   R0, #0\r
   bx      LR\r
 \r
+ASM_PFX(ArmHasMpExtensions):\r
+  mrc     p15,0,R0,c0,c0,5\r
+  // Get Multiprocessing extension (bit31)\r
+  lsr     R0, R0, #31\r
+  bx      LR\r
+\r
 ASM_PFX(ArmEnableAsynchronousAbort):\r
   cpsie   a\r
   isb\r