From 305680329ce04ed0a47a4368727cf7a74a7ef5dd Mon Sep 17 00:00:00 2001
From: Jon Medhurst <tixy@linaro.org>
Date: Mon, 10 Mar 2014 15:23:09 +0000
Subject: juno: Initialise architected timer in BL3-1

---
 plat/juno/bl31_plat_setup.c | 12 ++++++++++++
 1 file changed, 12 insertions(+)

diff --git a/plat/juno/bl31_plat_setup.c b/plat/juno/bl31_plat_setup.c
index ffdfdd4..c2c7ff8 100644
--- a/plat/juno/bl31_plat_setup.c
+++ b/plat/juno/bl31_plat_setup.c
@@ -29,6 +29,8 @@
  */
 
 #include <platform.h>
+#include <assert.h>
+#include <arch_helpers.h>
 
 /*******************************************************************************
  * 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()
 {
+	unsigned int counter_base_frequency;
 	/* Initialize the gic cpu and distributor interfaces */
 	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. */
 	plat_setup_topology();
 }
-- 
cgit v1.2.3