clk/visconti/pll.c

17 #include "pll.h"
56 static void visconti_pll_get_params(struct visconti_pll *pll,
61 	val = readl(pll->pll_base + PLL_FRACMODE_REG);
66 	rate_table->fracin = readl(pll->pll_base + PLL_FRACIN_REG) & PLL_FRACIN_MASK;
67 	rate_table->intin = readl(pll->pll_base + PLL_INTIN_REG) & PLL_INTIN_MASK;
68 	rate_table->refdiv = readl(pll->pll_base + PLL_REFDIV_REG) & PLL_REFDIV_MASK;
70 	postdiv = readl(pll->pll_base + PLL_POSTDIV_REG);
75 static const struct visconti_pll_rate_table *visconti_get_pll_settings(struct visconti_pll *pll,
78 	const struct visconti_pll_rate_table *rate_table = pll->rate_table;
81 	for (i = 0; i < pll->rate_count; i++)
88 static unsigned long visconti_get_pll_rate_from_data(struct visconti_pll *pll,
91 	const struct visconti_pll_rate_table *rate_table = pll->rate_table;
94 	for (i = 0; i < pll->rate_count; i++)
106 	struct visconti_pll *pll = to_visconti_pll(hw);
107 	const struct visconti_pll_rate_table *rate_table = pll->rate_table;
111 	for (i = 0; i < pll->rate_count; i++)
122 	struct visconti_pll *pll = to_visconti_pll(hw);
126 	visconti_pll_get_params(pll, &rate_table);
128 	return visconti_get_pll_rate_from_data(pll, &rate_table);
131 static int visconti_pll_set_params(struct visconti_pll *pll,
134 	writel(PLL_CREATE_FRACMODE(rate_table), pll->pll_base + PLL_FRACMODE_REG);
135 	writel(PLL_CREATE_OSTDIV(rate_table), pll->pll_base + PLL_POSTDIV_REG);
136 	writel(rate_table->intin, pll->pll_base + PLL_INTIN_REG);
137 	writel(rate_table->fracin, pll->pll_base + PLL_FRACIN_REG);
138 	writel(rate_table->refdiv, pll->pll_base + PLL_REFDIV_REG);
146 	struct visconti_pll *pll = to_visconti_pll(hw);
149 	rate_table = visconti_get_pll_settings(pll, rate);
153 	return visconti_pll_set_params(pll, rate_table);
158 	struct visconti_pll *pll = to_visconti_pll(hw);
161 	reg = readl(pll->pll_base + PLL_CTRL_REG);
168 	struct visconti_pll *pll = to_visconti_pll(hw);
169 	const struct visconti_pll_rate_table *rate_table = pll->rate_table;
176 	spin_lock_irqsave(pll->lock, flags);
178 	writel(PLL_CONFIG_SEL, pll->pll_base + PLL_CONF_REG);
180 	reg = readl(pll->pll_base + PLL_CTRL_REG);
182 	writel(reg, pll->pll_base + PLL_CTRL_REG);
184 	visconti_pll_set_params(pll, &rate_table[0]);
186 	reg = readl(pll->pll_base + PLL_CTRL_REG);
188 	writel(reg, pll->pll_base + PLL_CTRL_REG);
192 	reg = readl(pll->pll_base + PLL_CTRL_REG);
194 	writel(reg, pll->pll_base + PLL_CTRL_REG);
198 	reg = readl(pll->pll_base + PLL_CTRL_REG);
200 	writel(reg, pll->pll_base + PLL_CTRL_REG);
202 	spin_unlock_irqrestore(pll->lock, flags);
209 	struct visconti_pll *pll = to_visconti_pll(hw);
216 	spin_lock_irqsave(pll->lock, flags);
218 	writel(PLL_CONFIG_SEL, pll->pll_base + PLL_CONF_REG);
220 	reg = readl(pll->pll_base + PLL_CTRL_REG);
222 	writel(reg, pll->pll_base + PLL_CTRL_REG);
224 	reg = readl(pll->pll_base + PLL_CTRL_REG);
226 	writel(reg, pll->pll_base + PLL_CTRL_REG);
228 	spin_unlock_irqrestore(pll->lock, flags);
248 	struct visconti_pll *pll;
253 	pll = kzalloc(sizeof(*pll), GFP_KERNEL);
254 	if (!pll)
264 	pll->rate_count = len;
265 	pll->rate_table = kmemdup(rate_table,
266 				  pll->rate_count * sizeof(struct visconti_pll_rate_table),
268 	WARN(!pll->rate_table, "%s: could not allocate rate table for %s\n", __func__, name);
271 	pll->hw.init = &init;
272 	pll->pll_base = ctx->reg_base + offset;
273 	pll->lock = lock;
274 	pll->ctx = ctx;
276 	pll_hw_clk = &pll->hw;
277 	ret = clk_hw_register(NULL, &pll->hw);
279 		pr_err("failed to register pll clock %s : %d\n", name, ret);
280 		kfree(pll->rate_table);
281 		kfree(pll);