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