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