| /* |
| * Copyright (c) 2013-2014, ARM Limited and Contributors. All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * |
| * Redistributions of source code must retain the above copyright notice, this |
| * list of conditions and the following disclaimer. |
| * |
| * Redistributions in binary form must reproduce the above copyright notice, |
| * this list of conditions and the following disclaimer in the documentation |
| * and/or other materials provided with the distribution. |
| * |
| * Neither the name of ARM nor the names of its contributors may be used |
| * to endorse or promote products derived from this software without specific |
| * prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" |
| * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE |
| * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE |
| * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR |
| * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF |
| * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN |
| * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) |
| * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| * POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include <arch.h> |
| #include <arch_helpers.h> |
| #include <arm_gic.h> |
| #include <bl_common.h> |
| #include <cci400.h> |
| #include <debug.h> |
| #include <mmio.h> |
| #include <platform.h> |
| #include <platform_def.h> |
| #include <plat_config.h> |
| #include <xlat_tables.h> |
| #include "../fvp_def.h" |
| |
| /******************************************************************************* |
| * plat_config holds the characteristics of the differences between the three |
| * FVP platforms (Base, A53_A57 & Foundation). It will be populated during cold |
| * boot at each boot stage by the primary before enabling the MMU (to allow cci |
| * configuration) & used thereafter. Each BL will have its own copy to allow |
| * independent operation. |
| ******************************************************************************/ |
| plat_config_t plat_config; |
| |
| #define MAP_SHARED_RAM MAP_REGION_FLAT(FVP_SHARED_MEM_BASE, \ |
| FVP_SHARED_MEM_SIZE, \ |
| MT_MEMORY | MT_RW | MT_SECURE) |
| |
| #define MAP_FLASH0 MAP_REGION_FLAT(FLASH0_BASE, \ |
| FLASH0_SIZE, \ |
| MT_MEMORY | MT_RO | MT_SECURE) |
| |
| #define MAP_DEVICE0 MAP_REGION_FLAT(DEVICE0_BASE, \ |
| DEVICE0_SIZE, \ |
| MT_DEVICE | MT_RW | MT_SECURE) |
| |
| #define MAP_DEVICE1 MAP_REGION_FLAT(DEVICE1_BASE, \ |
| DEVICE1_SIZE, \ |
| MT_DEVICE | MT_RW | MT_SECURE) |
| |
| #define MAP_DRAM1_NS MAP_REGION_FLAT(DRAM1_NS_BASE, \ |
| DRAM1_NS_SIZE, \ |
| MT_MEMORY | MT_RW | MT_NS) |
| |
| #define MAP_TSP_SEC_MEM MAP_REGION_FLAT(TSP_SEC_MEM_BASE, \ |
| TSP_SEC_MEM_SIZE, \ |
| MT_MEMORY | MT_RW | MT_SECURE) |
| |
| /* |
| * Table of regions for various BL stages to map using the MMU. |
| * This doesn't include TZRAM as the 'mem_layout' argument passed to |
| * configure_mmu_elx() will give the available subset of that, |
| */ |
| #if IMAGE_BL1 |
| const mmap_region_t fvp_mmap[] = { |
| MAP_SHARED_RAM, |
| MAP_FLASH0, |
| MAP_DEVICE0, |
| MAP_DEVICE1, |
| {0} |
| }; |
| #endif |
| #if IMAGE_BL2 |
| const mmap_region_t fvp_mmap[] = { |
| MAP_SHARED_RAM, |
| MAP_FLASH0, |
| MAP_DEVICE0, |
| MAP_DEVICE1, |
| MAP_DRAM1_NS, |
| MAP_TSP_SEC_MEM, |
| {0} |
| }; |
| #endif |
| #if IMAGE_BL31 |
| const mmap_region_t fvp_mmap[] = { |
| MAP_SHARED_RAM, |
| MAP_DEVICE0, |
| MAP_DEVICE1, |
| {0} |
| }; |
| #endif |
| #if IMAGE_BL32 |
| const mmap_region_t fvp_mmap[] = { |
| MAP_DEVICE0, |
| MAP_DEVICE1, |
| {0} |
| }; |
| #endif |
| |
| /* Array of secure interrupts to be configured by the gic driver */ |
| const unsigned int irq_sec_array[] = { |
| IRQ_TZ_WDOG, |
| IRQ_SEC_PHY_TIMER, |
| IRQ_SEC_SGI_0, |
| IRQ_SEC_SGI_1, |
| IRQ_SEC_SGI_2, |
| IRQ_SEC_SGI_3, |
| IRQ_SEC_SGI_4, |
| IRQ_SEC_SGI_5, |
| IRQ_SEC_SGI_6, |
| IRQ_SEC_SGI_7 |
| }; |
| |
| const unsigned int num_sec_irqs = sizeof(irq_sec_array) / |
| sizeof(irq_sec_array[0]); |
| |
| /******************************************************************************* |
| * Macro generating the code for the function setting up the pagetables as per |
| * the platform memory map & initialize the mmu, for the given exception level |
| ******************************************************************************/ |
| #if USE_COHERENT_MEM |
| #define DEFINE_CONFIGURE_MMU_EL(_el) \ |
| void fvp_configure_mmu_el##_el(unsigned long total_base, \ |
| unsigned long total_size, \ |
| unsigned long ro_start, \ |
| unsigned long ro_limit, \ |
| unsigned long coh_start, \ |
| unsigned long coh_limit) \ |
| { \ |
| mmap_add_region(total_base, total_base, \ |
| total_size, \ |
| MT_MEMORY | MT_RW | MT_SECURE); \ |
| mmap_add_region(ro_start, ro_start, \ |
| ro_limit - ro_start, \ |
| MT_MEMORY | MT_RO | MT_SECURE); \ |
| mmap_add_region(coh_start, coh_start, \ |
| coh_limit - coh_start, \ |
| MT_DEVICE | MT_RW | MT_SECURE); \ |
| mmap_add(fvp_mmap); \ |
| init_xlat_tables(); \ |
| \ |
| enable_mmu_el##_el(0); \ |
| } |
| #else |
| #define DEFINE_CONFIGURE_MMU_EL(_el) \ |
| void fvp_configure_mmu_el##_el(unsigned long total_base, \ |
| unsigned long total_size, \ |
| unsigned long ro_start, \ |
| unsigned long ro_limit) \ |
| { \ |
| mmap_add_region(total_base, total_base, \ |
| total_size, \ |
| MT_MEMORY | MT_RW | MT_SECURE); \ |
| mmap_add_region(ro_start, ro_start, \ |
| ro_limit - ro_start, \ |
| MT_MEMORY | MT_RO | MT_SECURE); \ |
| mmap_add(fvp_mmap); \ |
| init_xlat_tables(); \ |
| \ |
| enable_mmu_el##_el(0); \ |
| } |
| #endif |
| |
| /* Define EL1 and EL3 variants of the function initialising the MMU */ |
| DEFINE_CONFIGURE_MMU_EL(1) |
| DEFINE_CONFIGURE_MMU_EL(3) |
| |
| /******************************************************************************* |
| * A single boot loader stack is expected to work on both the Foundation FVP |
| * models and the two flavours of the Base FVP models (AEMv8 & Cortex). The |
| * SYS_ID register provides a mechanism for detecting the differences between |
| * these platforms. This information is stored in a per-BL array to allow the |
| * code to take the correct path.Per BL platform configuration. |
| ******************************************************************************/ |
| int fvp_config_setup(void) |
| { |
| unsigned int rev, hbi, bld, arch, sys_id; |
| |
| sys_id = mmio_read_32(VE_SYSREGS_BASE + V2M_SYS_ID); |
| rev = (sys_id >> SYS_ID_REV_SHIFT) & SYS_ID_REV_MASK; |
| hbi = (sys_id >> SYS_ID_HBI_SHIFT) & SYS_ID_HBI_MASK; |
| bld = (sys_id >> SYS_ID_BLD_SHIFT) & SYS_ID_BLD_MASK; |
| arch = (sys_id >> SYS_ID_ARCH_SHIFT) & SYS_ID_ARCH_MASK; |
| |
| if (arch != ARCH_MODEL) { |
| ERROR("This firmware is for FVP models\n"); |
| panic(); |
| } |
| |
| /* |
| * The build field in the SYS_ID tells which variant of the GIC |
| * memory is implemented by the model. |
| */ |
| switch (bld) { |
| case BLD_GIC_VE_MMAP: |
| plat_config.gicd_base = VE_GICD_BASE; |
| plat_config.gicc_base = VE_GICC_BASE; |
| plat_config.gich_base = VE_GICH_BASE; |
| plat_config.gicv_base = VE_GICV_BASE; |
| break; |
| case BLD_GIC_A53A57_MMAP: |
| plat_config.gicd_base = BASE_GICD_BASE; |
| plat_config.gicc_base = BASE_GICC_BASE; |
| plat_config.gich_base = BASE_GICH_BASE; |
| plat_config.gicv_base = BASE_GICV_BASE; |
| break; |
| default: |
| ERROR("Unsupported board build %x\n", bld); |
| panic(); |
| } |
| |
| /* |
| * The hbi field in the SYS_ID is 0x020 for the Base FVP & 0x010 |
| * for the Foundation FVP. |
| */ |
| switch (hbi) { |
| case HBI_FOUNDATION: |
| plat_config.max_aff0 = 4; |
| plat_config.max_aff1 = 1; |
| plat_config.flags = 0; |
| |
| /* |
| * Check for supported revisions of Foundation FVP |
| * Allow future revisions to run but emit warning diagnostic |
| */ |
| switch (rev) { |
| case REV_FOUNDATION_V2_0: |
| case REV_FOUNDATION_V2_1: |
| break; |
| default: |
| WARN("Unrecognized Foundation FVP revision %x\n", rev); |
| break; |
| } |
| break; |
| case HBI_FVP_BASE: |
| plat_config.max_aff0 = 4; |
| plat_config.max_aff1 = 2; |
| plat_config.flags |= CONFIG_BASE_MMAP | CONFIG_HAS_CCI | |
| CONFIG_HAS_TZC; |
| |
| /* |
| * Check for supported revisions |
| * Allow future revisions to run but emit warning diagnostic |
| */ |
| switch (rev) { |
| case REV_FVP_BASE_V0: |
| break; |
| default: |
| WARN("Unrecognized Base FVP revision %x\n", rev); |
| break; |
| } |
| break; |
| default: |
| ERROR("Unsupported board HBI number 0x%x\n", hbi); |
| panic(); |
| } |
| |
| return 0; |
| } |
| |
| unsigned long plat_get_ns_image_entrypoint(void) |
| { |
| return NS_IMAGE_OFFSET; |
| } |
| |
| uint64_t plat_get_syscnt_freq(void) |
| { |
| uint64_t counter_base_frequency; |
| |
| /* Read the frequency from Frequency modes table */ |
| counter_base_frequency = mmio_read_32(SYS_CNTCTL_BASE + CNTFID_OFF); |
| |
| /* The first entry of the frequency modes table must not be 0 */ |
| if (counter_base_frequency == 0) |
| panic(); |
| |
| return counter_base_frequency; |
| } |
| |
| void fvp_cci_init(void) |
| { |
| /* |
| * Initialize CCI-400 driver |
| */ |
| if (plat_config.flags & CONFIG_HAS_CCI) |
| cci_init(CCI400_BASE, |
| CCI400_SL_IFACE3_CLUSTER_IX, |
| CCI400_SL_IFACE4_CLUSTER_IX); |
| } |
| |
| void fvp_cci_enable(void) |
| { |
| /* |
| * Enable CCI-400 coherency for this cluster. No need |
| * for locks as no other cpu is active at the |
| * moment |
| */ |
| if (plat_config.flags & CONFIG_HAS_CCI) |
| cci_enable_cluster_coherency(read_mpidr()); |
| } |
| |
| void fvp_gic_init(void) |
| { |
| arm_gic_init(plat_config.gicc_base, |
| plat_config.gicd_base, |
| BASE_GICR_BASE, |
| irq_sec_array, |
| num_sec_irqs); |
| } |
| |
| |
| /******************************************************************************* |
| * Gets SPSR for BL32 entry |
| ******************************************************************************/ |
| uint32_t fvp_get_spsr_for_bl32_entry(void) |
| { |
| /* |
| * The Secure Payload Dispatcher service is responsible for |
| * setting the SPSR prior to entry into the BL32 image. |
| */ |
| return 0; |
| } |
| |
| /******************************************************************************* |
| * Gets SPSR for BL33 entry |
| ******************************************************************************/ |
| uint32_t fvp_get_spsr_for_bl33_entry(void) |
| { |
| unsigned long el_status; |
| unsigned int mode; |
| uint32_t spsr; |
| |
| /* Figure out what mode we enter the non-secure world in */ |
| el_status = read_id_aa64pfr0_el1() >> ID_AA64PFR0_EL2_SHIFT; |
| el_status &= ID_AA64PFR0_ELX_MASK; |
| |
| if (el_status) |
| mode = MODE_EL2; |
| else |
| mode = MODE_EL1; |
| |
| /* |
| * TODO: Consider the possibility of specifying the SPSR in |
| * the FIP ToC and allowing the platform to have a say as |
| * well. |
| */ |
| spsr = SPSR_64(mode, MODE_SP_ELX, DISABLE_ALL_EXCEPTIONS); |
| return spsr; |
| } |