1 /*
2 * Copyright (c) 2015-2018, 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 ******************************************************************************/
plat_arm_bl2_handle_scp_bl2(image_info_t * scp_bl2_image_info)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
bl2_early_platform_setup2(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3)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
bl2_platform_setup(void)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