1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <linux/init.h>
30#include <linux/time.h>
31#include <linux/interrupt.h>
32#include <linux/err.h>
33#include <linux/clk.h>
34#include <linux/delay.h>
35#include <linux/irq.h>
36#include <linux/clocksource.h>
37#include <linux/clockchips.h>
38#include <linux/slab.h>
39#include <linux/of.h>
40#include <linux/of_address.h>
41#include <linux/of_irq.h>
42#include <linux/platform_device.h>
43#include <linux/platform_data/dmtimer-omap.h>
44#include <linux/sched_clock.h>
45
46#include <asm/mach/time.h>
47#include <asm/smp_twd.h>
48
49#include "omap_hwmod.h"
50#include "omap_device.h"
51#include <plat/counter-32k.h>
52#include <plat/dmtimer.h>
53#include "omap-pm.h"
54
55#include "soc.h"
56#include "common.h"
57#include "control.h"
58#include "powerdomain.h"
59#include "omap-secure.h"
60
61#define REALTIME_COUNTER_BASE 0x48243200
62#define INCREMENTER_NUMERATOR_OFFSET 0x10
63#define INCREMENTER_DENUMERATOR_RELOAD_OFFSET 0x14
64#define NUMERATOR_DENUMERATOR_MASK 0xfffff000
65
66
67
68static struct omap_dm_timer clkev;
69static struct clock_event_device clockevent_gpt;
70
71#ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
72static unsigned long arch_timer_freq;
73
74void set_cntfreq(void)
75{
76 omap_smc1(OMAP5_DRA7_MON_SET_CNTFRQ_INDEX, arch_timer_freq);
77}
78#endif
79
80static irqreturn_t omap2_gp_timer_interrupt(int irq, void *dev_id)
81{
82 struct clock_event_device *evt = &clockevent_gpt;
83
84 __omap_dm_timer_write_status(&clkev, OMAP_TIMER_INT_OVERFLOW);
85
86 evt->event_handler(evt);
87 return IRQ_HANDLED;
88}
89
90static struct irqaction omap2_gp_timer_irq = {
91 .name = "gp_timer",
92 .flags = IRQF_TIMER | IRQF_IRQPOLL,
93 .handler = omap2_gp_timer_interrupt,
94};
95
96static int omap2_gp_timer_set_next_event(unsigned long cycles,
97 struct clock_event_device *evt)
98{
99 __omap_dm_timer_load_start(&clkev, OMAP_TIMER_CTRL_ST,
100 0xffffffff - cycles, OMAP_TIMER_POSTED);
101
102 return 0;
103}
104
105static int omap2_gp_timer_shutdown(struct clock_event_device *evt)
106{
107 __omap_dm_timer_stop(&clkev, OMAP_TIMER_POSTED, clkev.rate);
108 return 0;
109}
110
111static int omap2_gp_timer_set_periodic(struct clock_event_device *evt)
112{
113 u32 period;
114
115 __omap_dm_timer_stop(&clkev, OMAP_TIMER_POSTED, clkev.rate);
116
117 period = clkev.rate / HZ;
118 period -= 1;
119
120 __omap_dm_timer_write(&clkev, OMAP_TIMER_LOAD_REG, 0xffffffff - period,
121 OMAP_TIMER_POSTED);
122 __omap_dm_timer_load_start(&clkev,
123 OMAP_TIMER_CTRL_AR | OMAP_TIMER_CTRL_ST,
124 0xffffffff - period, OMAP_TIMER_POSTED);
125 return 0;
126}
127
128static struct clock_event_device clockevent_gpt = {
129 .features = CLOCK_EVT_FEAT_PERIODIC |
130 CLOCK_EVT_FEAT_ONESHOT,
131 .rating = 300,
132 .set_next_event = omap2_gp_timer_set_next_event,
133 .set_state_shutdown = omap2_gp_timer_shutdown,
134 .set_state_periodic = omap2_gp_timer_set_periodic,
135 .set_state_oneshot = omap2_gp_timer_shutdown,
136 .tick_resume = omap2_gp_timer_shutdown,
137};
138
139static struct property device_disabled = {
140 .name = "status",
141 .length = sizeof("disabled"),
142 .value = "disabled",
143};
144
145static const struct of_device_id omap_timer_match[] __initconst = {
146 { .compatible = "ti,omap2420-timer", },
147 { .compatible = "ti,omap3430-timer", },
148 { .compatible = "ti,omap4430-timer", },
149 { .compatible = "ti,omap5430-timer", },
150 { .compatible = "ti,dm814-timer", },
151 { .compatible = "ti,dm816-timer", },
152 { .compatible = "ti,am335x-timer", },
153 { .compatible = "ti,am335x-timer-1ms", },
154 { }
155};
156
157
158
159
160
161
162
163
164
165
166
167
168static struct device_node * __init omap_get_timer_dt(const struct of_device_id *match,
169 const char *property)
170{
171 struct device_node *np;
172
173 for_each_matching_node(np, match) {
174 if (!of_device_is_available(np))
175 continue;
176
177 if (property && !of_get_property(np, property, NULL))
178 continue;
179
180 if (!property && (of_get_property(np, "ti,timer-alwon", NULL) ||
181 of_get_property(np, "ti,timer-dsp", NULL) ||
182 of_get_property(np, "ti,timer-pwm", NULL) ||
183 of_get_property(np, "ti,timer-secure", NULL)))
184 continue;
185
186 if (!of_device_is_compatible(np, "ti,omap-counter32k"))
187 of_add_property(np, &device_disabled);
188 return np;
189 }
190
191 return NULL;
192}
193
194
195
196
197
198
199
200
201
202static void __init omap_dmtimer_init(void)
203{
204 struct device_node *np;
205
206 if (!cpu_is_omap34xx())
207 return;
208
209
210 if ((omap_type() != OMAP2_DEVICE_TYPE_GP)) {
211 np = omap_get_timer_dt(omap_timer_match, "ti,timer-secure");
212 of_node_put(np);
213 }
214}
215
216
217
218
219
220
221static u32 __init omap_dm_timer_get_errata(void)
222{
223 if (cpu_is_omap24xx())
224 return 0;
225
226 return OMAP_TIMER_ERRATA_I103_I767;
227}
228
229static int __init omap_dm_timer_init_one(struct omap_dm_timer *timer,
230 const char *fck_source,
231 const char *property,
232 const char **timer_name,
233 int posted)
234{
235 char name[10];
236 const char *oh_name = NULL;
237 struct device_node *np;
238 struct omap_hwmod *oh;
239 struct resource irq, mem;
240 struct clk *src;
241 int r = 0;
242
243 if (of_have_populated_dt()) {
244 np = omap_get_timer_dt(omap_timer_match, property);
245 if (!np)
246 return -ENODEV;
247
248 of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
249 if (!oh_name)
250 return -ENODEV;
251
252 timer->irq = irq_of_parse_and_map(np, 0);
253 if (!timer->irq)
254 return -ENXIO;
255
256 timer->io_base = of_iomap(np, 0);
257
258 of_node_put(np);
259 } else {
260 if (omap_dm_timer_reserve_systimer(timer->id))
261 return -ENODEV;
262
263 sprintf(name, "timer%d", timer->id);
264 oh_name = name;
265 }
266
267 oh = omap_hwmod_lookup(oh_name);
268 if (!oh)
269 return -ENODEV;
270
271 *timer_name = oh->name;
272
273 if (!of_have_populated_dt()) {
274 r = omap_hwmod_get_resource_byname(oh, IORESOURCE_IRQ, NULL,
275 &irq);
276 if (r)
277 return -ENXIO;
278 timer->irq = irq.start;
279
280 r = omap_hwmod_get_resource_byname(oh, IORESOURCE_MEM, NULL,
281 &mem);
282 if (r)
283 return -ENXIO;
284
285
286 timer->io_base = ioremap(mem.start, mem.end - mem.start);
287 }
288
289 if (!timer->io_base)
290 return -ENXIO;
291
292
293 timer->fclk = clk_get(NULL, omap_hwmod_get_main_clk(oh));
294 if (IS_ERR(timer->fclk))
295 return PTR_ERR(timer->fclk);
296
297 src = clk_get(NULL, fck_source);
298 if (IS_ERR(src))
299 return PTR_ERR(src);
300
301 WARN(clk_set_parent(timer->fclk, src) < 0,
302 "Cannot set timer parent clock, no PLL clock driver?");
303
304 clk_put(src);
305
306 omap_hwmod_setup_one(oh_name);
307 omap_hwmod_enable(oh);
308 __omap_dm_timer_init_regs(timer);
309
310 if (posted)
311 __omap_dm_timer_enable_posted(timer);
312
313
314 if (posted != timer->posted)
315 return -EINVAL;
316
317 timer->rate = clk_get_rate(timer->fclk);
318 timer->reserved = 1;
319
320 return r;
321}
322
323#if !defined(CONFIG_SMP) && defined(CONFIG_GENERIC_CLOCKEVENTS_BROADCAST)
324void tick_broadcast(const struct cpumask *mask)
325{
326}
327#endif
328
329static void __init omap2_gp_clockevent_init(int gptimer_id,
330 const char *fck_source,
331 const char *property)
332{
333 int res;
334
335 clkev.id = gptimer_id;
336 clkev.errata = omap_dm_timer_get_errata();
337
338
339
340
341
342
343 __omap_dm_timer_override_errata(&clkev, OMAP_TIMER_ERRATA_I103_I767);
344
345 res = omap_dm_timer_init_one(&clkev, fck_source, property,
346 &clockevent_gpt.name, OMAP_TIMER_POSTED);
347 BUG_ON(res);
348
349 omap2_gp_timer_irq.dev_id = &clkev;
350 setup_irq(clkev.irq, &omap2_gp_timer_irq);
351
352 __omap_dm_timer_int_enable(&clkev, OMAP_TIMER_INT_OVERFLOW);
353
354 clockevent_gpt.cpumask = cpu_possible_mask;
355 clockevent_gpt.irq = omap_dm_timer_get_irq(&clkev);
356 clockevents_config_and_register(&clockevent_gpt, clkev.rate,
357 3,
358 0xffffffff);
359
360 pr_info("OMAP clockevent source: %s at %lu Hz\n", clockevent_gpt.name,
361 clkev.rate);
362}
363
364
365static struct omap_dm_timer clksrc;
366static bool use_gptimer_clksrc __initdata;
367
368
369
370
371static cycle_t clocksource_read_cycles(struct clocksource *cs)
372{
373 return (cycle_t)__omap_dm_timer_read_counter(&clksrc,
374 OMAP_TIMER_NONPOSTED);
375}
376
377static struct clocksource clocksource_gpt = {
378 .rating = 300,
379 .read = clocksource_read_cycles,
380 .mask = CLOCKSOURCE_MASK(32),
381 .flags = CLOCK_SOURCE_IS_CONTINUOUS,
382};
383
384static u64 notrace dmtimer_read_sched_clock(void)
385{
386 if (clksrc.reserved)
387 return __omap_dm_timer_read_counter(&clksrc,
388 OMAP_TIMER_NONPOSTED);
389
390 return 0;
391}
392
393static const struct of_device_id omap_counter_match[] __initconst = {
394 { .compatible = "ti,omap-counter32k", },
395 { }
396};
397
398
399static int __init __maybe_unused omap2_sync32k_clocksource_init(void)
400{
401 int ret;
402 struct device_node *np = NULL;
403 struct omap_hwmod *oh;
404 const char *oh_name = "counter_32k";
405
406
407
408
409
410 if (of_have_populated_dt()) {
411 np = omap_get_timer_dt(omap_counter_match, NULL);
412 if (!np)
413 return -ENODEV;
414
415 of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
416 if (!oh_name)
417 return -ENODEV;
418 }
419
420
421
422
423 oh = omap_hwmod_lookup(oh_name);
424 if (!oh || oh->slaves_cnt == 0)
425 return -ENODEV;
426
427 omap_hwmod_setup_one(oh_name);
428
429 ret = omap_hwmod_enable(oh);
430 if (ret) {
431 pr_warn("%s: failed to enable counter_32k module (%d)\n",
432 __func__, ret);
433 return ret;
434 }
435
436 if (!of_have_populated_dt()) {
437 void __iomem *vbase;
438
439 vbase = omap_hwmod_get_mpu_rt_va(oh);
440
441 ret = omap_init_clocksource_32k(vbase);
442 if (ret) {
443 pr_warn("%s: failed to initialize counter_32k as a clocksource (%d)\n",
444 __func__, ret);
445 omap_hwmod_idle(oh);
446 }
447 }
448 return ret;
449}
450
451static void __init omap2_gptimer_clocksource_init(int gptimer_id,
452 const char *fck_source,
453 const char *property)
454{
455 int res;
456
457 clksrc.id = gptimer_id;
458 clksrc.errata = omap_dm_timer_get_errata();
459
460 res = omap_dm_timer_init_one(&clksrc, fck_source, property,
461 &clocksource_gpt.name,
462 OMAP_TIMER_NONPOSTED);
463 BUG_ON(res);
464
465 __omap_dm_timer_load_start(&clksrc,
466 OMAP_TIMER_CTRL_ST | OMAP_TIMER_CTRL_AR, 0,
467 OMAP_TIMER_NONPOSTED);
468 sched_clock_register(dmtimer_read_sched_clock, 32, clksrc.rate);
469
470 if (clocksource_register_hz(&clocksource_gpt, clksrc.rate))
471 pr_err("Could not register clocksource %s\n",
472 clocksource_gpt.name);
473 else
474 pr_info("OMAP clocksource: %s at %lu Hz\n",
475 clocksource_gpt.name, clksrc.rate);
476}
477
478static void __init __omap_sync32k_timer_init(int clkev_nr, const char *clkev_src,
479 const char *clkev_prop, int clksrc_nr, const char *clksrc_src,
480 const char *clksrc_prop, bool gptimer)
481{
482 omap_clk_init();
483 omap_dmtimer_init();
484 omap2_gp_clockevent_init(clkev_nr, clkev_src, clkev_prop);
485
486
487 if (use_gptimer_clksrc || gptimer)
488 omap2_gptimer_clocksource_init(clksrc_nr, clksrc_src,
489 clksrc_prop);
490 else
491 omap2_sync32k_clocksource_init();
492}
493
494void __init omap_init_time(void)
495{
496 __omap_sync32k_timer_init(1, "timer_32k_ck", "ti,timer-alwon",
497 2, "timer_sys_ck", NULL, false);
498
499 if (of_have_populated_dt())
500 clocksource_probe();
501}
502
503#if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM43XX)
504void __init omap3_secure_sync32k_timer_init(void)
505{
506 __omap_sync32k_timer_init(12, "secure_32k_fck", "ti,timer-secure",
507 2, "timer_sys_ck", NULL, false);
508}
509#endif
510
511#if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM33XX)
512void __init omap3_gptimer_timer_init(void)
513{
514 __omap_sync32k_timer_init(2, "timer_sys_ck", NULL,
515 1, "timer_sys_ck", "ti,timer-alwon", true);
516}
517#endif
518
519#if defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5) || \
520 defined(CONFIG_SOC_DRA7XX) || defined(CONFIG_SOC_AM43XX)
521static void __init omap4_sync32k_timer_init(void)
522{
523 __omap_sync32k_timer_init(1, "timer_32k_ck", "ti,timer-alwon",
524 2, "sys_clkin_ck", NULL, false);
525}
526
527void __init omap4_local_timer_init(void)
528{
529 omap4_sync32k_timer_init();
530 clocksource_probe();
531}
532#endif
533
534#if defined(CONFIG_SOC_OMAP5) || defined(CONFIG_SOC_DRA7XX)
535
536
537
538
539
540
541
542
543
544
545static void __init realtime_counter_init(void)
546{
547#ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
548 void __iomem *base;
549 static struct clk *sys_clk;
550 unsigned long rate;
551 unsigned int reg;
552 unsigned long long num, den;
553
554 base = ioremap(REALTIME_COUNTER_BASE, SZ_32);
555 if (!base) {
556 pr_err("%s: ioremap failed\n", __func__);
557 return;
558 }
559 sys_clk = clk_get(NULL, "sys_clkin");
560 if (IS_ERR(sys_clk)) {
561 pr_err("%s: failed to get system clock handle\n", __func__);
562 iounmap(base);
563 return;
564 }
565
566 rate = clk_get_rate(sys_clk);
567
568 if (soc_is_dra7xx()) {
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588 reg = omap_ctrl_readl(DRA7_CTRL_CORE_BOOTSTRAP);
589 if (reg & DRA7_SPEEDSELECT_MASK) {
590 num = 75;
591 den = 244;
592 goto sysclk1_based;
593 }
594 }
595
596
597 switch (rate) {
598 case 12000000:
599 num = 64;
600 den = 125;
601 break;
602 case 13000000:
603 num = 768;
604 den = 1625;
605 break;
606 case 19200000:
607 num = 8;
608 den = 25;
609 break;
610 case 20000000:
611 num = 192;
612 den = 625;
613 break;
614 case 26000000:
615 num = 384;
616 den = 1625;
617 break;
618 case 27000000:
619 num = 256;
620 den = 1125;
621 break;
622 case 38400000:
623 default:
624
625 num = 4;
626 den = 25;
627 break;
628 }
629
630sysclk1_based:
631
632 reg = readl_relaxed(base + INCREMENTER_NUMERATOR_OFFSET) &
633 NUMERATOR_DENUMERATOR_MASK;
634 reg |= num;
635 writel_relaxed(reg, base + INCREMENTER_NUMERATOR_OFFSET);
636
637 reg = readl_relaxed(base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET) &
638 NUMERATOR_DENUMERATOR_MASK;
639 reg |= den;
640 writel_relaxed(reg, base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET);
641
642 arch_timer_freq = DIV_ROUND_UP_ULL(rate * num, den);
643 set_cntfreq();
644
645 iounmap(base);
646#endif
647}
648
649void __init omap5_realtime_timer_init(void)
650{
651 omap4_sync32k_timer_init();
652 realtime_counter_init();
653
654 clocksource_probe();
655}
656#endif
657
658
659
660
661
662
663
664
665
666
667
668
669
670static int __init omap_timer_init(struct omap_hwmod *oh, void *unused)
671{
672 int id;
673 int ret = 0;
674 char *name = "omap_timer";
675 struct dmtimer_platform_data *pdata;
676 struct platform_device *pdev;
677 struct omap_timer_capability_dev_attr *timer_dev_attr;
678
679 pr_debug("%s: %s\n", __func__, oh->name);
680
681
682 timer_dev_attr = oh->dev_attr;
683 if (omap_type() != OMAP2_DEVICE_TYPE_GP && timer_dev_attr)
684 if (timer_dev_attr->timer_capability == OMAP_TIMER_SECURE)
685 return ret;
686
687 pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
688 if (!pdata) {
689 pr_err("%s: No memory for [%s]\n", __func__, oh->name);
690 return -ENOMEM;
691 }
692
693
694
695
696
697
698
699
700
701
702
703 sscanf(oh->name, "timer%2d", &id);
704
705 if (timer_dev_attr)
706 pdata->timer_capability = timer_dev_attr->timer_capability;
707
708 pdata->timer_errata = omap_dm_timer_get_errata();
709 pdata->get_context_loss_count = omap_pm_get_dev_context_loss_count;
710
711 pdev = omap_device_build(name, id, oh, pdata, sizeof(*pdata));
712
713 if (IS_ERR(pdev)) {
714 pr_err("%s: Can't build omap_device for %s: %s.\n",
715 __func__, name, oh->name);
716 ret = -EINVAL;
717 }
718
719 kfree(pdata);
720
721 return ret;
722}
723
724
725
726
727
728
729
730static int __init omap2_dm_timer_init(void)
731{
732 int ret;
733
734
735 if (of_have_populated_dt())
736 return -ENODEV;
737
738 ret = omap_hwmod_for_each_by_class("timer", omap_timer_init, NULL);
739 if (unlikely(ret)) {
740 pr_err("%s: device registration failed.\n", __func__);
741 return -EINVAL;
742 }
743
744 return 0;
745}
746omap_arch_initcall(omap2_dm_timer_init);
747
748
749
750
751
752
753
754
755
756
757static int __init omap2_override_clocksource(char *str)
758{
759 if (!str)
760 return 0;
761
762
763
764
765
766 if (!strcmp(str, "gp_timer"))
767 use_gptimer_clksrc = true;
768
769 return 0;
770}
771early_param("clocksource", omap2_override_clocksource);
772