1 // SPDX-License-Identifier: GPL-2.0-only
7 #include <linux/clk-provider.h>
16 #include "clk.h"
27 	const struct zx_pll_config *config = zx_pll->lookup_table;  in rate_to_idx()
30 	for (i = 0; i < zx_pll->count; i++) {  in rate_to_idx()
32 			return i > 0 ? i - 1 : 0;  in rate_to_idx()
38 	return i - 1;  in rate_to_idx()
43 	const struct zx_pll_config *config = zx_pll->lookup_table;  in hw_to_idx()
47 	hw_cfg0 = readl_relaxed(zx_pll->reg_base);  in hw_to_idx()
48 	hw_cfg1 = readl_relaxed(zx_pll->reg_base + CFG0_CFG1_OFFSET);  in hw_to_idx()
51 	hw_cfg0 &= ~BIT(zx_pll->lock_bit);  in hw_to_idx()
54 	if (zx_pll->pd_bit < 32)  in hw_to_idx()
55 		hw_cfg0 |= BIT(zx_pll->pd_bit);  in hw_to_idx()
57 	for (i = 0; i < zx_pll->count; i++) {  in hw_to_idx()
62 	return -EINVAL;  in hw_to_idx()
72 	if (unlikely(idx == -EINVAL))  in zx_pll_recalc_rate()
75 	return zx_pll->lookup_table[idx].rate;  in zx_pll_recalc_rate()
86 	return zx_pll->lookup_table[idx].rate;  in zx_pll_round_rate()
98 	config = &zx_pll->lookup_table[idx];  in zx_pll_set_rate()
100 	writel_relaxed(config->cfg0, zx_pll->reg_base);  in zx_pll_set_rate()
101 	writel_relaxed(config->cfg1, zx_pll->reg_base + CFG0_CFG1_OFFSET);  in zx_pll_set_rate()
112 	if (zx_pll->pd_bit > 31)  in zx_pll_enable()
115 	reg = readl_relaxed(zx_pll->reg_base);  in zx_pll_enable()
116 	writel_relaxed(reg & ~BIT(zx_pll->pd_bit), zx_pll->reg_base);  in zx_pll_enable()
118 	return readl_relaxed_poll_timeout(zx_pll->reg_base, reg,  in zx_pll_enable()
119 					  reg & BIT(zx_pll->lock_bit), 0, 100);  in zx_pll_enable()
127 	if (zx_pll->pd_bit > 31)  in zx_pll_disable()
130 	reg = readl_relaxed(zx_pll->reg_base);  in zx_pll_disable()
131 	writel_relaxed(reg | BIT(zx_pll->pd_bit), zx_pll->reg_base);  in zx_pll_disable()
139 	reg = readl_relaxed(zx_pll->reg_base);  in zx_pll_is_enabled()
141 	return !(reg & BIT(zx_pll->pd_bit));  in zx_pll_is_enabled()
154 struct clk *clk_register_zx_pll(const char *name, const char *parent_name,  in clk_register_zx_pll()
160 	struct clk *clk;  in clk_register_zx_pll()  local
165 		return ERR_PTR(-ENOMEM);  in clk_register_zx_pll()
173 	zx_pll->reg_base = reg_base;  in clk_register_zx_pll()
174 	zx_pll->lookup_table = lookup_table;  in clk_register_zx_pll()
175 	zx_pll->count = count;  in clk_register_zx_pll()
176 	zx_pll->lock_bit = LOCK_FLAG;  in clk_register_zx_pll()
177 	zx_pll->pd_bit = POWER_DOWN;  in clk_register_zx_pll()
178 	zx_pll->lock = lock;  in clk_register_zx_pll()
179 	zx_pll->hw.init = &init;  in clk_register_zx_pll()
181 	clk = clk_register(NULL, &zx_pll->hw);  in clk_register_zx_pll()
182 	if (IS_ERR(clk))  in clk_register_zx_pll()
185 	return clk;  in clk_register_zx_pll()
191 	u32 sel, integ, fra_div, tmp;  in calc_reg()  local
199 	sel = tmp / BPAR;  in calc_reg()
203 	tmp = (sel << 24) | (integ << 16) | (0xff << 8) | fra_div;  in calc_reg()
214 	u32 sel, integ, fra_div, tmp;  in calc_rate()  local
218 	sel = (tmp >> 24) & BIT(0);  in calc_rate()
224 	tmp += sel * BPAR;  in calc_rate()
237 	reg = readl_relaxed(zx_audio->reg_base);  in zx_audio_recalc_rate()
247 		return -EINVAL;  in zx_audio_round_rate()
260 	writel_relaxed(reg, zx_audio->reg_base);  in zx_audio_set_rate()
271 	reg = readl_relaxed(zx_audio->reg_base);  in zx_audio_enable()
272 	writel_relaxed(reg & ~ZX_AUDIO_EN, zx_audio->reg_base);  in zx_audio_enable()
281 	reg = readl_relaxed(zx_audio->reg_base);  in zx_audio_disable()
282 	writel_relaxed(reg | ZX_AUDIO_EN, zx_audio->reg_base);  in zx_audio_disable()
293 struct clk *clk_register_zx_audio(const char *name,  in clk_register_zx_audio()
299 	struct clk *clk;  in clk_register_zx_audio()  local
304 		return ERR_PTR(-ENOMEM);  in clk_register_zx_audio()
312 	zx_audio->reg_base = reg_base;  in clk_register_zx_audio()
313 	zx_audio->hw.init = &init;  in clk_register_zx_audio()
315 	clk = clk_register(NULL, &zx_audio->hw);  in clk_register_zx_audio()
316 	if (IS_ERR(clk))  in clk_register_zx_audio()
319 	return clk;  in clk_register_zx_audio()
369 	m = parent_rate - rate * reg_int;  in audio_calc_reg()
387 	div_table->rate = parent_rate * n / (reg_int * n + m);  in audio_calc_reg()
388 	div_table->int_reg = reg_int;  in audio_calc_reg()
389 	div_table->frac_reg = reg_frac;  in audio_calc_reg()
398 	reg_frac = readl_relaxed(zx_audio_div->reg_base);  in zx_audio_div_recalc_rate()
399 	reg_int = readl_relaxed(zx_audio_div->reg_base + 0x4);  in zx_audio_div_recalc_rate()
426 	writel_relaxed(divt.frac_reg, zx_audio_div->reg_base);  in zx_audio_div_set_rate()
428 	val = readl_relaxed(zx_audio_div->reg_base + 0x4);  in zx_audio_div_set_rate()
431 	writel_relaxed(val, zx_audio_div->reg_base + 0x4);  in zx_audio_div_set_rate()
435 	val = readl_relaxed(zx_audio_div->reg_base + 0x4);  in zx_audio_div_set_rate()
437 	writel_relaxed(val, zx_audio_div->reg_base + 0x4);  in zx_audio_div_set_rate()