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 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 */ 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