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