2012-03-26 12:59:50 +02:00
|
|
|
//
|
2014-08-04 16:18:13 +02:00
|
|
|
// Copyright (c) 2012-2014, ARM Limited. All rights reserved.
|
2012-03-26 12:59:50 +02:00
|
|
|
//
|
2019-04-04 01:03:18 +02:00
|
|
|
// SPDX-License-Identifier: BSD-2-Clause-Patent
|
2012-03-26 12:59:50 +02:00
|
|
|
//
|
|
|
|
//
|
|
|
|
|
2017-04-12 16:17:00 +02:00
|
|
|
#include <AsmMacroIoLib.h>
|
2012-03-26 12:59:50 +02:00
|
|
|
|
2016-08-10 14:36:47 +02:00
|
|
|
.arch_extension sec
|
2012-03-26 12:59:50 +02:00
|
|
|
|
2016-08-10 14:36:47 +02:00
|
|
|
ASM_FUNC(ArmCallSmc)
|
2014-08-04 16:18:13 +02:00
|
|
|
push {r4-r8}
|
|
|
|
// r0 will be popped just after the SMC call
|
|
|
|
push {r0}
|
2012-03-26 12:59:50 +02:00
|
|
|
|
2014-08-04 16:18:13 +02:00
|
|
|
// 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]
|
2012-03-26 12:59:50 +02:00
|
|
|
|
|
|
|
smc #0
|
|
|
|
|
2014-08-04 16:18:13 +02:00
|
|
|
// 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}
|
|
|
|
|
2013-03-06 01:01:49 +01:00
|
|
|
bx lr
|