107570d59SYatharth Kochar /* 2*cc47e1adSDimitris Papastamos * Copyright (c) 2016-2017, 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> 807570d59SYatharth Kochar #include <bl_common.h> 907570d59SYatharth Kochar #include <desc_image_load.h> 1007570d59SYatharth Kochar #include <plat_arm.h> 1107570d59SYatharth Kochar 1207570d59SYatharth Kochar #if JUNO_AARCH32_EL3_RUNTIME 1307570d59SYatharth Kochar /******************************************************************************* 1407570d59SYatharth Kochar * This function changes the spsr for BL32 image to bypass 1507570d59SYatharth Kochar * the check in BL1 AArch64 exception handler. This is needed in the aarch32 1607570d59SYatharth Kochar * boot flow as the core comes up in aarch64 and to enter the BL32 image a warm 1707570d59SYatharth Kochar * reset in aarch32 state is required. 1807570d59SYatharth Kochar ******************************************************************************/ 1907570d59SYatharth Kochar int bl2_plat_handle_post_image_load(unsigned int image_id) 2007570d59SYatharth Kochar { 2107570d59SYatharth Kochar int err = arm_bl2_handle_post_image_load(image_id); 2207570d59SYatharth Kochar 2307570d59SYatharth Kochar if (!err && (image_id == BL32_IMAGE_ID)) { 2407570d59SYatharth Kochar bl_mem_params_node_t *bl_mem_params = get_bl_mem_params_node(image_id); 2507570d59SYatharth Kochar assert(bl_mem_params); 2607570d59SYatharth Kochar bl_mem_params->ep_info.spsr = SPSR_64(MODE_EL3, MODE_SP_ELX, 2707570d59SYatharth Kochar DISABLE_ALL_EXCEPTIONS); 2807570d59SYatharth Kochar } 2907570d59SYatharth Kochar 3007570d59SYatharth Kochar return err; 3107570d59SYatharth Kochar } 32*cc47e1adSDimitris Papastamos 33*cc47e1adSDimitris Papastamos /* 34*cc47e1adSDimitris Papastamos * We need to override some of the platform functions when booting SP_MIN 35*cc47e1adSDimitris Papastamos * on Juno AArch32. 36*cc47e1adSDimitris Papastamos */ 37*cc47e1adSDimitris Papastamos 38*cc47e1adSDimitris Papastamos static unsigned int scp_boot_config; 39*cc47e1adSDimitris Papastamos 40*cc47e1adSDimitris Papastamos void bl2_early_platform_setup(meminfo_t *mem_layout) 41*cc47e1adSDimitris Papastamos { 42*cc47e1adSDimitris Papastamos arm_bl2_early_platform_setup(mem_layout); 43*cc47e1adSDimitris Papastamos 44*cc47e1adSDimitris Papastamos /* Save SCP Boot config before it gets overwritten by SCP_BL2 loading */ 45*cc47e1adSDimitris Papastamos VERBOSE("BL2: Saving SCP Boot config = 0x%x\n", scp_boot_config); 46*cc47e1adSDimitris Papastamos scp_boot_config = mmio_read_32(SCP_BOOT_CFG_ADDR); 47*cc47e1adSDimitris Papastamos } 48*cc47e1adSDimitris Papastamos 49*cc47e1adSDimitris Papastamos void bl2_platform_setup(void) 50*cc47e1adSDimitris Papastamos { 51*cc47e1adSDimitris Papastamos arm_bl2_platform_setup(); 52*cc47e1adSDimitris Papastamos 53*cc47e1adSDimitris Papastamos mmio_write_32(SCP_BOOT_CFG_ADDR, scp_boot_config); 54*cc47e1adSDimitris Papastamos VERBOSE("BL2: Restored SCP Boot config = 0x%x\n", scp_boot_config); 55*cc47e1adSDimitris Papastamos } 5607570d59SYatharth Kochar #endif /* JUNO_AARCH32_EL3_RUNTIME */ 57