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 ******************************************************************************/
bl2_el3_setup(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3)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 ******************************************************************************/
bl2_setup(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3)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 ******************************************************************************/
bl2_main(void)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