mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-28 08:08:45 +00:00
033648652f
RFC4122 defines that fields are stored in network order (big endian), but TF-A stores them in machine order (little endian by default in TF-A). We cannot change the future UUIDs that are already generated, but we can store all the bytes using arrays and modify fiptool to generate the UUIDs with the correct byte order. Change-Id: I97be2d3168d91f4dee7ccfafc533ea55ff33e46f Signed-off-by: Roberto Vargas <roberto.vargas@arm.com>
154 lines
3.2 KiB
C
154 lines
3.2 KiB
C
/*
|
|
* Copyright (c) 2014-2018, ARM Limited and Contributors. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <assert.h>
|
|
#include <cpu_data.h>
|
|
#include <debug.h>
|
|
#include <pmf.h>
|
|
#include <psci.h>
|
|
#include <runtime_instr.h>
|
|
#include <runtime_svc.h>
|
|
#include <sdei.h>
|
|
#include <smccc_helpers.h>
|
|
#include <spm_svc.h>
|
|
#include <std_svc.h>
|
|
#include <stdint.h>
|
|
#include <uuid.h>
|
|
|
|
/* Standard Service UUID */
|
|
static uuid_t arm_svc_uid = {
|
|
{0x5b, 0x90, 0x8d, 0x10},
|
|
{0x63, 0xf8},
|
|
{0xe8, 0x47},
|
|
0xae, 0x2d,
|
|
{0xc0, 0xfb, 0x56, 0x41, 0xf6, 0xe2}
|
|
};
|
|
|
|
/* Setup Standard Services */
|
|
static int32_t std_svc_setup(void)
|
|
{
|
|
uintptr_t svc_arg;
|
|
int ret = 0;
|
|
|
|
svc_arg = get_arm_std_svc_args(PSCI_FID_MASK);
|
|
assert(svc_arg);
|
|
|
|
/*
|
|
* PSCI is one of the specifications implemented as a Standard Service.
|
|
* The `psci_setup()` also does EL3 architectural setup.
|
|
*/
|
|
if (psci_setup((const psci_lib_args_t *)svc_arg) != PSCI_E_SUCCESS) {
|
|
ret = 1;
|
|
}
|
|
|
|
#if ENABLE_SPM
|
|
if (spm_setup() != 0) {
|
|
ret = 1;
|
|
}
|
|
#endif
|
|
|
|
#if SDEI_SUPPORT
|
|
/* SDEI initialisation */
|
|
sdei_init();
|
|
#endif
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Top-level Standard Service SMC handler. This handler will in turn dispatch
|
|
* calls to PSCI SMC handler
|
|
*/
|
|
static uintptr_t std_svc_smc_handler(uint32_t smc_fid,
|
|
u_register_t x1,
|
|
u_register_t x2,
|
|
u_register_t x3,
|
|
u_register_t x4,
|
|
void *cookie,
|
|
void *handle,
|
|
u_register_t flags)
|
|
{
|
|
/*
|
|
* Dispatch PSCI calls to PSCI SMC handler and return its return
|
|
* value
|
|
*/
|
|
if (is_psci_fid(smc_fid)) {
|
|
uint64_t ret;
|
|
|
|
#if ENABLE_RUNTIME_INSTRUMENTATION
|
|
|
|
/*
|
|
* Flush cache line so that even if CPU power down happens
|
|
* the timestamp update is reflected in memory.
|
|
*/
|
|
PMF_WRITE_TIMESTAMP(rt_instr_svc,
|
|
RT_INSTR_ENTER_PSCI,
|
|
PMF_CACHE_MAINT,
|
|
get_cpu_data(cpu_data_pmf_ts[CPU_DATA_PMF_TS0_IDX]));
|
|
#endif
|
|
|
|
ret = psci_smc_handler(smc_fid, x1, x2, x3, x4,
|
|
cookie, handle, flags);
|
|
|
|
#if ENABLE_RUNTIME_INSTRUMENTATION
|
|
PMF_CAPTURE_TIMESTAMP(rt_instr_svc,
|
|
RT_INSTR_EXIT_PSCI,
|
|
PMF_NO_CACHE_MAINT);
|
|
#endif
|
|
|
|
SMC_RET1(handle, ret);
|
|
}
|
|
|
|
#if ENABLE_SPM
|
|
/*
|
|
* Dispatch SPM calls to SPM SMC handler and return its return
|
|
* value
|
|
*/
|
|
if (is_spm_fid(smc_fid)) {
|
|
return spm_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
|
|
handle, flags);
|
|
}
|
|
#endif
|
|
|
|
#if SDEI_SUPPORT
|
|
if (is_sdei_fid(smc_fid)) {
|
|
return sdei_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
|
|
flags);
|
|
}
|
|
#endif
|
|
|
|
switch (smc_fid) {
|
|
case ARM_STD_SVC_CALL_COUNT:
|
|
/*
|
|
* Return the number of Standard Service Calls. PSCI is the only
|
|
* standard service implemented; so return number of PSCI calls
|
|
*/
|
|
SMC_RET1(handle, PSCI_NUM_CALLS);
|
|
|
|
case ARM_STD_SVC_UID:
|
|
/* Return UID to the caller */
|
|
SMC_UUID_RET(handle, arm_svc_uid);
|
|
|
|
case ARM_STD_SVC_VERSION:
|
|
/* Return the version of current implementation */
|
|
SMC_RET2(handle, STD_SVC_VERSION_MAJOR, STD_SVC_VERSION_MINOR);
|
|
|
|
default:
|
|
WARN("Unimplemented Standard Service Call: 0x%x \n", smc_fid);
|
|
SMC_RET1(handle, SMC_UNK);
|
|
}
|
|
}
|
|
|
|
/* Register Standard Service Calls as runtime service */
|
|
DECLARE_RT_SVC(
|
|
std_svc,
|
|
|
|
OEN_STD_START,
|
|
OEN_STD_END,
|
|
SMC_TYPE_FAST,
|
|
std_svc_setup,
|
|
std_svc_smc_handler
|
|
);
|