From 1c297bf015226c182b66498d5a64b8b51c7624f5 Mon Sep 17 00:00:00 2001 From: Jeenu Viswambharan Date: Tue, 7 Jan 2014 10:21:18 +0000 Subject: [PATCH] Move architecture timer setup to platform-specific code At present, bl1_arch_setup() and bl31_arch_setup() program the counter frequency using a value from the memory mapped generic timer. The generic timer however is not necessarily present on all ARM systems (although it is architected to be present on all server systems). This patch moves the timer setup to platform-specific code and updates the relevant documentation. Also, CNTR.FCREQ is set as the specification requires the bit corresponding to the counter's frequency to be set when enabling. Since we intend to use the base frequency, set bit 8. Fixes ARM-software/tf-issues#24 Change-Id: I32c52cf882253e01f49056f47c58c23e6f422652 --- bl1/aarch64/bl1_arch_setup.c | 8 -------- bl31/aarch64/bl31_arch_setup.c | 8 -------- docs/firmware-design.md | 19 ++++++++----------- docs/porting-guide.md | 6 ++++-- plat/fvp/bl1_plat_setup.c | 18 ++++++++++++++++-- plat/fvp/bl31_plat_setup.c | 13 ++++++++++++- 6 files changed, 40 insertions(+), 32 deletions(-) diff --git a/bl1/aarch64/bl1_arch_setup.c b/bl1/aarch64/bl1_arch_setup.c index 3a528e1dd..e82ad09b5 100644 --- a/bl1/aarch64/bl1_arch_setup.c +++ b/bl1/aarch64/bl1_arch_setup.c @@ -39,7 +39,6 @@ void bl1_arch_setup(void) { unsigned long tmp_reg = 0; - unsigned int counter_base_frequency; /* Enable alignment checks and set the exception endianess to LE */ tmp_reg = read_sctlr(); @@ -61,13 +60,6 @@ void bl1_arch_setup(void) enable_serror(); enable_debug_exceptions(); - /* 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 */ - assert(counter_base_frequency != 0); - - /* Program the counter frequency */ - write_cntfrq_el0(counter_base_frequency); return; } diff --git a/bl31/aarch64/bl31_arch_setup.c b/bl31/aarch64/bl31_arch_setup.c index 03b9623c0..faeccf313 100644 --- a/bl31/aarch64/bl31_arch_setup.c +++ b/bl31/aarch64/bl31_arch_setup.c @@ -40,7 +40,6 @@ void bl31_arch_setup(void) { unsigned long tmp_reg = 0; - unsigned int counter_base_frequency; /* Enable alignment checks and set the exception endianness to LE */ tmp_reg = read_sctlr(); @@ -62,13 +61,6 @@ void bl31_arch_setup(void) enable_serror(); enable_debug_exceptions(); - /* 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 */ - assert(counter_base_frequency != 0); - - /* Program the counter frequency */ - write_cntfrq_el0(counter_base_frequency); return; } diff --git a/docs/firmware-design.md b/docs/firmware-design.md index 11d6f1d05..1f799b644 100644 --- a/docs/firmware-design.md +++ b/docs/firmware-design.md @@ -151,19 +151,16 @@ BL1 performs minimal architectural initialization as follows. and Advanced SIMD execution are configured to not trap to EL3 by clearing the `CPTR_EL3.TFP` bit. - - `CNTFRQ_EL0`. The `CNTFRQ_EL0` register is programmed with the base - frequency of the system counter, which is retrieved from the first entry - in the frequency modes table. - - - Generic Timer. The system level implementation of the generic timer is - enabled through the memory mapped interface. - #### Platform initialization -BL1 enables issuing of snoop and DVM (Distributed Virtual Memory) requests from -the CCI-400 slave interface corresponding to the cluster that includes the -primary CPU. BL1 also initializes UART0 (PL011 console), which enables access to -the `printf` family of functions. +BL1 enables issuing of snoop and DVM (Distributed Virtual Memory) requests +from the CCI-400 slave interface corresponding to the cluster that includes +the primary CPU. BL1 also initializes UART0 (PL011 console), which enables +access to the `printf` family of functions. The `CNTFRQ_EL0` register is +programmed with the base frequency of the system counter, which is retrieved +from the first entry in the frequency modes table. The system level +implementation of the generic timer is enabled through the memory mapped +interface. #### BL2 image load and execution diff --git a/docs/porting-guide.md b/docs/porting-guide.md index 56467fb97..6bba3604b 100644 --- a/docs/porting-guide.md +++ b/docs/porting-guide.md @@ -446,8 +446,9 @@ This function executes with the MMU and data caches enabled. It is responsible for performing any remaining platform-specific setup that can occur after the MMU and data cache have been enabled. -In the ARM FVP port, it zeros out the ZI section and enables the system level -implementation of the generic timer counter. +In the ARM FVP port, this function enables system-level implementation of the +generic timer counter. It also initializes counter frequency for CPU's generic +timers. This function is also responsible for initializing the storage abstraction layer which is used to load further bootloader images. @@ -771,6 +772,7 @@ BL3-1 runtime services and normal world software can function correctly. The ARM FVP port does the following: * Initializes the generic interrupt controller. * Configures the CLCD controller. +* Initializes counter frequency for CPU's generic timer * Grants access to the system counter timer module * Initializes the FVP power controller device * Detects the system topology. diff --git a/plat/fvp/bl1_plat_setup.c b/plat/fvp/bl1_plat_setup.c index d4fd81b25..b0c011eb4 100644 --- a/plat/fvp/bl1_plat_setup.c +++ b/plat/fvp/bl1_plat_setup.c @@ -112,11 +112,25 @@ void bl1_early_platform_setup(void) ******************************************************************************/ void bl1_platform_setup(void) { + unsigned int counter_base_frequency; + /* Initialise the IO layer and register platform IO devices */ io_setup(); - /* Enable and initialize the System level generic timer */ - mmio_write_32(SYS_CNTCTL_BASE + CNTCR_OFF, CNTCR_EN); + /* + * Enable and initialize the System level generic timer. Choose base + * frequency for the timer + */ + mmio_write_32(SYS_CNTCTL_BASE + CNTCR_OFF, CNTCR_FCREQ(0) | CNTCR_EN); + + /* 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 */ + assert(counter_base_frequency != 0); + + /* Program the counter frequency */ + write_cntfrq_el0(counter_base_frequency); } diff --git a/plat/fvp/bl31_plat_setup.c b/plat/fvp/bl31_plat_setup.c index 01b0a454c..1b24687bc 100644 --- a/plat/fvp/bl31_plat_setup.c +++ b/plat/fvp/bl31_plat_setup.c @@ -30,7 +30,8 @@ #include #include -#include +#include +#include /******************************************************************************* * Declarations of linker defined symbols which will help us find the layout @@ -125,6 +126,7 @@ void bl31_early_platform_setup(bl31_args *from_bl2, void bl31_platform_setup() { unsigned int reg_val; + unsigned int counter_base_frequency; /* Initialize the gic cpu and distributor interfaces */ gic_setup(); @@ -138,6 +140,15 @@ void bl31_platform_setup() mmio_write_32(VE_SYSREGS_BASE + V2M_SYS_CFGCTRL, (1ull << 31) | (1 << 30) | (7 << 20) | (0 << 16)); + /* 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 */ + assert(counter_base_frequency != 0); + + /* Program the counter frequency */ + write_cntfrq_el0(counter_base_frequency); + /* Allow access to the System counter timer module */ reg_val = (1 << CNTACR_RPCT_SHIFT) | (1 << CNTACR_RVCT_SHIFT); reg_val |= (1 << CNTACR_RFRQ_SHIFT) | (1 << CNTACR_RVOFF_SHIFT);