| 1 |
/* |
| 2 |
* Copyright (c) 2015-2023, Arm Limited and Contributors. All rights reserved. |
| 3 |
* |
| 4 |
* SPDX-License-Identifier: BSD-3-Clause |
| 5 |
*/ |
| 6 |
|
| 7 |
#include <string.h> |
| 8 |
|
| 9 |
#include <common/bl_common.h> |
| 10 |
#include <common/debug.h> |
| 11 |
#include <drivers/arm/css/css_scp.h> |
| 12 |
#include <lib/mmio.h> |
| 13 |
#include <lib/utils.h> |
| 14 |
#include <plat/arm/common/plat_arm.h> |
| 15 |
#include <platform_def.h> |
| 16 |
|
| 17 |
/* Weak definition may be overridden in specific CSS based platform */ |
| 18 |
#pragma weak plat_arm_bl2_handle_scp_bl2 |
| 19 |
|
| 20 |
/******************************************************************************* |
| 21 |
* Transfer SCP_BL2 from Trusted RAM using the SCP Download protocol. |
| 22 |
* Return 0 on success, -1 otherwise. |
| 23 |
******************************************************************************/ |
| 24 |
int plat_arm_bl2_handle_scp_bl2(image_info_t *scp_bl2_image_info) |
| 25 |
{ |
| 26 |
int ret; |
| 27 |
|
| 28 |
INFO("BL2: Initiating SCP_BL2 transfer to SCP\n"); |
| 29 |
|
| 30 |
ret = css_scp_boot_image_xfer((void *)scp_bl2_image_info->image_base, |
| 31 |
scp_bl2_image_info->image_size); |
| 32 |
|
| 33 |
if (ret == 0) |
| 34 |
ret = css_scp_boot_ready(); |
| 35 |
|
| 36 |
if (ret == 0) |
| 37 |
INFO("BL2: SCP_BL2 transferred to SCP\n"); |
| 38 |
else |
| 39 |
ERROR("BL2: SCP_BL2 transfer failure\n"); |
| 40 |
|
| 41 |
return ret; |
| 42 |
} |
| 43 |
|
| 44 |
#if !CSS_USE_SCMI_SDS_DRIVER |
| 45 |
# if defined(EL3_PAYLOAD_BASE) || JUNO_AARCH32_EL3_RUNTIME |
| 46 |
|
| 47 |
/* |
| 48 |
* We need to override some of the platform functions when booting an EL3 |
| 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. |
| 52 |
*/ |
| 53 |
|
| 54 |
static unsigned int scp_boot_config; |
| 55 |
|
| 56 |
void bl2_early_platform_setup2(u_register_t arg0, u_register_t arg1, |
| 57 |
u_register_t arg2, u_register_t arg3) |
| 58 |
{ |
| 59 |
arm_bl2_early_platform_setup((uintptr_t)arg0, (meminfo_t *)arg1); |
| 60 |
|
| 61 |
/* Save SCP Boot config before it gets overwritten by SCP_BL2 loading */ |
| 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: |
| 75 |
* - zeroing the first 128 bytes of Trusted SRAM using zeromem instead |
| 76 |
* of zero_normalmem since this is device memory. |
| 77 |
* - restoring the SCP boot configuration. |
| 78 |
*/ |
| 79 |
VERBOSE("BL2: Restoring SCP reset data in Trusted SRAM\n"); |
| 80 |
zeromem((void *) ARM_SHARED_RAM_BASE, 128); |
| 81 |
mmio_write_32(SCP_BOOT_CFG_ADDR, scp_boot_config); |
| 82 |
} |
| 83 |
|
| 84 |
# endif /* EL3_PAYLOAD_BASE */ |
| 85 |
|
| 86 |
#endif /* CSS_USE_SCMI_SDS_DRIVER */ |
| 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 |
} |