arm: mxc: Add sched_clock to mxc-platform
Add sched_clock using cyc_to_sched_clock and update_sched_clock
with HAVE_SCHED_CLOCK.
Signed-off-by: Jan Weitzel <J.Weitzel@phytec.de>
Signed-off-by: Carsten Emde <cbe@osadl.org>
Signed-off-by: Thomas Gleixner <tglx@linutronix.de>
diff --git a/arch/arm/Kconfig b/arch/arm/Kconfig
index 8d3ed31..54cf810 100644
--- a/arch/arm/Kconfig
+++ b/arch/arm/Kconfig
@@ -317,6 +317,7 @@
select GENERIC_GPIO
select ARCH_REQUIRE_GPIOLIB
select HAVE_CLK
+ select HAVE_SCHED_CLOCK
help
Support for Freescale MXC/iMX-based family of processors
diff --git a/arch/arm/plat-mxc/time.c b/arch/arm/plat-mxc/time.c
index cfa7437..ebcbc20 100644
--- a/arch/arm/plat-mxc/time.c
+++ b/arch/arm/plat-mxc/time.c
@@ -26,6 +26,7 @@
#include <linux/clockchips.h>
#include <linux/clk.h>
+#include <asm/sched_clock.h>
#include <mach/hardware.h>
#include <asm/mach/time.h>
#include <mach/common.h>
@@ -119,6 +120,22 @@
.flags = CLOCK_SOURCE_IS_CONTINUOUS,
};
+static DEFINE_CLOCK_DATA(cd);
+
+unsigned long long notrace sched_clock(void)
+{
+ cycle_t cyc = clocksource_mxc.read(NULL);
+
+ return cyc_to_sched_clock(&cd, cyc, (u32)~0);
+}
+
+static void notrace mxc_update_sched_clock(void)
+{
+ cycle_t cyc = clocksource_mxc.read(NULL);
+
+ update_sched_clock(&cd, cyc, (u32)~0);
+}
+
static int __init mxc_clocksource_init(struct clk *timer_clk)
{
unsigned int c = clk_get_rate(timer_clk);
@@ -130,6 +147,7 @@
clocksource_mxc.mult = clocksource_hz2mult(c,
clocksource_mxc.shift);
+ init_sched_clock(&cd, mxc_update_sched_clock, 32, c);
clocksource_register(&clocksource_mxc);
return 0;