This source file includes following definitions.
- rda_ostimer_start
- rda_ostimer_stop
- rda_ostimer_set_state_shutdown
- rda_ostimer_set_state_oneshot
- rda_ostimer_set_state_periodic
- rda_ostimer_tick_resume
- rda_ostimer_set_next_event
- rda_ostimer_interrupt
- rda_hwtimer_read
- rda_timer_init
1
2
3
4
5
6
7
8
9
10
11
12
13
14 #include <linux/init.h>
15 #include <linux/interrupt.h>
16
17 #include "timer-of.h"
18
19 #define RDA_OSTIMER_LOADVAL_L 0x000
20 #define RDA_OSTIMER_CTRL 0x004
21 #define RDA_HWTIMER_LOCKVAL_L 0x024
22 #define RDA_HWTIMER_LOCKVAL_H 0x028
23 #define RDA_TIMER_IRQ_MASK_SET 0x02c
24 #define RDA_TIMER_IRQ_MASK_CLR 0x030
25 #define RDA_TIMER_IRQ_CLR 0x034
26
27 #define RDA_OSTIMER_CTRL_ENABLE BIT(24)
28 #define RDA_OSTIMER_CTRL_REPEAT BIT(28)
29 #define RDA_OSTIMER_CTRL_LOAD BIT(30)
30
31 #define RDA_TIMER_IRQ_MASK_OSTIMER BIT(0)
32
33 #define RDA_TIMER_IRQ_CLR_OSTIMER BIT(0)
34
35 static int rda_ostimer_start(void __iomem *base, bool periodic, u64 cycles)
36 {
37 u32 ctrl, load_l;
38
39 load_l = (u32)cycles;
40 ctrl = ((cycles >> 32) & 0xffffff);
41 ctrl |= RDA_OSTIMER_CTRL_LOAD | RDA_OSTIMER_CTRL_ENABLE;
42 if (periodic)
43 ctrl |= RDA_OSTIMER_CTRL_REPEAT;
44
45
46 writel_relaxed(RDA_TIMER_IRQ_MASK_OSTIMER,
47 base + RDA_TIMER_IRQ_MASK_SET);
48
49
50 writel_relaxed(load_l, base + RDA_OSTIMER_LOADVAL_L);
51 writel_relaxed(ctrl, base + RDA_OSTIMER_CTRL);
52
53 return 0;
54 }
55
56 static int rda_ostimer_stop(void __iomem *base)
57 {
58
59 writel_relaxed(RDA_TIMER_IRQ_MASK_OSTIMER,
60 base + RDA_TIMER_IRQ_MASK_CLR);
61
62 writel_relaxed(0, base + RDA_OSTIMER_CTRL);
63
64 return 0;
65 }
66
67 static int rda_ostimer_set_state_shutdown(struct clock_event_device *evt)
68 {
69 struct timer_of *to = to_timer_of(evt);
70
71 rda_ostimer_stop(timer_of_base(to));
72
73 return 0;
74 }
75
76 static int rda_ostimer_set_state_oneshot(struct clock_event_device *evt)
77 {
78 struct timer_of *to = to_timer_of(evt);
79
80 rda_ostimer_stop(timer_of_base(to));
81
82 return 0;
83 }
84
85 static int rda_ostimer_set_state_periodic(struct clock_event_device *evt)
86 {
87 struct timer_of *to = to_timer_of(evt);
88 unsigned long cycles_per_jiffy;
89
90 rda_ostimer_stop(timer_of_base(to));
91
92 cycles_per_jiffy = ((unsigned long long)NSEC_PER_SEC / HZ *
93 evt->mult) >> evt->shift;
94 rda_ostimer_start(timer_of_base(to), true, cycles_per_jiffy);
95
96 return 0;
97 }
98
99 static int rda_ostimer_tick_resume(struct clock_event_device *evt)
100 {
101 return 0;
102 }
103
104 static int rda_ostimer_set_next_event(unsigned long evt,
105 struct clock_event_device *ev)
106 {
107 struct timer_of *to = to_timer_of(ev);
108
109 rda_ostimer_start(timer_of_base(to), false, evt);
110
111 return 0;
112 }
113
114 static irqreturn_t rda_ostimer_interrupt(int irq, void *dev_id)
115 {
116 struct clock_event_device *evt = dev_id;
117 struct timer_of *to = to_timer_of(evt);
118
119
120 writel_relaxed(RDA_TIMER_IRQ_CLR_OSTIMER,
121 timer_of_base(to) + RDA_TIMER_IRQ_CLR);
122
123 if (evt->event_handler)
124 evt->event_handler(evt);
125
126 return IRQ_HANDLED;
127 }
128
129 static struct timer_of rda_ostimer_of = {
130 .flags = TIMER_OF_IRQ | TIMER_OF_BASE,
131
132 .clkevt = {
133 .name = "rda-ostimer",
134 .rating = 250,
135 .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT |
136 CLOCK_EVT_FEAT_DYNIRQ,
137 .set_state_shutdown = rda_ostimer_set_state_shutdown,
138 .set_state_oneshot = rda_ostimer_set_state_oneshot,
139 .set_state_periodic = rda_ostimer_set_state_periodic,
140 .tick_resume = rda_ostimer_tick_resume,
141 .set_next_event = rda_ostimer_set_next_event,
142 },
143
144 .of_base = {
145 .name = "rda-timer",
146 .index = 0,
147 },
148
149 .of_irq = {
150 .name = "ostimer",
151 .handler = rda_ostimer_interrupt,
152 .flags = IRQF_TIMER,
153 },
154 };
155
156 static u64 rda_hwtimer_read(struct clocksource *cs)
157 {
158 void __iomem *base = timer_of_base(&rda_ostimer_of);
159 u32 lo, hi;
160
161
162 do {
163 lo = readl_relaxed(base + RDA_HWTIMER_LOCKVAL_L);
164 hi = readl_relaxed(base + RDA_HWTIMER_LOCKVAL_H);
165 } while (hi != readl_relaxed(base + RDA_HWTIMER_LOCKVAL_H));
166
167 return ((u64)hi << 32) | lo;
168 }
169
170 static struct clocksource rda_hwtimer_clocksource = {
171 .name = "rda-timer",
172 .rating = 400,
173 .read = rda_hwtimer_read,
174 .mask = CLOCKSOURCE_MASK(64),
175 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
176 };
177
178 static int __init rda_timer_init(struct device_node *np)
179 {
180 unsigned long rate = 2000000;
181 int ret;
182
183 ret = timer_of_init(np, &rda_ostimer_of);
184 if (ret)
185 return ret;
186
187 clocksource_register_hz(&rda_hwtimer_clocksource, rate);
188
189 clockevents_config_and_register(&rda_ostimer_of.clkevt, rate,
190 0x2, UINT_MAX);
191
192 return 0;
193 }
194
195 TIMER_OF_DECLARE(rda8810pl, "rda,8810pl-timer", rda_timer_init);