xref: /rk3399_ARM-atf/bl2/bl2_main.c (revision fd7b287cbe9147ca9e07dd9f30c49c58bbdd92a8)
1 /*
2  * Copyright (c) 2013-2019, ARM Limited and Contributors. All rights reserved.
3  *
4  * SPDX-License-Identifier: BSD-3-Clause
5  */
6 
7 #include <arch_helpers.h>
8 #include <bl1/bl1.h>
9 #include <bl2/bl2.h>
10 #include <common/bl_common.h>
11 #include <common/debug.h>
12 #include <drivers/auth/auth_mod.h>
13 #include <drivers/console.h>
14 #include <plat/common/platform.h>
15 
16 #include "bl2_private.h"
17 
18 #ifdef AARCH32
19 #define NEXT_IMAGE	"BL32"
20 #else
21 #define NEXT_IMAGE	"BL31"
22 #endif
23 
24 #if !BL2_AT_EL3
25 /*******************************************************************************
26  * Setup function for BL2.
27  ******************************************************************************/
28 void bl2_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2,
29 	       u_register_t arg3)
30 {
31 	/* Perform early platform-specific setup */
32 	bl2_early_platform_setup2(arg0, arg1, arg2, arg3);
33 
34 #ifdef AARCH64
35 	/*
36 	 * Update pointer authentication key before the MMU is enabled. It is
37 	 * saved in the rodata section, that can be writen before enabling the
38 	 * MMU. This function must be called after the console is initialized
39 	 * in the early platform setup.
40 	 */
41 	bl_handle_pauth();
42 #endif /* AARCH64 */
43 
44 	/* Perform late platform-specific setup */
45 	bl2_plat_arch_setup();
46 }
47 
48 #else /* if BL2_AT_EL3 */
49 /*******************************************************************************
50  * Setup function for BL2 when BL2_AT_EL3=1.
51  ******************************************************************************/
52 void bl2_el3_setup(u_register_t arg0, u_register_t arg1, u_register_t arg2,
53 		   u_register_t arg3)
54 {
55 	/* Perform early platform-specific setup */
56 	bl2_el3_early_platform_setup(arg0, arg1, arg2, arg3);
57 
58 #ifdef AARCH64
59 	/*
60 	 * Update pointer authentication key before the MMU is enabled. It is
61 	 * saved in the rodata section, that can be writen before enabling the
62 	 * MMU. This function must be called after the console is initialized
63 	 * in the early platform setup.
64 	 */
65 	bl_handle_pauth();
66 #endif /* AARCH64 */
67 
68 	/* Perform late platform-specific setup */
69 	bl2_el3_plat_arch_setup();
70 }
71 #endif /* BL2_AT_EL3 */
72 
73 /*******************************************************************************
74  * The only thing to do in BL2 is to load further images and pass control to
75  * next BL. The memory occupied by BL2 will be reclaimed by BL3x stages. BL2
76  * runs entirely in S-EL1.
77  ******************************************************************************/
78 void bl2_main(void)
79 {
80 	entry_point_info_t *next_bl_ep_info;
81 
82 	NOTICE("BL2: %s\n", version_string);
83 	NOTICE("BL2: %s\n", build_message);
84 
85 	/* Perform remaining generic architectural setup in S-EL1 */
86 	bl2_arch_setup();
87 
88 #if TRUSTED_BOARD_BOOT
89 	/* Initialize authentication module */
90 	auth_mod_init();
91 #endif /* TRUSTED_BOARD_BOOT */
92 
93 	/* initialize boot source */
94 	bl2_plat_preload_setup();
95 
96 	/* Load the subsequent bootloader images. */
97 	next_bl_ep_info = bl2_load_images();
98 
99 #if !BL2_AT_EL3
100 #ifdef AARCH32
101 	/*
102 	 * For AArch32 state BL1 and BL2 share the MMU setup.
103 	 * Given that BL2 does not map BL1 regions, MMU needs
104 	 * to be disabled in order to go back to BL1.
105 	 */
106 	disable_mmu_icache_secure();
107 #endif /* AARCH32 */
108 
109 	console_flush();
110 
111 	/*
112 	 * Run next BL image via an SMC to BL1. Information on how to pass
113 	 * control to the BL32 (if present) and BL33 software images will
114 	 * be passed to next BL image as an argument.
115 	 */
116 	smc(BL1_SMC_RUN_IMAGE, (unsigned long)next_bl_ep_info, 0, 0, 0, 0, 0, 0);
117 #else /* if BL2_AT_EL3 */
118 	NOTICE("BL2: Booting " NEXT_IMAGE "\n");
119 	print_entry_point_info(next_bl_ep_info);
120 	console_flush();
121 
122 	bl2_run_next_image(next_bl_ep_info);
123 #endif /* BL2_AT_EL3 */
124 }
125