1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/kernel.h>
14#include <linux/time.h>
15#include <linux/timex.h>
16#include <linux/interrupt.h>
17#include <linux/ftrace.h>
18
19#include <linux/clocksource.h>
20#include <linux/clockchips.h>
21#include <linux/irq.h>
22#include <linux/io.h>
23
24#include <asm/cpuinfo.h>
25
26
27inline void openrisc_timer_set(unsigned long count)
28{
29 mtspr(SPR_TTCR, count);
30}
31
32
33inline void openrisc_timer_set_next(unsigned long delta)
34{
35 u32 c;
36
37
38
39
40
41 c = mfspr(SPR_TTCR);
42 c += delta;
43 c &= SPR_TTMR_TP;
44
45
46
47
48 mtspr(SPR_TTMR, SPR_TTMR_CR | SPR_TTMR_IE | c);
49}
50
51static int openrisc_timer_set_next_event(unsigned long delta,
52 struct clock_event_device *dev)
53{
54 openrisc_timer_set_next(delta);
55 return 0;
56}
57
58
59
60
61
62
63DEFINE_PER_CPU(struct clock_event_device, clockevent_openrisc_timer);
64
65void openrisc_clockevent_init(void)
66{
67 unsigned int cpu = smp_processor_id();
68 struct clock_event_device *evt =
69 &per_cpu(clockevent_openrisc_timer, cpu);
70 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[cpu];
71
72 mtspr(SPR_TTMR, SPR_TTMR_CR);
73
74#ifdef CONFIG_SMP
75 evt->broadcast = tick_broadcast;
76#endif
77 evt->name = "openrisc_timer_clockevent",
78 evt->features = CLOCK_EVT_FEAT_ONESHOT,
79 evt->rating = 300,
80 evt->set_next_event = openrisc_timer_set_next_event,
81
82 evt->cpumask = cpumask_of(cpu);
83
84
85 clockevents_config_and_register(evt, cpuinfo->clock_frequency,
86 100, 0x0fffffff);
87
88}
89
90static inline void timer_ack(void)
91{
92
93
94
95
96
97 mtspr(SPR_TTMR, SPR_TTMR_CR);
98}
99
100
101
102
103
104
105
106
107
108
109irqreturn_t __irq_entry timer_interrupt(struct pt_regs *regs)
110{
111 struct pt_regs *old_regs = set_irq_regs(regs);
112 unsigned int cpu = smp_processor_id();
113 struct clock_event_device *evt =
114 &per_cpu(clockevent_openrisc_timer, cpu);
115
116 timer_ack();
117
118
119
120
121 irq_enter();
122 evt->event_handler(evt);
123 irq_exit();
124
125 set_irq_regs(old_regs);
126
127 return IRQ_HANDLED;
128}
129
130
131
132
133
134
135
136static u64 openrisc_timer_read(struct clocksource *cs)
137{
138 return (u64) mfspr(SPR_TTCR);
139}
140
141static struct clocksource openrisc_timer = {
142 .name = "openrisc_timer",
143 .rating = 200,
144 .read = openrisc_timer_read,
145 .mask = CLOCKSOURCE_MASK(32),
146 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
147};
148
149static int __init openrisc_timer_init(void)
150{
151 struct cpuinfo_or1k *cpuinfo = &cpuinfo_or1k[smp_processor_id()];
152
153 if (clocksource_register_hz(&openrisc_timer, cpuinfo->clock_frequency))
154 panic("failed to register clocksource");
155
156
157 mtspr(SPR_TTMR, SPR_TTMR_CR);
158
159 return 0;
160}
161
162void __init time_init(void)
163{
164 u32 upr;
165
166 upr = mfspr(SPR_UPR);
167 if (!(upr & SPR_UPR_TTP))
168 panic("Linux not supported on devices without tick timer");
169
170 openrisc_timer_init();
171 openrisc_clockevent_init();
172}
173