[ARM] 4012/1: Clocksource for pxa
Add a clocksource driver for pxa2xx systems Signed-off-by: Luotao Fu <lfu@pengutronix.de> Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de> Signed-off-by: Nicolas Pitre <nico@cam.org> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
This commit is contained in:
parent
da2c12a279
commit
c80204e5d6
@ -18,6 +18,7 @@
|
|||||||
#include <linux/signal.h>
|
#include <linux/signal.h>
|
||||||
#include <linux/errno.h>
|
#include <linux/errno.h>
|
||||||
#include <linux/sched.h>
|
#include <linux/sched.h>
|
||||||
|
#include <linux/clocksource.h>
|
||||||
|
|
||||||
#include <asm/system.h>
|
#include <asm/system.h>
|
||||||
#include <asm/hardware.h>
|
#include <asm/hardware.h>
|
||||||
@ -48,27 +49,6 @@ static int pxa_set_rtc(void)
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* IRQs are disabled before entering here from do_gettimeofday() */
|
|
||||||
static unsigned long pxa_gettimeoffset (void)
|
|
||||||
{
|
|
||||||
long ticks_to_match, elapsed, usec;
|
|
||||||
|
|
||||||
/* Get ticks before next timer match */
|
|
||||||
ticks_to_match = OSMR0 - OSCR;
|
|
||||||
|
|
||||||
/* We need elapsed ticks since last match */
|
|
||||||
elapsed = LATCH - ticks_to_match;
|
|
||||||
|
|
||||||
/* don't get fooled by the workaround in pxa_timer_interrupt() */
|
|
||||||
if (elapsed <= 0)
|
|
||||||
return 0;
|
|
||||||
|
|
||||||
/* Now convert them to usec */
|
|
||||||
usec = (unsigned long)(elapsed * (tick_nsec / 1000))/LATCH;
|
|
||||||
|
|
||||||
return usec;
|
|
||||||
}
|
|
||||||
|
|
||||||
#ifdef CONFIG_NO_IDLE_HZ
|
#ifdef CONFIG_NO_IDLE_HZ
|
||||||
static unsigned long initial_match;
|
static unsigned long initial_match;
|
||||||
static int match_posponed;
|
static int match_posponed;
|
||||||
@ -121,6 +101,20 @@ static struct irqaction pxa_timer_irq = {
|
|||||||
.handler = pxa_timer_interrupt,
|
.handler = pxa_timer_interrupt,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
cycle_t pxa_get_cycles(void)
|
||||||
|
{
|
||||||
|
return OSCR;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct clocksource clocksource_pxa = {
|
||||||
|
.name = "pxa_timer",
|
||||||
|
.rating = 200,
|
||||||
|
.read = pxa_get_cycles,
|
||||||
|
.mask = CLOCKSOURCE_MASK(32),
|
||||||
|
.shift = 20,
|
||||||
|
.is_continuous = 1,
|
||||||
|
};
|
||||||
|
|
||||||
static void __init pxa_timer_init(void)
|
static void __init pxa_timer_init(void)
|
||||||
{
|
{
|
||||||
struct timespec tv;
|
struct timespec tv;
|
||||||
@ -139,6 +133,14 @@ static void __init pxa_timer_init(void)
|
|||||||
OIER = OIER_E0; /* enable match on timer 0 to cause interrupts */
|
OIER = OIER_E0; /* enable match on timer 0 to cause interrupts */
|
||||||
OSMR0 = OSCR + LATCH; /* set initial match */
|
OSMR0 = OSCR + LATCH; /* set initial match */
|
||||||
local_irq_restore(flags);
|
local_irq_restore(flags);
|
||||||
|
|
||||||
|
/* on PXA OSCR runs continiously and is not written to, so we can use it
|
||||||
|
* as clock source directly.
|
||||||
|
*/
|
||||||
|
clocksource_pxa.mult =
|
||||||
|
clocksource_hz2mult(CLOCK_TICK_RATE, clocksource_pxa.shift);
|
||||||
|
clocksource_register(&clocksource_pxa);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
#ifdef CONFIG_NO_IDLE_HZ
|
#ifdef CONFIG_NO_IDLE_HZ
|
||||||
@ -211,7 +213,6 @@ struct sys_timer pxa_timer = {
|
|||||||
.init = pxa_timer_init,
|
.init = pxa_timer_init,
|
||||||
.suspend = pxa_timer_suspend,
|
.suspend = pxa_timer_suspend,
|
||||||
.resume = pxa_timer_resume,
|
.resume = pxa_timer_resume,
|
||||||
.offset = pxa_gettimeoffset,
|
|
||||||
#ifdef CONFIG_NO_IDLE_HZ
|
#ifdef CONFIG_NO_IDLE_HZ
|
||||||
.dyn_tick = &pxa_dyn_tick,
|
.dyn_tick = &pxa_dyn_tick,
|
||||||
#endif
|
#endif
|
||||||
|
Loading…
Reference in New Issue
Block a user