1 /*
2 * Copyright (c) 2013-2023, 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/debug.h>
10 #include <common/desc_image_load.h>
11 #include <drivers/arm/sp804_delay_timer.h>
12 #include <lib/fconf/fconf.h>
13 #include <lib/fconf/fconf_dyn_cfg_getter.h>
14
15 #include <plat/arm/common/plat_arm.h>
16 #include <plat/common/platform.h>
17 #include <platform_def.h>
18
19 #include "fvp_private.h"
20
bl2_early_platform_setup2(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3)21 void bl2_early_platform_setup2(u_register_t arg0, u_register_t arg1, u_register_t arg2, u_register_t arg3)
22 {
23 arm_bl2_early_platform_setup((uintptr_t)arg0, (meminfo_t *)arg1);
24
25 /* Initialize the platform config for future decision making */
26 fvp_config_setup();
27 }
28
bl2_platform_setup(void)29 void bl2_platform_setup(void)
30 {
31 arm_bl2_platform_setup();
32
33 /* Initialize System level generic or SP804 timer */
34 fvp_timer_init();
35 }
36
37 /*******************************************************************************
38 * This function returns the list of executable images
39 ******************************************************************************/
plat_get_next_bl_params(void)40 struct bl_params *plat_get_next_bl_params(void)
41 {
42 struct bl_params *arm_bl_params;
43 const struct dyn_cfg_dtb_info_t *hw_config_info __unused;
44 bl_mem_params_node_t *param_node __unused;
45
46 arm_bl_params = arm_get_next_bl_params();
47
48 #if !RESET_TO_BL2 && !EL3_PAYLOAD_BASE
49 const struct dyn_cfg_dtb_info_t *fw_config_info;
50 uintptr_t fw_config_base = 0UL;
51 entry_point_info_t *ep_info;
52
53 #if __aarch64__
54 /* Get BL31 image node */
55 param_node = get_bl_mem_params_node(BL31_IMAGE_ID);
56 #else /* aarch32 */
57 /* Get SP_MIN image node */
58 param_node = get_bl_mem_params_node(BL32_IMAGE_ID);
59 #endif /* __aarch64__ */
60 assert(param_node != NULL);
61
62 /* get fw_config load address */
63 fw_config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, FW_CONFIG_ID);
64 assert(fw_config_info != NULL);
65
66 fw_config_base = fw_config_info->config_addr;
67 assert(fw_config_base != 0UL);
68
69 /*
70 * Get the entry point info of next executable image and override
71 * arg1 of entry point info with fw_config base address
72 */
73 ep_info = ¶m_node->ep_info;
74 ep_info->args.arg1 = (uint32_t)fw_config_base;
75
76 /* grab NS HW config address */
77 hw_config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, HW_CONFIG_ID);
78 assert(hw_config_info != NULL);
79
80 /* To retrieve actual size of the HW_CONFIG */
81 param_node = get_bl_mem_params_node(HW_CONFIG_ID);
82 assert(param_node != NULL);
83
84 /* Copy HW config from Secure address to NS address */
85 memcpy((void *)hw_config_info->secondary_config_addr,
86 (void *)hw_config_info->config_addr,
87 (size_t)param_node->image_info.image_size);
88
89 /*
90 * Ensure HW-config device tree committed to memory, as there is
91 * a possibility to use HW-config without cache and MMU enabled
92 * at BL33
93 */
94 flush_dcache_range(hw_config_info->secondary_config_addr,
95 param_node->image_info.image_size);
96
97 param_node = get_bl_mem_params_node(BL33_IMAGE_ID);
98 assert(param_node != NULL);
99
100 /* Update BL33's ep info with NS HW config address */
101 param_node->ep_info.args.arg1 = hw_config_info->secondary_config_addr;
102 #endif /* !RESET_TO_BL2 && !EL3_PAYLOAD_BASE */
103
104 return arm_bl_params;
105 }
106
