|
@@ -55,6 +55,7 @@
|
|
|
#include "soc.h"
|
|
|
#include "common.h"
|
|
|
#include "powerdomain.h"
|
|
|
+#include "omap-secure.h"
|
|
|
|
|
|
#define REALTIME_COUNTER_BASE 0x48243200
|
|
|
#define INCREMENTER_NUMERATOR_OFFSET 0x10
|
|
@@ -66,6 +67,15 @@
|
|
|
static struct omap_dm_timer clkev;
|
|
|
static struct clock_event_device clockevent_gpt;
|
|
|
|
|
|
+#ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
|
|
|
+static unsigned long arch_timer_freq;
|
|
|
+
|
|
|
+void set_cntfreq(void)
|
|
|
+{
|
|
|
+ omap_smc1(OMAP5_DRA7_MON_SET_CNTFRQ_INDEX, arch_timer_freq);
|
|
|
+}
|
|
|
+#endif
|
|
|
+
|
|
|
static irqreturn_t omap2_gp_timer_interrupt(int irq, void *dev_id)
|
|
|
{
|
|
|
struct clock_event_device *evt = &clockevent_gpt;
|
|
@@ -515,6 +525,10 @@ static void __init realtime_counter_init(void)
|
|
|
num = 8;
|
|
|
den = 25;
|
|
|
break;
|
|
|
+ case 20000000:
|
|
|
+ num = 192;
|
|
|
+ den = 625;
|
|
|
+ break;
|
|
|
case 2600000:
|
|
|
num = 384;
|
|
|
den = 1625;
|
|
@@ -542,6 +556,9 @@ static void __init realtime_counter_init(void)
|
|
|
reg |= den;
|
|
|
__raw_writel(reg, base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET);
|
|
|
|
|
|
+ arch_timer_freq = (rate / den) * num;
|
|
|
+ set_cntfreq();
|
|
|
+
|
|
|
iounmap(base);
|
|
|
}
|
|
|
#else
|