Linux Audio

Check our new training course

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