1 /*
2 * Copyright (c) 2016-2019, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <stdint.h>
8
9 #include <common/debug.h>
10 #include <common/runtime_svc.h>
11 #include <lib/debugfs.h>
12 #include <lib/pmf/pmf.h>
13 #include <plat/arm/common/arm_sip_svc.h>
14 #include <plat/arm/common/plat_arm.h>
15 #include <tools_share/uuid.h>
16
17 /* ARM SiP Service UUID */
18 DEFINE_SVC_UUID2(arm_sip_svc_uid,
19 0x556d75e2, 0x6033, 0xb54b, 0xb5, 0x75,
20 0x62, 0x79, 0xfd, 0x11, 0x37, 0xff);
21
arm_sip_setup(void)22 static int arm_sip_setup(void)
23 {
24 if (pmf_setup() != 0) {
25 return 1;
26 }
27
28 #if USE_DEBUGFS
29
30 if (debugfs_smc_setup() != 0) {
31 return 1;
32 }
33
34 #endif /* USE_DEBUGFS */
35
36 return 0;
37 }
38
39 /*
40 * This function handles ARM defined SiP Calls
41 */
arm_sip_handler(unsigned int 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)42 static uintptr_t arm_sip_handler(unsigned int smc_fid,
43 u_register_t x1,
44 u_register_t x2,
45 u_register_t x3,
46 u_register_t x4,
47 void *cookie,
48 void *handle,
49 u_register_t flags)
50 {
51 int call_count = 0;
52
53 /*
54 * Dispatch PMF calls to PMF SMC handler and return its return
55 * value
56 */
57 if (is_pmf_fid(smc_fid)) {
58 return pmf_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
59 handle, flags);
60 }
61
62 #if USE_DEBUGFS
63
64 if (is_debugfs_fid(smc_fid)) {
65 return debugfs_smc_handler(smc_fid, x1, x2, x3, x4, cookie,
66 handle, flags);
67 }
68
69 #endif /* USE_DEBUGFS */
70
71 switch (smc_fid) {
72 case ARM_SIP_SVC_EXE_STATE_SWITCH: {
73 /* Execution state can be switched only if EL3 is AArch64 */
74 #ifdef __aarch64__
75 /* Allow calls from non-secure only */
76 if (!is_caller_non_secure(flags))
77 SMC_RET1(handle, STATE_SW_E_DENIED);
78
79 /*
80 * Pointers used in execution state switch are all 32 bits wide
81 */
82 return (uintptr_t) arm_execution_state_switch(smc_fid,
83 (uint32_t) x1, (uint32_t) x2, (uint32_t) x3,
84 (uint32_t) x4, handle);
85 #else
86 /* State switch denied */
87 SMC_RET1(handle, STATE_SW_E_DENIED);
88 #endif /* __aarch64__ */
89 }
90
91 case ARM_SIP_SVC_CALL_COUNT:
92 /* PMF calls */
93 call_count += PMF_NUM_SMC_CALLS;
94
95 /* State switch call */
96 call_count += 1;
97
98 SMC_RET1(handle, call_count);
99
100 case ARM_SIP_SVC_UID:
101 /* Return UID to the caller */
102 SMC_UUID_RET(handle, arm_sip_svc_uid);
103
104 case ARM_SIP_SVC_VERSION:
105 /* Return the version of current implementation */
106 SMC_RET2(handle, ARM_SIP_SVC_VERSION_MAJOR, ARM_SIP_SVC_VERSION_MINOR);
107
108 default:
109 WARN("Unimplemented ARM SiP Service Call: 0x%x \n", smc_fid);
110 SMC_RET1(handle, SMC_UNK);
111 }
112
113 }
114
115
116 /* Define a runtime service descriptor for fast SMC calls */
117 DECLARE_RT_SVC(
118 arm_sip_svc,
119 OEN_SIP_START,
120 OEN_SIP_END,
121 SMC_TYPE_FAST,
122 arm_sip_setup,
123 arm_sip_handler
124 );
125