1 // SPDX-License-Identifier: GPL-2.0
3  * Pistachio clocksource based on general-purpose timers
10 #include <linux/clk.h>
48 	struct clocksource cs;  member
53 #define to_pistachio_clocksource(cs)	\  argument
54 	container_of(cs, struct pistachio_clocksource, cs)
68 pistachio_clocksource_read_cycles(struct clocksource *cs)  in pistachio_clocksource_read_cycles()  argument
70 	struct pistachio_clocksource *pcs = to_pistachio_clocksource(cs);  in pistachio_clocksource_read_cycles()
80 	raw_spin_lock_irqsave(&pcs->lock, flags);  in pistachio_clocksource_read_cycles()
81 	overflow = gpt_readl(pcs->base, TIMER_CURRENT_OVERFLOW_VALUE, 0);  in pistachio_clocksource_read_cycles()
82 	counter = gpt_readl(pcs->base, TIMER_CURRENT_VALUE, 0);  in pistachio_clocksource_read_cycles()
83 	raw_spin_unlock_irqrestore(&pcs->lock, flags);  in pistachio_clocksource_read_cycles()
90 	return pistachio_clocksource_read_cycles(&pcs_gpt.cs);  in pistachio_read_sched_clock()
93 static void pistachio_clksrc_set_mode(struct clocksource *cs, int timeridx,  in pistachio_clksrc_set_mode()  argument
96 	struct pistachio_clocksource *pcs = to_pistachio_clocksource(cs);  in pistachio_clksrc_set_mode()
99 	val = gpt_readl(pcs->base, TIMER_CFG, timeridx);  in pistachio_clksrc_set_mode()
105 	gpt_writel(pcs->base, val, TIMER_CFG, timeridx);  in pistachio_clksrc_set_mode()
108 static void pistachio_clksrc_enable(struct clocksource *cs, int timeridx)  in pistachio_clksrc_enable()  argument
110 	struct pistachio_clocksource *pcs = to_pistachio_clocksource(cs);  in pistachio_clksrc_enable()
113 	pistachio_clksrc_set_mode(cs, timeridx, false);  in pistachio_clksrc_enable()
114 	gpt_writel(pcs->base, RELOAD_VALUE, TIMER_RELOAD_VALUE, timeridx);  in pistachio_clksrc_enable()
115 	pistachio_clksrc_set_mode(cs, timeridx, true);  in pistachio_clksrc_enable()
118 static void pistachio_clksrc_disable(struct clocksource *cs, int timeridx)  in pistachio_clksrc_disable()  argument
121 	pistachio_clksrc_set_mode(cs, timeridx, false);  in pistachio_clksrc_disable()
124 static int pistachio_clocksource_enable(struct clocksource *cs)  in pistachio_clocksource_enable()  argument
126 	pistachio_clksrc_enable(cs, 0);  in pistachio_clocksource_enable()
130 static void pistachio_clocksource_disable(struct clocksource *cs)  in pistachio_clocksource_disable()  argument
132 	pistachio_clksrc_disable(cs, 0);  in pistachio_clocksource_disable()
137 	.cs =	{
151 	struct clk *sys_clk, *fast_clk;  in pistachio_clksrc_of_init()
159 		return -ENXIO;  in pistachio_clksrc_of_init()
162 	periph_regs = syscon_regmap_lookup_by_phandle(node, "img,cr-periph");  in pistachio_clksrc_of_init()
169 	/* Switch to using the fast counter clock */  in pistachio_clksrc_of_init()
189 		pr_err("failed to enable clock (%d)\n", ret);  in pistachio_clksrc_of_init()
195 		pr_err("failed to enable clock (%d)\n", ret);  in pistachio_clksrc_of_init()
213 	return clocksource_register_hz(&pcs_gpt.cs, rate);  in pistachio_clksrc_of_init()
215 TIMER_OF_DECLARE(pistachio_gptimer, "img,pistachio-gptimer",