1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * linux/arch/arm/plat-omap/dmtimer.c
4 *
5 * OMAP Dual-Mode Timers
6 *
7 * Copyright (C) 2010 Texas Instruments Incorporated - https://www.ti.com/
8 * Tarun Kanti DebBarma <tarun.kanti@ti.com>
9 * Thara Gopinath <thara@ti.com>
10 *
11 * dmtimer adaptation to platform_driver.
12 *
13 * Copyright (C) 2005 Nokia Corporation
14 * OMAP2 support by Juha Yrjola
15 * API improvements and OMAP2 clock framework support by Timo Teras
16 *
17 * Copyright (C) 2009 Texas Instruments
18 * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
19 */
20
21 #include <linux/clk.h>
22 #include <linux/clk-provider.h>
23 #include <linux/cpu_pm.h>
24 #include <linux/module.h>
25 #include <linux/io.h>
26 #include <linux/device.h>
27 #include <linux/err.h>
28 #include <linux/pm_runtime.h>
29 #include <linux/of.h>
30 #include <linux/of_device.h>
31 #include <linux/platform_device.h>
32 #include <linux/platform_data/dmtimer-omap.h>
33
34 #include <clocksource/timer-ti-dm.h>
35
36 static u32 omap_reserved_systimers;
37 static LIST_HEAD(omap_timer_list);
38 static DEFINE_SPINLOCK(dm_timer_lock);
39
40 enum {
41 REQUEST_ANY = 0,
42 REQUEST_BY_ID,
43 REQUEST_BY_CAP,
44 REQUEST_BY_NODE,
45 };
46
47 /**
48 * omap_dm_timer_read_reg - read timer registers in posted and non-posted mode
49 * @timer: timer pointer over which read operation to perform
50 * @reg: lowest byte holds the register offset
51 *
52 * The posted mode bit is encoded in reg. Note that in posted mode write
53 * pending bit must be checked. Otherwise a read of a non completed write
54 * will produce an error.
55 */
omap_dm_timer_read_reg(struct omap_dm_timer * timer,u32 reg)56 static inline u32 omap_dm_timer_read_reg(struct omap_dm_timer *timer, u32 reg)
57 {
58 WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
59 return __omap_dm_timer_read(timer, reg, timer->posted);
60 }
61
62 /**
63 * omap_dm_timer_write_reg - write timer registers in posted and non-posted mode
64 * @timer: timer pointer over which write operation is to perform
65 * @reg: lowest byte holds the register offset
66 * @value: data to write into the register
67 *
68 * The posted mode bit is encoded in reg. Note that in posted mode the write
69 * pending bit must be checked. Otherwise a write on a register which has a
70 * pending write will be lost.
71 */
omap_dm_timer_write_reg(struct omap_dm_timer * timer,u32 reg,u32 value)72 static void omap_dm_timer_write_reg(struct omap_dm_timer *timer, u32 reg,
73 u32 value)
74 {
75 WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
76 __omap_dm_timer_write(timer, reg, value, timer->posted);
77 }
78
omap_timer_restore_context(struct omap_dm_timer * timer)79 static void omap_timer_restore_context(struct omap_dm_timer *timer)
80 {
81 __omap_dm_timer_write(timer, OMAP_TIMER_OCP_CFG_OFFSET,
82 timer->context.ocp_cfg, 0);
83
84 omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG,
85 timer->context.twer);
86 omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG,
87 timer->context.tcrr);
88 omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG,
89 timer->context.tldr);
90 omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG,
91 timer->context.tmar);
92 omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG,
93 timer->context.tsicr);
94 writel_relaxed(timer->context.tier, timer->irq_ena);
95 omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG,
96 timer->context.tclr);
97 }
98
omap_timer_save_context(struct omap_dm_timer * timer)99 static void omap_timer_save_context(struct omap_dm_timer *timer)
100 {
101 timer->context.ocp_cfg =
102 __omap_dm_timer_read(timer, OMAP_TIMER_OCP_CFG_OFFSET, 0);
103
104 timer->context.tclr =
105 omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
106 timer->context.twer =
107 omap_dm_timer_read_reg(timer, OMAP_TIMER_WAKEUP_EN_REG);
108 timer->context.tldr =
109 omap_dm_timer_read_reg(timer, OMAP_TIMER_LOAD_REG);
110 timer->context.tmar =
111 omap_dm_timer_read_reg(timer, OMAP_TIMER_MATCH_REG);
112 timer->context.tier = readl_relaxed(timer->irq_ena);
113 timer->context.tsicr =
114 omap_dm_timer_read_reg(timer, OMAP_TIMER_IF_CTRL_REG);
115 }
116
omap_timer_context_notifier(struct notifier_block * nb,unsigned long cmd,void * v)117 static int omap_timer_context_notifier(struct notifier_block *nb,
118 unsigned long cmd, void *v)
119 {
120 struct omap_dm_timer *timer;
121
122 timer = container_of(nb, struct omap_dm_timer, nb);
123
124 switch (cmd) {
125 case CPU_CLUSTER_PM_ENTER:
126 if ((timer->capability & OMAP_TIMER_ALWON) ||
127 !atomic_read(&timer->enabled))
128 break;
129 omap_timer_save_context(timer);
130 break;
131 case CPU_CLUSTER_PM_ENTER_FAILED:
132 case CPU_CLUSTER_PM_EXIT:
133 if ((timer->capability & OMAP_TIMER_ALWON) ||
134 !atomic_read(&timer->enabled))
135 break;
136 omap_timer_restore_context(timer);
137 break;
138 }
139
140 return NOTIFY_OK;
141 }
142
omap_dm_timer_reset(struct omap_dm_timer * timer)143 static int omap_dm_timer_reset(struct omap_dm_timer *timer)
144 {
145 u32 l, timeout = 100000;
146
147 if (timer->revision != 1)
148 return -EINVAL;
149
150 omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
151
152 do {
153 l = __omap_dm_timer_read(timer,
154 OMAP_TIMER_V1_SYS_STAT_OFFSET, 0);
155 } while (!l && timeout--);
156
157 if (!timeout) {
158 dev_err(&timer->pdev->dev, "Timer failed to reset\n");
159 return -ETIMEDOUT;
160 }
161
162 /* Configure timer for smart-idle mode */
163 l = __omap_dm_timer_read(timer, OMAP_TIMER_OCP_CFG_OFFSET, 0);
164 l |= 0x2 << 0x3;
165 __omap_dm_timer_write(timer, OMAP_TIMER_OCP_CFG_OFFSET, l, 0);
166
167 timer->posted = 0;
168
169 return 0;
170 }
171
omap_dm_timer_set_source(struct omap_dm_timer * timer,int source)172 static int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
173 {
174 int ret;
175 const char *parent_name;
176 struct clk *parent;
177 struct dmtimer_platform_data *pdata;
178
179 if (unlikely(!timer) || IS_ERR(timer->fclk))
180 return -EINVAL;
181
182 switch (source) {
183 case OMAP_TIMER_SRC_SYS_CLK:
184 parent_name = "timer_sys_ck";
185 break;
186 case OMAP_TIMER_SRC_32_KHZ:
187 parent_name = "timer_32k_ck";
188 break;
189 case OMAP_TIMER_SRC_EXT_CLK:
190 parent_name = "timer_ext_ck";
191 break;
192 default:
193 return -EINVAL;
194 }
195
196 pdata = timer->pdev->dev.platform_data;
197
198 /*
199 * FIXME: Used for OMAP1 devices only because they do not currently
200 * use the clock framework to set the parent clock. To be removed
201 * once OMAP1 migrated to using clock framework for dmtimers
202 */
203 if (pdata && pdata->set_timer_src)
204 return pdata->set_timer_src(timer->pdev, source);
205
206 #if defined(CONFIG_COMMON_CLK)
207 /* Check if the clock has configurable parents */
208 if (clk_hw_get_num_parents(__clk_get_hw(timer->fclk)) < 2)
209 return 0;
210 #endif
211
212 parent = clk_get(&timer->pdev->dev, parent_name);
213 if (IS_ERR(parent)) {
214 pr_err("%s: %s not found\n", __func__, parent_name);
215 return -EINVAL;
216 }
217
218 ret = clk_set_parent(timer->fclk, parent);
219 if (ret < 0)
220 pr_err("%s: failed to set %s as parent\n", __func__,
221 parent_name);
222
223 clk_put(parent);
224
225 return ret;
226 }
227
omap_dm_timer_enable(struct omap_dm_timer * timer)228 static void omap_dm_timer_enable(struct omap_dm_timer *timer)
229 {
230 pm_runtime_get_sync(&timer->pdev->dev);
231 }
232
omap_dm_timer_disable(struct omap_dm_timer * timer)233 static void omap_dm_timer_disable(struct omap_dm_timer *timer)
234 {
235 pm_runtime_put_sync(&timer->pdev->dev);
236 }
237
omap_dm_timer_prepare(struct omap_dm_timer * timer)238 static int omap_dm_timer_prepare(struct omap_dm_timer *timer)
239 {
240 int rc;
241
242 /*
243 * FIXME: OMAP1 devices do not use the clock framework for dmtimers so
244 * do not call clk_get() for these devices.
245 */
246 if (!(timer->capability & OMAP_TIMER_NEEDS_RESET)) {
247 timer->fclk = clk_get(&timer->pdev->dev, "fck");
248 if (WARN_ON_ONCE(IS_ERR(timer->fclk))) {
249 dev_err(&timer->pdev->dev, ": No fclk handle.\n");
250 return -EINVAL;
251 }
252 }
253
254 omap_dm_timer_enable(timer);
255
256 if (timer->capability & OMAP_TIMER_NEEDS_RESET) {
257 rc = omap_dm_timer_reset(timer);
258 if (rc) {
259 omap_dm_timer_disable(timer);
260 return rc;
261 }
262 }
263
264 __omap_dm_timer_enable_posted(timer);
265 omap_dm_timer_disable(timer);
266
267 return 0;
268 }
269
omap_dm_timer_reserved_systimer(int id)270 static inline u32 omap_dm_timer_reserved_systimer(int id)
271 {
272 return (omap_reserved_systimers & (1 << (id - 1))) ? 1 : 0;
273 }
274
omap_dm_timer_reserve_systimer(int id)275 int omap_dm_timer_reserve_systimer(int id)
276 {
277 if (omap_dm_timer_reserved_systimer(id))
278 return -ENODEV;
279
280 omap_reserved_systimers |= (1 << (id - 1));
281
282 return 0;
283 }
284
_omap_dm_timer_request(int req_type,void * data)285 static struct omap_dm_timer *_omap_dm_timer_request(int req_type, void *data)
286 {
287 struct omap_dm_timer *timer = NULL, *t;
288 struct device_node *np = NULL;
289 unsigned long flags;
290 u32 cap = 0;
291 int id = 0;
292
293 switch (req_type) {
294 case REQUEST_BY_ID:
295 id = *(int *)data;
296 break;
297 case REQUEST_BY_CAP:
298 cap = *(u32 *)data;
299 break;
300 case REQUEST_BY_NODE:
301 np = (struct device_node *)data;
302 break;
303 default:
304 /* REQUEST_ANY */
305 break;
306 }
307
308 spin_lock_irqsave(&dm_timer_lock, flags);
309 list_for_each_entry(t, &omap_timer_list, node) {
310 if (t->reserved)
311 continue;
312
313 switch (req_type) {
314 case REQUEST_BY_ID:
315 if (id == t->pdev->id) {
316 timer = t;
317 timer->reserved = 1;
318 goto found;
319 }
320 break;
321 case REQUEST_BY_CAP:
322 if (cap == (t->capability & cap)) {
323 /*
324 * If timer is not NULL, we have already found
325 * one timer. But it was not an exact match
326 * because it had more capabilities than what
327 * was required. Therefore, unreserve the last
328 * timer found and see if this one is a better
329 * match.
330 */
331 if (timer)
332 timer->reserved = 0;
333 timer = t;
334 timer->reserved = 1;
335
336 /* Exit loop early if we find an exact match */
337 if (t->capability == cap)
338 goto found;
339 }
340 break;
341 case REQUEST_BY_NODE:
342 if (np == t->pdev->dev.of_node) {
343 timer = t;
344 timer->reserved = 1;
345 goto found;
346 }
347 break;
348 default:
349 /* REQUEST_ANY */
350 timer = t;
351 timer->reserved = 1;
352 goto found;
353 }
354 }
355 found:
356 spin_unlock_irqrestore(&dm_timer_lock, flags);
357
358 if (timer && omap_dm_timer_prepare(timer)) {
359 timer->reserved = 0;
360 timer = NULL;
361 }
362
363 if (!timer)
364 pr_debug("%s: timer request failed!\n", __func__);
365
366 return timer;
367 }
368
omap_dm_timer_request(void)369 static struct omap_dm_timer *omap_dm_timer_request(void)
370 {
371 return _omap_dm_timer_request(REQUEST_ANY, NULL);
372 }
373
omap_dm_timer_request_specific(int id)374 static struct omap_dm_timer *omap_dm_timer_request_specific(int id)
375 {
376 /* Requesting timer by ID is not supported when device tree is used */
377 if (of_have_populated_dt()) {
378 pr_warn("%s: Please use omap_dm_timer_request_by_node()\n",
379 __func__);
380 return NULL;
381 }
382
383 return _omap_dm_timer_request(REQUEST_BY_ID, &id);
384 }
385
386 /**
387 * omap_dm_timer_request_by_cap - Request a timer by capability
388 * @cap: Bit mask of capabilities to match
389 *
390 * Find a timer based upon capabilities bit mask. Callers of this function
391 * should use the definitions found in the plat/dmtimer.h file under the
392 * comment "timer capabilities used in hwmod database". Returns pointer to
393 * timer handle on success and a NULL pointer on failure.
394 */
omap_dm_timer_request_by_cap(u32 cap)395 struct omap_dm_timer *omap_dm_timer_request_by_cap(u32 cap)
396 {
397 return _omap_dm_timer_request(REQUEST_BY_CAP, &cap);
398 }
399
400 /**
401 * omap_dm_timer_request_by_node - Request a timer by device-tree node
402 * @np: Pointer to device-tree timer node
403 *
404 * Request a timer based upon a device node pointer. Returns pointer to
405 * timer handle on success and a NULL pointer on failure.
406 */
omap_dm_timer_request_by_node(struct device_node * np)407 static struct omap_dm_timer *omap_dm_timer_request_by_node(struct device_node *np)
408 {
409 if (!np)
410 return NULL;
411
412 return _omap_dm_timer_request(REQUEST_BY_NODE, np);
413 }
414
omap_dm_timer_free(struct omap_dm_timer * timer)415 static int omap_dm_timer_free(struct omap_dm_timer *timer)
416 {
417 if (unlikely(!timer))
418 return -EINVAL;
419
420 clk_put(timer->fclk);
421
422 WARN_ON(!timer->reserved);
423 timer->reserved = 0;
424 return 0;
425 }
426
omap_dm_timer_get_irq(struct omap_dm_timer * timer)427 int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
428 {
429 if (timer)
430 return timer->irq;
431 return -EINVAL;
432 }
433
434 #if defined(CONFIG_ARCH_OMAP1)
435 #include <mach/hardware.h>
436
omap_dm_timer_get_fclk(struct omap_dm_timer * timer)437 static struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
438 {
439 return NULL;
440 }
441
442 /**
443 * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
444 * @inputmask: current value of idlect mask
445 */
omap_dm_timer_modify_idlect_mask(__u32 inputmask)446 __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
447 {
448 int i = 0;
449 struct omap_dm_timer *timer = NULL;
450 unsigned long flags;
451
452 /* If ARMXOR cannot be idled this function call is unnecessary */
453 if (!(inputmask & (1 << 1)))
454 return inputmask;
455
456 /* If any active timer is using ARMXOR return modified mask */
457 spin_lock_irqsave(&dm_timer_lock, flags);
458 list_for_each_entry(timer, &omap_timer_list, node) {
459 u32 l;
460
461 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
462 if (l & OMAP_TIMER_CTRL_ST) {
463 if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
464 inputmask &= ~(1 << 1);
465 else
466 inputmask &= ~(1 << 2);
467 }
468 i++;
469 }
470 spin_unlock_irqrestore(&dm_timer_lock, flags);
471
472 return inputmask;
473 }
474
475 #else
476
omap_dm_timer_get_fclk(struct omap_dm_timer * timer)477 static struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
478 {
479 if (timer && !IS_ERR(timer->fclk))
480 return timer->fclk;
481 return NULL;
482 }
483
omap_dm_timer_modify_idlect_mask(__u32 inputmask)484 __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
485 {
486 BUG();
487
488 return 0;
489 }
490
491 #endif
492
omap_dm_timer_trigger(struct omap_dm_timer * timer)493 int omap_dm_timer_trigger(struct omap_dm_timer *timer)
494 {
495 if (unlikely(!timer || !atomic_read(&timer->enabled))) {
496 pr_err("%s: timer not available or enabled.\n", __func__);
497 return -EINVAL;
498 }
499
500 omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
501 return 0;
502 }
503
omap_dm_timer_start(struct omap_dm_timer * timer)504 static int omap_dm_timer_start(struct omap_dm_timer *timer)
505 {
506 u32 l;
507
508 if (unlikely(!timer))
509 return -EINVAL;
510
511 omap_dm_timer_enable(timer);
512
513 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
514 if (!(l & OMAP_TIMER_CTRL_ST)) {
515 l |= OMAP_TIMER_CTRL_ST;
516 omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
517 }
518
519 return 0;
520 }
521
omap_dm_timer_stop(struct omap_dm_timer * timer)522 static int omap_dm_timer_stop(struct omap_dm_timer *timer)
523 {
524 unsigned long rate = 0;
525
526 if (unlikely(!timer))
527 return -EINVAL;
528
529 if (!(timer->capability & OMAP_TIMER_NEEDS_RESET))
530 rate = clk_get_rate(timer->fclk);
531
532 __omap_dm_timer_stop(timer, timer->posted, rate);
533
534 omap_dm_timer_disable(timer);
535 return 0;
536 }
537
omap_dm_timer_set_load(struct omap_dm_timer * timer,unsigned int load)538 static int omap_dm_timer_set_load(struct omap_dm_timer *timer,
539 unsigned int load)
540 {
541 if (unlikely(!timer))
542 return -EINVAL;
543
544 omap_dm_timer_enable(timer);
545 omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
546
547 omap_dm_timer_disable(timer);
548 return 0;
549 }
550
omap_dm_timer_set_match(struct omap_dm_timer * timer,int enable,unsigned int match)551 static int omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
552 unsigned int match)
553 {
554 u32 l;
555
556 if (unlikely(!timer))
557 return -EINVAL;
558
559 omap_dm_timer_enable(timer);
560 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
561 if (enable)
562 l |= OMAP_TIMER_CTRL_CE;
563 else
564 l &= ~OMAP_TIMER_CTRL_CE;
565 omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
566 omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
567
568 omap_dm_timer_disable(timer);
569 return 0;
570 }
571
omap_dm_timer_set_pwm(struct omap_dm_timer * timer,int def_on,int toggle,int trigger,int autoreload)572 static int omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
573 int toggle, int trigger, int autoreload)
574 {
575 u32 l;
576
577 if (unlikely(!timer))
578 return -EINVAL;
579
580 omap_dm_timer_enable(timer);
581 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
582 l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
583 OMAP_TIMER_CTRL_PT | (0x03 << 10) | OMAP_TIMER_CTRL_AR);
584 if (def_on)
585 l |= OMAP_TIMER_CTRL_SCPWM;
586 if (toggle)
587 l |= OMAP_TIMER_CTRL_PT;
588 l |= trigger << 10;
589 if (autoreload)
590 l |= OMAP_TIMER_CTRL_AR;
591 omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
592
593 omap_dm_timer_disable(timer);
594 return 0;
595 }
596
omap_dm_timer_get_pwm_status(struct omap_dm_timer * timer)597 static int omap_dm_timer_get_pwm_status(struct omap_dm_timer *timer)
598 {
599 u32 l;
600
601 if (unlikely(!timer))
602 return -EINVAL;
603
604 omap_dm_timer_enable(timer);
605 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
606 omap_dm_timer_disable(timer);
607
608 return l;
609 }
610
omap_dm_timer_set_prescaler(struct omap_dm_timer * timer,int prescaler)611 static int omap_dm_timer_set_prescaler(struct omap_dm_timer *timer,
612 int prescaler)
613 {
614 u32 l;
615
616 if (unlikely(!timer) || prescaler < -1 || prescaler > 7)
617 return -EINVAL;
618
619 omap_dm_timer_enable(timer);
620 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
621 l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
622 if (prescaler >= 0) {
623 l |= OMAP_TIMER_CTRL_PRE;
624 l |= prescaler << 2;
625 }
626 omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
627
628 omap_dm_timer_disable(timer);
629 return 0;
630 }
631
omap_dm_timer_set_int_enable(struct omap_dm_timer * timer,unsigned int value)632 static int omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
633 unsigned int value)
634 {
635 if (unlikely(!timer))
636 return -EINVAL;
637
638 omap_dm_timer_enable(timer);
639 __omap_dm_timer_int_enable(timer, value);
640
641 omap_dm_timer_disable(timer);
642 return 0;
643 }
644
645 /**
646 * omap_dm_timer_set_int_disable - disable timer interrupts
647 * @timer: pointer to timer handle
648 * @mask: bit mask of interrupts to be disabled
649 *
650 * Disables the specified timer interrupts for a timer.
651 */
omap_dm_timer_set_int_disable(struct omap_dm_timer * timer,u32 mask)652 static int omap_dm_timer_set_int_disable(struct omap_dm_timer *timer, u32 mask)
653 {
654 u32 l = mask;
655
656 if (unlikely(!timer))
657 return -EINVAL;
658
659 omap_dm_timer_enable(timer);
660
661 if (timer->revision == 1)
662 l = readl_relaxed(timer->irq_ena) & ~mask;
663
664 writel_relaxed(l, timer->irq_dis);
665 l = omap_dm_timer_read_reg(timer, OMAP_TIMER_WAKEUP_EN_REG) & ~mask;
666 omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG, l);
667
668 omap_dm_timer_disable(timer);
669 return 0;
670 }
671
omap_dm_timer_read_status(struct omap_dm_timer * timer)672 static unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
673 {
674 unsigned int l;
675
676 if (unlikely(!timer || !atomic_read(&timer->enabled))) {
677 pr_err("%s: timer not available or enabled.\n", __func__);
678 return 0;
679 }
680
681 l = readl_relaxed(timer->irq_stat);
682
683 return l;
684 }
685
omap_dm_timer_write_status(struct omap_dm_timer * timer,unsigned int value)686 static int omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
687 {
688 if (unlikely(!timer || !atomic_read(&timer->enabled)))
689 return -EINVAL;
690
691 __omap_dm_timer_write_status(timer, value);
692
693 return 0;
694 }
695
omap_dm_timer_read_counter(struct omap_dm_timer * timer)696 static unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
697 {
698 if (unlikely(!timer || !atomic_read(&timer->enabled))) {
699 pr_err("%s: timer not iavailable or enabled.\n", __func__);
700 return 0;
701 }
702
703 return __omap_dm_timer_read_counter(timer, timer->posted);
704 }
705
omap_dm_timer_write_counter(struct omap_dm_timer * timer,unsigned int value)706 static int omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
707 {
708 if (unlikely(!timer || !atomic_read(&timer->enabled))) {
709 pr_err("%s: timer not available or enabled.\n", __func__);
710 return -EINVAL;
711 }
712
713 omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
714
715 /* Save the context */
716 timer->context.tcrr = value;
717 return 0;
718 }
719
omap_dm_timers_active(void)720 int omap_dm_timers_active(void)
721 {
722 struct omap_dm_timer *timer;
723
724 list_for_each_entry(timer, &omap_timer_list, node) {
725 if (!timer->reserved)
726 continue;
727
728 if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
729 OMAP_TIMER_CTRL_ST) {
730 return 1;
731 }
732 }
733 return 0;
734 }
735
omap_dm_timer_runtime_suspend(struct device * dev)736 static int __maybe_unused omap_dm_timer_runtime_suspend(struct device *dev)
737 {
738 struct omap_dm_timer *timer = dev_get_drvdata(dev);
739
740 atomic_set(&timer->enabled, 0);
741
742 if (timer->capability & OMAP_TIMER_ALWON || !timer->func_base)
743 return 0;
744
745 omap_timer_save_context(timer);
746
747 return 0;
748 }
749
omap_dm_timer_runtime_resume(struct device * dev)750 static int __maybe_unused omap_dm_timer_runtime_resume(struct device *dev)
751 {
752 struct omap_dm_timer *timer = dev_get_drvdata(dev);
753
754 if (!(timer->capability & OMAP_TIMER_ALWON) && timer->func_base)
755 omap_timer_restore_context(timer);
756
757 atomic_set(&timer->enabled, 1);
758
759 return 0;
760 }
761
762 static const struct dev_pm_ops omap_dm_timer_pm_ops = {
763 SET_RUNTIME_PM_OPS(omap_dm_timer_runtime_suspend,
764 omap_dm_timer_runtime_resume, NULL)
765 };
766
767 static const struct of_device_id omap_timer_match[];
768
769 /**
770 * omap_dm_timer_probe - probe function called for every registered device
771 * @pdev: pointer to current timer platform device
772 *
773 * Called by driver framework at the end of device registration for all
774 * timer devices.
775 */
omap_dm_timer_probe(struct platform_device * pdev)776 static int omap_dm_timer_probe(struct platform_device *pdev)
777 {
778 unsigned long flags;
779 struct omap_dm_timer *timer;
780 struct device *dev = &pdev->dev;
781 const struct dmtimer_platform_data *pdata;
782 int ret;
783
784 pdata = of_device_get_match_data(dev);
785 if (!pdata)
786 pdata = dev_get_platdata(dev);
787 else
788 dev->platform_data = (void *)pdata;
789
790 if (!pdata) {
791 dev_err(dev, "%s: no platform data.\n", __func__);
792 return -ENODEV;
793 }
794
795 timer = devm_kzalloc(dev, sizeof(*timer), GFP_KERNEL);
796 if (!timer)
797 return -ENOMEM;
798
799 timer->irq = platform_get_irq(pdev, 0);
800 if (timer->irq < 0)
801 return timer->irq;
802
803 timer->fclk = ERR_PTR(-ENODEV);
804 timer->io_base = devm_platform_ioremap_resource(pdev, 0);
805 if (IS_ERR(timer->io_base))
806 return PTR_ERR(timer->io_base);
807
808 platform_set_drvdata(pdev, timer);
809
810 if (dev->of_node) {
811 if (of_find_property(dev->of_node, "ti,timer-alwon", NULL))
812 timer->capability |= OMAP_TIMER_ALWON;
813 if (of_find_property(dev->of_node, "ti,timer-dsp", NULL))
814 timer->capability |= OMAP_TIMER_HAS_DSP_IRQ;
815 if (of_find_property(dev->of_node, "ti,timer-pwm", NULL))
816 timer->capability |= OMAP_TIMER_HAS_PWM;
817 if (of_find_property(dev->of_node, "ti,timer-secure", NULL))
818 timer->capability |= OMAP_TIMER_SECURE;
819 } else {
820 timer->id = pdev->id;
821 timer->capability = pdata->timer_capability;
822 timer->reserved = omap_dm_timer_reserved_systimer(timer->id);
823 }
824
825 if (!(timer->capability & OMAP_TIMER_ALWON)) {
826 timer->nb.notifier_call = omap_timer_context_notifier;
827 cpu_pm_register_notifier(&timer->nb);
828 }
829
830 if (pdata)
831 timer->errata = pdata->timer_errata;
832
833 timer->pdev = pdev;
834
835 pm_runtime_enable(dev);
836
837 if (!timer->reserved) {
838 ret = pm_runtime_get_sync(dev);
839 if (ret < 0) {
840 dev_err(dev, "%s: pm_runtime_get_sync failed!\n",
841 __func__);
842 goto err_get_sync;
843 }
844 __omap_dm_timer_init_regs(timer);
845 pm_runtime_put(dev);
846 }
847
848 /* add the timer element to the list */
849 spin_lock_irqsave(&dm_timer_lock, flags);
850 list_add_tail(&timer->node, &omap_timer_list);
851 spin_unlock_irqrestore(&dm_timer_lock, flags);
852
853 dev_dbg(dev, "Device Probed.\n");
854
855 return 0;
856
857 err_get_sync:
858 pm_runtime_put_noidle(dev);
859 pm_runtime_disable(dev);
860 return ret;
861 }
862
863 /**
864 * omap_dm_timer_remove - cleanup a registered timer device
865 * @pdev: pointer to current timer platform device
866 *
867 * Called by driver framework whenever a timer device is unregistered.
868 * In addition to freeing platform resources it also deletes the timer
869 * entry from the local list.
870 */
omap_dm_timer_remove(struct platform_device * pdev)871 static int omap_dm_timer_remove(struct platform_device *pdev)
872 {
873 struct omap_dm_timer *timer;
874 unsigned long flags;
875 int ret = -EINVAL;
876
877 spin_lock_irqsave(&dm_timer_lock, flags);
878 list_for_each_entry(timer, &omap_timer_list, node)
879 if (!strcmp(dev_name(&timer->pdev->dev),
880 dev_name(&pdev->dev))) {
881 if (!(timer->capability & OMAP_TIMER_ALWON))
882 cpu_pm_unregister_notifier(&timer->nb);
883 list_del(&timer->node);
884 ret = 0;
885 break;
886 }
887 spin_unlock_irqrestore(&dm_timer_lock, flags);
888
889 pm_runtime_disable(&pdev->dev);
890
891 return ret;
892 }
893
894 static const struct omap_dm_timer_ops dmtimer_ops = {
895 .request_by_node = omap_dm_timer_request_by_node,
896 .request_specific = omap_dm_timer_request_specific,
897 .request = omap_dm_timer_request,
898 .set_source = omap_dm_timer_set_source,
899 .get_irq = omap_dm_timer_get_irq,
900 .set_int_enable = omap_dm_timer_set_int_enable,
901 .set_int_disable = omap_dm_timer_set_int_disable,
902 .free = omap_dm_timer_free,
903 .enable = omap_dm_timer_enable,
904 .disable = omap_dm_timer_disable,
905 .get_fclk = omap_dm_timer_get_fclk,
906 .start = omap_dm_timer_start,
907 .stop = omap_dm_timer_stop,
908 .set_load = omap_dm_timer_set_load,
909 .set_match = omap_dm_timer_set_match,
910 .set_pwm = omap_dm_timer_set_pwm,
911 .get_pwm_status = omap_dm_timer_get_pwm_status,
912 .set_prescaler = omap_dm_timer_set_prescaler,
913 .read_counter = omap_dm_timer_read_counter,
914 .write_counter = omap_dm_timer_write_counter,
915 .read_status = omap_dm_timer_read_status,
916 .write_status = omap_dm_timer_write_status,
917 };
918
919 static const struct dmtimer_platform_data omap3plus_pdata = {
920 .timer_errata = OMAP_TIMER_ERRATA_I103_I767,
921 .timer_ops = &dmtimer_ops,
922 };
923
924 static const struct of_device_id omap_timer_match[] = {
925 {
926 .compatible = "ti,omap2420-timer",
927 },
928 {
929 .compatible = "ti,omap3430-timer",
930 .data = &omap3plus_pdata,
931 },
932 {
933 .compatible = "ti,omap4430-timer",
934 .data = &omap3plus_pdata,
935 },
936 {
937 .compatible = "ti,omap5430-timer",
938 .data = &omap3plus_pdata,
939 },
940 {
941 .compatible = "ti,am335x-timer",
942 .data = &omap3plus_pdata,
943 },
944 {
945 .compatible = "ti,am335x-timer-1ms",
946 .data = &omap3plus_pdata,
947 },
948 {
949 .compatible = "ti,dm816-timer",
950 .data = &omap3plus_pdata,
951 },
952 {},
953 };
954 MODULE_DEVICE_TABLE(of, omap_timer_match);
955
956 static struct platform_driver omap_dm_timer_driver = {
957 .probe = omap_dm_timer_probe,
958 .remove = omap_dm_timer_remove,
959 .driver = {
960 .name = "omap_timer",
961 .of_match_table = of_match_ptr(omap_timer_match),
962 .pm = &omap_dm_timer_pm_ops,
963 },
964 };
965
966 module_platform_driver(omap_dm_timer_driver);
967
968 MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");
969 MODULE_LICENSE("GPL");
970 MODULE_AUTHOR("Texas Instruments Inc");
971