Linux Audio

Check our new training course

In-person Linux kernel drivers training

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