1 /* 2 * Copyright (c) 2013-2018, ARM Limited and Contributors. All rights reserved. 3 * 4 * SPDX-License-Identifier: BSD-3-Clause 5 */ 6 7 #include <arm_config.h> 8 #include <arm_def.h> 9 #include <arm_spm_def.h> 10 #include <assert.h> 11 #include <cci.h> 12 #include <ccn.h> 13 #include <debug.h> 14 #include <gicv2.h> 15 #include <mmio.h> 16 #include <plat_arm.h> 17 #include <platform.h> 18 #include <secure_partition.h> 19 #include <v2m_def.h> 20 #include <xlat_tables_compat.h> 21 22 #include "../fvp_def.h" 23 #include "fvp_private.h" 24 25 /* Defines for GIC Driver build time selection */ 26 #define FVP_GICV2 1 27 #define FVP_GICV3 2 28 29 /******************************************************************************* 30 * arm_config holds the characteristics of the differences between the three FVP 31 * platforms (Base, A53_A57 & Foundation). It will be populated during cold boot 32 * at each boot stage by the primary before enabling the MMU (to allow 33 * interconnect configuration) & used thereafter. Each BL will have its own copy 34 * to allow independent operation. 35 ******************************************************************************/ 36 arm_config_t arm_config; 37 38 #define MAP_DEVICE0 MAP_REGION_FLAT(DEVICE0_BASE, \ 39 DEVICE0_SIZE, \ 40 MT_DEVICE | MT_RW | MT_SECURE) 41 42 #define MAP_DEVICE1 MAP_REGION_FLAT(DEVICE1_BASE, \ 43 DEVICE1_SIZE, \ 44 MT_DEVICE | MT_RW | MT_SECURE) 45 46 /* 47 * Need to be mapped with write permissions in order to set a new non-volatile 48 * counter value. 49 */ 50 #define MAP_DEVICE2 MAP_REGION_FLAT(DEVICE2_BASE, \ 51 DEVICE2_SIZE, \ 52 MT_DEVICE | MT_RW | MT_SECURE) 53 54 /* 55 * Table of memory regions for various BL stages to map using the MMU. 56 * This doesn't include Trusted SRAM as setup_page_tables() already takes care 57 * of mapping it. 58 * 59 * The flash needs to be mapped as writable in order to erase the FIP's Table of 60 * Contents in case of unrecoverable error (see plat_error_handler()). 61 */ 62 #ifdef IMAGE_BL1 63 const mmap_region_t plat_arm_mmap[] = { 64 ARM_MAP_SHARED_RAM, 65 V2M_MAP_FLASH0_RW, 66 V2M_MAP_IOFPGA, 67 MAP_DEVICE0, 68 MAP_DEVICE1, 69 #if TRUSTED_BOARD_BOOT 70 /* To access the Root of Trust Public Key registers. */ 71 MAP_DEVICE2, 72 /* Map DRAM to authenticate NS_BL2U image. */ 73 ARM_MAP_NS_DRAM1, 74 #endif 75 {0} 76 }; 77 #endif 78 #ifdef IMAGE_BL2 79 const mmap_region_t plat_arm_mmap[] = { 80 ARM_MAP_SHARED_RAM, 81 V2M_MAP_FLASH0_RW, 82 V2M_MAP_IOFPGA, 83 MAP_DEVICE0, 84 MAP_DEVICE1, 85 ARM_MAP_NS_DRAM1, 86 #ifdef AARCH64 87 ARM_MAP_DRAM2, 88 #endif 89 #ifdef SPD_tspd 90 ARM_MAP_TSP_SEC_MEM, 91 #endif 92 #if TRUSTED_BOARD_BOOT 93 /* To access the Root of Trust Public Key registers. */ 94 MAP_DEVICE2, 95 #if !BL2_AT_EL3 96 ARM_MAP_BL1_RW, 97 #endif 98 #endif /* TRUSTED_BOARD_BOOT */ 99 #if ENABLE_SPM 100 ARM_SP_IMAGE_MMAP, 101 #endif 102 #if ARM_BL31_IN_DRAM 103 ARM_MAP_BL31_SEC_DRAM, 104 #endif 105 #ifdef SPD_opteed 106 ARM_MAP_OPTEE_CORE_MEM, 107 ARM_OPTEE_PAGEABLE_LOAD_MEM, 108 #endif 109 {0} 110 }; 111 #endif 112 #ifdef IMAGE_BL2U 113 const mmap_region_t plat_arm_mmap[] = { 114 MAP_DEVICE0, 115 V2M_MAP_IOFPGA, 116 {0} 117 }; 118 #endif 119 #ifdef IMAGE_BL31 120 const mmap_region_t plat_arm_mmap[] = { 121 ARM_MAP_SHARED_RAM, 122 ARM_MAP_EL3_TZC_DRAM, 123 V2M_MAP_IOFPGA, 124 MAP_DEVICE0, 125 MAP_DEVICE1, 126 ARM_V2M_MAP_MEM_PROTECT, 127 #if ENABLE_SPM 128 ARM_SPM_BUF_EL3_MMAP, 129 #endif 130 {0} 131 }; 132 133 #if ENABLE_SPM && defined(IMAGE_BL31) 134 const mmap_region_t plat_arm_secure_partition_mmap[] = { 135 V2M_MAP_IOFPGA_EL0, /* for the UART */ 136 MAP_REGION_FLAT(DEVICE0_BASE, \ 137 DEVICE0_SIZE, \ 138 MT_DEVICE | MT_RO | MT_SECURE | MT_USER), 139 ARM_SP_IMAGE_MMAP, 140 ARM_SP_IMAGE_NS_BUF_MMAP, 141 ARM_SP_IMAGE_RW_MMAP, 142 ARM_SPM_BUF_EL0_MMAP, 143 {0} 144 }; 145 #endif 146 #endif 147 #ifdef IMAGE_BL32 148 const mmap_region_t plat_arm_mmap[] = { 149 #ifdef AARCH32 150 ARM_MAP_SHARED_RAM, 151 ARM_V2M_MAP_MEM_PROTECT, 152 #endif 153 V2M_MAP_IOFPGA, 154 MAP_DEVICE0, 155 MAP_DEVICE1, 156 {0} 157 }; 158 #endif 159 160 ARM_CASSERT_MMAP 161 162 #if FVP_INTERCONNECT_DRIVER != FVP_CCN 163 static const int fvp_cci400_map[] = { 164 PLAT_FVP_CCI400_CLUS0_SL_PORT, 165 PLAT_FVP_CCI400_CLUS1_SL_PORT, 166 }; 167 168 static const int fvp_cci5xx_map[] = { 169 PLAT_FVP_CCI5XX_CLUS0_SL_PORT, 170 PLAT_FVP_CCI5XX_CLUS1_SL_PORT, 171 }; 172 173 static unsigned int get_interconnect_master(void) 174 { 175 unsigned int master; 176 u_register_t mpidr; 177 178 mpidr = read_mpidr_el1(); 179 master = ((arm_config.flags & ARM_CONFIG_FVP_SHIFTED_AFF) != 0U) ? 180 MPIDR_AFFLVL2_VAL(mpidr) : MPIDR_AFFLVL1_VAL(mpidr); 181 182 assert(master < FVP_CLUSTER_COUNT); 183 return master; 184 } 185 #endif 186 187 #if ENABLE_SPM && defined(IMAGE_BL31) 188 /* 189 * Boot information passed to a secure partition during initialisation. Linear 190 * indices in MP information will be filled at runtime. 191 */ 192 static secure_partition_mp_info_t sp_mp_info[] = { 193 [0] = {0x80000000, 0}, 194 [1] = {0x80000001, 0}, 195 [2] = {0x80000002, 0}, 196 [3] = {0x80000003, 0}, 197 [4] = {0x80000100, 0}, 198 [5] = {0x80000101, 0}, 199 [6] = {0x80000102, 0}, 200 [7] = {0x80000103, 0}, 201 }; 202 203 const secure_partition_boot_info_t plat_arm_secure_partition_boot_info = { 204 .h.type = PARAM_SP_IMAGE_BOOT_INFO, 205 .h.version = VERSION_1, 206 .h.size = sizeof(secure_partition_boot_info_t), 207 .h.attr = 0, 208 .sp_mem_base = ARM_SP_IMAGE_BASE, 209 .sp_mem_limit = ARM_SP_IMAGE_LIMIT, 210 .sp_image_base = ARM_SP_IMAGE_BASE, 211 .sp_stack_base = PLAT_SP_IMAGE_STACK_BASE, 212 .sp_heap_base = ARM_SP_IMAGE_HEAP_BASE, 213 .sp_ns_comm_buf_base = ARM_SP_IMAGE_NS_BUF_BASE, 214 .sp_shared_buf_base = PLAT_SPM_BUF_BASE, 215 .sp_image_size = ARM_SP_IMAGE_SIZE, 216 .sp_pcpu_stack_size = PLAT_SP_IMAGE_STACK_PCPU_SIZE, 217 .sp_heap_size = ARM_SP_IMAGE_HEAP_SIZE, 218 .sp_ns_comm_buf_size = ARM_SP_IMAGE_NS_BUF_SIZE, 219 .sp_shared_buf_size = PLAT_SPM_BUF_SIZE, 220 .num_sp_mem_regions = ARM_SP_IMAGE_NUM_MEM_REGIONS, 221 .num_cpus = PLATFORM_CORE_COUNT, 222 .mp_info = &sp_mp_info[0], 223 }; 224 225 const struct mmap_region *plat_get_secure_partition_mmap(void *cookie) 226 { 227 return plat_arm_secure_partition_mmap; 228 } 229 230 const struct secure_partition_boot_info *plat_get_secure_partition_boot_info( 231 void *cookie) 232 { 233 return &plat_arm_secure_partition_boot_info; 234 } 235 236 #endif 237 238 /******************************************************************************* 239 * A single boot loader stack is expected to work on both the Foundation FVP 240 * models and the two flavours of the Base FVP models (AEMv8 & Cortex). The 241 * SYS_ID register provides a mechanism for detecting the differences between 242 * these platforms. This information is stored in a per-BL array to allow the 243 * code to take the correct path.Per BL platform configuration. 244 ******************************************************************************/ 245 void __init fvp_config_setup(void) 246 { 247 unsigned int rev, hbi, bld, arch, sys_id; 248 249 sys_id = mmio_read_32(V2M_SYSREGS_BASE + V2M_SYS_ID); 250 rev = (sys_id >> V2M_SYS_ID_REV_SHIFT) & V2M_SYS_ID_REV_MASK; 251 hbi = (sys_id >> V2M_SYS_ID_HBI_SHIFT) & V2M_SYS_ID_HBI_MASK; 252 bld = (sys_id >> V2M_SYS_ID_BLD_SHIFT) & V2M_SYS_ID_BLD_MASK; 253 arch = (sys_id >> V2M_SYS_ID_ARCH_SHIFT) & V2M_SYS_ID_ARCH_MASK; 254 255 if (arch != ARCH_MODEL) { 256 ERROR("This firmware is for FVP models\n"); 257 panic(); 258 } 259 260 /* 261 * The build field in the SYS_ID tells which variant of the GIC 262 * memory is implemented by the model. 263 */ 264 switch (bld) { 265 case BLD_GIC_VE_MMAP: 266 ERROR("Legacy Versatile Express memory map for GIC peripheral" 267 " is not supported\n"); 268 panic(); 269 break; 270 case BLD_GIC_A53A57_MMAP: 271 break; 272 default: 273 ERROR("Unsupported board build %x\n", bld); 274 panic(); 275 } 276 277 /* 278 * The hbi field in the SYS_ID is 0x020 for the Base FVP & 0x010 279 * for the Foundation FVP. 280 */ 281 switch (hbi) { 282 case HBI_FOUNDATION_FVP: 283 arm_config.flags = 0; 284 285 /* 286 * Check for supported revisions of Foundation FVP 287 * Allow future revisions to run but emit warning diagnostic 288 */ 289 switch (rev) { 290 case REV_FOUNDATION_FVP_V2_0: 291 case REV_FOUNDATION_FVP_V2_1: 292 case REV_FOUNDATION_FVP_v9_1: 293 case REV_FOUNDATION_FVP_v9_6: 294 break; 295 default: 296 WARN("Unrecognized Foundation FVP revision %x\n", rev); 297 break; 298 } 299 break; 300 case HBI_BASE_FVP: 301 arm_config.flags |= (ARM_CONFIG_BASE_MMAP | ARM_CONFIG_HAS_TZC); 302 303 /* 304 * Check for supported revisions 305 * Allow future revisions to run but emit warning diagnostic 306 */ 307 switch (rev) { 308 case REV_BASE_FVP_V0: 309 arm_config.flags |= ARM_CONFIG_FVP_HAS_CCI400; 310 break; 311 case REV_BASE_FVP_REVC: 312 arm_config.flags |= (ARM_CONFIG_FVP_HAS_SMMUV3 | 313 ARM_CONFIG_FVP_HAS_CCI5XX); 314 break; 315 default: 316 WARN("Unrecognized Base FVP revision %x\n", rev); 317 break; 318 } 319 break; 320 default: 321 ERROR("Unsupported board HBI number 0x%x\n", hbi); 322 panic(); 323 } 324 325 /* 326 * We assume that the presence of MT bit, and therefore shifted 327 * affinities, is uniform across the platform: either all CPUs, or no 328 * CPUs implement it. 329 */ 330 if ((read_mpidr_el1() & MPIDR_MT_MASK) != 0U) 331 arm_config.flags |= ARM_CONFIG_FVP_SHIFTED_AFF; 332 } 333 334 335 void __init fvp_interconnect_init(void) 336 { 337 #if FVP_INTERCONNECT_DRIVER == FVP_CCN 338 if (ccn_get_part0_id(PLAT_ARM_CCN_BASE) != CCN_502_PART0_ID) { 339 ERROR("Unrecognized CCN variant detected. Only CCN-502 is supported"); 340 panic(); 341 } 342 343 plat_arm_interconnect_init(); 344 #else 345 uintptr_t cci_base = 0U; 346 const int *cci_map = NULL; 347 unsigned int map_size = 0U; 348 349 /* Initialize the right interconnect */ 350 if ((arm_config.flags & ARM_CONFIG_FVP_HAS_CCI5XX) != 0U) { 351 cci_base = PLAT_FVP_CCI5XX_BASE; 352 cci_map = fvp_cci5xx_map; 353 map_size = ARRAY_SIZE(fvp_cci5xx_map); 354 } else if ((arm_config.flags & ARM_CONFIG_FVP_HAS_CCI400) != 0U) { 355 cci_base = PLAT_FVP_CCI400_BASE; 356 cci_map = fvp_cci400_map; 357 map_size = ARRAY_SIZE(fvp_cci400_map); 358 } else { 359 return; 360 } 361 362 assert(cci_base != 0U); 363 assert(cci_map != NULL); 364 cci_init(cci_base, cci_map, map_size); 365 #endif 366 } 367 368 void fvp_interconnect_enable(void) 369 { 370 #if FVP_INTERCONNECT_DRIVER == FVP_CCN 371 plat_arm_interconnect_enter_coherency(); 372 #else 373 unsigned int master; 374 375 if ((arm_config.flags & (ARM_CONFIG_FVP_HAS_CCI400 | 376 ARM_CONFIG_FVP_HAS_CCI5XX)) != 0U) { 377 master = get_interconnect_master(); 378 cci_enable_snoop_dvm_reqs(master); 379 } 380 #endif 381 } 382 383 void fvp_interconnect_disable(void) 384 { 385 #if FVP_INTERCONNECT_DRIVER == FVP_CCN 386 plat_arm_interconnect_exit_coherency(); 387 #else 388 unsigned int master; 389 390 if ((arm_config.flags & (ARM_CONFIG_FVP_HAS_CCI400 | 391 ARM_CONFIG_FVP_HAS_CCI5XX)) != 0U) { 392 master = get_interconnect_master(); 393 cci_disable_snoop_dvm_reqs(master); 394 } 395 #endif 396 } 397 398 #if TRUSTED_BOARD_BOOT 399 int plat_get_mbedtls_heap(void **heap_addr, size_t *heap_size) 400 { 401 assert(heap_addr != NULL); 402 assert(heap_size != NULL); 403 404 return arm_get_mbedtls_heap(heap_addr, heap_size); 405 } 406 #endif 407