1 /*
2 * Copyright (c) 2015-2019, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <assert.h>
8
9 #include <libfdt.h>
10
11 #include <platform_def.h>
12
13 #include <common/bl_common.h>
14 #include <lib/xlat_tables/xlat_mmu_helpers.h>
15 #include <lib/xlat_tables/xlat_tables_defs.h>
16 #include <plat/common/platform.h>
17
18 #include <rpi_shared.h>
19
20 /*
21 * Placeholder variables for copying the arguments that have been passed to
22 * BL31 from BL2.
23 */
24 static entry_point_info_t bl32_image_ep_info;
25 static entry_point_info_t bl33_image_ep_info;
26
27 /*******************************************************************************
28 * Return a pointer to the 'entry_point_info' structure of the next image for
29 * the security state specified. BL33 corresponds to the non-secure image type
30 * while BL32 corresponds to the secure image type. A NULL pointer is returned
31 * if the image does not exist.
32 ******************************************************************************/
bl31_plat_get_next_image_ep_info(uint32_t type)33 entry_point_info_t *bl31_plat_get_next_image_ep_info(uint32_t type)
34 {
35 entry_point_info_t *next_image_info;
36
37 assert(sec_state_is_valid(type) != 0);
38
39 next_image_info = (type == NON_SECURE)
40 ? &bl33_image_ep_info : &bl32_image_ep_info;
41
42 /* None of the images can have 0x0 as the entrypoint. */
43 if (next_image_info->pc) {
44 return next_image_info;
45 } else {
46 return NULL;
47 }
48 }
49
50 /*******************************************************************************
51 * Return entrypoint of BL33.
52 ******************************************************************************/
plat_get_ns_image_entrypoint(void)53 uintptr_t plat_get_ns_image_entrypoint(void)
54 {
55 #ifdef PRELOADED_BL33_BASE
56 return PRELOADED_BL33_BASE;
57 #else
58 return PLAT_RPI3_NS_IMAGE_OFFSET;
59 #endif
60 }
61
62 /*******************************************************************************
63 * Perform any BL31 early platform setup. Here is an opportunity to copy
64 * parameters passed by the calling EL (S-EL1 in BL2 & EL3 in BL1) before
65 * they are lost (potentially). This needs to be done before the MMU is
66 * initialized so that the memory layout can be used while creating page
67 * tables. BL2 has flushed this information to memory, so we are guaranteed
68 * to pick up good data.
69 ******************************************************************************/
bl31_early_platform_setup2(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3)70 void bl31_early_platform_setup2(u_register_t arg0, u_register_t arg1,
71 u_register_t arg2, u_register_t arg3)
72
73 {
74 /* Initialize the console to provide early debug support */
75 rpi3_console_init();
76
77 /*
78 * In debug builds, a special value is passed in 'arg1' to verify
79 * platform parameters from BL2 to BL31. Not used in release builds.
80 */
81 assert(arg1 == RPI3_BL31_PLAT_PARAM_VAL);
82
83 /* Check that params passed from BL2 are not NULL. */
84 bl_params_t *params_from_bl2 = (bl_params_t *) arg0;
85
86 assert(params_from_bl2 != NULL);
87 assert(params_from_bl2->h.type == PARAM_BL_PARAMS);
88 assert(params_from_bl2->h.version >= VERSION_2);
89
90 bl_params_node_t *bl_params = params_from_bl2->head;
91
92 /*
93 * Copy BL33 and BL32 (if present), entry point information.
94 * They are stored in Secure RAM, in BL2's address space.
95 */
96 while (bl_params) {
97 if (bl_params->image_id == BL32_IMAGE_ID) {
98 bl32_image_ep_info = *bl_params->ep_info;
99 }
100
101 if (bl_params->image_id == BL33_IMAGE_ID) {
102 bl33_image_ep_info = *bl_params->ep_info;
103 }
104
105 bl_params = bl_params->next_params_info;
106 }
107
108 if (bl33_image_ep_info.pc == 0) {
109 panic();
110 }
111
112 #if RPI3_DIRECT_LINUX_BOOT
113 # if RPI3_BL33_IN_AARCH32
114 /*
115 * According to the file ``Documentation/arm/Booting`` of the Linux
116 * kernel tree, Linux expects:
117 * r0 = 0
118 * r1 = machine type number, optional in DT-only platforms (~0 if so)
119 * r2 = Physical address of the device tree blob
120 */
121 VERBOSE("rpi3: Preparing to boot 32-bit Linux kernel\n");
122 bl33_image_ep_info.args.arg0 = 0U;
123 bl33_image_ep_info.args.arg1 = ~0U;
124 bl33_image_ep_info.args.arg2 = (u_register_t) RPI3_PRELOADED_DTB_BASE;
125 # else
126 /*
127 * According to the file ``Documentation/arm64/booting.txt`` of the
128 * Linux kernel tree, Linux expects the physical address of the device
129 * tree blob (DTB) in x0, while x1-x3 are reserved for future use and
130 * must be 0.
131 */
132 VERBOSE("rpi3: Preparing to boot 64-bit Linux kernel\n");
133 bl33_image_ep_info.args.arg0 = (u_register_t) RPI3_PRELOADED_DTB_BASE;
134 bl33_image_ep_info.args.arg1 = 0ULL;
135 bl33_image_ep_info.args.arg2 = 0ULL;
136 bl33_image_ep_info.args.arg3 = 0ULL;
137 # endif /* RPI3_BL33_IN_AARCH32 */
138 #endif /* RPI3_DIRECT_LINUX_BOOT */
139 }
140
bl31_plat_arch_setup(void)141 void bl31_plat_arch_setup(void)
142 {
143 rpi3_setup_page_tables(BL31_BASE, BL31_END - BL31_BASE,
144 BL_CODE_BASE, BL_CODE_END,
145 BL_RO_DATA_BASE, BL_RO_DATA_END
146 #if USE_COHERENT_MEM
147 , BL_COHERENT_RAM_BASE, BL_COHERENT_RAM_END
148 #endif
149 );
150
151 enable_mmu_el3(0);
152 }
153
154 #ifdef RPI3_PRELOADED_DTB_BASE
155 /*
156 * Add information to the device tree (if any) about the reserved DRAM used by
157 * the Trusted Firmware.
158 */
rpi3_dtb_add_mem_rsv(void)159 static void rpi3_dtb_add_mem_rsv(void)
160 {
161 int i, regions, rc;
162 uint64_t addr, size;
163 void *dtb = (void *)RPI3_PRELOADED_DTB_BASE;
164
165 INFO("rpi3: Checking DTB...\n");
166
167 /* Return if no device tree is detected */
168 if (fdt_check_header(dtb) != 0)
169 return;
170
171 regions = fdt_num_mem_rsv(dtb);
172
173 VERBOSE("rpi3: Found %d mem reserve region(s)\n", regions);
174
175 /* We expect to find one reserved region that we can modify */
176 if (regions < 1)
177 return;
178
179 /*
180 * Look for the region that corresponds to the default boot firmware. It
181 * starts at address 0, and it is not needed when the default firmware
182 * is replaced by this port of the Trusted Firmware.
183 */
184 for (i = 0; i < regions; i++) {
185 if (fdt_get_mem_rsv(dtb, i, &addr, &size) != 0)
186 continue;
187
188 if (addr != 0x0)
189 continue;
190
191 VERBOSE("rpi3: Firmware mem reserve region found\n");
192
193 rc = fdt_del_mem_rsv(dtb, i);
194 if (rc != 0) {
195 INFO("rpi3: Can't remove mem reserve region (%d)\n", rc);
196 }
197
198 break;
199 }
200
201 if (i == regions) {
202 VERBOSE("rpi3: Firmware mem reserve region not found\n");
203 }
204
205 /*
206 * Reserve all SRAM. As said in the documentation, this isn't actually
207 * secure memory, so it is needed to tell BL33 that this is a reserved
208 * memory region. It doesn't guarantee it won't use it, though.
209 */
210 rc = fdt_add_mem_rsv(dtb, SEC_SRAM_BASE, SEC_SRAM_SIZE);
211 if (rc != 0) {
212 WARN("rpi3: Can't add mem reserve region (%d)\n", rc);
213 }
214
215 INFO("rpi3: Reserved 0x%llx - 0x%llx in DTB\n", SEC_SRAM_BASE,
216 SEC_SRAM_BASE + SEC_SRAM_SIZE);
217 }
218 #endif
219
bl31_platform_setup(void)220 void bl31_platform_setup(void)
221 {
222 #ifdef RPI3_PRELOADED_DTB_BASE
223 /* Only modify a DTB if we know where to look for it */
224 rpi3_dtb_add_mem_rsv();
225 #endif
226 }
227