1 /*
2 * Copyright (c) 2014-2021, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <assert.h>
8 #include <stdint.h>
9
10 #include <common/debug.h>
11 #include <common/runtime_svc.h>
12 #include <lib/el3_runtime/cpu_data.h>
13 #include <lib/pmf/pmf.h>
14 #include <lib/psci/psci.h>
15 #include <lib/runtime_instr.h>
16 #include <services/gtsi_svc.h>
17 #include <services/pci_svc.h>
18 #include <services/rmmd_svc.h>
19 #include <services/sdei.h>
20 #include <services/spm_mm_svc.h>
21 #include <services/spmd_svc.h>
22 #include <services/std_svc.h>
23 #include <services/trng_svc.h>
24 #include <smccc_helpers.h>
25 #include <tools_share/uuid.h>
26
27 /* Standard Service UUID */
28 static uuid_t arm_svc_uid = {
29 {0x5b, 0x90, 0x8d, 0x10},
30 {0x63, 0xf8},
31 {0xe8, 0x47},
32 0xae, 0x2d,
33 {0xc0, 0xfb, 0x56, 0x41, 0xf6, 0xe2}
34 };
35
36 /* Setup Standard Services */
std_svc_setup(void)37 static int32_t std_svc_setup(void)
38 {
39 uintptr_t svc_arg;
40 int ret = 0;
41
42 svc_arg = get_arm_std_svc_args(PSCI_FID_MASK);
43 assert(svc_arg);
44
45 /*
46 * PSCI is one of the specifications implemented as a Standard Service.
47 * The `psci_setup()` also does EL3 architectural setup.
48 */
49 if (psci_setup((const psci_lib_args_t *)svc_arg) != PSCI_E_SUCCESS) {
50 ret = 1;
51 }
52
53 #if SPM_MM
54 if (spm_mm_setup() != 0) {
55 ret = 1;
56 }
57 #endif
58
59 #if defined(SPD_spmd)
60 if (spmd_setup() != 0) {
61 ret = 1;
62 }
63 #endif
64
65 #if SDEI_SUPPORT
66 /* SDEI initialisation */
67 sdei_init();
68 #endif
69
70 trng_setup();
71
72 return ret;
73 }
74
75 /*
76 * Top-level Standard Service SMC handler. This handler will in turn dispatch
77 * calls to PSCI SMC handler
78 */
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)79 static uintptr_t std_svc_smc_handler(uint32_t smc_fid,
80 u_register_t x1,
81 u_register_t x2,
82 u_register_t x3,
83 u_register_t x4,
84 void *cookie,
85 void *handle,
86 u_register_t flags)
87 {
88 if (((smc_fid >> FUNCID_CC_SHIFT) & FUNCID_CC_MASK) == SMC_32) {
89 /* 32-bit SMC function, clear top parameter bits */
90
91 x1 &= UINT32_MAX;
92 x2 &= UINT32_MAX;
93 x3 &= UINT32_MAX;
94 x4 &= UINT32_MAX;
95 }
96
97 /*
98 * Dispatch PSCI calls to PSCI SMC handler and return its return
99 * value
100 */
101 if (is_psci_fid(smc_fid)) {
102 uint64_t ret;
103
104 #if ENABLE_RUNTIME_INSTRUMENTATION
105
106 /*
107 * Flush cache line so that even if CPU power down happens
108 * the timestamp update is reflected in memory.
109 */
110 PMF_WRITE_TIMESTAMP(rt_instr_svc,
111 RT_INSTR_ENTER_PSCI,
112 PMF_CACHE_MAINT,
113 get_cpu_data(cpu_data_pmf_ts[CPU_DATA_PMF_TS0_IDX]));
114 #endif
115
116 ret = psci_smc_handler(smc_fid, x1, x2, x3, x4,
117 cookie, handle, flags);
118
119 #if ENABLE_RUNTIME_INSTRUMENTATION
120 PMF_CAPTURE_TIMESTAMP(rt_instr_svc,
121 RT_INSTR_EXIT_PSCI,
122 PMF_NO_CACHE_MAINT);
123 #endif
124
125 SMC_RET1(handle, ret);
126 }
127
128 #if SPM_MM
129 /*
130 * Dispatch SPM calls to SPM SMC handler and return its return
131 * value
132 */
133 if (is_spm_mm_fid(smc_fid)) {
134 return spm_mm_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
135 handle, flags);
136 }
137 #endif
138
139 #if defined(SPD_spmd)
140 /*
141 * Dispatch FFA calls to the FFA SMC handler implemented by the SPM
142 * dispatcher and return its return value
143 */
144 if (is_ffa_fid(smc_fid)) {
145 return spmd_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
146 handle, flags);
147 }
148 #endif
149
150 #if SDEI_SUPPORT
151 if (is_sdei_fid(smc_fid)) {
152 return sdei_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
153 flags);
154 }
155 #endif
156
157 #if TRNG_SUPPORT
158 if (is_trng_fid(smc_fid)) {
159 return trng_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
160 flags);
161 }
162 #endif
163 #if ENABLE_RME
164 /*
165 * Granule transition service interface functions (GTSI) are allocated
166 * from the Std service range. Call the RMM dispatcher to handle calls.
167 */
168 if (is_gtsi_fid(smc_fid)) {
169 return rmmd_gtsi_handler(smc_fid, x1, x2, x3, x4, cookie,
170 handle, flags);
171 }
172 #endif
173
174 #if SMC_PCI_SUPPORT
175 if (is_pci_fid(smc_fid)) {
176 return pci_smc_handler(smc_fid, x1, x2, x3, x4, cookie, handle,
177 flags);
178 }
179 #endif
180
181 switch (smc_fid) {
182 case ARM_STD_SVC_CALL_COUNT:
183 /*
184 * Return the number of Standard Service Calls. PSCI is the only
185 * standard service implemented; so return number of PSCI calls
186 */
187 SMC_RET1(handle, PSCI_NUM_CALLS);
188
189 case ARM_STD_SVC_UID:
190 /* Return UID to the caller */
191 SMC_UUID_RET(handle, arm_svc_uid);
192
193 case ARM_STD_SVC_VERSION:
194 /* Return the version of current implementation */
195 SMC_RET2(handle, STD_SVC_VERSION_MAJOR, STD_SVC_VERSION_MINOR);
196
197 default:
198 VERBOSE("Unimplemented Standard Service Call: 0x%x \n", smc_fid);
199 SMC_RET1(handle, SMC_UNK);
200 }
201 }
202
203 /* Register Standard Service Calls as runtime service */
204 DECLARE_RT_SVC(
205 std_svc,
206
207 OEN_STD_START,
208 OEN_STD_END,
209 SMC_TYPE_FAST,
210 std_svc_setup,
211 std_svc_smc_handler
212 );
213