juno: Initialise architected timer in BL3-1
This commit is contained in:
parent
b86295169e
commit
305680329c
|
@ -29,6 +29,8 @@
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <platform.h>
|
#include <platform.h>
|
||||||
|
#include <assert.h>
|
||||||
|
#include <arch_helpers.h>
|
||||||
|
|
||||||
/*******************************************************************************
|
/*******************************************************************************
|
||||||
* Declarations of linker defined symbols which will help us find the layout
|
* Declarations of linker defined symbols which will help us find the layout
|
||||||
|
@ -120,9 +122,19 @@ void bl31_early_platform_setup(bl31_args *from_bl2,
|
||||||
******************************************************************************/
|
******************************************************************************/
|
||||||
void bl31_platform_setup()
|
void bl31_platform_setup()
|
||||||
{
|
{
|
||||||
|
unsigned int counter_base_frequency;
|
||||||
/* Initialize the gic cpu and distributor interfaces */
|
/* Initialize the gic cpu and distributor interfaces */
|
||||||
gic_setup();
|
gic_setup();
|
||||||
|
|
||||||
|
/* 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);
|
||||||
|
|
||||||
/* Topologies are best known to the platform. */
|
/* Topologies are best known to the platform. */
|
||||||
plat_setup_topology();
|
plat_setup_topology();
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue