1 /* 2 * Copyright (c) 2015-2018, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <arch.h> 8 #include <arch_helpers.h> 9 #include <arm_def.h> 10 #include <assert.h> 11 #include <bl_common.h> 12 #include <console.h> 13 #include <debug.h> 14 #include <mmio.h> 15 #include <plat_arm.h> 16 #include <platform.h> 17 #include <ras.h> 18 19 #define BL31_END (uintptr_t)(&__BL31_END__) 20 21 /* 22 * Placeholder variables for copying the arguments that have been passed to 23 * BL31 from BL2. 24 */ 25 static entry_point_info_t bl32_image_ep_info; 26 static entry_point_info_t bl33_image_ep_info; 27 28 /* 29 * Check that BL31_BASE is above ARM_TB_FW_CONFIG_LIMIT. The reserved page 30 * is required for SOC_FW_CONFIG/TOS_FW_CONFIG passed from BL2. 31 */ 32 CASSERT(BL31_BASE >= ARM_TB_FW_CONFIG_LIMIT, assert_bl31_base_overflows); 33 34 /* Weak definitions may be overridden in specific ARM standard platform */ 35 #pragma weak bl31_early_platform_setup2 36 #pragma weak bl31_platform_setup 37 #pragma weak bl31_plat_arch_setup 38 #pragma weak bl31_plat_get_next_image_ep_info 39 40 41 /******************************************************************************* 42 * Return a pointer to the 'entry_point_info' structure of the next image for the 43 * security state specified. BL33 corresponds to the non-secure image type 44 * while BL32 corresponds to the secure image type. A NULL pointer is returned 45 * if the image does not exist. 46 ******************************************************************************/ 47 entry_point_info_t *bl31_plat_get_next_image_ep_info(uint32_t type) 48 { 49 entry_point_info_t *next_image_info; 50 51 assert(sec_state_is_valid(type)); 52 next_image_info = (type == NON_SECURE) 53 ? &bl33_image_ep_info : &bl32_image_ep_info; 54 /* 55 * None of the images on the ARM development platforms can have 0x0 56 * as the entrypoint 57 */ 58 if (next_image_info->pc) 59 return next_image_info; 60 else 61 return NULL; 62 } 63 64 /******************************************************************************* 65 * Perform any BL31 early platform setup common to ARM standard platforms. 66 * Here is an opportunity to copy parameters passed by the calling EL (S-EL1 67 * in BL2 & S-EL3 in BL1) before they are lost (potentially). This needs to be 68 * done before the MMU is initialized so that the memory layout can be used 69 * while creating page tables. BL2 has flushed this information to memory, so 70 * we are guaranteed to pick up good data. 71 ******************************************************************************/ 72 #if LOAD_IMAGE_V2 73 void arm_bl31_early_platform_setup(void *from_bl2, uintptr_t soc_fw_config, 74 uintptr_t hw_config, void *plat_params_from_bl2) 75 #else 76 void arm_bl31_early_platform_setup(bl31_params_t *from_bl2, uintptr_t soc_fw_config, 77 uintptr_t hw_config, void *plat_params_from_bl2) 78 #endif 79 { 80 /* Initialize the console to provide early debug support */ 81 arm_console_boot_init(); 82 83 #if RESET_TO_BL31 84 /* There are no parameters from BL2 if BL31 is a reset vector */ 85 assert(from_bl2 == NULL); 86 assert(plat_params_from_bl2 == NULL); 87 88 # ifdef BL32_BASE 89 /* Populate entry point information for BL32 */ 90 SET_PARAM_HEAD(&bl32_image_ep_info, 91 PARAM_EP, 92 VERSION_1, 93 0); 94 SET_SECURITY_STATE(bl32_image_ep_info.h.attr, SECURE); 95 bl32_image_ep_info.pc = BL32_BASE; 96 bl32_image_ep_info.spsr = arm_get_spsr_for_bl32_entry(); 97 # endif /* BL32_BASE */ 98 99 /* Populate entry point information for BL33 */ 100 SET_PARAM_HEAD(&bl33_image_ep_info, 101 PARAM_EP, 102 VERSION_1, 103 0); 104 /* 105 * Tell BL31 where the non-trusted software image 106 * is located and the entry state information 107 */ 108 bl33_image_ep_info.pc = plat_get_ns_image_entrypoint(); 109 110 bl33_image_ep_info.spsr = arm_get_spsr_for_bl33_entry(); 111 SET_SECURITY_STATE(bl33_image_ep_info.h.attr, NON_SECURE); 112 113 # if ARM_LINUX_KERNEL_AS_BL33 114 /* 115 * According to the file ``Documentation/arm64/booting.txt`` of the 116 * Linux kernel tree, Linux expects the physical address of the device 117 * tree blob (DTB) in x0, while x1-x3 are reserved for future use and 118 * must be 0. 119 */ 120 bl33_image_ep_info.args.arg0 = (u_register_t)ARM_PRELOADED_DTB_BASE; 121 bl33_image_ep_info.args.arg1 = 0U; 122 bl33_image_ep_info.args.arg2 = 0U; 123 bl33_image_ep_info.args.arg3 = 0U; 124 # endif 125 126 #else /* RESET_TO_BL31 */ 127 128 /* 129 * In debug builds, we pass a special value in 'plat_params_from_bl2' 130 * to verify platform parameters from BL2 to BL31. 131 * In release builds, it's not used. 132 */ 133 assert(((unsigned long long)plat_params_from_bl2) == 134 ARM_BL31_PLAT_PARAM_VAL); 135 136 # if LOAD_IMAGE_V2 137 /* 138 * Check params passed from BL2 should not be NULL, 139 */ 140 bl_params_t *params_from_bl2 = (bl_params_t *)from_bl2; 141 assert(params_from_bl2 != NULL); 142 assert(params_from_bl2->h.type == PARAM_BL_PARAMS); 143 assert(params_from_bl2->h.version >= VERSION_2); 144 145 bl_params_node_t *bl_params = params_from_bl2->head; 146 147 /* 148 * Copy BL33 and BL32 (if present), entry point information. 149 * They are stored in Secure RAM, in BL2's address space. 150 */ 151 while (bl_params) { 152 if (bl_params->image_id == BL32_IMAGE_ID) 153 bl32_image_ep_info = *bl_params->ep_info; 154 155 if (bl_params->image_id == BL33_IMAGE_ID) 156 bl33_image_ep_info = *bl_params->ep_info; 157 158 bl_params = bl_params->next_params_info; 159 } 160 161 if (bl33_image_ep_info.pc == 0) 162 panic(); 163 164 # else /* LOAD_IMAGE_V2 */ 165 166 /* 167 * Check params passed from BL2 should not be NULL, 168 */ 169 assert(from_bl2 != NULL); 170 assert(from_bl2->h.type == PARAM_BL31); 171 assert(from_bl2->h.version >= VERSION_1); 172 173 /* Dynamic Config is not supported for LOAD_IMAGE_V1 */ 174 assert(soc_fw_config == 0); 175 assert(hw_config == 0); 176 177 /* 178 * Copy BL32 (if populated by BL2) and BL33 entry point information. 179 * They are stored in Secure RAM, in BL2's address space. 180 */ 181 if (from_bl2->bl32_ep_info) 182 bl32_image_ep_info = *from_bl2->bl32_ep_info; 183 bl33_image_ep_info = *from_bl2->bl33_ep_info; 184 185 # endif /* LOAD_IMAGE_V2 */ 186 #endif /* RESET_TO_BL31 */ 187 } 188 189 void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1, 190 u_register_t arg2, u_register_t arg3) 191 { 192 arm_bl31_early_platform_setup((void *)arg0, arg1, arg2, (void *)arg3); 193 194 /* 195 * Initialize Interconnect for this cluster during cold boot. 196 * No need for locks as no other CPU is active. 197 */ 198 plat_arm_interconnect_init(); 199 200 /* 201 * Enable Interconnect coherency for the primary CPU's cluster. 202 * Earlier bootloader stages might already do this (e.g. Trusted 203 * Firmware's BL1 does it) but we can't assume so. There is no harm in 204 * executing this code twice anyway. 205 * Platform specific PSCI code will enable coherency for other 206 * clusters. 207 */ 208 plat_arm_interconnect_enter_coherency(); 209 } 210 211 /******************************************************************************* 212 * Perform any BL31 platform setup common to ARM standard platforms 213 ******************************************************************************/ 214 void arm_bl31_platform_setup(void) 215 { 216 /* Initialize the GIC driver, cpu and distributor interfaces */ 217 plat_arm_gic_driver_init(); 218 plat_arm_gic_init(); 219 220 #if RESET_TO_BL31 221 /* 222 * Do initial security configuration to allow DRAM/device access 223 * (if earlier BL has not already done so). 224 */ 225 plat_arm_security_setup(); 226 227 #if defined(PLAT_ARM_MEM_PROT_ADDR) 228 arm_nor_psci_do_dyn_mem_protect(); 229 #endif /* PLAT_ARM_MEM_PROT_ADDR */ 230 231 #endif /* RESET_TO_BL31 */ 232 233 /* Enable and initialize the System level generic timer */ 234 mmio_write_32(ARM_SYS_CNTCTL_BASE + CNTCR_OFF, 235 CNTCR_FCREQ(0) | CNTCR_EN); 236 237 /* Allow access to the System counter timer module */ 238 arm_configure_sys_timer(); 239 240 /* Initialize power controller before setting up topology */ 241 plat_arm_pwrc_setup(); 242 243 #if RAS_EXTENSION 244 ras_init(); 245 #endif 246 } 247 248 /******************************************************************************* 249 * Perform any BL31 platform runtime setup prior to BL31 exit common to ARM 250 * standard platforms 251 * Perform BL31 platform setup 252 ******************************************************************************/ 253 void arm_bl31_plat_runtime_setup(void) 254 { 255 #if MULTI_CONSOLE_API 256 console_switch_state(CONSOLE_FLAG_RUNTIME); 257 #else 258 console_uninit(); 259 #endif 260 261 /* Initialize the runtime console */ 262 arm_console_runtime_init(); 263 } 264 265 void bl31_platform_setup(void) 266 { 267 arm_bl31_platform_setup(); 268 } 269 270 void bl31_plat_runtime_setup(void) 271 { 272 arm_bl31_plat_runtime_setup(); 273 } 274 275 /******************************************************************************* 276 * Perform the very early platform specific architectural setup shared between 277 * ARM standard platforms. This only does basic initialization. Later 278 * architectural setup (bl31_arch_setup()) does not do anything platform 279 * specific. 280 ******************************************************************************/ 281 void arm_bl31_plat_arch_setup(void) 282 { 283 arm_setup_page_tables(BL31_BASE, 284 BL31_END - BL31_BASE, 285 BL_CODE_BASE, 286 BL_CODE_END, 287 BL_RO_DATA_BASE, 288 BL_RO_DATA_END 289 #if USE_COHERENT_MEM 290 , BL_COHERENT_RAM_BASE, 291 BL_COHERENT_RAM_END 292 #endif 293 ); 294 enable_mmu_el3(0); 295 } 296 297 void bl31_plat_arch_setup(void) 298 { 299 arm_bl31_plat_arch_setup(); 300 } 301