1//
2//  Copyright (c) 2012-2014, ARM Limited. All rights reserved.
3//
4//  This program and the accompanying materials
5//  are licensed and made available under the terms and conditions of the BSD License
6//  which accompanies this distribution.  The full text of the license may be found at
7//  http://opensource.org/licenses/bsd-license.php
8//
9//  THE PROGRAM IS DISTRIBUTED UNDER THE BSD LICENSE ON AN "AS IS" BASIS,
10//  WITHOUT WARRANTIES OR REPRESENTATIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED.
11//
12//
13
14#include <AsmMacroIoLibV8.h>
15
16ASM_FUNC(ArmCallSmc)
17  // Push x0 on the stack - The stack must always be quad-word aligned
18  str   x0, [sp, #-16]!
19
20  // Load the SMC arguments values into the appropriate registers
21  ldp   x6, x7, [x0, #48]
22  ldp   x4, x5, [x0, #32]
23  ldp   x2, x3, [x0, #16]
24  ldp   x0, x1, [x0, #0]
25
26  smc   #0
27
28  // Pop the ARM_SMC_ARGS structure address from the stack into x9
29  ldr   x9, [sp], #16
30
31  // Store the SMC returned values into the ARM_SMC_ARGS structure.
32  // A SMC call can return up to 4 values - we do not need to store back x4-x7.
33  stp   x2, x3, [x9, #16]
34  stp   x0, x1, [x9, #0]
35
36  mov   x0, x9
37
38  ret
39