2 * linux/arch/arm/mach-mmp/time.c
4 * Support for clocksource and clockevents
6 * Copyright (C) 2008 Marvell International Ltd.
9 * 2008-04-11: Jason Chagas <Jason.chagas@marvell.com>
10 * 2008-10-08: Bin Yang <bin.yang@marvell.com>
12 * The timers module actually includes three timers, each timer with up to
13 * three match comparators. Timer #0 is used here in free-running mode as
14 * the clock source, and match comparator #1 used as clock event device.
16 * This program is free software; you can redistribute it and/or modify
17 * it under the terms of the GNU General Public License version 2 as
18 * published by the Free Software Foundation.
21 #include <linux/init.h>
22 #include <linux/kernel.h>
23 #include <linux/interrupt.h>
24 #include <linux/clockchips.h>
27 #include <linux/irq.h>
28 #include <linux/sched.h>
30 #include <asm/sched_clock.h>
31 #include <mach/addr-map.h>
32 #include <mach/regs-timers.h>
33 #include <mach/regs-apbc.h>
34 #include <mach/irqs.h>
35 #include <mach/cputype.h>
36 #include <asm/mach/time.h>
40 #define TIMERS_VIRT_BASE TIMERS1_VIRT_BASE
42 #define MAX_DELTA (0xfffffffe)
43 #define MIN_DELTA (16)
45 static DEFINE_CLOCK_DATA(cd
);
48 * FIXME: the timer needs some delay to stablize the counter capture
50 static inline uint32_t timer_read(void)
54 __raw_writel(1, TIMERS_VIRT_BASE
+ TMR_CVWR(0));
59 return __raw_readl(TIMERS_VIRT_BASE
+ TMR_CVWR(0));
62 unsigned long long notrace
sched_clock(void)
64 u32 cyc
= timer_read();
65 return cyc_to_sched_clock(&cd
, cyc
, (u32
)~0);
68 static void notrace
mmp_update_sched_clock(void)
70 u32 cyc
= timer_read();
71 update_sched_clock(&cd
, cyc
, (u32
)~0);
74 static irqreturn_t
timer_interrupt(int irq
, void *dev_id
)
76 struct clock_event_device
*c
= dev_id
;
78 /* disable and clear pending interrupt status */
79 __raw_writel(0x0, TIMERS_VIRT_BASE
+ TMR_IER(0));
80 __raw_writel(0x1, TIMERS_VIRT_BASE
+ TMR_ICR(0));
85 static int timer_set_next_event(unsigned long delta
,
86 struct clock_event_device
*dev
)
88 unsigned long flags
, next
;
90 local_irq_save(flags
);
92 /* clear pending interrupt status and enable */
93 __raw_writel(0x01, TIMERS_VIRT_BASE
+ TMR_ICR(0));
94 __raw_writel(0x01, TIMERS_VIRT_BASE
+ TMR_IER(0));
96 next
= timer_read() + delta
;
97 __raw_writel(next
, TIMERS_VIRT_BASE
+ TMR_TN_MM(0, 0));
99 local_irq_restore(flags
);
103 static void timer_set_mode(enum clock_event_mode mode
,
104 struct clock_event_device
*dev
)
108 local_irq_save(flags
);
110 case CLOCK_EVT_MODE_ONESHOT
:
111 case CLOCK_EVT_MODE_UNUSED
:
112 case CLOCK_EVT_MODE_SHUTDOWN
:
113 /* disable the matching interrupt */
114 __raw_writel(0x00, TIMERS_VIRT_BASE
+ TMR_IER(0));
116 case CLOCK_EVT_MODE_RESUME
:
117 case CLOCK_EVT_MODE_PERIODIC
:
120 local_irq_restore(flags
);
123 static struct clock_event_device ckevt
= {
124 .name
= "clockevent",
125 .features
= CLOCK_EVT_FEAT_ONESHOT
,
128 .set_next_event
= timer_set_next_event
,
129 .set_mode
= timer_set_mode
,
132 static cycle_t
clksrc_read(struct clocksource
*cs
)
137 static struct clocksource cksrc
= {
138 .name
= "clocksource",
141 .mask
= CLOCKSOURCE_MASK(32),
142 .flags
= CLOCK_SOURCE_IS_CONTINUOUS
,
145 static void __init
timer_config(void)
147 uint32_t ccr
= __raw_readl(TIMERS_VIRT_BASE
+ TMR_CCR
);
148 uint32_t cer
= __raw_readl(TIMERS_VIRT_BASE
+ TMR_CER
);
149 uint32_t cmr
= __raw_readl(TIMERS_VIRT_BASE
+ TMR_CMR
);
151 __raw_writel(cer
& ~0x1, TIMERS_VIRT_BASE
+ TMR_CER
); /* disable */
153 ccr
&= (cpu_is_mmp2()) ? TMR_CCR_CS_0(0) : TMR_CCR_CS_0(3);
154 __raw_writel(ccr
, TIMERS_VIRT_BASE
+ TMR_CCR
);
156 /* free-running mode */
157 __raw_writel(cmr
| 0x01, TIMERS_VIRT_BASE
+ TMR_CMR
);
159 __raw_writel(0x0, TIMERS_VIRT_BASE
+ TMR_PLCR(0)); /* free-running */
160 __raw_writel(0x7, TIMERS_VIRT_BASE
+ TMR_ICR(0)); /* clear status */
161 __raw_writel(0x0, TIMERS_VIRT_BASE
+ TMR_IER(0));
163 /* enable timer counter */
164 __raw_writel(cer
| 0x01, TIMERS_VIRT_BASE
+ TMR_CER
);
167 static struct irqaction timer_irq
= {
169 .flags
= IRQF_DISABLED
| IRQF_TIMER
| IRQF_IRQPOLL
,
170 .handler
= timer_interrupt
,
174 void __init
timer_init(int irq
)
178 init_sched_clock(&cd
, mmp_update_sched_clock
, 32, CLOCK_TICK_RATE
);
180 ckevt
.mult
= div_sc(CLOCK_TICK_RATE
, NSEC_PER_SEC
, ckevt
.shift
);
181 ckevt
.max_delta_ns
= clockevent_delta2ns(MAX_DELTA
, &ckevt
);
182 ckevt
.min_delta_ns
= clockevent_delta2ns(MIN_DELTA
, &ckevt
);
183 ckevt
.cpumask
= cpumask_of(0);
185 setup_irq(irq
, &timer_irq
);
187 clocksource_register_hz(&cksrc
, CLOCK_TICK_RATE
);
188 clockevents_register_device(&ckevt
);