xref: /rk3399_ARM-atf/bl2/bl2_main.c (revision 4112bfa0c223eda73af1cfe57ca7dc926f767dd8)
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 	bl31_plat_params_t *bl2_to_bl31_plat_params;
71 	unsigned int bl2_load, bl31_load;
72 	entry_point_info_t *bl31_ep_info;
73 	int e;
74 
75 	/* Perform remaining generic architectural setup in S-El1 */
76 	bl2_arch_setup();
77 
78 	/* Perform platform setup in BL1 */
79 	bl2_platform_setup();
80 
81 	printf("BL2 %s\n\r", build_message);
82 
83 	/* Find out how much free trusted ram remains after BL2 load */
84 	bl2_tzram_layout = bl2_plat_sec_mem_layout();
85 
86 	/*
87 	 * Get a pointer to the memory the platform has set aside to pass
88 	 * information to BL31.
89 	 */
90 	bl2_to_bl31_params = bl2_plat_get_bl31_params();
91 	bl2_to_bl31_plat_params = bl2_plat_get_bl31_plat_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 	/*
120 	 * Create a new layout of memory for BL31 as seen by BL2. This
121 	 * will gobble up all the BL2 memory.
122 	 */
123 	init_bl31_mem_layout(bl2_tzram_layout,
124 			     &bl2_to_bl31_plat_params->bl31_meminfo,
125 			     bl31_load);
126 
127 	/* Load the BL33 image in non-secure memory provided by the platform */
128 	e = load_image(&bl2_to_bl31_plat_params->bl33_meminfo,
129 			BL33_IMAGE_NAME,
130 			BOT_LOAD,
131 			plat_get_ns_image_entrypoint(),
132 			bl2_to_bl31_params->bl33_image_info,
133 			bl2_to_bl31_params->bl33_ep_info);
134 
135 	/* Halt if failed to load normal world firmware. */
136 	if (e) {
137 		ERROR("Failed to load BL3-3.\n");
138 		panic();
139 	}
140 	bl2_plat_set_bl33_ep_info(bl2_to_bl31_params->bl33_image_info,
141 				bl2_to_bl31_params->bl33_ep_info);
142 
143 	/*
144 	 * Load the BL32 image if there's one. It is upto to platform
145 	 * to specify where BL32 should be loaded if it exists. It
146 	 * could create space in the secure sram or point to a
147 	 * completely different memory. A zero size indicates that the
148 	 * platform does not want to load a BL32 image.
149 	 */
150 	if (bl2_to_bl31_plat_params->bl32_meminfo.total_size) {
151 		e = load_image(&bl2_to_bl31_plat_params->bl32_meminfo,
152 			       BL32_IMAGE_NAME,
153 			       bl2_to_bl31_plat_params->bl32_meminfo.attr &
154 			       LOAD_MASK,
155 			       BL32_BASE,
156 			       bl2_to_bl31_params->bl32_image_info,
157 			       bl2_to_bl31_params->bl32_ep_info);
158 
159 		/* Halt if failed to load normal world firmware. */
160 		if (e) {
161 			WARN("Failed to load BL3-2.\n");
162 		} else {
163 			bl2_plat_set_bl32_ep_info(
164 				bl2_to_bl31_params->bl32_image_info,
165 				bl2_to_bl31_params->bl32_ep_info);
166 		}
167 	}
168 
169 
170 	/*
171 	 * Run BL31 via an SMC to BL1. Information on how to pass control to
172 	 * the BL32 (if present) and BL33 software images will be passed to
173 	 * BL31 as an argument.
174 	 */
175 	 bl2_run_bl31(bl31_ep_info, (unsigned long)bl2_to_bl31_params,
176 				(unsigned long)bl2_to_bl31_plat_params);
177 }
178