1 // SPDX-License-Identifier: GPL-2.0-only
11 #include <linux/clk.h>
13 #include <linux/clk-provider.h>
17 #include "microchip-isc-regs.h"
18 #include "microchip-isc.h"
23 	struct regmap *regmap = isc_clk->regmap;  in isc_wait_clk_stable()
35 	return -ETIMEDOUT;  in isc_wait_clk_stable()
43 	ret = pm_runtime_resume_and_get(isc_clk->dev);  in isc_clk_prepare()
56 	pm_runtime_put_sync(isc_clk->dev);  in isc_clk_unprepare()
62 	u32 id = isc_clk->id;  in isc_clk_enable()
63 	struct regmap *regmap = isc_clk->regmap;  in isc_clk_enable()
67 	dev_dbg(isc_clk->dev, "ISC CLK: %s, id = %d, div = %d, parent id = %d\n",  in isc_clk_enable()
68 		__func__, id, isc_clk->div, isc_clk->parent_id);  in isc_clk_enable()
70 	spin_lock_irqsave(&isc_clk->lock, flags);  in isc_clk_enable()
73 			   (isc_clk->div << ISC_CLKCFG_DIV_SHIFT(id)) |  in isc_clk_enable()
74 			   (isc_clk->parent_id << ISC_CLKCFG_SEL_SHIFT(id)));  in isc_clk_enable()
77 	spin_unlock_irqrestore(&isc_clk->lock, flags);  in isc_clk_enable()
83 		return -EINVAL;  in isc_clk_enable()
89 	u32 id = isc_clk->id;  in isc_clk_disable()
92 	spin_lock_irqsave(&isc_clk->lock, flags);  in isc_clk_disable()
93 	regmap_write(isc_clk->regmap, ISC_CLKDIS, ISC_CLK(id));  in isc_clk_disable()
94 	spin_unlock_irqrestore(&isc_clk->lock, flags);  in isc_clk_disable()
103 	ret = pm_runtime_resume_and_get(isc_clk->dev);  in isc_clk_is_enabled()
107 	regmap_read(isc_clk->regmap, ISC_CLKSR, &status);  in isc_clk_is_enabled()
109 	pm_runtime_put_sync(isc_clk->dev);  in isc_clk_is_enabled()
111 	return status & ISC_CLK(isc_clk->id) ? 1 : 0;  in isc_clk_is_enabled()
119 	return DIV_ROUND_CLOSEST(parent_rate, isc_clk->div + 1);  in isc_clk_recalc_rate()
126 	long best_rate = -EINVAL;  in isc_clk_determine_rate()
127 	int best_diff = -1;  in isc_clk_determine_rate()
128 	unsigned int i, div;  in isc_clk_determine_rate()  local
142 		for (div = 1; div < ISC_CLK_MAX_DIV + 2; div++) {  in isc_clk_determine_rate()
146 			rate = DIV_ROUND_CLOSEST(parent_rate, div);  in isc_clk_determine_rate()
147 			diff = abs(req->rate - rate);  in isc_clk_determine_rate()
152 				req->best_parent_rate = parent_rate;  in isc_clk_determine_rate()
153 				req->best_parent_hw = parent;  in isc_clk_determine_rate()
156 			if (!best_diff || rate < req->rate)  in isc_clk_determine_rate()
164 	dev_dbg(isc_clk->dev,  in isc_clk_determine_rate()
165 		"ISC CLK: %s, best_rate = %ld, parent clk: %s @ %ld\n",  in isc_clk_determine_rate()
167 		__clk_get_name((req->best_parent_hw)->clk),  in isc_clk_determine_rate()
168 		req->best_parent_rate);  in isc_clk_determine_rate()
173 	req->rate = best_rate;  in isc_clk_determine_rate()
183 		return -EINVAL;  in isc_clk_set_parent()
185 	isc_clk->parent_id = index;  in isc_clk_set_parent()
194 	return isc_clk->parent_id;  in isc_clk_get_parent()
202 	u32 div;  in isc_clk_set_rate()  local
205 		return -EINVAL;  in isc_clk_set_rate()
207 	div = DIV_ROUND_CLOSEST(parent_rate, rate);  in isc_clk_set_rate()
208 	if (div > (ISC_CLK_MAX_DIV + 1) || !div)  in isc_clk_set_rate()
209 		return -EINVAL;  in isc_clk_set_rate()
211 	isc_clk->div = div - 1;  in isc_clk_set_rate()
231 	struct regmap *regmap = isc->regmap;  in isc_clk_register()
232 	struct device_node *np = isc->dev->of_node;  in isc_clk_register()
235 	const char *clk_name = np->name;  in isc_clk_register()
239 	if (id == ISC_ISPCK && !isc->ispck_required)  in isc_clk_register()
244 		return -EINVAL;  in isc_clk_register()
252 		of_property_read_string(np, "clock-output-names", &clk_name);  in isc_clk_register()
254 		clk_name = "isc-ispck";  in isc_clk_register()
262 	isc_clk = &isc->isc_clks[id];  in isc_clk_register()
263 	isc_clk->hw.init	= &init;  in isc_clk_register()
264 	isc_clk->regmap		= regmap;  in isc_clk_register()
265 	isc_clk->id		= id;  in isc_clk_register()
266 	isc_clk->dev		= isc->dev;  in isc_clk_register()
267 	spin_lock_init(&isc_clk->lock);  in isc_clk_register()
269 	isc_clk->clk = clk_register(isc->dev, &isc_clk->hw);  in isc_clk_register()
270 	if (IS_ERR(isc_clk->clk)) {  in isc_clk_register()
271 		dev_err(isc->dev, "%s: clock register fail\n", clk_name);  in isc_clk_register()
272 		return PTR_ERR(isc_clk->clk);  in isc_clk_register()
274 		of_clk_add_provider(np, of_clk_src_simple_get, isc_clk->clk);  in isc_clk_register()
285 	for (i = 0; i < ARRAY_SIZE(isc->isc_clks); i++)  in microchip_isc_clk_init()
286 		isc->isc_clks[i].clk = ERR_PTR(-EINVAL);  in microchip_isc_clk_init()
288 	for (i = 0; i < ARRAY_SIZE(isc->isc_clks); i++) {  in microchip_isc_clk_init()
302 	of_clk_del_provider(isc->dev->of_node);  in microchip_isc_clk_cleanup()
304 	for (i = 0; i < ARRAY_SIZE(isc->isc_clks); i++) {  in microchip_isc_clk_cleanup()
305 		struct isc_clk *isc_clk = &isc->isc_clks[i];  in microchip_isc_clk_cleanup()
307 		if (!IS_ERR(isc_clk->clk))  in microchip_isc_clk_cleanup()
308 			clk_unregister(isc_clk->clk);  in microchip_isc_clk_cleanup()