1 /* 2 * Copyright (c) 2013-2024, Arm Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <assert.h> 8 9 #include <arch_helpers.h> 10 #include <arch_features.h> 11 #include <bl1/bl1.h> 12 #include <bl2/bl2.h> 13 #include <common/bl_common.h> 14 #include <common/build_message.h> 15 #include <common/debug.h> 16 #include <drivers/auth/auth_mod.h> 17 #include <drivers/auth/crypto_mod.h> 18 #include <drivers/console.h> 19 #include <drivers/fwu/fwu.h> 20 #include <lib/bootmarker_capture.h> 21 #include <lib/extensions/pauth.h> 22 #include <lib/pmf/pmf.h> 23 #include <plat/common/platform.h> 24 25 #include "bl2_private.h" 26 27 #ifdef __aarch64__ 28 #define NEXT_IMAGE "BL31" 29 #else 30 #define NEXT_IMAGE "BL32" 31 #endif 32 33 #if ENABLE_RUNTIME_INSTRUMENTATION 34 PMF_REGISTER_SERVICE(bl_svc, PMF_RT_INSTR_SVC_ID, 35 BL_TOTAL_IDS, PMF_DUMP_ENABLE); 36 #endif 37 38 #if RESET_TO_BL2 39 /******************************************************************************* 40 * Setup function for BL2 when RESET_TO_BL2=1 41 ******************************************************************************/ 42 void bl2_el3_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2, 43 u_register_t arg3) 44 { 45 /* Enable early console if EARLY_CONSOLE flag is enabled */ 46 plat_setup_early_console(); 47 48 /* Perform early platform-specific setup */ 49 bl2_el3_early_platform_setup(arg0, arg1, arg2, arg3); 50 51 /* Perform late platform-specific setup */ 52 bl2_el3_plat_arch_setup(); 53 54 #if CTX_INCLUDE_PAUTH_REGS 55 /* 56 * Assert that the ARMv8.3-PAuth registers are present or an access 57 * fault will be triggered when they are being saved or restored. 58 */ 59 assert(is_armv8_3_pauth_present()); 60 #endif /* CTX_INCLUDE_PAUTH_REGS */ 61 } 62 #else /* RESET_TO_BL2 */ 63 64 /******************************************************************************* 65 * Setup function for BL2 when RESET_TO_BL2=0 66 ******************************************************************************/ 67 void bl2_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2, 68 u_register_t arg3) 69 { 70 /* Enable early console if EARLY_CONSOLE flag is enabled */ 71 plat_setup_early_console(); 72 73 /* Perform early platform-specific setup */ 74 bl2_early_platform_setup2(arg0, arg1, arg2, arg3); 75 76 /* Perform late platform-specific setup */ 77 bl2_plat_arch_setup(); 78 79 #if CTX_INCLUDE_PAUTH_REGS 80 /* 81 * Assert that the ARMv8.3-PAuth registers are present or an access 82 * fault will be triggered when they are being saved or restored. 83 */ 84 assert(is_armv8_3_pauth_present()); 85 #endif /* CTX_INCLUDE_PAUTH_REGS */ 86 } 87 #endif /* RESET_TO_BL2 */ 88 89 /******************************************************************************* 90 * The only thing to do in BL2 is to load further images and pass control to 91 * next BL. The memory occupied by BL2 will be reclaimed by BL3x stages. BL2 92 * runs entirely in S-EL1. 93 ******************************************************************************/ 94 void bl2_main(void) 95 { 96 entry_point_info_t *next_bl_ep_info; 97 98 #if ENABLE_RUNTIME_INSTRUMENTATION 99 PMF_CAPTURE_TIMESTAMP(bl_svc, BL2_ENTRY, PMF_CACHE_MAINT); 100 #endif 101 102 NOTICE("BL2: %s\n", build_version_string); 103 NOTICE("BL2: %s\n", build_message); 104 105 /* Perform remaining generic architectural setup in S-EL1 */ 106 bl2_arch_setup(); 107 108 #if PSA_FWU_SUPPORT 109 fwu_init(); 110 #endif /* PSA_FWU_SUPPORT */ 111 112 crypto_mod_init(); 113 114 /* Initialize authentication module */ 115 auth_mod_init(); 116 117 /* Initialize the Measured Boot backend */ 118 bl2_plat_mboot_init(); 119 120 /* Initialize boot source */ 121 bl2_plat_preload_setup(); 122 123 /* Load the subsequent bootloader images. */ 124 next_bl_ep_info = bl2_load_images(); 125 126 /* Teardown the Measured Boot backend */ 127 bl2_plat_mboot_finish(); 128 129 #if !BL2_RUNS_AT_EL3 130 #ifndef __aarch64__ 131 /* 132 * For AArch32 state BL1 and BL2 share the MMU setup. 133 * Given that BL2 does not map BL1 regions, MMU needs 134 * to be disabled in order to go back to BL1. 135 */ 136 disable_mmu_icache_secure(); 137 #endif /* !__aarch64__ */ 138 139 #if ENABLE_PAUTH 140 /* 141 * Disable pointer authentication before running next boot image 142 */ 143 pauth_disable_el1(); 144 #endif /* ENABLE_PAUTH */ 145 146 #if ENABLE_RUNTIME_INSTRUMENTATION 147 PMF_CAPTURE_TIMESTAMP(bl_svc, BL2_EXIT, PMF_CACHE_MAINT); 148 #endif 149 150 console_flush(); 151 152 /* 153 * Run next BL image via an SMC to BL1. Information on how to pass 154 * control to the BL32 (if present) and BL33 software images will 155 * be passed to next BL image as an argument. 156 */ 157 smc(BL1_SMC_RUN_IMAGE, (unsigned long)next_bl_ep_info, 0, 0, 0, 0, 0, 0); 158 #else /* if BL2_RUNS_AT_EL3 */ 159 160 NOTICE("BL2: Booting " NEXT_IMAGE "\n"); 161 print_entry_point_info(next_bl_ep_info); 162 #if ENABLE_RUNTIME_INSTRUMENTATION 163 PMF_CAPTURE_TIMESTAMP(bl_svc, BL2_EXIT, PMF_CACHE_MAINT); 164 #endif 165 console_flush(); 166 167 #if ENABLE_PAUTH 168 /* 169 * Disable pointer authentication before running next boot image 170 */ 171 pauth_disable_el3(); 172 #endif /* ENABLE_PAUTH */ 173 174 bl2_run_next_image(next_bl_ep_info); 175 #endif /* BL2_RUNS_AT_EL3 */ 176 } 177