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