1 /* 2 * Copyright (c) 2016-2017, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <assert.h> 8 #include <bl_common.h> 9 #include <desc_image_load.h> 10 #include <plat_arm.h> 11 12 #if JUNO_AARCH32_EL3_RUNTIME 13 /******************************************************************************* 14 * This function changes the spsr for BL32 image to bypass 15 * the check in BL1 AArch64 exception handler. This is needed in the aarch32 16 * boot flow as the core comes up in aarch64 and to enter the BL32 image a warm 17 * reset in aarch32 state is required. 18 ******************************************************************************/ bl2_plat_handle_post_image_load(unsigned int image_id)19int bl2_plat_handle_post_image_load(unsigned int image_id) 20 { 21 int err = arm_bl2_handle_post_image_load(image_id); 22 23 if (!err && (image_id == BL32_IMAGE_ID)) { 24 bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id); 25 assert(bl_mem_params); 26 bl_mem_params->ep_info.spsr = SPSR_64(MODE_EL3, MODE_SP_ELX, 27 DISABLE_ALL_EXCEPTIONS); 28 } 29 30 return err; 31 } 32 33 #if !CSS_USE_SCMI_SDS_DRIVER 34 /* 35 * We need to override some of the platform functions when booting SP_MIN 36 * on Juno AArch32. These needs to be done only for SCPI/BOM SCP systems as 37 * in case of SDS, the structures remain in memory and doesn't need to be 38 * overwritten. 39 */ 40 41 static unsigned int scp_boot_config; 42 bl2_early_platform_setup(meminfo_t * mem_layout)43void bl2_early_platform_setup(meminfo_t *mem_layout) 44 { 45 arm_bl2_early_platform_setup(mem_layout); 46 47 /* Save SCP Boot config before it gets overwritten by SCP_BL2 loading */ 48 VERBOSE("BL2: Saving SCP Boot config = 0x%x\n", scp_boot_config); 49 scp_boot_config = mmio_read_32(SCP_BOOT_CFG_ADDR); 50 } 51 bl2_platform_setup(void)52void bl2_platform_setup(void) 53 { 54 arm_bl2_platform_setup(); 55 56 mmio_write_32(SCP_BOOT_CFG_ADDR, scp_boot_config); 57 VERBOSE("BL2: Restored SCP Boot config = 0x%x\n", scp_boot_config); 58 } 59 #endif 60 61 #endif /* JUNO_AARCH32_EL3_RUNTIME */ 62