1 /* 2 * Copyright 2018-2021 NXP 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 * 6 */ 7 8 #include <assert.h> 9 #include <string.h> 10 11 #include <caam.h> 12 #include <common/runtime_svc.h> 13 #include <dcfg.h> 14 #include <lib/mmio.h> 15 #include <tools_share/uuid.h> 16 17 #include <plat_common.h> 18 #include <sipsvc.h> 19 20 /* Layerscape SiP Service UUID */ 21 DEFINE_SVC_UUID2(nxp_sip_svc_uid, 22 0x871de4ef, 0xedfc, 0x4209, 0xa4, 0x23, 23 0x8d, 0x23, 0x75, 0x9d, 0x3b, 0x9f); 24 25 #pragma weak nxp_plat_sip_handler 26 static uintptr_t nxp_plat_sip_handler(unsigned int smc_fid, 27 u_register_t x1, 28 u_register_t x2, 29 u_register_t x3, 30 u_register_t x4, 31 void *cookie, 32 void *handle, 33 u_register_t flags) 34 { 35 ERROR("%s: unhandled SMC (0x%x)\n", __func__, smc_fid); 36 SMC_RET1(handle, SMC_UNK); 37 } 38 39 uint64_t el2_2_aarch32(u_register_t smc_id, u_register_t start_addr, 40 u_register_t parm1, u_register_t parm2); 41 42 uint64_t prefetch_disable(u_register_t smc_id, u_register_t mask); 43 uint64_t bl31_get_porsr1(void); 44 45 static void clean_top_32b_of_param(uint32_t smc_fid, 46 u_register_t *px1, 47 u_register_t *px2, 48 u_register_t *px3, 49 u_register_t *px4) 50 { 51 /* if parameters from SMC32. Clean top 32 bits */ 52 if (GET_SMC_CC(smc_fid) == SMC_32) { 53 *px1 = *px1 & SMC32_PARAM_MASK; 54 *px2 = *px2 & SMC32_PARAM_MASK; 55 *px3 = *px3 & SMC32_PARAM_MASK; 56 *px4 = *px4 & SMC32_PARAM_MASK; 57 } 58 } 59 60 /* This function handles Layerscape defined SiP Calls */ 61 static uintptr_t nxp_sip_handler(unsigned int smc_fid, 62 u_register_t x1, 63 u_register_t x2, 64 u_register_t x3, 65 u_register_t x4, 66 void *cookie, 67 void *handle, 68 u_register_t flags) 69 { 70 uint32_t ns; 71 uint64_t ret; 72 dram_regions_info_t *info_dram_regions; 73 74 /* if parameter is sent from SMC32. Clean top 32 bits */ 75 clean_top_32b_of_param(smc_fid, &x1, &x2, &x3, &x4); 76 77 /* Determine which security state this SMC originated from */ 78 ns = is_caller_non_secure(flags); 79 if (ns == 0) { 80 /* SiP SMC service secure world's call */ 81 ; 82 } else { 83 /* SiP SMC service normal world's call */ 84 ; 85 } 86 87 switch (smc_fid & SMC_FUNC_MASK) { 88 case SIP_SVC_RNG: 89 if (is_sec_enabled() == false) { 90 NOTICE("SEC is disabled.\n"); 91 SMC_RET1(handle, SMC_UNK); 92 } 93 94 /* Return zero on failure */ 95 ret = get_random((int)x1); 96 if (ret != 0) { 97 SMC_RET2(handle, SMC_OK, ret); 98 } else { 99 SMC_RET1(handle, SMC_UNK); 100 } 101 /* break is not required as SMC_RETx return */ 102 case SIP_SVC_HUK: 103 if (ns != 0 || is_sec_enabled() == false) { 104 NOTICE("SEC is disabled.\n"); 105 SMC_RET1(handle, SMC_UNK); 106 } 107 ret = get_hw_unq_key_blob_hw((uint8_t *) x1, (uint32_t) x2); 108 109 if (ret == SMC_OK) { 110 SMC_RET1(handle, SMC_OK); 111 } else { 112 SMC_RET1(handle, SMC_UNK); 113 } 114 /* break is not required as SMC_RETx return */ 115 case SIP_SVC_MEM_BANK: 116 VERBOSE("Handling SMC SIP_SVC_MEM_BANK.\n"); 117 info_dram_regions = get_dram_regions_info(); 118 119 if (x1 == -1) { 120 SMC_RET2(handle, SMC_OK, 121 info_dram_regions->total_dram_size); 122 } else if (x1 >= info_dram_regions->num_dram_regions) { 123 SMC_RET1(handle, SMC_UNK); 124 } else { 125 SMC_RET3(handle, SMC_OK, 126 info_dram_regions->region[x1].addr, 127 info_dram_regions->region[x1].size); 128 } 129 /* break is not required as SMC_RETx return */ 130 case SIP_SVC_PREFETCH_DIS: 131 VERBOSE("In SIP_SVC_PREFETCH_DIS call\n"); 132 ret = prefetch_disable(smc_fid, x1); 133 if (ret == SMC_OK) { 134 SMC_RET1(handle, SMC_OK); 135 } else { 136 SMC_RET1(handle, SMC_UNK); 137 } 138 /* break is not required as SMC_RETx return */ 139 case SIP_SVC_2_AARCH32: 140 ret = el2_2_aarch32(smc_fid, x1, x2, x3); 141 142 /* In success case, control should not reach here. */ 143 NOTICE("SMC: SIP_SVC_2_AARCH32 Failed.\n"); 144 SMC_RET1(handle, SMC_UNK); 145 /* break is not required as SMC_RETx return */ 146 case SIP_SVC_PORSR1: 147 ret = bl31_get_porsr1(); 148 SMC_RET2(handle, SMC_OK, ret); 149 /* break is not required as SMC_RETx return */ 150 default: 151 return nxp_plat_sip_handler(smc_fid, x1, x2, x3, x4, 152 cookie, handle, flags); 153 } 154 } 155 156 /* This function is responsible for handling all SiP calls */ 157 static uintptr_t sip_smc_handler(unsigned int smc_fid, 158 u_register_t x1, 159 u_register_t x2, 160 u_register_t x3, 161 u_register_t x4, 162 void *cookie, 163 void *handle, 164 u_register_t flags) 165 { 166 switch (smc_fid & SMC_FUNC_MASK) { 167 case SIP_SVC_CALL_COUNT: 168 /* Return the number of Layerscape SiP Service Calls. */ 169 SMC_RET1(handle, LS_COMMON_SIP_NUM_CALLS); 170 break; 171 case SIP_SVC_UID: 172 /* Return UID to the caller */ 173 SMC_UUID_RET(handle, nxp_sip_svc_uid); 174 break; 175 case SIP_SVC_VERSION: 176 /* Return the version of current implementation */ 177 SMC_RET2(handle, LS_SIP_SVC_VERSION_MAJOR, 178 LS_SIP_SVC_VERSION_MINOR); 179 break; 180 default: 181 return nxp_sip_handler(smc_fid, x1, x2, x3, x4, 182 cookie, handle, flags); 183 } 184 } 185 186 /* Define a runtime service descriptor for fast SMC calls */ 187 DECLARE_RT_SVC( 188 nxp_sip_svc, 189 OEN_SIP_START, 190 OEN_SIP_END, 191 SMC_TYPE_FAST, 192 NULL, 193 sip_smc_handler 194 ); 195