m68knommu: switch 68328 timer to use GENERIC_TIME
Switch the 68328 CPU timer code to using GENERIC_TIME. Signed-off-by: Greg Ungerer <gerg@uclinux.org> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
This commit is contained in:
parent
f6efaf62bb
commit
36a90f26aa
1 changed files with 43 additions and 13 deletions
|
@ -19,6 +19,7 @@
|
||||||
#include <linux/mm.h>
|
#include <linux/mm.h>
|
||||||
#include <linux/interrupt.h>
|
#include <linux/interrupt.h>
|
||||||
#include <linux/irq.h>
|
#include <linux/irq.h>
|
||||||
|
#include <linux/clocksource.h>
|
||||||
#include <asm/setup.h>
|
#include <asm/setup.h>
|
||||||
#include <asm/system.h>
|
#include <asm/system.h>
|
||||||
#include <asm/pgtable.h>
|
#include <asm/pgtable.h>
|
||||||
|
@ -51,6 +52,19 @@
|
||||||
#define TICKS_PER_JIFFY 10
|
#define TICKS_PER_JIFFY 10
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
static u32 m68328_tick_cnt;
|
||||||
|
|
||||||
|
/***************************************************************************/
|
||||||
|
|
||||||
|
static irqreturn_t hw_tick(int irq, void *dummy)
|
||||||
|
{
|
||||||
|
/* Reset Timer1 */
|
||||||
|
TSTAT &= 0;
|
||||||
|
|
||||||
|
m68328_tick_cnt += TICKS_PER_JIFFY;
|
||||||
|
return arch_timer_interrupt(irq, dummy);
|
||||||
|
}
|
||||||
|
|
||||||
/***************************************************************************/
|
/***************************************************************************/
|
||||||
|
|
||||||
static irqreturn_t hw_tick(int irq, void *dummy)
|
static irqreturn_t hw_tick(int irq, void *dummy)
|
||||||
|
@ -69,6 +83,33 @@ static struct irqaction m68328_timer_irq = {
|
||||||
.handler = hw_tick,
|
.handler = hw_tick,
|
||||||
};
|
};
|
||||||
|
|
||||||
|
/***************************************************************************/
|
||||||
|
|
||||||
|
static cycle_t m68328_read_clk(void)
|
||||||
|
{
|
||||||
|
unsigned long flags;
|
||||||
|
u32 cycles;
|
||||||
|
|
||||||
|
local_irq_save(flags);
|
||||||
|
cycles = m68328_tick_cnt + TCN;
|
||||||
|
local_irq_restore(flags);
|
||||||
|
|
||||||
|
return cycles;
|
||||||
|
}
|
||||||
|
|
||||||
|
/***************************************************************************/
|
||||||
|
|
||||||
|
static struct clocksource m68328_clk = {
|
||||||
|
.name = "timer",
|
||||||
|
.rating = 250,
|
||||||
|
.read = m68328_read_clk,
|
||||||
|
.shift = 20,
|
||||||
|
.mask = CLOCKSOURCE_MASK(32),
|
||||||
|
.flags = CLOCK_SOURCE_IS_CONTINUOUS,
|
||||||
|
};
|
||||||
|
|
||||||
|
/***************************************************************************/
|
||||||
|
|
||||||
void hw_timer_init(void)
|
void hw_timer_init(void)
|
||||||
{
|
{
|
||||||
/* disable timer 1 */
|
/* disable timer 1 */
|
||||||
|
@ -84,19 +125,8 @@ void hw_timer_init(void)
|
||||||
|
|
||||||
/* Enable timer 1 */
|
/* Enable timer 1 */
|
||||||
TCTL |= TCTL_TEN;
|
TCTL |= TCTL_TEN;
|
||||||
}
|
m68328_clk.mult = clocksource_hz2mult(TICKS_PER_JIFFY*HZ, m68328_clk.shift);
|
||||||
|
clocksource_register(&m68328_clk);
|
||||||
/***************************************************************************/
|
|
||||||
|
|
||||||
unsigned long hw_timer_offset(void)
|
|
||||||
{
|
|
||||||
unsigned long ticks = TCN, offset = 0;
|
|
||||||
|
|
||||||
/* check for pending interrupt */
|
|
||||||
if (ticks < (TICKS_PER_JIFFY >> 1) && (ISR & (1 << TMR_IRQ_NUM)))
|
|
||||||
offset = 1000000 / HZ;
|
|
||||||
ticks = (ticks * 1000000 / HZ) / TICKS_PER_JIFFY;
|
|
||||||
return ticks + offset;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
/***************************************************************************/
|
/***************************************************************************/
|
||||||
|
|
Loading…
Add table
Reference in a new issue