blob: 5557d59915db281bcf0fb672f63e0de5dc6ebd01 [file] [log] [blame]
Achin Gupta4f6ad662013-10-25 09:08:21 +01001/*
Rohit Mathewf085b872023-12-20 17:29:18 +00002 * Copyright (c) 2013-2024, Arm Limited and Contributors. All rights reserved.
Achin Gupta4f6ad662013-10-25 09:08:21 +01003 *
dp-armfa3cf0b2017-05-03 09:38:09 +01004 * SPDX-License-Identifier: BSD-3-Clause
Achin Gupta4f6ad662013-10-25 09:08:21 +01005 */
6
Antonio Nino Diaze0f90632018-12-14 00:18:21 +00007#include <assert.h>
Soby Mathew414043d2024-03-26 17:16:00 +00008#include <string.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +00009
10#include <common/debug.h>
11#include <drivers/arm/cci.h>
12#include <drivers/arm/ccn.h>
13#include <drivers/arm/gicv2.h>
Alexei Fedorov7131d832019-08-16 14:15:59 +010014#include <drivers/arm/sp804_delay_timer.h>
15#include <drivers/generic_delay_timer.h>
AlexeiFedorov334d2352022-12-29 15:57:40 +000016#include <fconf_hw_config_getter.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +000017#include <lib/mmio.h>
Manish V Badarkhea637c3f2020-08-04 17:09:10 +010018#include <lib/smccc.h>
Antonio Nino Diaze0f90632018-12-14 00:18:21 +000019#include <lib/xlat_tables/xlat_tables_compat.h>
Antonio Nino Diaza320ecd2019-01-15 14:19:50 +000020#include <platform_def.h>
Manish V Badarkhea637c3f2020-08-04 17:09:10 +010021#include <services/arm_arch_svc.h>
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +010022#include <services/rmm_core_manifest.h>
Olivier Deprez21cf3602020-07-30 17:18:33 +020023#if SPM_MM
Paul Beesley45f40282019-10-15 10:57:42 +000024#include <services/spm_mm_partition.h>
Olivier Deprez21cf3602020-07-30 17:18:33 +020025#endif
Antonio Nino Diaze0f90632018-12-14 00:18:21 +000026
Manish V Badarkhea637c3f2020-08-04 17:09:10 +010027#include <plat/arm/common/arm_config.h>
28#include <plat/arm/common/plat_arm.h>
29#include <plat/common/platform.h>
30
Roberto Vargas2ca18d92018-02-12 12:36:17 +000031#include "fvp_private.h"
Achin Gupta4f6ad662013-10-25 09:08:21 +010032
Achin Gupta1fa7eb62015-11-03 14:18:34 +000033/* Defines for GIC Driver build time selection */
34#define FVP_GICV2 1
35#define FVP_GICV3 2
Achin Gupta1fa7eb62015-11-03 14:18:34 +000036
Soby Mathew414043d2024-03-26 17:16:00 +000037/* Defines for RMM Console*/
38#define FVP_RMM_CONSOLE_BASE UL(0x1c0c0000)
39#define FVP_RMM_CONSOLE_BAUD UL(115200)
40#define FVP_RMM_CONSOLE_CLK_IN_HZ UL(14745600)
41#define FVP_RMM_CONSOLE_NAME "pl011"
42
43#define FVP_RMM_CONSOLE_COUNT UL(1)
44
Achin Gupta4f6ad662013-10-25 09:08:21 +010045/*******************************************************************************
Dan Handley2b6b5742015-03-19 19:17:53 +000046 * arm_config holds the characteristics of the differences between the three FVP
47 * platforms (Base, A53_A57 & Foundation). It will be populated during cold boot
Vikram Kanigirifbb13012016-02-15 11:54:14 +000048 * at each boot stage by the primary before enabling the MMU (to allow
49 * interconnect configuration) & used thereafter. Each BL will have its own copy
50 * to allow independent operation.
Achin Gupta4f6ad662013-10-25 09:08:21 +010051 ******************************************************************************/
Dan Handley2b6b5742015-03-19 19:17:53 +000052arm_config_t arm_config;
Soby Mathewb08bc042014-09-03 17:48:44 +010053
54#define MAP_DEVICE0 MAP_REGION_FLAT(DEVICE0_BASE, \
55 DEVICE0_SIZE, \
56 MT_DEVICE | MT_RW | MT_SECURE)
57
58#define MAP_DEVICE1 MAP_REGION_FLAT(DEVICE1_BASE, \
59 DEVICE1_SIZE, \
60 MT_DEVICE | MT_RW | MT_SECURE)
61
Manish V Badarkheb24c6372021-01-24 03:26:50 +000062#if FVP_GICR_REGION_PROTECTION
63#define MAP_GICD_MEM MAP_REGION_FLAT(BASE_GICD_BASE, \
64 BASE_GICD_SIZE, \
65 MT_DEVICE | MT_RW | MT_SECURE)
66
67/* Map all core's redistributor memory as read-only. After boots up,
68 * per-core map its redistributor memory as read-write */
69#define MAP_GICR_MEM MAP_REGION_FLAT(BASE_GICR_BASE, \
70 (BASE_GICR_SIZE * PLATFORM_CORE_COUNT),\
71 MT_DEVICE | MT_RO | MT_SECURE)
72#endif /* FVP_GICR_REGION_PROTECTION */
73
Sandrine Bailleuxd9160a52017-05-26 15:48:10 +010074/*
75 * Need to be mapped with write permissions in order to set a new non-volatile
76 * counter value.
77 */
Juan Castillo31a68f02015-04-14 12:49:03 +010078#define MAP_DEVICE2 MAP_REGION_FLAT(DEVICE2_BASE, \
79 DEVICE2_SIZE, \
Antonio Nino Diaz9d602fe2016-05-20 14:14:16 +010080 MT_DEVICE | MT_RW | MT_SECURE)
Juan Castillo31a68f02015-04-14 12:49:03 +010081
Harrison Mutai1dcaf962023-08-08 15:10:07 +010082#if TRANSFER_LIST
83#ifdef FW_NS_HANDOFF_BASE
Harrison Mutai91ce7c92023-12-01 15:50:00 +000084#define MAP_FW_NS_HANDOFF \
85 MAP_REGION_FLAT(FW_NS_HANDOFF_BASE, PLAT_ARM_FW_HANDOFF_SIZE, \
86 MT_MEMORY | MT_RW | MT_NS)
Harrison Mutai1dcaf962023-08-08 15:10:07 +010087#endif
Harrison Mutai91ce7c92023-12-01 15:50:00 +000088#ifdef PLAT_ARM_EL3_FW_HANDOFF_BASE
89#define MAP_EL3_FW_HANDOFF \
90 MAP_REGION_FLAT(PLAT_ARM_EL3_FW_HANDOFF_BASE, \
91 PLAT_ARM_FW_HANDOFF_SIZE, MT_MEMORY | MT_RW | EL3_PAS)
92#endif
Harrison Mutai1dcaf962023-08-08 15:10:07 +010093#endif
94
Jon Medhurstb1eb0932014-02-26 16:27:53 +000095/*
Sandrine Bailleux4a1267a2016-05-18 16:11:47 +010096 * Table of memory regions for various BL stages to map using the MMU.
Roberto Vargas344ff022018-10-19 16:44:18 +010097 * This doesn't include Trusted SRAM as setup_page_tables() already takes care
98 * of mapping it.
Jon Medhurstb1eb0932014-02-26 16:27:53 +000099 */
Masahiro Yamada441bfdd2016-12-25 23:36:24 +0900100#ifdef IMAGE_BL1
Dan Handley2b6b5742015-03-19 19:17:53 +0000101const mmap_region_t plat_arm_mmap[] = {
102 ARM_MAP_SHARED_RAM,
Manish V Badarkhe76bf27b2021-06-16 16:50:43 +0100103 V2M_MAP_FLASH0_RO,
Dan Handley2b6b5742015-03-19 19:17:53 +0000104 V2M_MAP_IOFPGA,
Soby Mathewb08bc042014-09-03 17:48:44 +0100105 MAP_DEVICE0,
Manish V Badarkhee40334d2021-01-23 10:55:12 +0000106#if FVP_INTERCONNECT_DRIVER == FVP_CCN
Soby Mathewb08bc042014-09-03 17:48:44 +0100107 MAP_DEVICE1,
Manish V Badarkhee40334d2021-01-23 10:55:12 +0000108#endif
Yatharth Kochar736a3bf2015-10-11 14:14:55 +0100109#if TRUSTED_BOARD_BOOT
Sandrine Bailleuxd9160a52017-05-26 15:48:10 +0100110 /* To access the Root of Trust Public Key registers. */
111 MAP_DEVICE2,
112 /* Map DRAM to authenticate NS_BL2U image. */
Yatharth Kochar736a3bf2015-10-11 14:14:55 +0100113 ARM_MAP_NS_DRAM1,
114#endif
Soby Mathewb08bc042014-09-03 17:48:44 +0100115 {0}
116};
117#endif
Masahiro Yamada441bfdd2016-12-25 23:36:24 +0900118#ifdef IMAGE_BL2
Dan Handley2b6b5742015-03-19 19:17:53 +0000119const mmap_region_t plat_arm_mmap[] = {
120 ARM_MAP_SHARED_RAM,
Juan Castillob6132f12015-10-06 14:01:35 +0100121 V2M_MAP_FLASH0_RW,
Dan Handley2b6b5742015-03-19 19:17:53 +0000122 V2M_MAP_IOFPGA,
Soby Mathewb08bc042014-09-03 17:48:44 +0100123 MAP_DEVICE0,
Manish V Badarkhee40334d2021-01-23 10:55:12 +0000124#if FVP_INTERCONNECT_DRIVER == FVP_CCN
Soby Mathewb08bc042014-09-03 17:48:44 +0100125 MAP_DEVICE1,
Manish V Badarkhee40334d2021-01-23 10:55:12 +0000126#endif
Dan Handley2b6b5742015-03-19 19:17:53 +0000127 ARM_MAP_NS_DRAM1,
Julius Werner8e0ef0f2019-07-09 14:02:43 -0700128#ifdef __aarch64__
Roberto Vargasf8fda102017-08-08 11:27:20 +0100129 ARM_MAP_DRAM2,
130#endif
Manish V Badarkhe86854e72022-03-15 16:05:58 +0000131 /*
132 * Required to load HW_CONFIG, SPMC and SPs to trusted DRAM.
133 */
Achin Guptae97351d2019-10-11 15:15:19 +0100134 ARM_MAP_TRUSTED_DRAM,
Manish V Badarkheb65ae4e2022-12-12 10:14:25 +0000135
136 /*
137 * Required to load Event Log in TZC secured memory
138 */
139#if MEASURED_BOOT && (defined(SPD_tspd) || defined(SPD_opteed) || \
140defined(SPD_spmd))
141 ARM_MAP_EVENT_LOG_DRAM1,
142#endif /* MEASURED_BOOT && (SPD_tspd || SPD_opteed || SPD_spmd) */
143
Zelalem Awekec43c5632021-07-12 23:41:05 -0500144#if ENABLE_RME
145 ARM_MAP_RMM_DRAM,
146 ARM_MAP_GPT_L1_DRAM,
147#endif /* ENABLE_RME */
Sandrine Bailleuxb260c3a2017-08-30 10:59:22 +0100148#ifdef SPD_tspd
Dan Handley2b6b5742015-03-19 19:17:53 +0000149 ARM_MAP_TSP_SEC_MEM,
Sandrine Bailleuxb260c3a2017-08-30 10:59:22 +0100150#endif
Sandrine Bailleuxd9160a52017-05-26 15:48:10 +0100151#if TRUSTED_BOARD_BOOT
152 /* To access the Root of Trust Public Key registers. */
153 MAP_DEVICE2,
John Tsichritzisc34341a2018-07-30 13:41:52 +0100154#endif /* TRUSTED_BOARD_BOOT */
Manish V Badarkheeba13bd2022-01-08 23:08:02 +0000155
Arvind Ram Prakash11b9b492022-11-22 14:41:00 -0600156#if CRYPTO_SUPPORT && !RESET_TO_BL2
Manish V Badarkheeba13bd2022-01-08 23:08:02 +0000157 /*
158 * To access shared the Mbed TLS heap while booting the
159 * system with Crypto support
160 */
161 ARM_MAP_BL1_RW,
Arvind Ram Prakash11b9b492022-11-22 14:41:00 -0600162#endif /* CRYPTO_SUPPORT && !RESET_TO_BL2 */
Marc Bonnici6ba5abe2021-11-29 16:59:02 +0000163#if SPM_MM || SPMC_AT_EL3
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000164 ARM_SP_IMAGE_MMAP,
165#endif
David Wang0ba499f2016-03-07 11:02:57 +0800166#if ARM_BL31_IN_DRAM
167 ARM_MAP_BL31_SEC_DRAM,
168#endif
Jens Wiklander0814c6a2017-08-25 10:07:20 +0200169#ifdef SPD_opteed
Soby Mathew874fc9e2017-09-01 13:43:50 +0100170 ARM_MAP_OPTEE_CORE_MEM,
Jens Wiklander0814c6a2017-08-25 10:07:20 +0200171 ARM_OPTEE_PAGEABLE_LOAD_MEM,
172#endif
Harrison Mutai91ce7c92023-12-01 15:50:00 +0000173#ifdef MAP_EL3_FW_HANDOFF
174 MAP_EL3_FW_HANDOFF,
175#endif
176 { 0 }
Soby Mathewb08bc042014-09-03 17:48:44 +0100177};
178#endif
Masahiro Yamada441bfdd2016-12-25 23:36:24 +0900179#ifdef IMAGE_BL2U
Yatharth Kochar3a11eda2015-10-14 15:28:11 +0100180const mmap_region_t plat_arm_mmap[] = {
181 MAP_DEVICE0,
182 V2M_MAP_IOFPGA,
183 {0}
184};
185#endif
Masahiro Yamada441bfdd2016-12-25 23:36:24 +0900186#ifdef IMAGE_BL31
Dan Handley2b6b5742015-03-19 19:17:53 +0000187const mmap_region_t plat_arm_mmap[] = {
188 ARM_MAP_SHARED_RAM,
Ambroise Vincent9660dc12019-07-12 13:47:03 +0100189#if USE_DEBUGFS
190 /* Required by devfip, can be removed if devfip is not used */
191 V2M_MAP_FLASH0_RW,
192#endif /* USE_DEBUGFS */
Soby Mathew9ca28062017-10-11 16:08:58 +0100193 ARM_MAP_EL3_TZC_DRAM,
Dan Handley2b6b5742015-03-19 19:17:53 +0000194 V2M_MAP_IOFPGA,
Soby Mathewb08bc042014-09-03 17:48:44 +0100195 MAP_DEVICE0,
Manish V Badarkheb24c6372021-01-24 03:26:50 +0000196#if FVP_GICR_REGION_PROTECTION
197 MAP_GICD_MEM,
198 MAP_GICR_MEM,
199#else
Soby Mathewb08bc042014-09-03 17:48:44 +0100200 MAP_DEVICE1,
Manish V Badarkheb24c6372021-01-24 03:26:50 +0000201#endif /* FVP_GICR_REGION_PROTECTION */
Roberto Vargasa1c16b62017-08-03 09:16:43 +0100202 ARM_V2M_MAP_MEM_PROTECT,
Paul Beesleyfe975b42019-09-16 11:29:03 +0000203#if SPM_MM
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000204 ARM_SPM_BUF_EL3_MMAP,
205#endif
Zelalem Awekec43c5632021-07-12 23:41:05 -0500206#if ENABLE_RME
207 ARM_MAP_GPT_L1_DRAM,
Javier Almansa Sobrino7176a772021-11-24 18:37:37 +0000208 ARM_MAP_EL3_RMM_SHARED_MEM,
Zelalem Awekec43c5632021-07-12 23:41:05 -0500209#endif
Harrison Mutai1dcaf962023-08-08 15:10:07 +0100210#ifdef MAP_FW_NS_HANDOFF
211 MAP_FW_NS_HANDOFF,
212#endif
Harrison Mutai91ce7c92023-12-01 15:50:00 +0000213#ifdef MAP_EL3_FW_HANDOFF
214 MAP_EL3_FW_HANDOFF,
215#endif
216 { 0 }
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000217};
218
Paul Beesleyfe975b42019-09-16 11:29:03 +0000219#if defined(IMAGE_BL31) && SPM_MM
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000220const mmap_region_t plat_arm_secure_partition_mmap[] = {
221 V2M_MAP_IOFPGA_EL0, /* for the UART */
Elyes Haouas183638f2023-02-13 10:05:41 +0100222 MAP_REGION_FLAT(DEVICE0_BASE,
223 DEVICE0_SIZE,
Sandrine Bailleux4808f8b2018-01-12 15:50:12 +0100224 MT_DEVICE | MT_RO | MT_SECURE | MT_USER),
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000225 ARM_SP_IMAGE_MMAP,
226 ARM_SP_IMAGE_NS_BUF_MMAP,
227 ARM_SP_IMAGE_RW_MMAP,
228 ARM_SPM_BUF_EL0_MMAP,
Soby Mathewb08bc042014-09-03 17:48:44 +0100229 {0}
230};
231#endif
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000232#endif
Masahiro Yamada441bfdd2016-12-25 23:36:24 +0900233#ifdef IMAGE_BL32
Dan Handley2b6b5742015-03-19 19:17:53 +0000234const mmap_region_t plat_arm_mmap[] = {
Julius Werner8e0ef0f2019-07-09 14:02:43 -0700235#ifndef __aarch64__
Soby Mathew0d268dc2016-07-11 14:13:56 +0100236 ARM_MAP_SHARED_RAM,
Joel Hutton10503cc2018-03-15 11:33:44 +0000237 ARM_V2M_MAP_MEM_PROTECT,
Soby Mathew0d268dc2016-07-11 14:13:56 +0100238#endif
Dan Handley2b6b5742015-03-19 19:17:53 +0000239 V2M_MAP_IOFPGA,
Soby Mathewb08bc042014-09-03 17:48:44 +0100240 MAP_DEVICE0,
241 MAP_DEVICE1,
Jon Medhurstb1eb0932014-02-26 16:27:53 +0000242 {0}
243};
Soby Mathewb08bc042014-09-03 17:48:44 +0100244#endif
Jon Medhurstb1eb0932014-02-26 16:27:53 +0000245
Zelalem Aweke96c0bab2021-07-11 18:39:39 -0500246#ifdef IMAGE_RMM
247const mmap_region_t plat_arm_mmap[] = {
248 V2M_MAP_IOFPGA,
249 MAP_DEVICE0,
250 MAP_DEVICE1,
251 {0}
252};
253#endif
254
Dan Handley2b6b5742015-03-19 19:17:53 +0000255ARM_CASSERT_MMAP
Soby Mathew13ee9682015-01-22 11:22:22 +0000256
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100257#if FVP_INTERCONNECT_DRIVER != FVP_CCN
258static const int fvp_cci400_map[] = {
259 PLAT_FVP_CCI400_CLUS0_SL_PORT,
260 PLAT_FVP_CCI400_CLUS1_SL_PORT,
261};
262
263static const int fvp_cci5xx_map[] = {
264 PLAT_FVP_CCI5XX_CLUS0_SL_PORT,
265 PLAT_FVP_CCI5XX_CLUS1_SL_PORT,
266};
267
268static unsigned int get_interconnect_master(void)
269{
270 unsigned int master;
271 u_register_t mpidr;
272
273 mpidr = read_mpidr_el1();
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000274 master = ((arm_config.flags & ARM_CONFIG_FVP_SHIFTED_AFF) != 0U) ?
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100275 MPIDR_AFFLVL2_VAL(mpidr) : MPIDR_AFFLVL1_VAL(mpidr);
276
277 assert(master < FVP_CLUSTER_COUNT);
278 return master;
279}
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000280#endif
281
Paul Beesleyfe975b42019-09-16 11:29:03 +0000282#if defined(IMAGE_BL31) && SPM_MM
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000283/*
284 * Boot information passed to a secure partition during initialisation. Linear
285 * indices in MP information will be filled at runtime.
286 */
Paul Beesley45f40282019-10-15 10:57:42 +0000287static spm_mm_mp_info_t sp_mp_info[] = {
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000288 [0] = {0x80000000, 0},
289 [1] = {0x80000001, 0},
290 [2] = {0x80000002, 0},
291 [3] = {0x80000003, 0},
292 [4] = {0x80000100, 0},
293 [5] = {0x80000101, 0},
294 [6] = {0x80000102, 0},
295 [7] = {0x80000103, 0},
296};
297
Paul Beesley45f40282019-10-15 10:57:42 +0000298const spm_mm_boot_info_t plat_arm_secure_partition_boot_info = {
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000299 .h.type = PARAM_SP_IMAGE_BOOT_INFO,
300 .h.version = VERSION_1,
Paul Beesley45f40282019-10-15 10:57:42 +0000301 .h.size = sizeof(spm_mm_boot_info_t),
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000302 .h.attr = 0,
303 .sp_mem_base = ARM_SP_IMAGE_BASE,
304 .sp_mem_limit = ARM_SP_IMAGE_LIMIT,
305 .sp_image_base = ARM_SP_IMAGE_BASE,
306 .sp_stack_base = PLAT_SP_IMAGE_STACK_BASE,
307 .sp_heap_base = ARM_SP_IMAGE_HEAP_BASE,
Ard Biesheuvel8b034fc2018-12-29 19:43:21 +0100308 .sp_ns_comm_buf_base = PLAT_SP_IMAGE_NS_BUF_BASE,
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000309 .sp_shared_buf_base = PLAT_SPM_BUF_BASE,
310 .sp_image_size = ARM_SP_IMAGE_SIZE,
311 .sp_pcpu_stack_size = PLAT_SP_IMAGE_STACK_PCPU_SIZE,
312 .sp_heap_size = ARM_SP_IMAGE_HEAP_SIZE,
Ard Biesheuvel8b034fc2018-12-29 19:43:21 +0100313 .sp_ns_comm_buf_size = PLAT_SP_IMAGE_NS_BUF_SIZE,
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000314 .sp_shared_buf_size = PLAT_SPM_BUF_SIZE,
315 .num_sp_mem_regions = ARM_SP_IMAGE_NUM_MEM_REGIONS,
316 .num_cpus = PLATFORM_CORE_COUNT,
317 .mp_info = &sp_mp_info[0],
318};
319
320const struct mmap_region *plat_get_secure_partition_mmap(void *cookie)
321{
322 return plat_arm_secure_partition_mmap;
323}
324
Paul Beesley45f40282019-10-15 10:57:42 +0000325const struct spm_mm_boot_info *plat_get_secure_partition_boot_info(
Antonio Nino Diaz7289f922017-11-09 11:34:09 +0000326 void *cookie)
327{
328 return &plat_arm_secure_partition_boot_info;
329}
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100330#endif
Achin Gupta4f6ad662013-10-25 09:08:21 +0100331
Achin Gupta4f6ad662013-10-25 09:08:21 +0100332/*******************************************************************************
333 * A single boot loader stack is expected to work on both the Foundation FVP
334 * models and the two flavours of the Base FVP models (AEMv8 & Cortex). The
335 * SYS_ID register provides a mechanism for detecting the differences between
336 * these platforms. This information is stored in a per-BL array to allow the
337 * code to take the correct path.Per BL platform configuration.
338 ******************************************************************************/
Daniel Boulbyf45a4bb2018-09-18 13:26:03 +0100339void __init fvp_config_setup(void)
Achin Gupta4f6ad662013-10-25 09:08:21 +0100340{
Soby Mathew8e2f2872014-08-14 12:49:05 +0100341 unsigned int rev, hbi, bld, arch, sys_id;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100342
Dan Handley2b6b5742015-03-19 19:17:53 +0000343 sys_id = mmio_read_32(V2M_SYSREGS_BASE + V2M_SYS_ID);
344 rev = (sys_id >> V2M_SYS_ID_REV_SHIFT) & V2M_SYS_ID_REV_MASK;
345 hbi = (sys_id >> V2M_SYS_ID_HBI_SHIFT) & V2M_SYS_ID_HBI_MASK;
346 bld = (sys_id >> V2M_SYS_ID_BLD_SHIFT) & V2M_SYS_ID_BLD_MASK;
347 arch = (sys_id >> V2M_SYS_ID_ARCH_SHIFT) & V2M_SYS_ID_ARCH_MASK;
Achin Gupta4f6ad662013-10-25 09:08:21 +0100348
Andrew Thoelke960347d2014-06-26 14:27:26 +0100349 if (arch != ARCH_MODEL) {
350 ERROR("This firmware is for FVP models\n");
James Morrissey40a6f642014-02-10 14:24:36 +0000351 panic();
Andrew Thoelke960347d2014-06-26 14:27:26 +0100352 }
Achin Gupta4f6ad662013-10-25 09:08:21 +0100353
354 /*
355 * The build field in the SYS_ID tells which variant of the GIC
356 * memory is implemented by the model.
357 */
358 switch (bld) {
359 case BLD_GIC_VE_MMAP:
Soby Mathewcf022c52016-01-13 17:06:00 +0000360 ERROR("Legacy Versatile Express memory map for GIC peripheral"
361 " is not supported\n");
Achin Gupta1fa7eb62015-11-03 14:18:34 +0000362 panic();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100363 break;
364 case BLD_GIC_A53A57_MMAP:
Achin Gupta4f6ad662013-10-25 09:08:21 +0100365 break;
366 default:
Andrew Thoelke960347d2014-06-26 14:27:26 +0100367 ERROR("Unsupported board build %x\n", bld);
368 panic();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100369 }
370
371 /*
372 * The hbi field in the SYS_ID is 0x020 for the Base FVP & 0x010
373 * for the Foundation FVP.
374 */
375 switch (hbi) {
Dan Handley2b6b5742015-03-19 19:17:53 +0000376 case HBI_FOUNDATION_FVP:
Dan Handley2b6b5742015-03-19 19:17:53 +0000377 arm_config.flags = 0;
Andrew Thoelke960347d2014-06-26 14:27:26 +0100378
379 /*
380 * Check for supported revisions of Foundation FVP
381 * Allow future revisions to run but emit warning diagnostic
382 */
383 switch (rev) {
Dan Handley2b6b5742015-03-19 19:17:53 +0000384 case REV_FOUNDATION_FVP_V2_0:
385 case REV_FOUNDATION_FVP_V2_1:
386 case REV_FOUNDATION_FVP_v9_1:
Sandrine Bailleux8b33d702016-09-22 09:46:50 +0100387 case REV_FOUNDATION_FVP_v9_6:
Andrew Thoelke960347d2014-06-26 14:27:26 +0100388 break;
389 default:
390 WARN("Unrecognized Foundation FVP revision %x\n", rev);
391 break;
392 }
Achin Gupta4f6ad662013-10-25 09:08:21 +0100393 break;
Dan Handley2b6b5742015-03-19 19:17:53 +0000394 case HBI_BASE_FVP:
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100395 arm_config.flags |= (ARM_CONFIG_BASE_MMAP | ARM_CONFIG_HAS_TZC);
Andrew Thoelke960347d2014-06-26 14:27:26 +0100396
397 /*
398 * Check for supported revisions
399 * Allow future revisions to run but emit warning diagnostic
400 */
401 switch (rev) {
Dan Handley2b6b5742015-03-19 19:17:53 +0000402 case REV_BASE_FVP_V0:
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100403 arm_config.flags |= ARM_CONFIG_FVP_HAS_CCI400;
404 break;
405 case REV_BASE_FVP_REVC:
Isla Mitchellc7860cf2017-08-17 12:25:34 +0100406 arm_config.flags |= (ARM_CONFIG_FVP_HAS_SMMUV3 |
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100407 ARM_CONFIG_FVP_HAS_CCI5XX);
Andrew Thoelke960347d2014-06-26 14:27:26 +0100408 break;
409 default:
410 WARN("Unrecognized Base FVP revision %x\n", rev);
411 break;
412 }
Achin Gupta4f6ad662013-10-25 09:08:21 +0100413 break;
414 default:
Andrew Thoelke960347d2014-06-26 14:27:26 +0100415 ERROR("Unsupported board HBI number 0x%x\n", hbi);
416 panic();
Achin Gupta4f6ad662013-10-25 09:08:21 +0100417 }
Isla Mitchellc7860cf2017-08-17 12:25:34 +0100418
419 /*
420 * We assume that the presence of MT bit, and therefore shifted
421 * affinities, is uniform across the platform: either all CPUs, or no
422 * CPUs implement it.
423 */
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000424 if ((read_mpidr_el1() & MPIDR_MT_MASK) != 0U)
Isla Mitchellc7860cf2017-08-17 12:25:34 +0100425 arm_config.flags |= ARM_CONFIG_FVP_SHIFTED_AFF;
Sandrine Bailleux3fa98472014-03-31 11:25:18 +0100426}
Vikram Kanigiri96377452014-04-24 11:02:16 +0100427
Vikram Kanigiri4e97e542015-02-26 15:25:58 +0000428
Daniel Boulbyf45a4bb2018-09-18 13:26:03 +0100429void __init fvp_interconnect_init(void)
Vikram Kanigiri96377452014-04-24 11:02:16 +0100430{
Soby Mathew7356b1e2016-03-24 10:12:42 +0000431#if FVP_INTERCONNECT_DRIVER == FVP_CCN
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100432 if (ccn_get_part0_id(PLAT_ARM_CCN_BASE) != CCN_502_PART0_ID) {
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000433 ERROR("Unrecognized CCN variant detected. Only CCN-502 is supported");
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100434 panic();
435 }
436
437 plat_arm_interconnect_init();
438#else
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000439 uintptr_t cci_base = 0U;
440 const int *cci_map = NULL;
441 unsigned int map_size = 0U;
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100442
443 /* Initialize the right interconnect */
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000444 if ((arm_config.flags & ARM_CONFIG_FVP_HAS_CCI5XX) != 0U) {
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100445 cci_base = PLAT_FVP_CCI5XX_BASE;
446 cci_map = fvp_cci5xx_map;
447 map_size = ARRAY_SIZE(fvp_cci5xx_map);
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000448 } else if ((arm_config.flags & ARM_CONFIG_FVP_HAS_CCI400) != 0U) {
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100449 cci_base = PLAT_FVP_CCI400_BASE;
450 cci_map = fvp_cci400_map;
451 map_size = ARRAY_SIZE(fvp_cci400_map);
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000452 } else {
453 return;
Soby Mathew7356b1e2016-03-24 10:12:42 +0000454 }
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100455
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000456 assert(cci_base != 0U);
457 assert(cci_map != NULL);
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100458 cci_init(cci_base, cci_map, map_size);
459#endif
Dan Handleybe234f92014-08-04 16:11:15 +0100460}
461
Vikram Kanigirifbb13012016-02-15 11:54:14 +0000462void fvp_interconnect_enable(void)
Dan Handleybe234f92014-08-04 16:11:15 +0100463{
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100464#if FVP_INTERCONNECT_DRIVER == FVP_CCN
465 plat_arm_interconnect_enter_coherency();
466#else
467 unsigned int master;
468
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000469 if ((arm_config.flags & (ARM_CONFIG_FVP_HAS_CCI400 |
470 ARM_CONFIG_FVP_HAS_CCI5XX)) != 0U) {
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100471 master = get_interconnect_master();
472 cci_enable_snoop_dvm_reqs(master);
473 }
474#endif
Vikram Kanigiri4e97e542015-02-26 15:25:58 +0000475}
476
Vikram Kanigirifbb13012016-02-15 11:54:14 +0000477void fvp_interconnect_disable(void)
Vikram Kanigiri4e97e542015-02-26 15:25:58 +0000478{
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100479#if FVP_INTERCONNECT_DRIVER == FVP_CCN
480 plat_arm_interconnect_exit_coherency();
481#else
482 unsigned int master;
483
Antonio Nino Diaz6971f002018-11-06 13:14:21 +0000484 if ((arm_config.flags & (ARM_CONFIG_FVP_HAS_CCI400 |
485 ARM_CONFIG_FVP_HAS_CCI5XX)) != 0U) {
Jeenu Viswambharan9e78b922017-07-18 15:42:50 +0100486 master = get_interconnect_master();
487 cci_disable_snoop_dvm_reqs(master);
488 }
489#endif
Vikram Kanigiri96377452014-04-24 11:02:16 +0100490}
John Tsichritzisc34341a2018-07-30 13:41:52 +0100491
Manish V Badarkheeba13bd2022-01-08 23:08:02 +0000492#if CRYPTO_SUPPORT
John Tsichritzisc34341a2018-07-30 13:41:52 +0100493int plat_get_mbedtls_heap(void **heap_addr, size_t *heap_size)
494{
495 assert(heap_addr != NULL);
496 assert(heap_size != NULL);
497
498 return arm_get_mbedtls_heap(heap_addr, heap_size);
499}
Manish V Badarkheeba13bd2022-01-08 23:08:02 +0000500#endif /* CRYPTO_SUPPORT */
Alexei Fedorov7131d832019-08-16 14:15:59 +0100501
502void fvp_timer_init(void)
503{
Madhukar Pappireddy7a554a12020-08-12 13:18:19 -0500504#if USE_SP804_TIMER
Alexei Fedorov7131d832019-08-16 14:15:59 +0100505 /* Enable the clock override for SP804 timer 0, which means that no
506 * clock dividers are applied and the raw (35MHz) clock will be used.
507 */
508 mmio_write_32(V2M_SP810_BASE, FVP_SP810_CTRL_TIM0_OV);
509
510 /* Initialize delay timer driver using SP804 dual timer 0 */
511 sp804_timer_init(V2M_SP804_TIMER0_BASE,
512 SP804_TIMER_CLKMULT, SP804_TIMER_CLKDIV);
513#else
514 generic_delay_timer_init();
515
516 /* Enable System level generic timer */
517 mmio_write_32(ARM_SYS_CNTCTL_BASE + CNTCR_OFF,
518 CNTCR_FCREQ(0U) | CNTCR_EN);
Madhukar Pappireddy7a554a12020-08-12 13:18:19 -0500519#endif /* USE_SP804_TIMER */
Alexei Fedorov7131d832019-08-16 14:15:59 +0100520}
Manish V Badarkhea637c3f2020-08-04 17:09:10 +0100521
522/*****************************************************************************
523 * plat_is_smccc_feature_available() - This function checks whether SMCCC
524 * feature is availabile for platform.
525 * @fid: SMCCC function id
526 *
527 * Return SMC_ARCH_CALL_SUCCESS if SMCCC feature is available and
528 * SMC_ARCH_CALL_NOT_SUPPORTED otherwise.
529 *****************************************************************************/
530int32_t plat_is_smccc_feature_available(u_register_t fid)
531{
532 switch (fid) {
533 case SMCCC_ARCH_SOC_ID:
534 return SMC_ARCH_CALL_SUCCESS;
535 default:
536 return SMC_ARCH_CALL_NOT_SUPPORTED;
537 }
538}
539
540/* Get SOC version */
541int32_t plat_get_soc_version(void)
542{
543 return (int32_t)
Yann Gautieree050772021-05-20 14:57:34 +0200544 (SOC_ID_SET_JEP_106(ARM_SOC_CONTINUATION_CODE,
545 ARM_SOC_IDENTIFICATION_CODE) |
546 (FVP_SOC_ID & SOC_ID_IMPL_DEF_MASK));
Manish V Badarkhea637c3f2020-08-04 17:09:10 +0100547}
548
549/* Get SOC revision */
550int32_t plat_get_soc_revision(void)
551{
552 unsigned int sys_id;
553
554 sys_id = mmio_read_32(V2M_SYSREGS_BASE + V2M_SYS_ID);
Yann Gautieree050772021-05-20 14:57:34 +0200555 return (int32_t)(((sys_id >> V2M_SYS_ID_REV_SHIFT) &
556 V2M_SYS_ID_REV_MASK) & SOC_ID_REV_MASK);
Manish V Badarkhea637c3f2020-08-04 17:09:10 +0100557}
Javier Almansa Sobrino7176a772021-11-24 18:37:37 +0000558
559#if ENABLE_RME
560/*
561 * Get a pointer to the RMM-EL3 Shared buffer and return it
562 * through the pointer passed as parameter.
563 *
564 * This function returns the size of the shared buffer.
565 */
566size_t plat_rmmd_get_el3_rmm_shared_mem(uintptr_t *shared)
567{
568 *shared = (uintptr_t)RMM_SHARED_BASE;
569
570 return (size_t)RMM_SHARED_SIZE;
571}
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100572
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000573int plat_rmmd_load_manifest(struct rmm_manifest *manifest)
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100574{
Soby Mathew414043d2024-03-26 17:16:00 +0000575 uint64_t checksum, num_banks, num_consoles;
AlexeiFedorov334d2352022-12-29 15:57:40 +0000576 struct ns_dram_bank *bank_ptr;
Soby Mathew414043d2024-03-26 17:16:00 +0000577 struct console_info *console_ptr;
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000578
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100579 assert(manifest != NULL);
580
AlexeiFedorov334d2352022-12-29 15:57:40 +0000581 /* Get number of DRAM banks */
582 num_banks = FCONF_GET_PROPERTY(hw_config, dram_layout, num_banks);
583 assert(num_banks <= ARM_DRAM_NUM_BANKS);
584
Soby Mathew414043d2024-03-26 17:16:00 +0000585 /* Set number of consoles */
586 num_consoles = FVP_RMM_CONSOLE_COUNT;
587
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100588 manifest->version = RMMD_MANIFEST_VERSION;
Javier Almansa Sobrino04a6f2f2022-12-01 17:20:45 +0000589 manifest->padding = 0U; /* RES0 */
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100590 manifest->plat_data = (uintptr_t)NULL;
AlexeiFedorov334d2352022-12-29 15:57:40 +0000591 manifest->plat_dram.num_banks = num_banks;
Soby Mathew414043d2024-03-26 17:16:00 +0000592 manifest->plat_console.num_consoles = num_consoles;
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000593
AlexeiFedorov334d2352022-12-29 15:57:40 +0000594 /*
Soby Mathew414043d2024-03-26 17:16:00 +0000595 * Boot Manifest structure illustration, with two dram banks and
596 * a single console.
AlexeiFedorov334d2352022-12-29 15:57:40 +0000597 *
Soby Mathew414043d2024-03-26 17:16:00 +0000598 * +----------------------------------------+
599 * | offset | field | comment |
600 * +--------+----------------+--------------+
601 * | 0 | version | 0x00000003 |
602 * +--------+----------------+--------------+
603 * | 4 | padding | 0x00000000 |
604 * +--------+----------------+--------------+
605 * | 8 | plat_data | NULL |
606 * +--------+----------------+--------------+
607 * | 16 | num_banks | |
608 * +--------+----------------+ |
609 * | 24 | banks | plat_dram |
610 * +--------+----------------+ |
611 * | 32 | checksum | |
612 * +--------+----------------+--------------+
613 * | 40 | num_consoles | |
614 * +--------+----------------+ |
615 * | 48 | consoles | plat_console |
616 * +--------+----------------+ |
617 * | 56 | checksum | |
618 * +--------+----------------+--------------+
619 * | 64 | base 0 | |
620 * +--------+----------------+ bank[0] |
621 * | 72 | size 0 | |
622 * +--------+----------------+--------------+
623 * | 80 | base 1 | |
624 * +--------+----------------+ bank[1] |
625 * | 88 | size 1 | |
626 * +--------+----------------+--------------+
627 * | 96 | base | |
628 * +--------+----------------+ |
629 * | 104 | map_pages | |
630 * +--------+----------------+ |
631 * | 112 | name | |
632 * +--------+----------------+ consoles[0] |
633 * | 120 | clk_in_hz | |
634 * +--------+----------------+ |
635 * | 128 | baud_rate | |
636 * +--------+----------------+ |
637 * | 136 | flags | |
638 * +--------+----------------+--------------+
AlexeiFedorov334d2352022-12-29 15:57:40 +0000639 */
Soby Mathew414043d2024-03-26 17:16:00 +0000640
AlexeiFedorov334d2352022-12-29 15:57:40 +0000641 bank_ptr = (struct ns_dram_bank *)
Soby Mathew414043d2024-03-26 17:16:00 +0000642 (((uintptr_t)manifest) + sizeof(*manifest));
643 console_ptr = (struct console_info *)
644 ((uintptr_t)bank_ptr + (num_banks * sizeof(*bank_ptr)));
AlexeiFedorov334d2352022-12-29 15:57:40 +0000645
646 manifest->plat_dram.banks = bank_ptr;
Soby Mathew414043d2024-03-26 17:16:00 +0000647 manifest->plat_console.consoles = console_ptr;
648
649 /* Ensure the manifest is not larger than the shared buffer */
650 assert((sizeof(struct rmm_manifest) +
651 (sizeof(struct console_info) * manifest->plat_console.num_consoles) +
652 (sizeof(struct ns_dram_bank) * manifest->plat_dram.num_banks)) <= ARM_EL3_RMM_SHARED_SIZE);
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000653
AlexeiFedorov334d2352022-12-29 15:57:40 +0000654 /* Calculate checksum of plat_dram structure */
655 checksum = num_banks + (uint64_t)bank_ptr;
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000656
AlexeiFedorov334d2352022-12-29 15:57:40 +0000657 /* Store FVP DRAM banks data in Boot Manifest */
658 for (unsigned long i = 0UL; i < num_banks; i++) {
659 uintptr_t base = FCONF_GET_PROPERTY(hw_config, dram_layout, dram_bank[i].base);
660 uint64_t size = FCONF_GET_PROPERTY(hw_config, dram_layout, dram_bank[i].size);
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000661
AlexeiFedorov334d2352022-12-29 15:57:40 +0000662 bank_ptr[i].base = base;
663 bank_ptr[i].size = size;
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000664
AlexeiFedorov334d2352022-12-29 15:57:40 +0000665 /* Update checksum */
666 checksum += base + size;
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000667 }
668
AlexeiFedorov334d2352022-12-29 15:57:40 +0000669 /* Checksum must be 0 */
670 manifest->plat_dram.checksum = ~checksum + 1UL;
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100671
Soby Mathew414043d2024-03-26 17:16:00 +0000672 /* Calculate the checksum of the plat_consoles structure */
673 checksum = num_consoles + (uint64_t)console_ptr;
674
675 /* Zero out the console info struct */
676 memset((void *)console_ptr, '\0', sizeof(struct console_info) * num_consoles);
677
678 console_ptr[0].map_pages = 1;
679 console_ptr[0].base = FVP_RMM_CONSOLE_BASE;
680 console_ptr[0].clk_in_hz = FVP_RMM_CONSOLE_CLK_IN_HZ;
681 console_ptr[0].baud_rate = FVP_RMM_CONSOLE_BAUD;
682
683 strlcpy(console_ptr[0].name, FVP_RMM_CONSOLE_NAME, RMM_CONSOLE_MAX_NAME_LEN-1UL);
684
685 /* Update checksum */
686 checksum += console_ptr[0].base + console_ptr[0].map_pages +
687 console_ptr[0].clk_in_hz + console_ptr[0].baud_rate;
688
689 /* Checksum must be 0 */
690 manifest->plat_console.checksum = ~checksum + 1UL;
691
Javier Almansa Sobrino4165e842022-04-25 17:18:15 +0100692 return 0;
693}
AlexeiFedorov8e754f92022-12-14 17:28:11 +0000694#endif /* ENABLE_RME */