1 /*
2 * Copyright (c) 2022, Arm Limited. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7
8 #include <plat/common/platform.h>
9 #include <services/rmmd_svc.h>
10 #include "trp_private.h"
11
12 /*
13 * Per cpu data structure to populate parameters for an SMC in C code and use
14 * a pointer to this structure in assembler code to populate x0-x7
15 */
16 static trp_args_t trp_smc_args[PLATFORM_CORE_COUNT];
17
18 /*
19 * Set the arguments for SMC call
20 */
set_smc_args(uint64_t arg0,uint64_t arg1,uint64_t arg2,uint64_t arg3,uint64_t arg4,uint64_t arg5,uint64_t arg6,uint64_t arg7)21 trp_args_t *set_smc_args(uint64_t arg0,
22 uint64_t arg1,
23 uint64_t arg2,
24 uint64_t arg3,
25 uint64_t arg4,
26 uint64_t arg5,
27 uint64_t arg6,
28 uint64_t arg7)
29 {
30 uint32_t linear_id;
31 trp_args_t *pcpu_smc_args;
32
33 /*
34 * Return to Secure Monitor by raising an SMC. The results of the
35 * service are passed as an arguments to the SMC
36 */
37 linear_id = plat_my_core_pos();
38 pcpu_smc_args = &trp_smc_args[linear_id];
39 write_trp_arg(pcpu_smc_args, TRP_ARG0, arg0);
40 write_trp_arg(pcpu_smc_args, TRP_ARG1, arg1);
41 write_trp_arg(pcpu_smc_args, TRP_ARG2, arg2);
42 write_trp_arg(pcpu_smc_args, TRP_ARG3, arg3);
43 write_trp_arg(pcpu_smc_args, TRP_ARG4, arg4);
44 write_trp_arg(pcpu_smc_args, TRP_ARG5, arg5);
45 write_trp_arg(pcpu_smc_args, TRP_ARG6, arg6);
46 write_trp_arg(pcpu_smc_args, TRP_ARG7, arg7);
47
48 return pcpu_smc_args;
49 }
50
51 /*
52 * Abort the boot process with the reason given in err.
53 */
trp_boot_abort(uint64_t err)54 __dead2 void trp_boot_abort(uint64_t err)
55 {
56 (void)trp_smc(set_smc_args(RMM_BOOT_COMPLETE, err, 0, 0, 0, 0, 0, 0));
57 panic();
58 }
59