• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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