This source file includes following definitions.
- pxa_read_sched_clock
- pxa_ost0_interrupt
- pxa_osmr0_set_next_event
- pxa_osmr0_shutdown
- pxa_timer_suspend
- pxa_timer_resume
- pxa_timer_common_init
- pxa_timer_dt_init
- pxa_timer_nodt_init
1
2
3
4
5
6
7
8
9
10
11
12 #include <linux/kernel.h>
13 #include <linux/init.h>
14 #include <linux/interrupt.h>
15 #include <linux/clk.h>
16 #include <linux/clockchips.h>
17 #include <linux/of_address.h>
18 #include <linux/of_irq.h>
19 #include <linux/sched/clock.h>
20 #include <linux/sched_clock.h>
21
22 #include <clocksource/pxa.h>
23
24 #include <asm/div64.h>
25
26 #define OSMR0 0x00
27 #define OSMR1 0x04
28 #define OSMR2 0x08
29 #define OSMR3 0x0C
30
31 #define OSCR 0x10
32 #define OSSR 0x14
33 #define OWER 0x18
34 #define OIER 0x1C
35
36 #define OSSR_M3 (1 << 3)
37 #define OSSR_M2 (1 << 2)
38 #define OSSR_M1 (1 << 1)
39 #define OSSR_M0 (1 << 0)
40
41 #define OIER_E0 (1 << 0)
42
43
44
45
46
47
48
49
50
51
52 #define timer_readl(reg) readl_relaxed(timer_base + (reg))
53 #define timer_writel(val, reg) writel_relaxed((val), timer_base + (reg))
54
55 static void __iomem *timer_base;
56
57 static u64 notrace pxa_read_sched_clock(void)
58 {
59 return timer_readl(OSCR);
60 }
61
62
63 #define MIN_OSCR_DELTA 16
64
65 static irqreturn_t
66 pxa_ost0_interrupt(int irq, void *dev_id)
67 {
68 struct clock_event_device *c = dev_id;
69
70
71 timer_writel(timer_readl(OIER) & ~OIER_E0, OIER);
72 timer_writel(OSSR_M0, OSSR);
73 c->event_handler(c);
74
75 return IRQ_HANDLED;
76 }
77
78 static int
79 pxa_osmr0_set_next_event(unsigned long delta, struct clock_event_device *dev)
80 {
81 unsigned long next, oscr;
82
83 timer_writel(timer_readl(OIER) | OIER_E0, OIER);
84 next = timer_readl(OSCR) + delta;
85 timer_writel(next, OSMR0);
86 oscr = timer_readl(OSCR);
87
88 return (signed)(next - oscr) <= MIN_OSCR_DELTA ? -ETIME : 0;
89 }
90
91 static int pxa_osmr0_shutdown(struct clock_event_device *evt)
92 {
93
94 timer_writel(timer_readl(OIER) & ~OIER_E0, OIER);
95 timer_writel(OSSR_M0, OSSR);
96 return 0;
97 }
98
99 #ifdef CONFIG_PM
100 static unsigned long osmr[4], oier, oscr;
101
102 static void pxa_timer_suspend(struct clock_event_device *cedev)
103 {
104 osmr[0] = timer_readl(OSMR0);
105 osmr[1] = timer_readl(OSMR1);
106 osmr[2] = timer_readl(OSMR2);
107 osmr[3] = timer_readl(OSMR3);
108 oier = timer_readl(OIER);
109 oscr = timer_readl(OSCR);
110 }
111
112 static void pxa_timer_resume(struct clock_event_device *cedev)
113 {
114
115
116
117
118
119
120 if (osmr[0] - oscr < MIN_OSCR_DELTA)
121 osmr[0] += MIN_OSCR_DELTA;
122
123 timer_writel(osmr[0], OSMR0);
124 timer_writel(osmr[1], OSMR1);
125 timer_writel(osmr[2], OSMR2);
126 timer_writel(osmr[3], OSMR3);
127 timer_writel(oier, OIER);
128 timer_writel(oscr, OSCR);
129 }
130 #else
131 #define pxa_timer_suspend NULL
132 #define pxa_timer_resume NULL
133 #endif
134
135 static struct clock_event_device ckevt_pxa_osmr0 = {
136 .name = "osmr0",
137 .features = CLOCK_EVT_FEAT_ONESHOT,
138 .rating = 200,
139 .set_next_event = pxa_osmr0_set_next_event,
140 .set_state_shutdown = pxa_osmr0_shutdown,
141 .set_state_oneshot = pxa_osmr0_shutdown,
142 .suspend = pxa_timer_suspend,
143 .resume = pxa_timer_resume,
144 };
145
146 static struct irqaction pxa_ost0_irq = {
147 .name = "ost0",
148 .flags = IRQF_TIMER | IRQF_IRQPOLL,
149 .handler = pxa_ost0_interrupt,
150 .dev_id = &ckevt_pxa_osmr0,
151 };
152
153 static int __init pxa_timer_common_init(int irq, unsigned long clock_tick_rate)
154 {
155 int ret;
156
157 timer_writel(0, OIER);
158 timer_writel(OSSR_M0 | OSSR_M1 | OSSR_M2 | OSSR_M3, OSSR);
159
160 sched_clock_register(pxa_read_sched_clock, 32, clock_tick_rate);
161
162 ckevt_pxa_osmr0.cpumask = cpumask_of(0);
163
164 ret = setup_irq(irq, &pxa_ost0_irq);
165 if (ret) {
166 pr_err("Failed to setup irq\n");
167 return ret;
168 }
169
170 ret = clocksource_mmio_init(timer_base + OSCR, "oscr0", clock_tick_rate, 200,
171 32, clocksource_mmio_readl_up);
172 if (ret) {
173 pr_err("Failed to init clocksource\n");
174 return ret;
175 }
176
177 clockevents_config_and_register(&ckevt_pxa_osmr0, clock_tick_rate,
178 MIN_OSCR_DELTA * 2, 0x7fffffff);
179
180 return 0;
181 }
182
183 static int __init pxa_timer_dt_init(struct device_node *np)
184 {
185 struct clk *clk;
186 int irq, ret;
187
188
189 timer_base = of_iomap(np, 0);
190 if (!timer_base) {
191 pr_err("%pOFn: unable to map resource\n", np);
192 return -ENXIO;
193 }
194
195 clk = of_clk_get(np, 0);
196 if (IS_ERR(clk)) {
197 pr_crit("%pOFn: unable to get clk\n", np);
198 return PTR_ERR(clk);
199 }
200
201 ret = clk_prepare_enable(clk);
202 if (ret) {
203 pr_crit("Failed to prepare clock\n");
204 return ret;
205 }
206
207
208 irq = irq_of_parse_and_map(np, 0);
209 if (irq <= 0) {
210 pr_crit("%pOFn: unable to parse OS-timer0 irq\n", np);
211 return -EINVAL;
212 }
213
214 return pxa_timer_common_init(irq, clk_get_rate(clk));
215 }
216 TIMER_OF_DECLARE(pxa_timer, "marvell,pxa-timer", pxa_timer_dt_init);
217
218
219
220
221 void __init pxa_timer_nodt_init(int irq, void __iomem *base)
222 {
223 struct clk *clk;
224
225 timer_base = base;
226 clk = clk_get(NULL, "OSTIMER0");
227 if (clk && !IS_ERR(clk)) {
228 clk_prepare_enable(clk);
229 pxa_timer_common_init(irq, clk_get_rate(clk));
230 } else {
231 pr_crit("%s: unable to get clk\n", __func__);
232 }
233 }