Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 1 | /* |
Harrison Mutai | b5e7d7e | 2023-10-18 09:58:48 +0100 | [diff] [blame^] | 2 | * Copyright (c) 2015-2023, Arm Limited and Contributors. All rights reserved. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 3 | * |
dp-arm | fa3cf0b | 2017-05-03 09:38:09 +0100 | [diff] [blame] | 4 | * SPDX-License-Identifier: BSD-3-Clause |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 5 | */ |
| 6 | |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 7 | #include <string.h> |
| 8 | |
| 9 | #include <common/bl_common.h> |
| 10 | #include <common/debug.h> |
Antonio Nino Diaz | 326f56b | 2019-01-23 18:55:03 +0000 | [diff] [blame] | 11 | #include <drivers/arm/css/css_scp.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 12 | #include <lib/mmio.h> |
| 13 | #include <lib/utils.h> |
Antonio Nino Diaz | bd7b740 | 2019-01-25 14:30:04 +0000 | [diff] [blame] | 14 | #include <plat/arm/common/plat_arm.h> |
Antonio Nino Diaz | a320ecd | 2019-01-15 14:19:50 +0000 | [diff] [blame] | 15 | #include <platform_def.h> |
Antonio Nino Diaz | e0f9063 | 2018-12-14 00:18:21 +0000 | [diff] [blame] | 16 | |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 17 | /* Weak definition may be overridden in specific CSS based platform */ |
Yatharth Kochar | f9a0f16 | 2016-09-13 17:07:57 +0100 | [diff] [blame] | 18 | #pragma weak plat_arm_bl2_handle_scp_bl2 |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 19 | |
| 20 | /******************************************************************************* |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 21 | * Transfer SCP_BL2 from Trusted RAM using the SCP Download protocol. |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 22 | * Return 0 on success, -1 otherwise. |
| 23 | ******************************************************************************/ |
Yatharth Kochar | f9a0f16 | 2016-09-13 17:07:57 +0100 | [diff] [blame] | 24 | int plat_arm_bl2_handle_scp_bl2(image_info_t *scp_bl2_image_info) |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 25 | { |
| 26 | int ret; |
| 27 | |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 28 | INFO("BL2: Initiating SCP_BL2 transfer to SCP\n"); |
Sandrine Bailleux | 04b66d8 | 2015-03-18 14:52:53 +0000 | [diff] [blame] | 29 | |
Soby Mathew | 73b7bf9 | 2017-05-03 12:58:41 +0100 | [diff] [blame] | 30 | ret = css_scp_boot_image_xfer((void *)scp_bl2_image_info->image_base, |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 31 | scp_bl2_image_info->image_size); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 32 | |
| 33 | if (ret == 0) |
Soby Mathew | 73b7bf9 | 2017-05-03 12:58:41 +0100 | [diff] [blame] | 34 | ret = css_scp_boot_ready(); |
| 35 | |
| 36 | if (ret == 0) |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 37 | INFO("BL2: SCP_BL2 transferred to SCP\n"); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 38 | else |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 39 | ERROR("BL2: SCP_BL2 transfer failure\n"); |
Dan Handley | 9df4804 | 2015-03-19 18:58:55 +0000 | [diff] [blame] | 40 | |
| 41 | return ret; |
| 42 | } |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 43 | |
Soby Mathew | 1ced6b8 | 2017-06-12 12:37:10 +0100 | [diff] [blame] | 44 | #if !CSS_USE_SCMI_SDS_DRIVER |
Soby Mathew | e9263d0 | 2017-11-15 12:05:28 +0000 | [diff] [blame] | 45 | # if defined(EL3_PAYLOAD_BASE) || JUNO_AARCH32_EL3_RUNTIME |
Soby Mathew | 1ced6b8 | 2017-06-12 12:37:10 +0100 | [diff] [blame] | 46 | |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 47 | /* |
| 48 | * We need to override some of the platform functions when booting an EL3 |
Soby Mathew | e9263d0 | 2017-11-15 12:05:28 +0000 | [diff] [blame] | 49 | * payload or SP_MIN on Juno AArch32. This needs to be done only for |
| 50 | * SCPI/BOM SCP systems as in case of SDS, the structures remain in memory and |
| 51 | * don't need to be overwritten. |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 52 | */ |
| 53 | |
| 54 | static unsigned int scp_boot_config; |
| 55 | |
Soby Mathew | 7d5a2e7 | 2018-01-10 15:59:31 +0000 | [diff] [blame] | 56 | void bl2_early_platform_setup2(u_register_t arg0, u_register_t arg1, |
| 57 | u_register_t arg2, u_register_t arg3) |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 58 | { |
Soby Mathew | 7d5a2e7 | 2018-01-10 15:59:31 +0000 | [diff] [blame] | 59 | arm_bl2_early_platform_setup((uintptr_t)arg0, (meminfo_t *)arg1); |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 60 | |
Juan Castillo | a72b647 | 2015-12-10 15:49:17 +0000 | [diff] [blame] | 61 | /* Save SCP Boot config before it gets overwritten by SCP_BL2 loading */ |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 62 | scp_boot_config = mmio_read_32(SCP_BOOT_CFG_ADDR); |
| 63 | VERBOSE("BL2: Saved SCP Boot config = 0x%x\n", scp_boot_config); |
| 64 | } |
| 65 | |
| 66 | void bl2_platform_setup(void) |
| 67 | { |
| 68 | arm_bl2_platform_setup(); |
| 69 | |
| 70 | /* |
| 71 | * Before releasing the AP cores out of reset, the SCP writes some data |
| 72 | * at the beginning of the Trusted SRAM. It is is overwritten before |
| 73 | * reaching this function. We need to restore this data, as if the |
| 74 | * target had just come out of reset. This implies: |
Roberto Vargas | 0b52e78 | 2017-08-30 08:24:48 +0100 | [diff] [blame] | 75 | * - zeroing the first 128 bytes of Trusted SRAM using zeromem instead |
| 76 | * of zero_normalmem since this is device memory. |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 77 | * - restoring the SCP boot configuration. |
| 78 | */ |
| 79 | VERBOSE("BL2: Restoring SCP reset data in Trusted SRAM\n"); |
Roberto Vargas | 0b52e78 | 2017-08-30 08:24:48 +0100 | [diff] [blame] | 80 | zeromem((void *) ARM_SHARED_RAM_BASE, 128); |
Sandrine Bailleux | 03897bb | 2015-11-26 16:31:34 +0000 | [diff] [blame] | 81 | mmio_write_32(SCP_BOOT_CFG_ADDR, scp_boot_config); |
| 82 | } |
Soby Mathew | 1ced6b8 | 2017-06-12 12:37:10 +0100 | [diff] [blame] | 83 | |
| 84 | # endif /* EL3_PAYLOAD_BASE */ |
| 85 | |
| 86 | #endif /* CSS_USE_SCMI_SDS_DRIVER */ |
Harrison Mutai | b5e7d7e | 2023-10-18 09:58:48 +0100 | [diff] [blame^] | 87 | |
| 88 | int bl2_plat_handle_post_image_load(unsigned int image_id) |
| 89 | { |
| 90 | return arm_bl2_plat_handle_post_image_load(image_id); |
| 91 | } |