xref: /rk3399_ARM-atf/plat/arm/board/juno/juno_bl2_setup.c (revision 5d5fb10f9cfe105fd1e160fdfc8bb77bd7492799)
107570d59SYatharth Kochar /*
2*5d5fb10fSMikael Olsson  * Copyright (c) 2016-2017,2021, ARM Limited and Contributors. All rights reserved.
307570d59SYatharth Kochar  *
482cb2c1aSdp-arm  * SPDX-License-Identifier: BSD-3-Clause
507570d59SYatharth Kochar  */
607570d59SYatharth Kochar 
707570d59SYatharth Kochar #include <assert.h>
809d40e0eSAntonio Nino Diaz 
909d40e0eSAntonio Nino Diaz #include <common/bl_common.h>
1009d40e0eSAntonio Nino Diaz #include <common/desc_image_load.h>
11*5d5fb10fSMikael Olsson #include <lib/fconf/fconf.h>
12*5d5fb10fSMikael Olsson #include <lib/fconf/fconf_dyn_cfg_getter.h>
13*5d5fb10fSMikael Olsson 
14bd9344f6SAntonio Nino Diaz #include <plat/arm/common/plat_arm.h>
1507570d59SYatharth Kochar 
1607570d59SYatharth Kochar #if JUNO_AARCH32_EL3_RUNTIME
1707570d59SYatharth Kochar /*******************************************************************************
1807570d59SYatharth Kochar  * This function changes the spsr for BL32 image to bypass
1907570d59SYatharth Kochar  * the check in BL1 AArch64 exception handler. This is needed in the aarch32
2007570d59SYatharth Kochar  * boot flow as the core comes up in aarch64 and to enter the BL32 image a warm
2107570d59SYatharth Kochar  * reset in aarch32 state is required.
2207570d59SYatharth Kochar  ******************************************************************************/
23490eeb04SDaniel Boulby int arm_bl2_plat_handle_post_image_load(unsigned int image_id)
2407570d59SYatharth Kochar {
2507570d59SYatharth Kochar 	int err = arm_bl2_handle_post_image_load(image_id);
2607570d59SYatharth Kochar 
2707570d59SYatharth Kochar 	if (!err && (image_id == BL32_IMAGE_ID)) {
2807570d59SYatharth Kochar 		bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id);
2907570d59SYatharth Kochar 		assert(bl_mem_params);
3007570d59SYatharth Kochar 		bl_mem_params->ep_info.spsr = SPSR_64(MODE_EL3, MODE_SP_ELX,
3107570d59SYatharth Kochar 			DISABLE_ALL_EXCEPTIONS);
3207570d59SYatharth Kochar 	}
3307570d59SYatharth Kochar 
3407570d59SYatharth Kochar 	return err;
3507570d59SYatharth Kochar }
36*5d5fb10fSMikael Olsson 
37*5d5fb10fSMikael Olsson #else
38*5d5fb10fSMikael Olsson 
39*5d5fb10fSMikael Olsson /*******************************************************************************
40*5d5fb10fSMikael Olsson  * This function returns the list of executable images
41*5d5fb10fSMikael Olsson  ******************************************************************************/
42*5d5fb10fSMikael Olsson struct bl_params *plat_get_next_bl_params(void)
43*5d5fb10fSMikael Olsson {
44*5d5fb10fSMikael Olsson 	struct bl_params *arm_bl_params = arm_get_next_bl_params();
45*5d5fb10fSMikael Olsson 
46*5d5fb10fSMikael Olsson #if __aarch64__
47*5d5fb10fSMikael Olsson 	const struct dyn_cfg_dtb_info_t *fw_config_info;
48*5d5fb10fSMikael Olsson 	bl_mem_params_node_t *param_node;
49*5d5fb10fSMikael Olsson 	uintptr_t fw_config_base = 0U;
50*5d5fb10fSMikael Olsson 	entry_point_info_t *ep_info;
51*5d5fb10fSMikael Olsson 
52*5d5fb10fSMikael Olsson 	/* Get BL31 image node */
53*5d5fb10fSMikael Olsson 	param_node = get_bl_mem_params_node(BL31_IMAGE_ID);
54*5d5fb10fSMikael Olsson 	assert(param_node != NULL);
55*5d5fb10fSMikael Olsson 
56*5d5fb10fSMikael Olsson 	/* Get fw_config load address */
57*5d5fb10fSMikael Olsson 	fw_config_info = FCONF_GET_PROPERTY(dyn_cfg, dtb, FW_CONFIG_ID);
58*5d5fb10fSMikael Olsson 	assert(fw_config_info != NULL);
59*5d5fb10fSMikael Olsson 
60*5d5fb10fSMikael Olsson 	fw_config_base = fw_config_info->config_addr;
61*5d5fb10fSMikael Olsson 	assert(fw_config_base != 0U);
62*5d5fb10fSMikael Olsson 
63*5d5fb10fSMikael Olsson 	/*
64*5d5fb10fSMikael Olsson 	 * Get the entry point info of BL31 image and override
65*5d5fb10fSMikael Olsson 	 * arg1 of entry point info with fw_config base address
66*5d5fb10fSMikael Olsson 	 */
67*5d5fb10fSMikael Olsson 	ep_info = &param_node->ep_info;
68*5d5fb10fSMikael Olsson 	ep_info->args.arg1 = (uint32_t)fw_config_base;
69*5d5fb10fSMikael Olsson #endif /* __aarch64__ */
70*5d5fb10fSMikael Olsson 
71*5d5fb10fSMikael Olsson 	return arm_bl_params;
72*5d5fb10fSMikael Olsson }
7307570d59SYatharth Kochar #endif /* JUNO_AARCH32_EL3_RUNTIME */
74