fvp_bl31_setup.c 1.26 KB
Newer Older
1
/*
2
 * Copyright (c) 2013-2019, ARM Limited and Contributors. All rights reserved.
3
 *
dp-arm's avatar
dp-arm committed
4
 * SPDX-License-Identifier: BSD-3-Clause
5
6
 */

7
#include <drivers/arm/smmu_v3.h>
8
9
#include <plat/arm/common/arm_config.h>
#include <plat/arm/common/plat_arm.h>
10
11
#include <plat/common/platform.h>

12
#include "fvp_private.h"
13

14
15
void __init bl31_early_platform_setup2(u_register_t arg0,
		u_register_t arg1, u_register_t arg2, u_register_t arg3)
16
{
17
	arm_bl31_early_platform_setup((void *)arg0, arg1, arg2, (void *)arg3);
18

19
	/* Initialize the platform config for future decision making */
20
	fvp_config_setup();
21

22
	/*
23
24
	 * Initialize the correct interconnect for this cluster during cold
	 * boot. No need for locks as no other CPU is active.
25
	 */
26
	fvp_interconnect_init();
27

28
	/*
29
	 * Enable coherency in interconnect for the primary CPU's cluster.
30
31
32
	 * Earlier bootloader stages might already do this (e.g. Trusted
	 * Firmware's BL1 does it) but we can't assume so. There is no harm in
	 * executing this code twice anyway.
33
34
	 * FVP PSCI code will enable coherency for other clusters.
	 */
35
	fvp_interconnect_enable();
36

37
38
39
	/* Initialize System level generic or SP804 timer */
	fvp_timer_init();

40
	/* On FVP RevC, initialize SMMUv3 */
41
	if ((arm_config.flags & ARM_CONFIG_FVP_HAS_SMMUV3) != 0U)
42
		smmuv3_init(PLAT_FVP_SMMUV3_BASE);
43
}