blob: a818037cb6c2810cbf5c52fd3c0a6e339c2118f5 [file] [log] [blame]
Achin Gupta86f23532019-10-11 15:41:16 +01001/*
2 * Copyright (c) 2020, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7#include <assert.h>
8#include <errno.h>
9#include <string.h>
10
11#include <arch_helpers.h>
Olivier Deprez2bae35f2020-04-16 13:39:06 +020012#include <arch/aarch64/arch_features.h>
Achin Gupta86f23532019-10-11 15:41:16 +010013#include <bl31/bl31.h>
14#include <common/debug.h>
15#include <common/runtime_svc.h>
16#include <lib/el3_runtime/context_mgmt.h>
17#include <lib/smccc.h>
18#include <lib/spinlock.h>
19#include <lib/utils.h>
Achin Gupta86f23532019-10-11 15:41:16 +010020#include <plat/common/common_def.h>
21#include <plat/common/platform.h>
22#include <platform_def.h>
J-Alves2672cde2020-05-07 18:42:25 +010023#include <services/ffa_svc.h>
Achin Gupta86f23532019-10-11 15:41:16 +010024#include <services/spmd_svc.h>
25#include <smccc_helpers.h>
26#include "spmd_private.h"
27
28/*******************************************************************************
29 * SPM Core context information.
30 ******************************************************************************/
Olivier Deprez2bae35f2020-04-16 13:39:06 +020031static spmd_spm_core_context_t spm_core_context[PLATFORM_CORE_COUNT];
Achin Gupta86f23532019-10-11 15:41:16 +010032
33/*******************************************************************************
34 * SPM Core attribute information read from its manifest.
35 ******************************************************************************/
Olivier Deprez2bae35f2020-04-16 13:39:06 +020036static spmc_manifest_attribute_t spmc_attrs;
Achin Gupta86f23532019-10-11 15:41:16 +010037
38/*******************************************************************************
Max Shvetsov745889c2020-02-27 14:54:21 +000039 * SPM Core entry point information. Discovered on the primary core and reused
40 * on secondary cores.
41 ******************************************************************************/
42static entry_point_info_t *spmc_ep_info;
43
44/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +020045 * SPM Core context on current CPU get helper.
46 ******************************************************************************/
47spmd_spm_core_context_t *spmd_get_context(void)
48{
49 unsigned int linear_id = plat_my_core_pos();
50
51 return &spm_core_context[linear_id];
52}
53
54/*******************************************************************************
Max Shvetsov745889c2020-02-27 14:54:21 +000055 * Static function declaration.
56 ******************************************************************************/
Olivier Deprez2bae35f2020-04-16 13:39:06 +020057static int32_t spmd_init(void);
Olivier Deprez69ca84a2020-02-07 15:44:43 +010058static int spmd_spmc_init(void *pm_addr);
J-Alves2672cde2020-05-07 18:42:25 +010059static uint64_t spmd_ffa_error_return(void *handle,
Olivier Deprez2bae35f2020-04-16 13:39:06 +020060 int error_code);
61static uint64_t spmd_smc_forward(uint32_t smc_fid,
62 bool secure_origin,
63 uint64_t x1,
64 uint64_t x2,
65 uint64_t x3,
66 uint64_t x4,
67 void *handle);
Max Shvetsov745889c2020-02-27 14:54:21 +000068
69/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +020070 * This function takes an SPMC context pointer and performs a synchronous
71 * SPMC entry.
Achin Gupta86f23532019-10-11 15:41:16 +010072 ******************************************************************************/
73uint64_t spmd_spm_core_sync_entry(spmd_spm_core_context_t *spmc_ctx)
74{
75 uint64_t rc;
76
77 assert(spmc_ctx != NULL);
78
79 cm_set_context(&(spmc_ctx->cpu_ctx), SECURE);
80
81 /* Restore the context assigned above */
82 cm_el1_sysregs_context_restore(SECURE);
Max Shvetsove7fd80e2020-02-25 13:55:00 +000083#if SPMD_SPM_AT_SEL2
Max Shvetsovbdf502d2020-02-25 13:56:19 +000084 cm_el2_sysregs_context_restore(SECURE);
Max Shvetsove7fd80e2020-02-25 13:55:00 +000085#endif
Achin Gupta86f23532019-10-11 15:41:16 +010086 cm_set_next_eret_context(SECURE);
87
Max Shvetsove7fd80e2020-02-25 13:55:00 +000088 /* Enter SPMC */
Achin Gupta86f23532019-10-11 15:41:16 +010089 rc = spmd_spm_core_enter(&spmc_ctx->c_rt_ctx);
90
91 /* Save secure state */
92 cm_el1_sysregs_context_save(SECURE);
Max Shvetsove7fd80e2020-02-25 13:55:00 +000093#if SPMD_SPM_AT_SEL2
Max Shvetsovbdf502d2020-02-25 13:56:19 +000094 cm_el2_sysregs_context_save(SECURE);
Max Shvetsove7fd80e2020-02-25 13:55:00 +000095#endif
Achin Gupta86f23532019-10-11 15:41:16 +010096
97 return rc;
98}
99
100/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200101 * This function returns to the place where spmd_spm_core_sync_entry() was
Achin Gupta86f23532019-10-11 15:41:16 +0100102 * called originally.
103 ******************************************************************************/
104__dead2 void spmd_spm_core_sync_exit(uint64_t rc)
105{
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200106 spmd_spm_core_context_t *ctx = spmd_get_context();
Achin Gupta86f23532019-10-11 15:41:16 +0100107
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200108 /* Get current CPU context from SPMC context */
Achin Gupta86f23532019-10-11 15:41:16 +0100109 assert(cm_get_context(SECURE) == &(ctx->cpu_ctx));
110
111 /*
112 * The SPMD must have initiated the original request through a
113 * synchronous entry into SPMC. Jump back to the original C runtime
114 * context with the value of rc in x0;
115 */
116 spmd_spm_core_exit(ctx->c_rt_ctx, rc);
117
118 panic();
119}
120
121/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200122 * Jump to the SPM Core for the first time.
Achin Gupta86f23532019-10-11 15:41:16 +0100123 ******************************************************************************/
124static int32_t spmd_init(void)
125{
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200126 spmd_spm_core_context_t *ctx = spmd_get_context();
127 uint64_t rc;
Achin Gupta86f23532019-10-11 15:41:16 +0100128
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200129 VERBOSE("SPM Core init start.\n");
Achin Gupta86f23532019-10-11 15:41:16 +0100130 ctx->state = SPMC_STATE_RESET;
131
132 rc = spmd_spm_core_sync_entry(ctx);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200133 if (rc != 0ULL) {
Achin Gupta86f23532019-10-11 15:41:16 +0100134 ERROR("SPMC initialisation failed 0x%llx\n", rc);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200135 return 0;
Achin Gupta86f23532019-10-11 15:41:16 +0100136 }
137
138 ctx->state = SPMC_STATE_IDLE;
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200139 VERBOSE("SPM Core init end.\n");
Achin Gupta86f23532019-10-11 15:41:16 +0100140
141 return 1;
142}
143
144/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200145 * Loads SPMC manifest and inits SPMC.
Achin Gupta86f23532019-10-11 15:41:16 +0100146 ******************************************************************************/
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100147static int spmd_spmc_init(void *pm_addr)
Achin Gupta86f23532019-10-11 15:41:16 +0100148{
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200149 spmd_spm_core_context_t *spm_ctx = spmd_get_context();
Achin Gupta86f23532019-10-11 15:41:16 +0100150 uint32_t ep_attr;
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200151 int rc;
Achin Gupta86f23532019-10-11 15:41:16 +0100152
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200153 /* Load the SPM Core manifest */
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100154 rc = plat_spm_core_manifest_load(&spmc_attrs, pm_addr);
Max Shvetsov745889c2020-02-27 14:54:21 +0000155 if (rc != 0) {
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200156 WARN("No or invalid SPM Core manifest image provided by BL2\n");
157 return rc;
Achin Gupta86f23532019-10-11 15:41:16 +0100158 }
159
160 /*
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200161 * Ensure that the SPM Core version is compatible with the SPM
162 * Dispatcher version.
Achin Gupta86f23532019-10-11 15:41:16 +0100163 */
J-Alves2672cde2020-05-07 18:42:25 +0100164 if ((spmc_attrs.major_version != FFA_VERSION_MAJOR) ||
165 (spmc_attrs.minor_version > FFA_VERSION_MINOR)) {
166 WARN("Unsupported FFA version (%u.%u)\n",
Achin Gupta86f23532019-10-11 15:41:16 +0100167 spmc_attrs.major_version, spmc_attrs.minor_version);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200168 return -EINVAL;
Achin Gupta86f23532019-10-11 15:41:16 +0100169 }
170
J-Alves2672cde2020-05-07 18:42:25 +0100171 VERBOSE("FFA version (%u.%u)\n", spmc_attrs.major_version,
Achin Gupta86f23532019-10-11 15:41:16 +0100172 spmc_attrs.minor_version);
173
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200174 VERBOSE("SPM Core run time EL%x.\n",
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000175 SPMD_SPM_AT_SEL2 ? MODE_EL2 : MODE_EL1);
Achin Gupta86f23532019-10-11 15:41:16 +0100176
Max Shvetsove79062e2020-03-12 15:16:40 +0000177 /* Validate the SPMC ID, Ensure high bit is set */
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200178 if (((spmc_attrs.spmc_id >> SPMC_SECURE_ID_SHIFT) &
179 SPMC_SECURE_ID_MASK) == 0U) {
180 WARN("Invalid ID (0x%x) for SPMC.\n", spmc_attrs.spmc_id);
181 return -EINVAL;
Max Shvetsove79062e2020-03-12 15:16:40 +0000182 }
183
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200184 /* Validate the SPM Core execution state */
Achin Gupta86f23532019-10-11 15:41:16 +0100185 if ((spmc_attrs.exec_state != MODE_RW_64) &&
186 (spmc_attrs.exec_state != MODE_RW_32)) {
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100187 WARN("Unsupported %s%x.\n", "SPM Core execution state 0x",
Achin Gupta86f23532019-10-11 15:41:16 +0100188 spmc_attrs.exec_state);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200189 return -EINVAL;
Achin Gupta86f23532019-10-11 15:41:16 +0100190 }
191
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100192 VERBOSE("%s%x.\n", "SPM Core execution state 0x",
193 spmc_attrs.exec_state);
Achin Gupta86f23532019-10-11 15:41:16 +0100194
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000195#if SPMD_SPM_AT_SEL2
196 /* Ensure manifest has not requested AArch32 state in S-EL2 */
197 if (spmc_attrs.exec_state == MODE_RW_32) {
198 WARN("AArch32 state at S-EL2 is not supported.\n");
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200199 return -EINVAL;
Achin Gupta86f23532019-10-11 15:41:16 +0100200 }
201
202 /*
203 * Check if S-EL2 is supported on this system if S-EL2
204 * is required for SPM
205 */
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200206 if (!is_armv8_4_sel2_present()) {
207 WARN("SPM Core run time S-EL2 is not supported.\n");
208 return -EINVAL;
Achin Gupta86f23532019-10-11 15:41:16 +0100209 }
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000210#endif /* SPMD_SPM_AT_SEL2 */
Achin Gupta86f23532019-10-11 15:41:16 +0100211
212 /* Initialise an entrypoint to set up the CPU context */
213 ep_attr = SECURE | EP_ST_ENABLE;
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200214 if ((read_sctlr_el3() & SCTLR_EE_BIT) != 0ULL) {
Achin Gupta86f23532019-10-11 15:41:16 +0100215 ep_attr |= EP_EE_BIG;
Max Shvetsov745889c2020-02-27 14:54:21 +0000216 }
217
Achin Gupta86f23532019-10-11 15:41:16 +0100218 SET_PARAM_HEAD(spmc_ep_info, PARAM_EP, VERSION_1, ep_attr);
219 assert(spmc_ep_info->pc == BL32_BASE);
220
221 /*
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200222 * Populate SPSR for SPM Core based upon validated parameters from the
223 * manifest.
Achin Gupta86f23532019-10-11 15:41:16 +0100224 */
225 if (spmc_attrs.exec_state == MODE_RW_32) {
226 spmc_ep_info->spsr = SPSR_MODE32(MODE32_svc, SPSR_T_ARM,
227 SPSR_E_LITTLE,
228 DAIF_FIQ_BIT |
229 DAIF_IRQ_BIT |
230 DAIF_ABT_BIT);
231 } else {
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000232
233#if SPMD_SPM_AT_SEL2
234 static const uint32_t runtime_el = MODE_EL2;
235#else
236 static const uint32_t runtime_el = MODE_EL1;
237#endif
238 spmc_ep_info->spsr = SPSR_64(runtime_el,
Achin Gupta86f23532019-10-11 15:41:16 +0100239 MODE_SP_ELX,
240 DISABLE_ALL_EXCEPTIONS);
241 }
242
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200243 /* Initialise SPM Core context with this entry point information */
Max Shvetsov745889c2020-02-27 14:54:21 +0000244 cm_setup_context(&spm_ctx->cpu_ctx, spmc_ep_info);
245
246 /* Reuse PSCI affinity states to mark this SPMC context as off */
247 spm_ctx->state = AFF_STATE_OFF;
Achin Gupta86f23532019-10-11 15:41:16 +0100248
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200249 INFO("SPM Core setup done.\n");
Achin Gupta86f23532019-10-11 15:41:16 +0100250
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200251 /* Register init function for deferred init. */
Achin Gupta86f23532019-10-11 15:41:16 +0100252 bl31_register_bl32_init(&spmd_init);
253
254 return 0;
Max Shvetsov745889c2020-02-27 14:54:21 +0000255}
Achin Gupta86f23532019-10-11 15:41:16 +0100256
Max Shvetsov745889c2020-02-27 14:54:21 +0000257/*******************************************************************************
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200258 * Initialize context of SPM Core.
Max Shvetsov745889c2020-02-27 14:54:21 +0000259 ******************************************************************************/
260int spmd_setup(void)
261{
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100262 void *spmc_manifest;
Max Shvetsov745889c2020-02-27 14:54:21 +0000263 int rc;
Achin Gupta86f23532019-10-11 15:41:16 +0100264
Max Shvetsov745889c2020-02-27 14:54:21 +0000265 spmc_ep_info = bl31_plat_get_next_image_ep_info(SECURE);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200266 if (spmc_ep_info == NULL) {
267 WARN("No SPM Core image provided by BL2 boot loader.\n");
268 return -EINVAL;
Max Shvetsov745889c2020-02-27 14:54:21 +0000269 }
270
271 /* Under no circumstances will this parameter be 0 */
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200272 assert(spmc_ep_info->pc != 0ULL);
Max Shvetsov745889c2020-02-27 14:54:21 +0000273
274 /*
275 * Check if BL32 ep_info has a reference to 'tos_fw_config'. This will
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200276 * be used as a manifest for the SPM Core at the next lower EL/mode.
Max Shvetsov745889c2020-02-27 14:54:21 +0000277 */
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100278 spmc_manifest = (void *)spmc_ep_info->args.arg0;
279 if (spmc_manifest == NULL) {
280 ERROR("Invalid or absent SPM Core manifest.\n");
281 return -EINVAL;
Max Shvetsov745889c2020-02-27 14:54:21 +0000282 }
283
284 /* Load manifest, init SPMC */
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100285 rc = spmd_spmc_init(spmc_manifest);
Max Shvetsov745889c2020-02-27 14:54:21 +0000286 if (rc != 0) {
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200287 WARN("Booting device without SPM initialization.\n");
Max Shvetsov745889c2020-02-27 14:54:21 +0000288 }
289
Olivier Deprez69ca84a2020-02-07 15:44:43 +0100290 return rc;
Max Shvetsov745889c2020-02-27 14:54:21 +0000291}
292
293/*******************************************************************************
294 * Forward SMC to the other security state
295 ******************************************************************************/
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200296static uint64_t spmd_smc_forward(uint32_t smc_fid,
297 bool secure_origin,
298 uint64_t x1,
299 uint64_t x2,
300 uint64_t x3,
301 uint64_t x4,
302 void *handle)
Max Shvetsov745889c2020-02-27 14:54:21 +0000303{
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100304 uint32_t secure_state_in = (secure_origin) ? SECURE : NON_SECURE;
305 uint32_t secure_state_out = (!secure_origin) ? SECURE : NON_SECURE;
306
Max Shvetsov745889c2020-02-27 14:54:21 +0000307 /* Save incoming security state */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100308 cm_el1_sysregs_context_save(secure_state_in);
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000309#if SPMD_SPM_AT_SEL2
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100310 cm_el2_sysregs_context_save(secure_state_in);
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000311#endif
Max Shvetsov745889c2020-02-27 14:54:21 +0000312
313 /* Restore outgoing security state */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100314 cm_el1_sysregs_context_restore(secure_state_out);
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000315#if SPMD_SPM_AT_SEL2
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100316 cm_el2_sysregs_context_restore(secure_state_out);
Max Shvetsove7fd80e2020-02-25 13:55:00 +0000317#endif
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100318 cm_set_next_eret_context(secure_state_out);
Max Shvetsov745889c2020-02-27 14:54:21 +0000319
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100320 SMC_RET8(cm_get_context(secure_state_out), smc_fid, x1, x2, x3, x4,
Max Shvetsov745889c2020-02-27 14:54:21 +0000321 SMC_GET_GP(handle, CTX_GPREG_X5),
322 SMC_GET_GP(handle, CTX_GPREG_X6),
323 SMC_GET_GP(handle, CTX_GPREG_X7));
324}
325
326/*******************************************************************************
J-Alves2672cde2020-05-07 18:42:25 +0100327 * Return FFA_ERROR with specified error code
Max Shvetsov745889c2020-02-27 14:54:21 +0000328 ******************************************************************************/
J-Alves2672cde2020-05-07 18:42:25 +0100329static uint64_t spmd_ffa_error_return(void *handle, int error_code)
Max Shvetsov745889c2020-02-27 14:54:21 +0000330{
J-Alves2672cde2020-05-07 18:42:25 +0100331 SMC_RET8(handle, FFA_ERROR,
332 FFA_TARGET_INFO_MBZ, error_code,
333 FFA_PARAM_MBZ, FFA_PARAM_MBZ, FFA_PARAM_MBZ,
334 FFA_PARAM_MBZ, FFA_PARAM_MBZ);
Achin Gupta86f23532019-10-11 15:41:16 +0100335}
336
337/*******************************************************************************
J-Alves2672cde2020-05-07 18:42:25 +0100338 * This function handles all SMCs in the range reserved for FFA. Each call is
Achin Gupta86f23532019-10-11 15:41:16 +0100339 * either forwarded to the other security state or handled by the SPM dispatcher
340 ******************************************************************************/
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200341uint64_t spmd_smc_handler(uint32_t smc_fid,
342 uint64_t x1,
343 uint64_t x2,
344 uint64_t x3,
345 uint64_t x4,
346 void *cookie,
347 void *handle,
Achin Gupta86f23532019-10-11 15:41:16 +0100348 uint64_t flags)
349{
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200350 spmd_spm_core_context_t *ctx = spmd_get_context();
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100351 bool secure_origin;
352 int32_t ret;
Achin Gupta86f23532019-10-11 15:41:16 +0100353
354 /* Determine which security state this SMC originated from */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100355 secure_origin = is_caller_secure(flags);
Achin Gupta86f23532019-10-11 15:41:16 +0100356
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200357 INFO("SPM: 0x%x 0x%llx 0x%llx 0x%llx 0x%llx 0x%llx 0x%llx 0x%llx\n",
Achin Gupta86f23532019-10-11 15:41:16 +0100358 smc_fid, x1, x2, x3, x4, SMC_GET_GP(handle, CTX_GPREG_X5),
359 SMC_GET_GP(handle, CTX_GPREG_X6),
360 SMC_GET_GP(handle, CTX_GPREG_X7));
361
362 switch (smc_fid) {
J-Alves2672cde2020-05-07 18:42:25 +0100363 case FFA_ERROR:
Achin Gupta86f23532019-10-11 15:41:16 +0100364 /*
365 * Check if this is the first invocation of this interface on
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200366 * this CPU. If so, then indicate that the SPM Core initialised
Achin Gupta86f23532019-10-11 15:41:16 +0100367 * unsuccessfully.
368 */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100369 if (secure_origin && (ctx->state == SPMC_STATE_RESET)) {
Achin Gupta86f23532019-10-11 15:41:16 +0100370 spmd_spm_core_sync_exit(x2);
Max Shvetsov745889c2020-02-27 14:54:21 +0000371 }
Achin Gupta86f23532019-10-11 15:41:16 +0100372
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100373 return spmd_smc_forward(smc_fid, secure_origin,
Max Shvetsov745889c2020-02-27 14:54:21 +0000374 x1, x2, x3, x4, handle);
Achin Gupta86f23532019-10-11 15:41:16 +0100375 break; /* not reached */
376
J-Alves2672cde2020-05-07 18:42:25 +0100377 case FFA_VERSION:
Achin Gupta86f23532019-10-11 15:41:16 +0100378 /*
379 * TODO: This is an optimization that the version information
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200380 * provided by the SPM Core manifest is returned by the SPM
Achin Gupta86f23532019-10-11 15:41:16 +0100381 * dispatcher. It might be a better idea to simply forward this
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200382 * call to the SPM Core and wash our hands completely.
Achin Gupta86f23532019-10-11 15:41:16 +0100383 */
J-Alves2672cde2020-05-07 18:42:25 +0100384 ret = MAKE_FFA_VERSION(spmc_attrs.major_version,
Achin Gupta86f23532019-10-11 15:41:16 +0100385 spmc_attrs.minor_version);
J-Alves2672cde2020-05-07 18:42:25 +0100386 SMC_RET8(handle, FFA_SUCCESS_SMC32, FFA_TARGET_INFO_MBZ, ret,
387 FFA_PARAM_MBZ, FFA_PARAM_MBZ, FFA_PARAM_MBZ,
388 FFA_PARAM_MBZ, FFA_PARAM_MBZ);
Achin Gupta86f23532019-10-11 15:41:16 +0100389 break; /* not reached */
390
J-Alves2672cde2020-05-07 18:42:25 +0100391 case FFA_FEATURES:
Achin Gupta86f23532019-10-11 15:41:16 +0100392 /*
393 * This is an optional interface. Do the minimal checks and
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200394 * forward to SPM Core which will handle it if implemented.
Achin Gupta86f23532019-10-11 15:41:16 +0100395 */
396
397 /*
J-Alves2672cde2020-05-07 18:42:25 +0100398 * Check if x1 holds a valid FFA fid. This is an
Achin Gupta86f23532019-10-11 15:41:16 +0100399 * optimization.
400 */
J-Alves2672cde2020-05-07 18:42:25 +0100401 if (!is_ffa_fid(x1)) {
402 return spmd_ffa_error_return(handle,
403 FFA_ERROR_NOT_SUPPORTED);
Max Shvetsov745889c2020-02-27 14:54:21 +0000404 }
Achin Gupta86f23532019-10-11 15:41:16 +0100405
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200406 /* Forward SMC from Normal world to the SPM Core */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100407 if (!secure_origin) {
408 return spmd_smc_forward(smc_fid, secure_origin,
Max Shvetsov745889c2020-02-27 14:54:21 +0000409 x1, x2, x3, x4, handle);
Achin Gupta86f23532019-10-11 15:41:16 +0100410 }
Max Shvetsov745889c2020-02-27 14:54:21 +0000411
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200412 /*
413 * Return success if call was from secure world i.e. all
J-Alves2672cde2020-05-07 18:42:25 +0100414 * FFA functions are supported. This is essentially a
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200415 * nop.
416 */
J-Alves2672cde2020-05-07 18:42:25 +0100417 SMC_RET8(handle, FFA_SUCCESS_SMC32, x1, x2, x3, x4,
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200418 SMC_GET_GP(handle, CTX_GPREG_X5),
419 SMC_GET_GP(handle, CTX_GPREG_X6),
420 SMC_GET_GP(handle, CTX_GPREG_X7));
421
Achin Gupta86f23532019-10-11 15:41:16 +0100422 break; /* not reached */
423
J-Alves2672cde2020-05-07 18:42:25 +0100424 case FFA_ID_GET:
Max Shvetsove79062e2020-03-12 15:16:40 +0000425 /*
J-Alves2672cde2020-05-07 18:42:25 +0100426 * Returns the ID of the calling FFA component.
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200427 */
Max Shvetsove79062e2020-03-12 15:16:40 +0000428 if (!secure_origin) {
J-Alves2672cde2020-05-07 18:42:25 +0100429 SMC_RET8(handle, FFA_SUCCESS_SMC32,
430 FFA_TARGET_INFO_MBZ, FFA_NS_ENDPOINT_ID,
431 FFA_PARAM_MBZ, FFA_PARAM_MBZ,
432 FFA_PARAM_MBZ, FFA_PARAM_MBZ,
433 FFA_PARAM_MBZ);
Max Shvetsove79062e2020-03-12 15:16:40 +0000434 }
435
J-Alves2672cde2020-05-07 18:42:25 +0100436 SMC_RET8(handle, FFA_SUCCESS_SMC32,
437 FFA_TARGET_INFO_MBZ, spmc_attrs.spmc_id,
438 FFA_PARAM_MBZ, FFA_PARAM_MBZ,
439 FFA_PARAM_MBZ, FFA_PARAM_MBZ,
440 FFA_PARAM_MBZ);
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200441
Max Shvetsove79062e2020-03-12 15:16:40 +0000442 break; /* not reached */
443
J-Alves2672cde2020-05-07 18:42:25 +0100444 case FFA_RX_RELEASE:
445 case FFA_RXTX_MAP_SMC32:
446 case FFA_RXTX_MAP_SMC64:
447 case FFA_RXTX_UNMAP:
448 case FFA_MSG_RUN:
Achin Gupta86f23532019-10-11 15:41:16 +0100449 /* This interface must be invoked only by the Normal world */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100450 if (secure_origin) {
J-Alves2672cde2020-05-07 18:42:25 +0100451 return spmd_ffa_error_return(handle,
452 FFA_ERROR_NOT_SUPPORTED);
Achin Gupta86f23532019-10-11 15:41:16 +0100453 }
454
455 /* Fall through to forward the call to the other world */
456
J-Alves2672cde2020-05-07 18:42:25 +0100457 case FFA_PARTITION_INFO_GET:
458 case FFA_MSG_SEND:
459 case FFA_MSG_SEND_DIRECT_REQ_SMC32:
460 case FFA_MSG_SEND_DIRECT_REQ_SMC64:
461 case FFA_MSG_SEND_DIRECT_RESP_SMC32:
462 case FFA_MSG_SEND_DIRECT_RESP_SMC64:
463 case FFA_MEM_DONATE_SMC32:
464 case FFA_MEM_DONATE_SMC64:
465 case FFA_MEM_LEND_SMC32:
466 case FFA_MEM_LEND_SMC64:
467 case FFA_MEM_SHARE_SMC32:
468 case FFA_MEM_SHARE_SMC64:
469 case FFA_MEM_RETRIEVE_REQ_SMC32:
470 case FFA_MEM_RETRIEVE_REQ_SMC64:
471 case FFA_MEM_RETRIEVE_RESP:
472 case FFA_MEM_RELINQUISH:
473 case FFA_MEM_RECLAIM:
474 case FFA_SUCCESS_SMC32:
475 case FFA_SUCCESS_SMC64:
Achin Gupta86f23532019-10-11 15:41:16 +0100476 /*
477 * TODO: Assume that no requests originate from EL3 at the
478 * moment. This will change if a SP service is required in
479 * response to secure interrupts targeted to EL3. Until then
480 * simply forward the call to the Normal world.
481 */
482
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100483 return spmd_smc_forward(smc_fid, secure_origin,
Max Shvetsov745889c2020-02-27 14:54:21 +0000484 x1, x2, x3, x4, handle);
Achin Gupta86f23532019-10-11 15:41:16 +0100485 break; /* not reached */
486
J-Alves2672cde2020-05-07 18:42:25 +0100487 case FFA_MSG_WAIT:
Achin Gupta86f23532019-10-11 15:41:16 +0100488 /*
489 * Check if this is the first invocation of this interface on
490 * this CPU from the Secure world. If so, then indicate that the
Olivier Deprez2bae35f2020-04-16 13:39:06 +0200491 * SPM Core initialised successfully.
Achin Gupta86f23532019-10-11 15:41:16 +0100492 */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100493 if (secure_origin && (ctx->state == SPMC_STATE_RESET)) {
Achin Gupta86f23532019-10-11 15:41:16 +0100494 spmd_spm_core_sync_exit(0);
495 }
496
Max Shvetsov745889c2020-02-27 14:54:21 +0000497 /* Fall through to forward the call to the other world */
Achin Gupta86f23532019-10-11 15:41:16 +0100498
J-Alves2672cde2020-05-07 18:42:25 +0100499 case FFA_MSG_YIELD:
Achin Gupta86f23532019-10-11 15:41:16 +0100500 /* This interface must be invoked only by the Secure world */
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100501 if (!secure_origin) {
J-Alves2672cde2020-05-07 18:42:25 +0100502 return spmd_ffa_error_return(handle,
503 FFA_ERROR_NOT_SUPPORTED);
Achin Gupta86f23532019-10-11 15:41:16 +0100504 }
505
Olivier Deprez41ff36a2019-12-23 16:21:12 +0100506 return spmd_smc_forward(smc_fid, secure_origin,
Max Shvetsov745889c2020-02-27 14:54:21 +0000507 x1, x2, x3, x4, handle);
Achin Gupta86f23532019-10-11 15:41:16 +0100508 break; /* not reached */
509
510 default:
511 WARN("SPM: Unsupported call 0x%08x\n", smc_fid);
J-Alves2672cde2020-05-07 18:42:25 +0100512 return spmd_ffa_error_return(handle, FFA_ERROR_NOT_SUPPORTED);
Achin Gupta86f23532019-10-11 15:41:16 +0100513 }
514}