Update for NetworkPkg.

[mirror_edk2.git] / ArmPkg / Include / AsmMacroIoLib.inc

diff --git a/ArmPkg/Include/AsmMacroIoLib.inc b/ArmPkg/Include/AsmMacroIoLib.inc
index 78e2ae29455c31fe5505625268648e3f4468f99d..5644bf9b3076f02ae16fd4ddb7ccd8bcd1d3f36d 100644 (file)
--- a/ArmPkg/Include/AsmMacroIoLib.inc
+++ b/ArmPkg/Include/AsmMacroIoLib.inc
@@ -77,5 +77,21 @@
   LoadConstantToRegMacro $Data, $Reg \r
   ldr  $Reg, =($Data) \r
   MEND \r
+  \r
+  MACRO\r
+  GetCorePositionInStack $Pos, $MpId, $Tmp\r
+  lsr   $Pos, $MpId, #6\r
+  and   $Tmp, $MpId, #3\r
+  add   $Pos, $Pos, $Tmp\r
+  MEND\r
+  \r
+  ; The reserved place must be 8-bytes aligned for pushing 64-bit variable on the stack\r
+  MACRO\r
+  SetPrimaryStack $StackTop, $GlobalSize, $Tmp\r
+  and     $Tmp, $GlobalSize, #7\r
+  rsbne   $Tmp, $Tmp, #8\r
+  add     $GlobalSize, $GlobalSize, $Tmp\r
+  sub     sp, $StackTop, $GlobalSize\r
+  MEND\r
 \r
   END\r