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