From caa84939a4d8b1189dea8619ccc57bdb3026b125 Mon Sep 17 00:00:00 2001 From: Jeenu Viswambharan Date: Thu, 6 Feb 2014 10:36:15 +0000 Subject: Add support for handling runtime service requests This patch uses the reworked exception handling support to handle runtime service requests through SMCs following the SMC calling convention. This is a giant commit since all the changes are inter-related. It does the following: 1. Replace the old exception handling mechanism with the new one 2. Enforce that SP_EL0 is used C runtime stacks. 3. Ensures that the cold and warm boot paths use the 'cpu_context' structure to program an ERET into the next lower EL. 4. Ensures that SP_EL3 always points to the next 'cpu_context' structure prior to an ERET into the next lower EL 5. Introduces a PSCI SMC handler which completes the use of PSCI as a runtime service Change-Id: I661797f834c0803d2c674d20f504df1b04c2b852 Co-authored-by: Achin Gupta --- common/psci/psci_main.c | 70 +++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 70 insertions(+) (limited to 'common/psci/psci_main.c') diff --git a/common/psci/psci_main.c b/common/psci/psci_main.c index a70a21ae..67f189d1 100644 --- a/common/psci/psci_main.c +++ b/common/psci/psci_main.c @@ -35,6 +35,9 @@ #include #include #include +#include +#include +#include /******************************************************************************* * PSCI frontend api for servicing SMCs. Described in the PSCI spec. @@ -199,3 +202,70 @@ void psci_system_reset(void) assert(0); } +/******************************************************************************* + * PSCI top level handler for servicing SMCs. + ******************************************************************************/ +uint64_t psci_smc_handler(uint32_t smc_fid, + uint64_t x1, + uint64_t x2, + uint64_t x3, + uint64_t x4, + void *cookie, + void *handle, + uint64_t flags) +{ + uint64_t rc; + + switch (smc_fid) { + case PSCI_VERSION: + rc = psci_version(); + break; + + case PSCI_CPU_OFF: + rc = __psci_cpu_off(); + break; + + case PSCI_CPU_SUSPEND_AARCH64: + case PSCI_CPU_SUSPEND_AARCH32: + rc = __psci_cpu_suspend(x1, x2, x3); + break; + + case PSCI_CPU_ON_AARCH64: + case PSCI_CPU_ON_AARCH32: + rc = psci_cpu_on(x1, x2, x3); + break; + + case PSCI_AFFINITY_INFO_AARCH32: + case PSCI_AFFINITY_INFO_AARCH64: + rc = psci_affinity_info(x1, x2); + break; + + case PSCI_MIG_AARCH32: + case PSCI_MIG_AARCH64: + rc = psci_migrate(x1); + break; + + case PSCI_MIG_INFO_TYPE: + rc = psci_migrate_info_type(); + break; + + case PSCI_MIG_INFO_UP_CPU_AARCH32: + case PSCI_MIG_INFO_UP_CPU_AARCH64: + rc = psci_migrate_info_up_cpu(); + break; + + case PSCI_SYSTEM_OFF: + psci_system_off(); + assert(0); + + case PSCI_SYSTEM_RESET: + psci_system_reset(); + assert(0); + + default: + rc = SMC_UNK; + WARN("Unimplemented psci call -> 0x%x \n", smc_fid); + } + + SMC_RET1(handle, rc); +} -- cgit v1.2.3