diff options
| author |   Angelos Mouzakitis <a.mouzakitis@virtualopensystems.com> | 2023-10-10 14:33:42 +0000 |
|---|---|---|
| committer | Angelos Mouzakitis <a.mouzakitis@virtualopensystems.com> | 2023-10-10 14:33:42 +0000 |
| commit | af1a266670d040d2f4083ff309d732d648afba2a (patch) | |
| tree | 2fc46203448ddcc6f81546d379abfaeb323575e9 /roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S | |
| parent | e02cda008591317b1625707ff8e115a4841aa889 (diff) | |
Change-Id: Iaf8d18082d3991dec7c0ebbea540f092188eb4ec
Diffstat (limited to 'roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S')
| -rw-r--r-- | roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S | 44 |
1 files changed, 44 insertions, 0 deletions
diff --git a/roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S b/roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S new file mode 100644 index 000000000..d218e7e70 --- /dev/null +++ b/roms/edk2/ArmPkg/Library/ArmSmcLib/Arm/ArmSmc.S @@ -0,0 +1,44 @@ +//
+// Copyright (c) 2012-2014, ARM Limited. All rights reserved.
+//
+// SPDX-License-Identifier: BSD-2-Clause-Patent
+//
+//
+
+#include <AsmMacroIoLib.h>
+
+.arch_extension sec
+
+ASM_FUNC(ArmCallSmc)
+ push {r4-r8}
+ // r0 will be popped just after the SMC call
+ push {r0}
+
+ // Load the SMC arguments values into the appropriate registers
+ ldr r7, [r0, #28]
+ ldr r6, [r0, #24]
+ ldr r5, [r0, #20]
+ ldr r4, [r0, #16]
+ ldr r3, [r0, #12]
+ ldr r2, [r0, #8]
+ ldr r1, [r0, #4]
+ ldr r0, [r0, #0]
+
+ smc #0
+
+ // Pop the ARM_SMC_ARGS structure address from the stack into r8
+ pop {r8}
+
+ // Load the SMC returned values into the appropriate registers
+ // A SMC call can return up to 4 values - we do not need to store back r4-r7.
+ str r3, [r8, #12]
+ str r2, [r8, #8]
+ str r1, [r8, #4]
+ str r0, [r8, #0]
+
+ mov r0, r8
+
+ // Restore the registers r4-r8
+ pop {r4-r8}
+
+ bx lr
|