Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 1 | /* |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 2 | * Copyright (c) 2014-2017, ARM Limited and Contributors. All rights reserved. |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 7 | #include <assert.h> |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 8 | #include <cpu_data.h> |
Dan Handley | 2bd4ef2 | 2014-04-09 13:14:54 +0100 | [diff] [blame] | 9 | #include <debug.h> |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 10 | #include <pmf.h> |
Dan Handley | 2bd4ef2 | 2014-04-09 13:14:54 +0100 | [diff] [blame] | 11 | #include <psci.h> |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 12 | #include <runtime_instr.h> |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 13 | #include <runtime_svc.h> |
Soby Mathew | d019487 | 2016-04-29 19:01:30 +0100 | [diff] [blame] | 14 | #include <smcc_helpers.h> |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 15 | #include <spm_svc.h> |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 16 | #include <std_svc.h> |
Dan Handley | 2bd4ef2 | 2014-04-09 13:14:54 +0100 | [diff] [blame] | 17 | #include <stdint.h> |
| 18 | #include <uuid.h> |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 19 | |
| 20 | /* Standard Service UUID */ |
| 21 | DEFINE_SVC_UUID(arm_svc_uid, |
| 22 | 0x108d905b, 0xf863, 0x47e8, 0xae, 0x2d, |
| 23 | 0xc0, 0xfb, 0x56, 0x41, 0xf6, 0xe2); |
| 24 | |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 25 | /* Setup Standard Services */ |
| 26 | static int32_t std_svc_setup(void) |
| 27 | { |
| 28 | uintptr_t svc_arg; |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 29 | int ret = 0; |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 30 | |
| 31 | svc_arg = get_arm_std_svc_args(PSCI_FID_MASK); |
| 32 | assert(svc_arg); |
| 33 | |
| 34 | /* |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 35 | * PSCI is one of the specifications implemented as a Standard Service. |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 36 | * The `psci_setup()` also does EL3 architectural setup. |
| 37 | */ |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 38 | if (psci_setup((const psci_lib_args_t *)svc_arg) != PSCI_E_SUCCESS) { |
| 39 | ret = 1; |
| 40 | } |
| 41 | |
| 42 | #if ENABLE_SPM |
| 43 | if (spm_setup() != 0) { |
| 44 | ret = 1; |
| 45 | } |
| 46 | #endif |
| 47 | |
| 48 | return ret; |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 49 | } |
| 50 | |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 51 | /* |
| 52 | * Top-level Standard Service SMC handler. This handler will in turn dispatch |
| 53 | * calls to PSCI SMC handler |
| 54 | */ |
Soby Mathew | a0fedc4 | 2016-06-16 14:52:04 +0100 | [diff] [blame] | 55 | uintptr_t std_svc_smc_handler(uint32_t smc_fid, |
| 56 | u_register_t x1, |
| 57 | u_register_t x2, |
| 58 | u_register_t x3, |
| 59 | u_register_t x4, |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 60 | void *cookie, |
| 61 | void *handle, |
Soby Mathew | a0fedc4 | 2016-06-16 14:52:04 +0100 | [diff] [blame] | 62 | u_register_t flags) |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 63 | { |
| 64 | /* |
| 65 | * Dispatch PSCI calls to PSCI SMC handler and return its return |
| 66 | * value |
| 67 | */ |
| 68 | if (is_psci_fid(smc_fid)) { |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 69 | uint64_t ret; |
| 70 | |
| 71 | #if ENABLE_RUNTIME_INSTRUMENTATION |
dp-arm | c93e21f | 2016-10-31 17:17:21 +0000 | [diff] [blame] | 72 | |
| 73 | /* |
| 74 | * Flush cache line so that even if CPU power down happens |
| 75 | * the timestamp update is reflected in memory. |
| 76 | */ |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 77 | PMF_WRITE_TIMESTAMP(rt_instr_svc, |
| 78 | RT_INSTR_ENTER_PSCI, |
dp-arm | c93e21f | 2016-10-31 17:17:21 +0000 | [diff] [blame] | 79 | PMF_CACHE_MAINT, |
dp-arm | 3cac786 | 2016-09-19 11:18:44 +0100 | [diff] [blame] | 80 | get_cpu_data(cpu_data_pmf_ts[CPU_DATA_PMF_TS0_IDX])); |
| 81 | #endif |
| 82 | |
| 83 | ret = psci_smc_handler(smc_fid, x1, x2, x3, x4, |
| 84 | cookie, handle, flags); |
| 85 | |
| 86 | #if ENABLE_RUNTIME_INSTRUMENTATION |
| 87 | PMF_CAPTURE_TIMESTAMP(rt_instr_svc, |
| 88 | RT_INSTR_EXIT_PSCI, |
| 89 | PMF_NO_CACHE_MAINT); |
| 90 | #endif |
| 91 | |
| 92 | SMC_RET1(handle, ret); |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 93 | } |
Antonio Nino Diaz | c41f206 | 2017-10-24 10:07:35 +0100 | [diff] [blame] | 94 | |
| 95 | |
| 96 | #if ENABLE_SPM |
| 97 | /* |
| 98 | * Dispatch SPM calls to SPM SMC handler and return its return |
| 99 | * value |
| 100 | */ |
| 101 | if (is_spm_fid(smc_fid)) { |
| 102 | return spm_smc_handler(smc_fid, x1, x2, x3, x4, cookie, |
| 103 | handle, flags); |
| 104 | } |
| 105 | #endif |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 106 | |
| 107 | switch (smc_fid) { |
| 108 | case ARM_STD_SVC_CALL_COUNT: |
| 109 | /* |
| 110 | * Return the number of Standard Service Calls. PSCI is the only |
| 111 | * standard service implemented; so return number of PSCI calls |
| 112 | */ |
| 113 | SMC_RET1(handle, PSCI_NUM_CALLS); |
| 114 | |
| 115 | case ARM_STD_SVC_UID: |
| 116 | /* Return UID to the caller */ |
| 117 | SMC_UUID_RET(handle, arm_svc_uid); |
| 118 | |
| 119 | case ARM_STD_SVC_VERSION: |
| 120 | /* Return the version of current implementation */ |
| 121 | SMC_RET2(handle, STD_SVC_VERSION_MAJOR, STD_SVC_VERSION_MINOR); |
| 122 | |
| 123 | default: |
| 124 | WARN("Unimplemented Standard Service Call: 0x%x \n", smc_fid); |
| 125 | SMC_RET1(handle, SMC_UNK); |
| 126 | } |
| 127 | } |
| 128 | |
| 129 | /* Register Standard Service Calls as runtime service */ |
| 130 | DECLARE_RT_SVC( |
| 131 | std_svc, |
| 132 | |
| 133 | OEN_STD_START, |
| 134 | OEN_STD_END, |
| 135 | SMC_TYPE_FAST, |
Soby Mathew | 8da8966 | 2016-09-19 17:21:15 +0100 | [diff] [blame] | 136 | std_svc_setup, |
Jeenu Viswambharan | 1814a3e | 2014-02-28 10:08:33 +0000 | [diff] [blame] | 137 | std_svc_smc_handler |
| 138 | ); |