Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 1 | /* |
Dimitris Papastamos | 47bc2ba | 2017-06-14 14:47:36 +0100 | [diff] [blame] | 2 | * Copyright (c) 2016-2017, ARM Limited and Contributors. All rights reserved. |
Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 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 | ******************************************************************************/ |
| 19 | int 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 | } |
Dimitris Papastamos | 47bc2ba | 2017-06-14 14:47:36 +0100 | [diff] [blame] | 32 | |
| 33 | /* |
| 34 | * We need to override some of the platform functions when booting SP_MIN |
| 35 | * on Juno AArch32. |
| 36 | */ |
| 37 | |
| 38 | static unsigned int scp_boot_config; |
| 39 | |
| 40 | void bl2_early_platform_setup(meminfo_t *mem_layout) |
| 41 | { |
| 42 | arm_bl2_early_platform_setup(mem_layout); |
| 43 | |
| 44 | /* Save SCP Boot config before it gets overwritten by SCP_BL2 loading */ |
| 45 | VERBOSE("BL2: Saving SCP Boot config = 0x%x\n", scp_boot_config); |
| 46 | scp_boot_config = mmio_read_32(SCP_BOOT_CFG_ADDR); |
| 47 | } |
| 48 | |
| 49 | void bl2_platform_setup(void) |
| 50 | { |
| 51 | arm_bl2_platform_setup(); |
| 52 | |
| 53 | mmio_write_32(SCP_BOOT_CFG_ADDR, scp_boot_config); |
| 54 | VERBOSE("BL2: Restored SCP Boot config = 0x%x\n", scp_boot_config); |
| 55 | } |
Yatharth Kochar | ede39cb | 2016-11-14 12:01:04 +0000 | [diff] [blame] | 56 | #endif /* JUNO_AARCH32_EL3_RUNTIME */ |