Debian Codegraph @

plat/arm/board/juno/juno_bl2_setup.c

raw
1 /*
2 * Copyright (c) 2016-2017,2021, ARM Limited and Contributors. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 #include <assert.h>
8
9 #include <common/bl_common.h>
10 #include <common/desc_image_load.h>
11 #include <lib/fconf/fconf.h>
12 #include <lib/fconf/fconf_dyn_cfg_getter.h>
13
14 #include <plat/arm/common/plat_arm.h>
15
16 #if JUNO_AARCH32_EL3_RUNTIME
17 /*******************************************************************************
18 * This function changes the spsr for BL32 image to bypass
19 * the check in BL1 AArch64 exception handler. This is needed in the aarch32
20 * boot flow as the core comes up in aarch64 and to enter the BL32 image a warm
21 * reset in aarch32 state is required.
22 ******************************************************************************/
23 int arm_bl2_plat_handle_post_image_load(unsigned int image_id)
24 {
25 int err = arm_bl2_handle_post_image_load(image_id);
26
27 if (!err && (image_id == BL32_IMAGE_ID)) {
28 bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id);
29 assert(bl_mem_params);
30 bl_mem_params->ep_info.spsr = SPSR_64(MODE_EL3, MODE_SP_ELX,
31 DISABLE_ALL_EXCEPTIONS);
32 }
33
34 return err;
35 }
36
37 #else
38
39 /*******************************************************************************
40 * This function returns the list of executable images
41 ******************************************************************************/
42 struct bl_params *plat_get_next_bl_params(void)
43 {
44 struct bl_params *arm_bl_params = arm_get_next_bl_params();
45
46 #if __aarch64__
47 const struct dyn_cfg_dtb_info_t *fw_config_info;
48 bl_mem_params_node_t *param_node;
49 uintptr_t fw_config_base = 0U;
50 entry_point_info_t *ep_info;
51
52 /* Get BL31 image node */
53 param_node = get_bl_mem_params_node(BL31_IMAGE_ID);
54 assert(param_node != NULL);
55
56 /* Get fw_config load address */
57 fw_config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, FW_CONFIG_ID);
58 assert(fw_config_info != NULL);
59
60 fw_config_base = fw_config_info->config_addr;
61 assert(fw_config_base != 0U);
62
63 /*
64 * Get the entry point info of BL31 image and override
65 * arg1 of entry point info with fw_config base address
66 */
67 ep_info = &param_node->ep_info;
68 ep_info->args.arg1 = (uint32_t)fw_config_base;
69 #endif /* __aarch64__ */
70
71 return arm_bl_params;
72 }
73 #endif /* JUNO_AARCH32_EL3_RUNTIME */