xref: /rk3399_ARM-atf/bl2/bl2_main.c (revision c6bc071020baebc660fc94390b50bc240e34c0a3)
1 /*
2  * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved.
3  *
4  * Redistribution and use in source and binary forms, with or without
5  * modification, are permitted provided that the following conditions are met:
6  *
7  * Redistributions of source code must retain the above copyright notice, this
8  * list of conditions and the following disclaimer.
9  *
10  * Redistributions in binary form must reproduce the above copyright notice,
11  * this list of conditions and the following disclaimer in the documentation
12  * and/or other materials provided with the distribution.
13  *
14  * Neither the name of ARM nor the names of its contributors may be used
15  * to endorse or promote products derived from this software without specific
16  * prior written permission.
17  *
18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
19  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
21  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
22  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28  * POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 #include <arch.h>
32 #include <arch_helpers.h>
33 #include <assert.h>
34 #include <bl_common.h>
35 #include <bl2.h>
36 #include <debug.h>
37 #include <platform.h>
38 #include <stdio.h>
39 #include "bl2_private.h"
40 
41 /*******************************************************************************
42  * Runs BL31 from the given entry point. It jumps to a higher exception level
43  * through an SMC.
44  ******************************************************************************/
45 static void __dead2 bl2_run_bl31(entry_point_info_t *bl31_ep_info,
46 				unsigned long arg1,
47 				unsigned long arg2)
48 {
49 	/* Set the args pointer */
50 	bl31_ep_info->args.arg0 = arg1;
51 	bl31_ep_info->args.arg1 = arg2;
52 
53 	/* Flush the params to be passed to memory */
54 	bl2_plat_flush_bl31_params();
55 
56 	smc(RUN_IMAGE, (unsigned long)bl31_ep_info, 0, 0, 0, 0, 0, 0);
57 }
58 
59 
60 /*******************************************************************************
61  * The only thing to do in BL2 is to load further images and pass control to
62  * BL31. The memory occupied by BL2 will be reclaimed by BL3_x stages. BL2 runs
63  * entirely in S-EL1. Since arm standard c libraries are not PIC, printf et al
64  * are not available. We rely on assertions to signal error conditions
65  ******************************************************************************/
66 void bl2_main(void)
67 {
68 	meminfo_t *bl2_tzram_layout;
69 	bl31_params_t *bl2_to_bl31_params;
70 	unsigned int bl2_load, bl31_load;
71 	entry_point_info_t *bl31_ep_info;
72 	meminfo_t bl32_mem_info;
73 	meminfo_t bl33_mem_info;
74 	int e;
75 
76 	/* Perform remaining generic architectural setup in S-El1 */
77 	bl2_arch_setup();
78 
79 	/* Perform platform setup in BL1 */
80 	bl2_platform_setup();
81 
82 	printf("BL2 %s\n\r", build_message);
83 
84 	/* Find out how much free trusted ram remains after BL2 load */
85 	bl2_tzram_layout = bl2_plat_sec_mem_layout();
86 
87 	/*
88 	 * Get a pointer to the memory the platform has set aside to pass
89 	 * information to BL31.
90 	 */
91 	bl2_to_bl31_params = bl2_plat_get_bl31_params();
92 	bl31_ep_info = bl2_plat_get_bl31_ep_info();
93 
94 	/*
95 	 * Load BL31. BL1 tells BL2 whether it has been TOP or BOTTOM loaded.
96 	 * To avoid fragmentation of trusted SRAM memory, BL31 is always
97 	 * loaded opposite to BL2. This allows BL31 to reclaim BL2 memory
98 	 * while maintaining its free space in one contiguous chunk.
99 	 */
100 	bl2_load = bl2_tzram_layout->attr & LOAD_MASK;
101 	assert((bl2_load == TOP_LOAD) || (bl2_load == BOT_LOAD));
102 	bl31_load = (bl2_load == TOP_LOAD) ? BOT_LOAD : TOP_LOAD;
103 	e = load_image(bl2_tzram_layout,
104 			BL31_IMAGE_NAME,
105 			bl31_load,
106 			BL31_BASE,
107 			bl2_to_bl31_params->bl31_image_info,
108 			bl31_ep_info);
109 
110 	/* Assert if it has not been possible to load BL31 */
111 	if (e) {
112 		ERROR("Failed to load BL3-1.\n");
113 		panic();
114 	}
115 
116 	bl2_plat_set_bl31_ep_info(bl2_to_bl31_params->bl31_image_info,
117 				bl31_ep_info);
118 
119 	bl2_plat_get_bl33_meminfo(&bl33_mem_info);
120 
121 	/* Load the BL33 image in non-secure memory provided by the platform */
122 	e = load_image(&bl33_mem_info,
123 			BL33_IMAGE_NAME,
124 			BOT_LOAD,
125 			plat_get_ns_image_entrypoint(),
126 			bl2_to_bl31_params->bl33_image_info,
127 			bl2_to_bl31_params->bl33_ep_info);
128 
129 	/* Halt if failed to load normal world firmware. */
130 	if (e) {
131 		ERROR("Failed to load BL3-3.\n");
132 		panic();
133 	}
134 	bl2_plat_set_bl33_ep_info(bl2_to_bl31_params->bl33_image_info,
135 				bl2_to_bl31_params->bl33_ep_info);
136 
137 
138 #ifdef BL32_BASE
139 	/*
140 	 * Load the BL32 image if there's one. It is upto to platform
141 	 * to specify where BL32 should be loaded if it exists. It
142 	 * could create space in the secure sram or point to a
143 	 * completely different memory.
144 	 *
145 	 * If a platform does not want to attempt to load BL3-2 image
146 	 * it must leave BL32_BASE undefined
147 	 */
148 	bl2_plat_get_bl32_meminfo(&bl32_mem_info);
149 	e = load_image(&bl32_mem_info,
150 		       BL32_IMAGE_NAME,
151 		       bl32_mem_info.attr & LOAD_MASK,
152 		       BL32_BASE,
153 		       bl2_to_bl31_params->bl32_image_info,
154 		       bl2_to_bl31_params->bl32_ep_info);
155 
156 	/* Issue a diagnostic if no Secure Payload could be loaded */
157 	if (e) {
158 		WARN("Failed to load BL3-2.\n");
159 	} else {
160 		bl2_plat_set_bl32_ep_info(
161 			bl2_to_bl31_params->bl32_image_info,
162 			bl2_to_bl31_params->bl32_ep_info);
163 	}
164 #endif /* BL32_BASE */
165 
166 	/*
167 	 * Run BL31 via an SMC to BL1. Information on how to pass control to
168 	 * the BL32 (if present) and BL33 software images will be passed to
169 	 * BL31 as an argument.
170 	 */
171 	 bl2_run_bl31(bl31_ep_info, (unsigned long)bl2_to_bl31_params, 0);
172 }
173