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