1 /*
2  * Copyright (c) 2013-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/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 
44 	arm_bl_params = arm_get_next_bl_params();
45 
46 #if __aarch64__ && !BL2_AT_EL3
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__ && !BL2_AT_EL3 */
70 
71 	return arm_bl_params;
72 }
73