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/platform_device.h>
31 #include <linux/platform_data/dmtimer-omap.h>
32 
33 #include <clocksource/timer-ti-dm.h>
34 
35 /*
36  * timer errata flags
37  *
38  * Errata i103/i767 impacts all OMAP3/4/5 devices including AM33xx. This
39  * errata prevents us from using posted mode on these devices, unless the
40  * timer counter register is never read. For more details please refer to
41  * the OMAP3/4/5 errata documents.
42  */
43 #define OMAP_TIMER_ERRATA_I103_I767			0x80000000
44 
45 /* posted mode types */
46 #define OMAP_TIMER_NONPOSTED			0x00
47 #define OMAP_TIMER_POSTED			0x01
48 
49 /* register offsets with the write pending bit encoded */
50 #define	WPSHIFT					16
51 
52 #define OMAP_TIMER_WAKEUP_EN_REG		(_OMAP_TIMER_WAKEUP_EN_OFFSET \
53 							| (WP_NONE << WPSHIFT))
54 
55 #define OMAP_TIMER_CTRL_REG			(_OMAP_TIMER_CTRL_OFFSET \
56 							| (WP_TCLR << WPSHIFT))
57 
58 #define OMAP_TIMER_COUNTER_REG			(_OMAP_TIMER_COUNTER_OFFSET \
59 							| (WP_TCRR << WPSHIFT))
60 
61 #define OMAP_TIMER_LOAD_REG			(_OMAP_TIMER_LOAD_OFFSET \
62 							| (WP_TLDR << WPSHIFT))
63 
64 #define OMAP_TIMER_TRIGGER_REG			(_OMAP_TIMER_TRIGGER_OFFSET \
65 							| (WP_TTGR << WPSHIFT))
66 
67 #define OMAP_TIMER_WRITE_PEND_REG		(_OMAP_TIMER_WRITE_PEND_OFFSET \
68 							| (WP_NONE << WPSHIFT))
69 
70 #define OMAP_TIMER_MATCH_REG			(_OMAP_TIMER_MATCH_OFFSET \
71 							| (WP_TMAR << WPSHIFT))
72 
73 #define OMAP_TIMER_CAPTURE_REG			(_OMAP_TIMER_CAPTURE_OFFSET \
74 							| (WP_NONE << WPSHIFT))
75 
76 #define OMAP_TIMER_IF_CTRL_REG			(_OMAP_TIMER_IF_CTRL_OFFSET \
77 							| (WP_NONE << WPSHIFT))
78 
79 #define OMAP_TIMER_CAPTURE2_REG			(_OMAP_TIMER_CAPTURE2_OFFSET \
80 							| (WP_NONE << WPSHIFT))
81 
82 #define OMAP_TIMER_TICK_POS_REG			(_OMAP_TIMER_TICK_POS_OFFSET \
83 							| (WP_TPIR << WPSHIFT))
84 
85 #define OMAP_TIMER_TICK_NEG_REG			(_OMAP_TIMER_TICK_NEG_OFFSET \
86 							| (WP_TNIR << WPSHIFT))
87 
88 #define OMAP_TIMER_TICK_COUNT_REG		(_OMAP_TIMER_TICK_COUNT_OFFSET \
89 							| (WP_TCVR << WPSHIFT))
90 
91 #define OMAP_TIMER_TICK_INT_MASK_SET_REG				\
92 		(_OMAP_TIMER_TICK_INT_MASK_SET_OFFSET | (WP_TOCR << WPSHIFT))
93 
94 #define OMAP_TIMER_TICK_INT_MASK_COUNT_REG				\
95 		(_OMAP_TIMER_TICK_INT_MASK_COUNT_OFFSET | (WP_TOWR << WPSHIFT))
96 
97 struct timer_regs {
98 	u32 ocp_cfg;
99 	u32 tidr;
100 	u32 tier;
101 	u32 twer;
102 	u32 tclr;
103 	u32 tcrr;
104 	u32 tldr;
105 	u32 ttrg;
106 	u32 twps;
107 	u32 tmar;
108 	u32 tcar1;
109 	u32 tsicr;
110 	u32 tcar2;
111 	u32 tpir;
112 	u32 tnir;
113 	u32 tcvr;
114 	u32 tocr;
115 	u32 towr;
116 };
117 
118 struct dmtimer {
119 	struct omap_dm_timer cookie;
120 	int id;
121 	int irq;
122 	struct clk *fclk;
123 
124 	void __iomem	*io_base;
125 	int		irq_stat;	/* TISR/IRQSTATUS interrupt status */
126 	int		irq_ena;	/* irq enable */
127 	int		irq_dis;	/* irq disable, only on v2 ip */
128 	void __iomem	*pend;		/* write pending */
129 	void __iomem	*func_base;	/* function register base */
130 
131 	atomic_t enabled;
132 	unsigned long rate;
133 	unsigned reserved:1;
134 	unsigned posted:1;
135 	unsigned omap1:1;
136 	struct timer_regs context;
137 	int revision;
138 	u32 capability;
139 	u32 errata;
140 	struct platform_device *pdev;
141 	struct list_head node;
142 	struct notifier_block nb;
143 	struct notifier_block fclk_nb;
144 	unsigned long fclk_rate;
145 };
146 
147 static u32 omap_reserved_systimers;
148 static LIST_HEAD(omap_timer_list);
149 static DEFINE_SPINLOCK(dm_timer_lock);
150 
151 enum {
152 	REQUEST_ANY = 0,
153 	REQUEST_BY_ID,
154 	REQUEST_BY_CAP,
155 	REQUEST_BY_NODE,
156 };
157 
158 /**
159  * dmtimer_read - read timer registers in posted and non-posted mode
160  * @timer:	timer pointer over which read operation to perform
161  * @reg:	lowest byte holds the register offset
162  *
163  * The posted mode bit is encoded in reg. Note that in posted mode, write
164  * pending bit must be checked. Otherwise a read of a non completed write
165  * will produce an error.
166  */
167 static inline u32 dmtimer_read(struct dmtimer *timer, u32 reg)
168 {
169 	u16 wp, offset;
170 
171 	wp = reg >> WPSHIFT;
172 	offset = reg & 0xff;
173 
174 	/* Wait for a possible write pending bit in posted mode */
175 	if (wp && timer->posted)
176 		while (readl_relaxed(timer->pend) & wp)
177 			cpu_relax();
178 
179 	return readl_relaxed(timer->func_base + offset);
180 }
181 
182 /**
183  * dmtimer_write - write timer registers in posted and non-posted mode
184  * @timer:      timer pointer over which write operation is to perform
185  * @reg:        lowest byte holds the register offset
186  * @val:        data to write into the register
187  *
188  * The posted mode bit is encoded in reg. Note that in posted mode, the write
189  * pending bit must be checked. Otherwise a write on a register which has a
190  * pending write will be lost.
191  */
192 static inline void dmtimer_write(struct dmtimer *timer, u32 reg, u32 val)
193 {
194 	u16 wp, offset;
195 
196 	wp = reg >> WPSHIFT;
197 	offset = reg & 0xff;
198 
199 	/* Wait for a possible write pending bit in posted mode */
200 	if (wp && timer->posted)
201 		while (readl_relaxed(timer->pend) & wp)
202 			cpu_relax();
203 
204 	writel_relaxed(val, timer->func_base + offset);
205 }
206 
207 static inline void __omap_dm_timer_init_regs(struct dmtimer *timer)
208 {
209 	u32 tidr;
210 
211 	/* Assume v1 ip if bits [31:16] are zero */
212 	tidr = readl_relaxed(timer->io_base);
213 	if (!(tidr >> 16)) {
214 		timer->revision = 1;
215 		timer->irq_stat = OMAP_TIMER_V1_STAT_OFFSET;
216 		timer->irq_ena = OMAP_TIMER_V1_INT_EN_OFFSET;
217 		timer->irq_dis = OMAP_TIMER_V1_INT_EN_OFFSET;
218 		timer->pend = timer->io_base + _OMAP_TIMER_WRITE_PEND_OFFSET;
219 		timer->func_base = timer->io_base;
220 	} else {
221 		timer->revision = 2;
222 		timer->irq_stat = OMAP_TIMER_V2_IRQSTATUS - OMAP_TIMER_V2_FUNC_OFFSET;
223 		timer->irq_ena = OMAP_TIMER_V2_IRQENABLE_SET - OMAP_TIMER_V2_FUNC_OFFSET;
224 		timer->irq_dis = OMAP_TIMER_V2_IRQENABLE_CLR - OMAP_TIMER_V2_FUNC_OFFSET;
225 		timer->pend = timer->io_base +
226 			_OMAP_TIMER_WRITE_PEND_OFFSET +
227 				OMAP_TIMER_V2_FUNC_OFFSET;
228 		timer->func_base = timer->io_base + OMAP_TIMER_V2_FUNC_OFFSET;
229 	}
230 }
231 
232 /*
233  * __omap_dm_timer_enable_posted - enables write posted mode
234  * @timer:      pointer to timer instance handle
235  *
236  * Enables the write posted mode for the timer. When posted mode is enabled
237  * writes to certain timer registers are immediately acknowledged by the
238  * internal bus and hence prevents stalling the CPU waiting for the write to
239  * complete. Enabling this feature can improve performance for writing to the
240  * timer registers.
241  */
242 static inline void __omap_dm_timer_enable_posted(struct dmtimer *timer)
243 {
244 	if (timer->posted)
245 		return;
246 
247 	if (timer->errata & OMAP_TIMER_ERRATA_I103_I767) {
248 		timer->posted = OMAP_TIMER_NONPOSTED;
249 		dmtimer_write(timer, OMAP_TIMER_IF_CTRL_REG, 0);
250 		return;
251 	}
252 
253 	dmtimer_write(timer, OMAP_TIMER_IF_CTRL_REG, OMAP_TIMER_CTRL_POSTED);
254 	timer->context.tsicr = OMAP_TIMER_CTRL_POSTED;
255 	timer->posted = OMAP_TIMER_POSTED;
256 }
257 
258 static inline void __omap_dm_timer_stop(struct dmtimer *timer)
259 {
260 	u32 l;
261 
262 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
263 	if (l & OMAP_TIMER_CTRL_ST) {
264 		l &= ~0x1;
265 		dmtimer_write(timer, OMAP_TIMER_CTRL_REG, l);
266 #ifdef CONFIG_ARCH_OMAP2PLUS
267 		/* Readback to make sure write has completed */
268 		dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
269 		/*
270 		 * Wait for functional clock period x 3.5 to make sure that
271 		 * timer is stopped
272 		 */
273 		udelay(3500000 / timer->fclk_rate + 1);
274 #endif
275 	}
276 
277 	/* Ack possibly pending interrupt */
278 	dmtimer_write(timer, timer->irq_stat, OMAP_TIMER_INT_OVERFLOW);
279 }
280 
281 static inline void __omap_dm_timer_int_enable(struct dmtimer *timer,
282 					      unsigned int value)
283 {
284 	dmtimer_write(timer, timer->irq_ena, value);
285 	dmtimer_write(timer, OMAP_TIMER_WAKEUP_EN_REG, value);
286 }
287 
288 static inline unsigned int
289 __omap_dm_timer_read_counter(struct dmtimer *timer)
290 {
291 	return dmtimer_read(timer, OMAP_TIMER_COUNTER_REG);
292 }
293 
294 static inline void __omap_dm_timer_write_status(struct dmtimer *timer,
295 						unsigned int value)
296 {
297 	dmtimer_write(timer, timer->irq_stat, value);
298 }
299 
300 static void omap_timer_restore_context(struct dmtimer *timer)
301 {
302 	dmtimer_write(timer, OMAP_TIMER_OCP_CFG_OFFSET, timer->context.ocp_cfg);
303 
304 	dmtimer_write(timer, OMAP_TIMER_WAKEUP_EN_REG, timer->context.twer);
305 	dmtimer_write(timer, OMAP_TIMER_COUNTER_REG, timer->context.tcrr);
306 	dmtimer_write(timer, OMAP_TIMER_LOAD_REG, timer->context.tldr);
307 	dmtimer_write(timer, OMAP_TIMER_MATCH_REG, timer->context.tmar);
308 	dmtimer_write(timer, OMAP_TIMER_IF_CTRL_REG, timer->context.tsicr);
309 	dmtimer_write(timer, timer->irq_ena, timer->context.tier);
310 	dmtimer_write(timer, OMAP_TIMER_CTRL_REG, timer->context.tclr);
311 }
312 
313 static void omap_timer_save_context(struct dmtimer *timer)
314 {
315 	timer->context.ocp_cfg = dmtimer_read(timer, OMAP_TIMER_OCP_CFG_OFFSET);
316 
317 	timer->context.tclr = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
318 	timer->context.twer = dmtimer_read(timer, OMAP_TIMER_WAKEUP_EN_REG);
319 	timer->context.tldr = dmtimer_read(timer, OMAP_TIMER_LOAD_REG);
320 	timer->context.tmar = dmtimer_read(timer, OMAP_TIMER_MATCH_REG);
321 	timer->context.tier = dmtimer_read(timer, timer->irq_ena);
322 	timer->context.tsicr = dmtimer_read(timer, OMAP_TIMER_IF_CTRL_REG);
323 }
324 
325 static int omap_timer_context_notifier(struct notifier_block *nb,
326 				       unsigned long cmd, void *v)
327 {
328 	struct dmtimer *timer;
329 
330 	timer = container_of(nb, struct dmtimer, nb);
331 
332 	switch (cmd) {
333 	case CPU_CLUSTER_PM_ENTER:
334 		if ((timer->capability & OMAP_TIMER_ALWON) ||
335 		    !atomic_read(&timer->enabled))
336 			break;
337 		omap_timer_save_context(timer);
338 		break;
339 	case CPU_CLUSTER_PM_ENTER_FAILED:	/* No need to restore context */
340 		break;
341 	case CPU_CLUSTER_PM_EXIT:
342 		if ((timer->capability & OMAP_TIMER_ALWON) ||
343 		    !atomic_read(&timer->enabled))
344 			break;
345 		omap_timer_restore_context(timer);
346 		break;
347 	}
348 
349 	return NOTIFY_OK;
350 }
351 
352 static int omap_timer_fclk_notifier(struct notifier_block *nb,
353 				    unsigned long event, void *data)
354 {
355 	struct clk_notifier_data *clk_data = data;
356 	struct dmtimer *timer = container_of(nb, struct dmtimer, fclk_nb);
357 
358 	switch (event) {
359 	case POST_RATE_CHANGE:
360 		timer->fclk_rate = clk_data->new_rate;
361 		return NOTIFY_OK;
362 	default:
363 		return NOTIFY_DONE;
364 	}
365 }
366 
367 static int omap_dm_timer_reset(struct dmtimer *timer)
368 {
369 	u32 l, timeout = 100000;
370 
371 	if (timer->revision != 1)
372 		return -EINVAL;
373 
374 	dmtimer_write(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
375 
376 	do {
377 		l = dmtimer_read(timer, OMAP_TIMER_V1_SYS_STAT_OFFSET);
378 	} while (!l && timeout--);
379 
380 	if (!timeout) {
381 		dev_err(&timer->pdev->dev, "Timer failed to reset\n");
382 		return -ETIMEDOUT;
383 	}
384 
385 	/* Configure timer for smart-idle mode */
386 	l = dmtimer_read(timer, OMAP_TIMER_OCP_CFG_OFFSET);
387 	l |= 0x2 << 0x3;
388 	dmtimer_write(timer, OMAP_TIMER_OCP_CFG_OFFSET, l);
389 
390 	timer->posted = 0;
391 
392 	return 0;
393 }
394 
395 /*
396  * Functions exposed to PWM and remoteproc drivers via platform_data.
397  * Do not use these in the driver, these will get deprecated and will
398  * will be replaced by Linux generic framework functions such as
399  * chained interrupts and clock framework.
400  */
401 static struct dmtimer *to_dmtimer(struct omap_dm_timer *cookie)
402 {
403 	if (!cookie)
404 		return NULL;
405 
406 	return container_of(cookie, struct dmtimer, cookie);
407 }
408 
409 static int omap_dm_timer_set_source(struct omap_dm_timer *cookie, int source)
410 {
411 	int ret;
412 	const char *parent_name;
413 	struct clk *parent;
414 	struct dmtimer_platform_data *pdata;
415 	struct dmtimer *timer;
416 
417 	timer = to_dmtimer(cookie);
418 	if (unlikely(!timer) || IS_ERR(timer->fclk))
419 		return -EINVAL;
420 
421 	switch (source) {
422 	case OMAP_TIMER_SRC_SYS_CLK:
423 		parent_name = "timer_sys_ck";
424 		break;
425 	case OMAP_TIMER_SRC_32_KHZ:
426 		parent_name = "timer_32k_ck";
427 		break;
428 	case OMAP_TIMER_SRC_EXT_CLK:
429 		parent_name = "timer_ext_ck";
430 		break;
431 	default:
432 		return -EINVAL;
433 	}
434 
435 	pdata = timer->pdev->dev.platform_data;
436 
437 	/*
438 	 * FIXME: Used for OMAP1 devices only because they do not currently
439 	 * use the clock framework to set the parent clock. To be removed
440 	 * once OMAP1 migrated to using clock framework for dmtimers
441 	 */
442 	if (timer->omap1 && pdata && pdata->set_timer_src)
443 		return pdata->set_timer_src(timer->pdev, source);
444 
445 #if defined(CONFIG_COMMON_CLK)
446 	/* Check if the clock has configurable parents */
447 	if (clk_hw_get_num_parents(__clk_get_hw(timer->fclk)) < 2)
448 		return 0;
449 #endif
450 
451 	parent = clk_get(&timer->pdev->dev, parent_name);
452 	if (IS_ERR(parent)) {
453 		pr_err("%s: %s not found\n", __func__, parent_name);
454 		return -EINVAL;
455 	}
456 
457 	ret = clk_set_parent(timer->fclk, parent);
458 	if (ret < 0)
459 		pr_err("%s: failed to set %s as parent\n", __func__,
460 			parent_name);
461 
462 	clk_put(parent);
463 
464 	return ret;
465 }
466 
467 static void omap_dm_timer_enable(struct omap_dm_timer *cookie)
468 {
469 	struct dmtimer *timer = to_dmtimer(cookie);
470 	struct device *dev = &timer->pdev->dev;
471 	int rc;
472 
473 	rc = pm_runtime_resume_and_get(dev);
474 	if (rc)
475 		dev_err(dev, "could not enable timer\n");
476 }
477 
478 static void omap_dm_timer_disable(struct omap_dm_timer *cookie)
479 {
480 	struct dmtimer *timer = to_dmtimer(cookie);
481 	struct device *dev = &timer->pdev->dev;
482 
483 	pm_runtime_put_sync(dev);
484 }
485 
486 static int omap_dm_timer_prepare(struct dmtimer *timer)
487 {
488 	struct device *dev = &timer->pdev->dev;
489 	int rc;
490 
491 	rc = pm_runtime_resume_and_get(dev);
492 	if (rc)
493 		return rc;
494 
495 	if (timer->capability & OMAP_TIMER_NEEDS_RESET) {
496 		rc = omap_dm_timer_reset(timer);
497 		if (rc) {
498 			pm_runtime_put_sync(dev);
499 			return rc;
500 		}
501 	}
502 
503 	__omap_dm_timer_enable_posted(timer);
504 	pm_runtime_put_sync(dev);
505 
506 	return 0;
507 }
508 
509 static inline u32 omap_dm_timer_reserved_systimer(int id)
510 {
511 	return (omap_reserved_systimers & (1 << (id - 1))) ? 1 : 0;
512 }
513 
514 static struct dmtimer *_omap_dm_timer_request(int req_type, void *data)
515 {
516 	struct dmtimer *timer = NULL, *t;
517 	struct device_node *np = NULL;
518 	unsigned long flags;
519 	u32 cap = 0;
520 	int id = 0;
521 
522 	switch (req_type) {
523 	case REQUEST_BY_ID:
524 		id = *(int *)data;
525 		break;
526 	case REQUEST_BY_CAP:
527 		cap = *(u32 *)data;
528 		break;
529 	case REQUEST_BY_NODE:
530 		np = (struct device_node *)data;
531 		break;
532 	default:
533 		/* REQUEST_ANY */
534 		break;
535 	}
536 
537 	spin_lock_irqsave(&dm_timer_lock, flags);
538 	list_for_each_entry(t, &omap_timer_list, node) {
539 		if (t->reserved)
540 			continue;
541 
542 		switch (req_type) {
543 		case REQUEST_BY_ID:
544 			if (id == t->pdev->id) {
545 				timer = t;
546 				timer->reserved = 1;
547 				goto found;
548 			}
549 			break;
550 		case REQUEST_BY_CAP:
551 			if (cap == (t->capability & cap)) {
552 				/*
553 				 * If timer is not NULL, we have already found
554 				 * one timer. But it was not an exact match
555 				 * because it had more capabilities than what
556 				 * was required. Therefore, unreserve the last
557 				 * timer found and see if this one is a better
558 				 * match.
559 				 */
560 				if (timer)
561 					timer->reserved = 0;
562 				timer = t;
563 				timer->reserved = 1;
564 
565 				/* Exit loop early if we find an exact match */
566 				if (t->capability == cap)
567 					goto found;
568 			}
569 			break;
570 		case REQUEST_BY_NODE:
571 			if (np == t->pdev->dev.of_node) {
572 				timer = t;
573 				timer->reserved = 1;
574 				goto found;
575 			}
576 			break;
577 		default:
578 			/* REQUEST_ANY */
579 			timer = t;
580 			timer->reserved = 1;
581 			goto found;
582 		}
583 	}
584 found:
585 	spin_unlock_irqrestore(&dm_timer_lock, flags);
586 
587 	if (timer && omap_dm_timer_prepare(timer)) {
588 		timer->reserved = 0;
589 		timer = NULL;
590 	}
591 
592 	if (!timer)
593 		pr_debug("%s: timer request failed!\n", __func__);
594 
595 	return timer;
596 }
597 
598 static struct omap_dm_timer *omap_dm_timer_request(void)
599 {
600 	struct dmtimer *timer;
601 
602 	timer = _omap_dm_timer_request(REQUEST_ANY, NULL);
603 	if (!timer)
604 		return NULL;
605 
606 	return &timer->cookie;
607 }
608 
609 static struct omap_dm_timer *omap_dm_timer_request_specific(int id)
610 {
611 	struct dmtimer *timer;
612 
613 	/* Requesting timer by ID is not supported when device tree is used */
614 	if (of_have_populated_dt()) {
615 		pr_warn("%s: Please use omap_dm_timer_request_by_node()\n",
616 			__func__);
617 		return NULL;
618 	}
619 
620 	timer = _omap_dm_timer_request(REQUEST_BY_ID, &id);
621 	if (!timer)
622 		return NULL;
623 
624 	return &timer->cookie;
625 }
626 
627 /**
628  * omap_dm_timer_request_by_node - Request a timer by device-tree node
629  * @np:		Pointer to device-tree timer node
630  *
631  * Request a timer based upon a device node pointer. Returns pointer to
632  * timer handle on success and a NULL pointer on failure.
633  */
634 static struct omap_dm_timer *omap_dm_timer_request_by_node(struct device_node *np)
635 {
636 	struct dmtimer *timer;
637 
638 	if (!np)
639 		return NULL;
640 
641 	timer = _omap_dm_timer_request(REQUEST_BY_NODE, np);
642 	if (!timer)
643 		return NULL;
644 
645 	return &timer->cookie;
646 }
647 
648 static int omap_dm_timer_free(struct omap_dm_timer *cookie)
649 {
650 	struct dmtimer *timer;
651 	struct device *dev;
652 	int rc;
653 
654 	timer = to_dmtimer(cookie);
655 	if (unlikely(!timer))
656 		return -EINVAL;
657 
658 	WARN_ON(!timer->reserved);
659 	timer->reserved = 0;
660 
661 	dev = &timer->pdev->dev;
662 	rc = pm_runtime_resume_and_get(dev);
663 	if (rc)
664 		return rc;
665 
666 	/* Clear timer configuration */
667 	dmtimer_write(timer, OMAP_TIMER_CTRL_REG, 0);
668 
669 	pm_runtime_put_sync(dev);
670 
671 	return 0;
672 }
673 
674 static int omap_dm_timer_get_irq(struct omap_dm_timer *cookie)
675 {
676 	struct dmtimer *timer = to_dmtimer(cookie);
677 	if (timer)
678 		return timer->irq;
679 	return -EINVAL;
680 }
681 
682 #if defined(CONFIG_ARCH_OMAP1)
683 #include <linux/soc/ti/omap1-io.h>
684 
685 static struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *cookie)
686 {
687 	return NULL;
688 }
689 
690 /**
691  * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
692  * @inputmask: current value of idlect mask
693  */
694 __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
695 {
696 	int i = 0;
697 	struct dmtimer *timer = NULL;
698 	unsigned long flags;
699 
700 	/* If ARMXOR cannot be idled this function call is unnecessary */
701 	if (!(inputmask & (1 << 1)))
702 		return inputmask;
703 
704 	/* If any active timer is using ARMXOR return modified mask */
705 	spin_lock_irqsave(&dm_timer_lock, flags);
706 	list_for_each_entry(timer, &omap_timer_list, node) {
707 		u32 l;
708 
709 		l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
710 		if (l & OMAP_TIMER_CTRL_ST) {
711 			if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
712 				inputmask &= ~(1 << 1);
713 			else
714 				inputmask &= ~(1 << 2);
715 		}
716 		i++;
717 	}
718 	spin_unlock_irqrestore(&dm_timer_lock, flags);
719 
720 	return inputmask;
721 }
722 
723 #else
724 
725 static struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *cookie)
726 {
727 	struct dmtimer *timer = to_dmtimer(cookie);
728 
729 	if (timer && !IS_ERR(timer->fclk))
730 		return timer->fclk;
731 	return NULL;
732 }
733 
734 __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
735 {
736 	BUG();
737 
738 	return 0;
739 }
740 
741 #endif
742 
743 static int omap_dm_timer_start(struct omap_dm_timer *cookie)
744 {
745 	struct dmtimer *timer;
746 	struct device *dev;
747 	int rc;
748 	u32 l;
749 
750 	timer = to_dmtimer(cookie);
751 	if (unlikely(!timer))
752 		return -EINVAL;
753 
754 	dev = &timer->pdev->dev;
755 
756 	rc = pm_runtime_resume_and_get(dev);
757 	if (rc)
758 		return rc;
759 
760 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
761 	if (!(l & OMAP_TIMER_CTRL_ST)) {
762 		l |= OMAP_TIMER_CTRL_ST;
763 		dmtimer_write(timer, OMAP_TIMER_CTRL_REG, l);
764 	}
765 
766 	return 0;
767 }
768 
769 static int omap_dm_timer_stop(struct omap_dm_timer *cookie)
770 {
771 	struct dmtimer *timer;
772 	struct device *dev;
773 
774 	timer = to_dmtimer(cookie);
775 	if (unlikely(!timer))
776 		return -EINVAL;
777 
778 	dev = &timer->pdev->dev;
779 
780 	__omap_dm_timer_stop(timer);
781 
782 	pm_runtime_put_sync(dev);
783 
784 	return 0;
785 }
786 
787 static int omap_dm_timer_set_load(struct omap_dm_timer *cookie,
788 				  unsigned int load)
789 {
790 	struct dmtimer *timer;
791 	struct device *dev;
792 	int rc;
793 
794 	timer = to_dmtimer(cookie);
795 	if (unlikely(!timer))
796 		return -EINVAL;
797 
798 	dev = &timer->pdev->dev;
799 	rc = pm_runtime_resume_and_get(dev);
800 	if (rc)
801 		return rc;
802 
803 	dmtimer_write(timer, OMAP_TIMER_LOAD_REG, load);
804 
805 	pm_runtime_put_sync(dev);
806 
807 	return 0;
808 }
809 
810 static int omap_dm_timer_set_match(struct omap_dm_timer *cookie, int enable,
811 				   unsigned int match)
812 {
813 	struct dmtimer *timer;
814 	struct device *dev;
815 	int rc;
816 	u32 l;
817 
818 	timer = to_dmtimer(cookie);
819 	if (unlikely(!timer))
820 		return -EINVAL;
821 
822 	dev = &timer->pdev->dev;
823 	rc = pm_runtime_resume_and_get(dev);
824 	if (rc)
825 		return rc;
826 
827 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
828 	if (enable)
829 		l |= OMAP_TIMER_CTRL_CE;
830 	else
831 		l &= ~OMAP_TIMER_CTRL_CE;
832 	dmtimer_write(timer, OMAP_TIMER_MATCH_REG, match);
833 	dmtimer_write(timer, OMAP_TIMER_CTRL_REG, l);
834 
835 	pm_runtime_put_sync(dev);
836 
837 	return 0;
838 }
839 
840 static int omap_dm_timer_set_pwm(struct omap_dm_timer *cookie, int def_on,
841 				 int toggle, int trigger, int autoreload)
842 {
843 	struct dmtimer *timer;
844 	struct device *dev;
845 	int rc;
846 	u32 l;
847 
848 	timer = to_dmtimer(cookie);
849 	if (unlikely(!timer))
850 		return -EINVAL;
851 
852 	dev = &timer->pdev->dev;
853 	rc = pm_runtime_resume_and_get(dev);
854 	if (rc)
855 		return rc;
856 
857 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
858 	l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
859 	       OMAP_TIMER_CTRL_PT | (0x03 << 10) | OMAP_TIMER_CTRL_AR);
860 	if (def_on)
861 		l |= OMAP_TIMER_CTRL_SCPWM;
862 	if (toggle)
863 		l |= OMAP_TIMER_CTRL_PT;
864 	l |= trigger << 10;
865 	if (autoreload)
866 		l |= OMAP_TIMER_CTRL_AR;
867 	dmtimer_write(timer, OMAP_TIMER_CTRL_REG, l);
868 
869 	pm_runtime_put_sync(dev);
870 
871 	return 0;
872 }
873 
874 static int omap_dm_timer_get_pwm_status(struct omap_dm_timer *cookie)
875 {
876 	struct dmtimer *timer;
877 	struct device *dev;
878 	int rc;
879 	u32 l;
880 
881 	timer = to_dmtimer(cookie);
882 	if (unlikely(!timer))
883 		return -EINVAL;
884 
885 	dev = &timer->pdev->dev;
886 	rc = pm_runtime_resume_and_get(dev);
887 	if (rc)
888 		return rc;
889 
890 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
891 
892 	pm_runtime_put_sync(dev);
893 
894 	return l;
895 }
896 
897 static int omap_dm_timer_set_prescaler(struct omap_dm_timer *cookie,
898 				       int prescaler)
899 {
900 	struct dmtimer *timer;
901 	struct device *dev;
902 	int rc;
903 	u32 l;
904 
905 	timer = to_dmtimer(cookie);
906 	if (unlikely(!timer) || prescaler < -1 || prescaler > 7)
907 		return -EINVAL;
908 
909 	dev = &timer->pdev->dev;
910 	rc = pm_runtime_resume_and_get(dev);
911 	if (rc)
912 		return rc;
913 
914 	l = dmtimer_read(timer, OMAP_TIMER_CTRL_REG);
915 	l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
916 	if (prescaler >= 0) {
917 		l |= OMAP_TIMER_CTRL_PRE;
918 		l |= prescaler << 2;
919 	}
920 	dmtimer_write(timer, OMAP_TIMER_CTRL_REG, l);
921 
922 	pm_runtime_put_sync(dev);
923 
924 	return 0;
925 }
926 
927 static int omap_dm_timer_set_int_enable(struct omap_dm_timer *cookie,
928 					unsigned int value)
929 {
930 	struct dmtimer *timer;
931 	struct device *dev;
932 	int rc;
933 
934 	timer = to_dmtimer(cookie);
935 	if (unlikely(!timer))
936 		return -EINVAL;
937 
938 	dev = &timer->pdev->dev;
939 	rc = pm_runtime_resume_and_get(dev);
940 	if (rc)
941 		return rc;
942 
943 	__omap_dm_timer_int_enable(timer, value);
944 
945 	pm_runtime_put_sync(dev);
946 
947 	return 0;
948 }
949 
950 /**
951  * omap_dm_timer_set_int_disable - disable timer interrupts
952  * @cookie:	pointer to timer cookie
953  * @mask:	bit mask of interrupts to be disabled
954  *
955  * Disables the specified timer interrupts for a timer.
956  */
957 static int omap_dm_timer_set_int_disable(struct omap_dm_timer *cookie, u32 mask)
958 {
959 	struct dmtimer *timer;
960 	struct device *dev;
961 	u32 l = mask;
962 	int rc;
963 
964 	timer = to_dmtimer(cookie);
965 	if (unlikely(!timer))
966 		return -EINVAL;
967 
968 	dev = &timer->pdev->dev;
969 	rc = pm_runtime_resume_and_get(dev);
970 	if (rc)
971 		return rc;
972 
973 	if (timer->revision == 1)
974 		l = dmtimer_read(timer, timer->irq_ena) & ~mask;
975 
976 	dmtimer_write(timer, timer->irq_dis, l);
977 	l = dmtimer_read(timer, OMAP_TIMER_WAKEUP_EN_REG) & ~mask;
978 	dmtimer_write(timer, OMAP_TIMER_WAKEUP_EN_REG, l);
979 
980 	pm_runtime_put_sync(dev);
981 
982 	return 0;
983 }
984 
985 static unsigned int omap_dm_timer_read_status(struct omap_dm_timer *cookie)
986 {
987 	struct dmtimer *timer;
988 	unsigned int l;
989 
990 	timer = to_dmtimer(cookie);
991 	if (unlikely(!timer || !atomic_read(&timer->enabled))) {
992 		pr_err("%s: timer not available or enabled.\n", __func__);
993 		return 0;
994 	}
995 
996 	l = dmtimer_read(timer, timer->irq_stat);
997 
998 	return l;
999 }
1000 
1001 static int omap_dm_timer_write_status(struct omap_dm_timer *cookie, unsigned int value)
1002 {
1003 	struct dmtimer *timer;
1004 
1005 	timer = to_dmtimer(cookie);
1006 	if (unlikely(!timer || !atomic_read(&timer->enabled)))
1007 		return -EINVAL;
1008 
1009 	__omap_dm_timer_write_status(timer, value);
1010 
1011 	return 0;
1012 }
1013 
1014 static unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *cookie)
1015 {
1016 	struct dmtimer *timer;
1017 
1018 	timer = to_dmtimer(cookie);
1019 	if (unlikely(!timer || !atomic_read(&timer->enabled))) {
1020 		pr_err("%s: timer not iavailable or enabled.\n", __func__);
1021 		return 0;
1022 	}
1023 
1024 	return __omap_dm_timer_read_counter(timer);
1025 }
1026 
1027 static int omap_dm_timer_write_counter(struct omap_dm_timer *cookie, unsigned int value)
1028 {
1029 	struct dmtimer *timer;
1030 
1031 	timer = to_dmtimer(cookie);
1032 	if (unlikely(!timer || !atomic_read(&timer->enabled))) {
1033 		pr_err("%s: timer not available or enabled.\n", __func__);
1034 		return -EINVAL;
1035 	}
1036 
1037 	dmtimer_write(timer, OMAP_TIMER_COUNTER_REG, value);
1038 
1039 	/* Save the context */
1040 	timer->context.tcrr = value;
1041 	return 0;
1042 }
1043 
1044 static int __maybe_unused omap_dm_timer_runtime_suspend(struct device *dev)
1045 {
1046 	struct dmtimer *timer = dev_get_drvdata(dev);
1047 
1048 	atomic_set(&timer->enabled, 0);
1049 
1050 	if (timer->capability & OMAP_TIMER_ALWON || !timer->func_base)
1051 		return 0;
1052 
1053 	omap_timer_save_context(timer);
1054 
1055 	return 0;
1056 }
1057 
1058 static int __maybe_unused omap_dm_timer_runtime_resume(struct device *dev)
1059 {
1060 	struct dmtimer *timer = dev_get_drvdata(dev);
1061 
1062 	if (!(timer->capability & OMAP_TIMER_ALWON) && timer->func_base)
1063 		omap_timer_restore_context(timer);
1064 
1065 	atomic_set(&timer->enabled, 1);
1066 
1067 	return 0;
1068 }
1069 
1070 static const struct dev_pm_ops omap_dm_timer_pm_ops = {
1071 	SET_RUNTIME_PM_OPS(omap_dm_timer_runtime_suspend,
1072 			   omap_dm_timer_runtime_resume, NULL)
1073 };
1074 
1075 static const struct of_device_id omap_timer_match[];
1076 
1077 /**
1078  * omap_dm_timer_probe - probe function called for every registered device
1079  * @pdev:	pointer to current timer platform device
1080  *
1081  * Called by driver framework at the end of device registration for all
1082  * timer devices.
1083  */
1084 static int omap_dm_timer_probe(struct platform_device *pdev)
1085 {
1086 	unsigned long flags;
1087 	struct dmtimer *timer;
1088 	struct device *dev = &pdev->dev;
1089 	const struct dmtimer_platform_data *pdata;
1090 	int ret;
1091 
1092 	pdata = of_device_get_match_data(dev);
1093 	if (!pdata)
1094 		pdata = dev_get_platdata(dev);
1095 	else
1096 		dev->platform_data = (void *)pdata;
1097 
1098 	if (!pdata) {
1099 		dev_err(dev, "%s: no platform data.\n", __func__);
1100 		return -ENODEV;
1101 	}
1102 
1103 	timer = devm_kzalloc(dev, sizeof(*timer), GFP_KERNEL);
1104 	if (!timer)
1105 		return  -ENOMEM;
1106 
1107 	timer->irq = platform_get_irq(pdev, 0);
1108 	if (timer->irq < 0)
1109 		return timer->irq;
1110 
1111 	timer->io_base = devm_platform_ioremap_resource(pdev, 0);
1112 	if (IS_ERR(timer->io_base))
1113 		return PTR_ERR(timer->io_base);
1114 
1115 	platform_set_drvdata(pdev, timer);
1116 
1117 	if (dev->of_node) {
1118 		if (of_property_read_bool(dev->of_node, "ti,timer-alwon"))
1119 			timer->capability |= OMAP_TIMER_ALWON;
1120 		if (of_property_read_bool(dev->of_node, "ti,timer-dsp"))
1121 			timer->capability |= OMAP_TIMER_HAS_DSP_IRQ;
1122 		if (of_property_read_bool(dev->of_node, "ti,timer-pwm"))
1123 			timer->capability |= OMAP_TIMER_HAS_PWM;
1124 		if (of_property_read_bool(dev->of_node, "ti,timer-secure"))
1125 			timer->capability |= OMAP_TIMER_SECURE;
1126 	} else {
1127 		timer->id = pdev->id;
1128 		timer->capability = pdata->timer_capability;
1129 		timer->reserved = omap_dm_timer_reserved_systimer(timer->id);
1130 	}
1131 
1132 	timer->omap1 = timer->capability & OMAP_TIMER_NEEDS_RESET;
1133 
1134 	/* OMAP1 devices do not yet use the clock framework for dmtimers */
1135 	if (!timer->omap1) {
1136 		timer->fclk = devm_clk_get(dev, "fck");
1137 		if (IS_ERR(timer->fclk))
1138 			return PTR_ERR(timer->fclk);
1139 
1140 		timer->fclk_nb.notifier_call = omap_timer_fclk_notifier;
1141 		ret = devm_clk_notifier_register(dev, timer->fclk,
1142 						 &timer->fclk_nb);
1143 		if (ret)
1144 			return ret;
1145 
1146 		timer->fclk_rate = clk_get_rate(timer->fclk);
1147 	} else {
1148 		timer->fclk = ERR_PTR(-ENODEV);
1149 	}
1150 
1151 	if (!(timer->capability & OMAP_TIMER_ALWON)) {
1152 		timer->nb.notifier_call = omap_timer_context_notifier;
1153 		cpu_pm_register_notifier(&timer->nb);
1154 	}
1155 
1156 	timer->errata = pdata->timer_errata;
1157 
1158 	timer->pdev = pdev;
1159 
1160 	pm_runtime_enable(dev);
1161 
1162 	if (!timer->reserved) {
1163 		ret = pm_runtime_resume_and_get(dev);
1164 		if (ret) {
1165 			dev_err(dev, "%s: pm_runtime_get_sync failed!\n",
1166 				__func__);
1167 			goto err_disable;
1168 		}
1169 		__omap_dm_timer_init_regs(timer);
1170 
1171 		/* Clear timer configuration */
1172 		dmtimer_write(timer, OMAP_TIMER_CTRL_REG, 0);
1173 
1174 		pm_runtime_put(dev);
1175 	}
1176 
1177 	/* add the timer element to the list */
1178 	spin_lock_irqsave(&dm_timer_lock, flags);
1179 	list_add_tail(&timer->node, &omap_timer_list);
1180 	spin_unlock_irqrestore(&dm_timer_lock, flags);
1181 
1182 	dev_dbg(dev, "Device Probed.\n");
1183 
1184 	return 0;
1185 
1186 err_disable:
1187 	pm_runtime_disable(dev);
1188 	return ret;
1189 }
1190 
1191 /**
1192  * omap_dm_timer_remove - cleanup a registered timer device
1193  * @pdev:	pointer to current timer platform device
1194  *
1195  * Called by driver framework whenever a timer device is unregistered.
1196  * In addition to freeing platform resources it also deletes the timer
1197  * entry from the local list.
1198  */
1199 static void omap_dm_timer_remove(struct platform_device *pdev)
1200 {
1201 	struct dmtimer *timer;
1202 	unsigned long flags;
1203 	int ret = -EINVAL;
1204 
1205 	spin_lock_irqsave(&dm_timer_lock, flags);
1206 	list_for_each_entry(timer, &omap_timer_list, node)
1207 		if (!strcmp(dev_name(&timer->pdev->dev),
1208 			    dev_name(&pdev->dev))) {
1209 			if (!(timer->capability & OMAP_TIMER_ALWON))
1210 				cpu_pm_unregister_notifier(&timer->nb);
1211 			list_del(&timer->node);
1212 			ret = 0;
1213 			break;
1214 		}
1215 	spin_unlock_irqrestore(&dm_timer_lock, flags);
1216 
1217 	pm_runtime_disable(&pdev->dev);
1218 
1219 	if (ret)
1220 		dev_err(&pdev->dev, "Unable to determine timer entry in list of drivers on remove\n");
1221 }
1222 
1223 static const struct omap_dm_timer_ops dmtimer_ops = {
1224 	.request_by_node = omap_dm_timer_request_by_node,
1225 	.request_specific = omap_dm_timer_request_specific,
1226 	.request = omap_dm_timer_request,
1227 	.set_source = omap_dm_timer_set_source,
1228 	.get_irq = omap_dm_timer_get_irq,
1229 	.set_int_enable = omap_dm_timer_set_int_enable,
1230 	.set_int_disable = omap_dm_timer_set_int_disable,
1231 	.free = omap_dm_timer_free,
1232 	.enable = omap_dm_timer_enable,
1233 	.disable = omap_dm_timer_disable,
1234 	.get_fclk = omap_dm_timer_get_fclk,
1235 	.start = omap_dm_timer_start,
1236 	.stop = omap_dm_timer_stop,
1237 	.set_load = omap_dm_timer_set_load,
1238 	.set_match = omap_dm_timer_set_match,
1239 	.set_pwm = omap_dm_timer_set_pwm,
1240 	.get_pwm_status = omap_dm_timer_get_pwm_status,
1241 	.set_prescaler = omap_dm_timer_set_prescaler,
1242 	.read_counter = omap_dm_timer_read_counter,
1243 	.write_counter = omap_dm_timer_write_counter,
1244 	.read_status = omap_dm_timer_read_status,
1245 	.write_status = omap_dm_timer_write_status,
1246 };
1247 
1248 static const struct dmtimer_platform_data omap3plus_pdata = {
1249 	.timer_errata = OMAP_TIMER_ERRATA_I103_I767,
1250 	.timer_ops = &dmtimer_ops,
1251 };
1252 
1253 static const struct dmtimer_platform_data am6_pdata = {
1254 	.timer_ops = &dmtimer_ops,
1255 };
1256 
1257 static const struct of_device_id omap_timer_match[] = {
1258 	{
1259 		.compatible = "ti,omap2420-timer",
1260 	},
1261 	{
1262 		.compatible = "ti,omap3430-timer",
1263 		.data = &omap3plus_pdata,
1264 	},
1265 	{
1266 		.compatible = "ti,omap4430-timer",
1267 		.data = &omap3plus_pdata,
1268 	},
1269 	{
1270 		.compatible = "ti,omap5430-timer",
1271 		.data = &omap3plus_pdata,
1272 	},
1273 	{
1274 		.compatible = "ti,am335x-timer",
1275 		.data = &omap3plus_pdata,
1276 	},
1277 	{
1278 		.compatible = "ti,am335x-timer-1ms",
1279 		.data = &omap3plus_pdata,
1280 	},
1281 	{
1282 		.compatible = "ti,dm816-timer",
1283 		.data = &omap3plus_pdata,
1284 	},
1285 	{
1286 		.compatible = "ti,am654-timer",
1287 		.data = &am6_pdata,
1288 	},
1289 	{},
1290 };
1291 MODULE_DEVICE_TABLE(of, omap_timer_match);
1292 
1293 static struct platform_driver omap_dm_timer_driver = {
1294 	.probe  = omap_dm_timer_probe,
1295 	.remove_new = omap_dm_timer_remove,
1296 	.driver = {
1297 		.name   = "omap_timer",
1298 		.of_match_table = omap_timer_match,
1299 		.pm = &omap_dm_timer_pm_ops,
1300 	},
1301 };
1302 
1303 module_platform_driver(omap_dm_timer_driver);
1304 
1305 MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");
1306 MODULE_AUTHOR("Texas Instruments Inc");
1307