1caab277bSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-only
2f76ee892STomi Valkeinen /*
3f76ee892STomi Valkeinen * Copyright (C) 2014 Texas Instruments Incorporated
4f76ee892STomi Valkeinen */
5f76ee892STomi Valkeinen
6f76ee892STomi Valkeinen #define DSS_SUBSYS_NAME "PLL"
7f76ee892STomi Valkeinen
8f76ee892STomi Valkeinen #include <linux/clk.h>
9f76ee892STomi Valkeinen #include <linux/io.h>
10f76ee892STomi Valkeinen #include <linux/kernel.h>
11f76ee892STomi Valkeinen #include <linux/regulator/consumer.h>
12f76ee892STomi Valkeinen #include <linux/sched.h>
13f76ee892STomi Valkeinen
1462d9e44eSPeter Ujfalusi #include <video/omapfb_dss.h>
15f76ee892STomi Valkeinen
16f76ee892STomi Valkeinen #include "dss.h"
17f76ee892STomi Valkeinen
18f76ee892STomi Valkeinen #define PLL_CONTROL 0x0000
19f76ee892STomi Valkeinen #define PLL_STATUS 0x0004
20f76ee892STomi Valkeinen #define PLL_GO 0x0008
21f76ee892STomi Valkeinen #define PLL_CONFIGURATION1 0x000C
22f76ee892STomi Valkeinen #define PLL_CONFIGURATION2 0x0010
23f76ee892STomi Valkeinen #define PLL_CONFIGURATION3 0x0014
24f76ee892STomi Valkeinen #define PLL_SSC_CONFIGURATION1 0x0018
25f76ee892STomi Valkeinen #define PLL_SSC_CONFIGURATION2 0x001C
26f76ee892STomi Valkeinen #define PLL_CONFIGURATION4 0x0020
27f76ee892STomi Valkeinen
28f76ee892STomi Valkeinen static struct dss_pll *dss_plls[4];
29f76ee892STomi Valkeinen
dss_pll_register(struct dss_pll * pll)30f76ee892STomi Valkeinen int dss_pll_register(struct dss_pll *pll)
31f76ee892STomi Valkeinen {
32f76ee892STomi Valkeinen int i;
33f76ee892STomi Valkeinen
34f76ee892STomi Valkeinen for (i = 0; i < ARRAY_SIZE(dss_plls); ++i) {
35f76ee892STomi Valkeinen if (!dss_plls[i]) {
36f76ee892STomi Valkeinen dss_plls[i] = pll;
37f76ee892STomi Valkeinen return 0;
38f76ee892STomi Valkeinen }
39f76ee892STomi Valkeinen }
40f76ee892STomi Valkeinen
41f76ee892STomi Valkeinen return -EBUSY;
42f76ee892STomi Valkeinen }
43f76ee892STomi Valkeinen
dss_pll_unregister(struct dss_pll * pll)44f76ee892STomi Valkeinen void dss_pll_unregister(struct dss_pll *pll)
45f76ee892STomi Valkeinen {
46f76ee892STomi Valkeinen int i;
47f76ee892STomi Valkeinen
48f76ee892STomi Valkeinen for (i = 0; i < ARRAY_SIZE(dss_plls); ++i) {
49f76ee892STomi Valkeinen if (dss_plls[i] == pll) {
50f76ee892STomi Valkeinen dss_plls[i] = NULL;
51f76ee892STomi Valkeinen return;
52f76ee892STomi Valkeinen }
53f76ee892STomi Valkeinen }
54f76ee892STomi Valkeinen }
55f76ee892STomi Valkeinen
dss_pll_find(const char * name)56f76ee892STomi Valkeinen struct dss_pll *dss_pll_find(const char *name)
57f76ee892STomi Valkeinen {
58f76ee892STomi Valkeinen int i;
59f76ee892STomi Valkeinen
60f76ee892STomi Valkeinen for (i = 0; i < ARRAY_SIZE(dss_plls); ++i) {
61f76ee892STomi Valkeinen if (dss_plls[i] && strcmp(dss_plls[i]->name, name) == 0)
62f76ee892STomi Valkeinen return dss_plls[i];
63f76ee892STomi Valkeinen }
64f76ee892STomi Valkeinen
65f76ee892STomi Valkeinen return NULL;
66f76ee892STomi Valkeinen }
67f76ee892STomi Valkeinen
dss_pll_enable(struct dss_pll * pll)68f76ee892STomi Valkeinen int dss_pll_enable(struct dss_pll *pll)
69f76ee892STomi Valkeinen {
70f76ee892STomi Valkeinen int r;
71f76ee892STomi Valkeinen
72f76ee892STomi Valkeinen r = clk_prepare_enable(pll->clkin);
73f76ee892STomi Valkeinen if (r)
74f76ee892STomi Valkeinen return r;
75f76ee892STomi Valkeinen
76f76ee892STomi Valkeinen if (pll->regulator) {
77f76ee892STomi Valkeinen r = regulator_enable(pll->regulator);
78f76ee892STomi Valkeinen if (r)
79f76ee892STomi Valkeinen goto err_reg;
80f76ee892STomi Valkeinen }
81f76ee892STomi Valkeinen
82f76ee892STomi Valkeinen r = pll->ops->enable(pll);
83f76ee892STomi Valkeinen if (r)
84f76ee892STomi Valkeinen goto err_enable;
85f76ee892STomi Valkeinen
86f76ee892STomi Valkeinen return 0;
87f76ee892STomi Valkeinen
88f76ee892STomi Valkeinen err_enable:
89f76ee892STomi Valkeinen if (pll->regulator)
90f76ee892STomi Valkeinen regulator_disable(pll->regulator);
91f76ee892STomi Valkeinen err_reg:
92f76ee892STomi Valkeinen clk_disable_unprepare(pll->clkin);
93f76ee892STomi Valkeinen return r;
94f76ee892STomi Valkeinen }
95f76ee892STomi Valkeinen
dss_pll_disable(struct dss_pll * pll)96f76ee892STomi Valkeinen void dss_pll_disable(struct dss_pll *pll)
97f76ee892STomi Valkeinen {
98f76ee892STomi Valkeinen pll->ops->disable(pll);
99f76ee892STomi Valkeinen
100f76ee892STomi Valkeinen if (pll->regulator)
101f76ee892STomi Valkeinen regulator_disable(pll->regulator);
102f76ee892STomi Valkeinen
103f76ee892STomi Valkeinen clk_disable_unprepare(pll->clkin);
104f76ee892STomi Valkeinen
105f76ee892STomi Valkeinen memset(&pll->cinfo, 0, sizeof(pll->cinfo));
106f76ee892STomi Valkeinen }
107f76ee892STomi Valkeinen
dss_pll_set_config(struct dss_pll * pll,const struct dss_pll_clock_info * cinfo)108f76ee892STomi Valkeinen int dss_pll_set_config(struct dss_pll *pll, const struct dss_pll_clock_info *cinfo)
109f76ee892STomi Valkeinen {
110f76ee892STomi Valkeinen int r;
111f76ee892STomi Valkeinen
112f76ee892STomi Valkeinen r = pll->ops->set_config(pll, cinfo);
113f76ee892STomi Valkeinen if (r)
114f76ee892STomi Valkeinen return r;
115f76ee892STomi Valkeinen
116f76ee892STomi Valkeinen pll->cinfo = *cinfo;
117f76ee892STomi Valkeinen
118f76ee892STomi Valkeinen return 0;
119f76ee892STomi Valkeinen }
120f76ee892STomi Valkeinen
dss_pll_hsdiv_calc(const struct dss_pll * pll,unsigned long clkdco,unsigned long out_min,unsigned long out_max,dss_hsdiv_calc_func func,void * data)121f76ee892STomi Valkeinen bool dss_pll_hsdiv_calc(const struct dss_pll *pll, unsigned long clkdco,
122f76ee892STomi Valkeinen unsigned long out_min, unsigned long out_max,
123f76ee892STomi Valkeinen dss_hsdiv_calc_func func, void *data)
124f76ee892STomi Valkeinen {
125f76ee892STomi Valkeinen const struct dss_pll_hw *hw = pll->hw;
126f76ee892STomi Valkeinen int m, m_start, m_stop;
127f76ee892STomi Valkeinen unsigned long out;
128f76ee892STomi Valkeinen
129f76ee892STomi Valkeinen out_min = out_min ? out_min : 1;
130f76ee892STomi Valkeinen out_max = out_max ? out_max : ULONG_MAX;
131f76ee892STomi Valkeinen
132f76ee892STomi Valkeinen m_start = max(DIV_ROUND_UP(clkdco, out_max), 1ul);
133f76ee892STomi Valkeinen
134f76ee892STomi Valkeinen m_stop = min((unsigned)(clkdco / out_min), hw->mX_max);
135f76ee892STomi Valkeinen
136f76ee892STomi Valkeinen for (m = m_start; m <= m_stop; ++m) {
137f76ee892STomi Valkeinen out = clkdco / m;
138f76ee892STomi Valkeinen
139f76ee892STomi Valkeinen if (func(m, out, data))
140f76ee892STomi Valkeinen return true;
141f76ee892STomi Valkeinen }
142f76ee892STomi Valkeinen
143f76ee892STomi Valkeinen return false;
144f76ee892STomi Valkeinen }
145f76ee892STomi Valkeinen
dss_pll_calc(const struct dss_pll * pll,unsigned long clkin,unsigned long pll_min,unsigned long pll_max,dss_pll_calc_func func,void * data)146f76ee892STomi Valkeinen bool dss_pll_calc(const struct dss_pll *pll, unsigned long clkin,
147f76ee892STomi Valkeinen unsigned long pll_min, unsigned long pll_max,
148f76ee892STomi Valkeinen dss_pll_calc_func func, void *data)
149f76ee892STomi Valkeinen {
150f76ee892STomi Valkeinen const struct dss_pll_hw *hw = pll->hw;
151f76ee892STomi Valkeinen int n, n_start, n_stop;
152f76ee892STomi Valkeinen int m, m_start, m_stop;
153f76ee892STomi Valkeinen unsigned long fint, clkdco;
154f76ee892STomi Valkeinen unsigned long pll_hw_max;
155f76ee892STomi Valkeinen unsigned long fint_hw_min, fint_hw_max;
156f76ee892STomi Valkeinen
157f76ee892STomi Valkeinen pll_hw_max = hw->clkdco_max;
158f76ee892STomi Valkeinen
159f76ee892STomi Valkeinen fint_hw_min = hw->fint_min;
160f76ee892STomi Valkeinen fint_hw_max = hw->fint_max;
161f76ee892STomi Valkeinen
162f76ee892STomi Valkeinen n_start = max(DIV_ROUND_UP(clkin, fint_hw_max), 1ul);
163f76ee892STomi Valkeinen n_stop = min((unsigned)(clkin / fint_hw_min), hw->n_max);
164f76ee892STomi Valkeinen
165f76ee892STomi Valkeinen pll_max = pll_max ? pll_max : ULONG_MAX;
166f76ee892STomi Valkeinen
167f76ee892STomi Valkeinen for (n = n_start; n <= n_stop; ++n) {
168f76ee892STomi Valkeinen fint = clkin / n;
169f76ee892STomi Valkeinen
170f76ee892STomi Valkeinen m_start = max(DIV_ROUND_UP(DIV_ROUND_UP(pll_min, fint), 2),
171f76ee892STomi Valkeinen 1ul);
172f76ee892STomi Valkeinen m_stop = min3((unsigned)(pll_max / fint / 2),
173f76ee892STomi Valkeinen (unsigned)(pll_hw_max / fint / 2),
174f76ee892STomi Valkeinen hw->m_max);
175f76ee892STomi Valkeinen
176f76ee892STomi Valkeinen for (m = m_start; m <= m_stop; ++m) {
177f76ee892STomi Valkeinen clkdco = 2 * m * fint;
178f76ee892STomi Valkeinen
179f76ee892STomi Valkeinen if (func(n, m, fint, clkdco, data))
180f76ee892STomi Valkeinen return true;
181f76ee892STomi Valkeinen }
182f76ee892STomi Valkeinen }
183f76ee892STomi Valkeinen
184f76ee892STomi Valkeinen return false;
185f76ee892STomi Valkeinen }
186f76ee892STomi Valkeinen
wait_for_bit_change(void __iomem * reg,int bitnum,int value)187f76ee892STomi Valkeinen static int wait_for_bit_change(void __iomem *reg, int bitnum, int value)
188f76ee892STomi Valkeinen {
189f76ee892STomi Valkeinen unsigned long timeout;
190f76ee892STomi Valkeinen ktime_t wait;
191f76ee892STomi Valkeinen int t;
192f76ee892STomi Valkeinen
193f76ee892STomi Valkeinen /* first busyloop to see if the bit changes right away */
194f76ee892STomi Valkeinen t = 100;
195f76ee892STomi Valkeinen while (t-- > 0) {
196f76ee892STomi Valkeinen if (FLD_GET(readl_relaxed(reg), bitnum, bitnum) == value)
197f76ee892STomi Valkeinen return value;
198f76ee892STomi Valkeinen }
199f76ee892STomi Valkeinen
200f76ee892STomi Valkeinen /* then loop for 500ms, sleeping for 1ms in between */
201f76ee892STomi Valkeinen timeout = jiffies + msecs_to_jiffies(500);
202f76ee892STomi Valkeinen while (time_before(jiffies, timeout)) {
203f76ee892STomi Valkeinen if (FLD_GET(readl_relaxed(reg), bitnum, bitnum) == value)
204f76ee892STomi Valkeinen return value;
205f76ee892STomi Valkeinen
206f76ee892STomi Valkeinen wait = ns_to_ktime(1000 * 1000);
207f76ee892STomi Valkeinen set_current_state(TASK_UNINTERRUPTIBLE);
208f76ee892STomi Valkeinen schedule_hrtimeout(&wait, HRTIMER_MODE_REL);
209f76ee892STomi Valkeinen }
210f76ee892STomi Valkeinen
211f76ee892STomi Valkeinen return !value;
212f76ee892STomi Valkeinen }
213f76ee892STomi Valkeinen
dss_pll_wait_reset_done(struct dss_pll * pll)214f76ee892STomi Valkeinen int dss_pll_wait_reset_done(struct dss_pll *pll)
215f76ee892STomi Valkeinen {
216f76ee892STomi Valkeinen void __iomem *base = pll->base;
217f76ee892STomi Valkeinen
218f76ee892STomi Valkeinen if (wait_for_bit_change(base + PLL_STATUS, 0, 1) != 1)
219f76ee892STomi Valkeinen return -ETIMEDOUT;
220f76ee892STomi Valkeinen else
221f76ee892STomi Valkeinen return 0;
222f76ee892STomi Valkeinen }
223f76ee892STomi Valkeinen
dss_wait_hsdiv_ack(struct dss_pll * pll,u32 hsdiv_ack_mask)224f76ee892STomi Valkeinen static int dss_wait_hsdiv_ack(struct dss_pll *pll, u32 hsdiv_ack_mask)
225f76ee892STomi Valkeinen {
226f76ee892STomi Valkeinen int t = 100;
227f76ee892STomi Valkeinen
228f76ee892STomi Valkeinen while (t-- > 0) {
229f76ee892STomi Valkeinen u32 v = readl_relaxed(pll->base + PLL_STATUS);
230f76ee892STomi Valkeinen v &= hsdiv_ack_mask;
231f76ee892STomi Valkeinen if (v == hsdiv_ack_mask)
232f76ee892STomi Valkeinen return 0;
233f76ee892STomi Valkeinen }
234f76ee892STomi Valkeinen
235f76ee892STomi Valkeinen return -ETIMEDOUT;
236f76ee892STomi Valkeinen }
237f76ee892STomi Valkeinen
dss_pll_write_config_type_a(struct dss_pll * pll,const struct dss_pll_clock_info * cinfo)238f76ee892STomi Valkeinen int dss_pll_write_config_type_a(struct dss_pll *pll,
239f76ee892STomi Valkeinen const struct dss_pll_clock_info *cinfo)
240f76ee892STomi Valkeinen {
241f76ee892STomi Valkeinen const struct dss_pll_hw *hw = pll->hw;
242f76ee892STomi Valkeinen void __iomem *base = pll->base;
243f76ee892STomi Valkeinen int r = 0;
244f76ee892STomi Valkeinen u32 l;
245f76ee892STomi Valkeinen
246f76ee892STomi Valkeinen l = 0;
247f76ee892STomi Valkeinen if (hw->has_stopmode)
248f76ee892STomi Valkeinen l = FLD_MOD(l, 1, 0, 0); /* PLL_STOPMODE */
249f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->n - 1, hw->n_msb, hw->n_lsb); /* PLL_REGN */
250f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->m, hw->m_msb, hw->m_lsb); /* PLL_REGM */
251f76ee892STomi Valkeinen /* M4 */
252f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[0] ? cinfo->mX[0] - 1 : 0,
253f76ee892STomi Valkeinen hw->mX_msb[0], hw->mX_lsb[0]);
254f76ee892STomi Valkeinen /* M5 */
255f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[1] ? cinfo->mX[1] - 1 : 0,
256f76ee892STomi Valkeinen hw->mX_msb[1], hw->mX_lsb[1]);
257f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION1);
258f76ee892STomi Valkeinen
259f76ee892STomi Valkeinen l = 0;
260f76ee892STomi Valkeinen /* M6 */
261f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[2] ? cinfo->mX[2] - 1 : 0,
262f76ee892STomi Valkeinen hw->mX_msb[2], hw->mX_lsb[2]);
263f76ee892STomi Valkeinen /* M7 */
264f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[3] ? cinfo->mX[3] - 1 : 0,
265f76ee892STomi Valkeinen hw->mX_msb[3], hw->mX_lsb[3]);
266f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION3);
267f76ee892STomi Valkeinen
268f76ee892STomi Valkeinen l = readl_relaxed(base + PLL_CONFIGURATION2);
269f76ee892STomi Valkeinen if (hw->has_freqsel) {
270f76ee892STomi Valkeinen u32 f = cinfo->fint < 1000000 ? 0x3 :
271f76ee892STomi Valkeinen cinfo->fint < 1250000 ? 0x4 :
272f76ee892STomi Valkeinen cinfo->fint < 1500000 ? 0x5 :
273f76ee892STomi Valkeinen cinfo->fint < 1750000 ? 0x6 :
274f76ee892STomi Valkeinen 0x7;
275f76ee892STomi Valkeinen
276f76ee892STomi Valkeinen l = FLD_MOD(l, f, 4, 1); /* PLL_FREQSEL */
277f76ee892STomi Valkeinen } else if (hw->has_selfreqdco) {
278f76ee892STomi Valkeinen u32 f = cinfo->clkdco < hw->clkdco_low ? 0x2 : 0x4;
279f76ee892STomi Valkeinen
280f76ee892STomi Valkeinen l = FLD_MOD(l, f, 3, 1); /* PLL_SELFREQDCO */
281f76ee892STomi Valkeinen }
282f76ee892STomi Valkeinen l = FLD_MOD(l, 1, 13, 13); /* PLL_REFEN */
283f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 14, 14); /* PHY_CLKINEN */
284f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 16, 16); /* M4_CLOCK_EN */
285f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 18, 18); /* M5_CLOCK_EN */
286f76ee892STomi Valkeinen l = FLD_MOD(l, 1, 20, 20); /* HSDIVBYPASS */
287f76ee892STomi Valkeinen if (hw->has_refsel)
288f76ee892STomi Valkeinen l = FLD_MOD(l, 3, 22, 21); /* REFSEL = sysclk */
289f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 23, 23); /* M6_CLOCK_EN */
290f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 25, 25); /* M7_CLOCK_EN */
291f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION2);
292f76ee892STomi Valkeinen
293f76ee892STomi Valkeinen writel_relaxed(1, base + PLL_GO); /* PLL_GO */
294f76ee892STomi Valkeinen
295f76ee892STomi Valkeinen if (wait_for_bit_change(base + PLL_GO, 0, 0) != 0) {
296f76ee892STomi Valkeinen DSSERR("DSS DPLL GO bit not going down.\n");
297f76ee892STomi Valkeinen r = -EIO;
298f76ee892STomi Valkeinen goto err;
299f76ee892STomi Valkeinen }
300f76ee892STomi Valkeinen
301f76ee892STomi Valkeinen if (wait_for_bit_change(base + PLL_STATUS, 1, 1) != 1) {
302f76ee892STomi Valkeinen DSSERR("cannot lock DSS DPLL\n");
303f76ee892STomi Valkeinen r = -EIO;
304f76ee892STomi Valkeinen goto err;
305f76ee892STomi Valkeinen }
306f76ee892STomi Valkeinen
307f76ee892STomi Valkeinen l = readl_relaxed(base + PLL_CONFIGURATION2);
308f76ee892STomi Valkeinen l = FLD_MOD(l, 1, 14, 14); /* PHY_CLKINEN */
309f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[0] ? 1 : 0, 16, 16); /* M4_CLOCK_EN */
310f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[1] ? 1 : 0, 18, 18); /* M5_CLOCK_EN */
311f76ee892STomi Valkeinen l = FLD_MOD(l, 0, 20, 20); /* HSDIVBYPASS */
312f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[2] ? 1 : 0, 23, 23); /* M6_CLOCK_EN */
313f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[3] ? 1 : 0, 25, 25); /* M7_CLOCK_EN */
314f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION2);
315f76ee892STomi Valkeinen
316f76ee892STomi Valkeinen r = dss_wait_hsdiv_ack(pll,
317f76ee892STomi Valkeinen (cinfo->mX[0] ? BIT(7) : 0) |
318f76ee892STomi Valkeinen (cinfo->mX[1] ? BIT(8) : 0) |
319f76ee892STomi Valkeinen (cinfo->mX[2] ? BIT(10) : 0) |
320f76ee892STomi Valkeinen (cinfo->mX[3] ? BIT(11) : 0));
321f76ee892STomi Valkeinen if (r) {
322f76ee892STomi Valkeinen DSSERR("failed to enable HSDIV clocks\n");
323f76ee892STomi Valkeinen goto err;
324f76ee892STomi Valkeinen }
325f76ee892STomi Valkeinen
326f76ee892STomi Valkeinen err:
327f76ee892STomi Valkeinen return r;
328f76ee892STomi Valkeinen }
329f76ee892STomi Valkeinen
dss_pll_write_config_type_b(struct dss_pll * pll,const struct dss_pll_clock_info * cinfo)330f76ee892STomi Valkeinen int dss_pll_write_config_type_b(struct dss_pll *pll,
331f76ee892STomi Valkeinen const struct dss_pll_clock_info *cinfo)
332f76ee892STomi Valkeinen {
333f76ee892STomi Valkeinen const struct dss_pll_hw *hw = pll->hw;
334f76ee892STomi Valkeinen void __iomem *base = pll->base;
335f76ee892STomi Valkeinen u32 l;
336f76ee892STomi Valkeinen
337f76ee892STomi Valkeinen l = 0;
338f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->m, 20, 9); /* PLL_REGM */
339f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->n - 1, 8, 1); /* PLL_REGN */
340f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION1);
341f76ee892STomi Valkeinen
342f76ee892STomi Valkeinen l = readl_relaxed(base + PLL_CONFIGURATION2);
343f76ee892STomi Valkeinen l = FLD_MOD(l, 0x0, 12, 12); /* PLL_HIGHFREQ divide by 2 */
344f76ee892STomi Valkeinen l = FLD_MOD(l, 0x1, 13, 13); /* PLL_REFEN */
345f76ee892STomi Valkeinen l = FLD_MOD(l, 0x0, 14, 14); /* PHY_CLKINEN */
346f76ee892STomi Valkeinen if (hw->has_refsel)
347f76ee892STomi Valkeinen l = FLD_MOD(l, 0x3, 22, 21); /* REFSEL = SYSCLK */
348f76ee892STomi Valkeinen
349f76ee892STomi Valkeinen /* PLL_SELFREQDCO */
350f76ee892STomi Valkeinen if (cinfo->clkdco > hw->clkdco_low)
351f76ee892STomi Valkeinen l = FLD_MOD(l, 0x4, 3, 1);
352f76ee892STomi Valkeinen else
353f76ee892STomi Valkeinen l = FLD_MOD(l, 0x2, 3, 1);
354f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION2);
355f76ee892STomi Valkeinen
356f76ee892STomi Valkeinen l = readl_relaxed(base + PLL_CONFIGURATION3);
357f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->sd, 17, 10); /* PLL_REGSD */
358f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION3);
359f76ee892STomi Valkeinen
360f76ee892STomi Valkeinen l = readl_relaxed(base + PLL_CONFIGURATION4);
361f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mX[0], 24, 18); /* PLL_REGM2 */
362f76ee892STomi Valkeinen l = FLD_MOD(l, cinfo->mf, 17, 0); /* PLL_REGM_F */
363f76ee892STomi Valkeinen writel_relaxed(l, base + PLL_CONFIGURATION4);
364f76ee892STomi Valkeinen
365f76ee892STomi Valkeinen writel_relaxed(1, base + PLL_GO); /* PLL_GO */
366f76ee892STomi Valkeinen
367f76ee892STomi Valkeinen if (wait_for_bit_change(base + PLL_GO, 0, 0) != 0) {
368f76ee892STomi Valkeinen DSSERR("DSS DPLL GO bit not going down.\n");
369f76ee892STomi Valkeinen return -EIO;
370f76ee892STomi Valkeinen }
371f76ee892STomi Valkeinen
372f76ee892STomi Valkeinen if (wait_for_bit_change(base + PLL_STATUS, 1, 1) != 1) {
373f76ee892STomi Valkeinen DSSERR("cannot lock DSS DPLL\n");
374f76ee892STomi Valkeinen return -ETIMEDOUT;
375f76ee892STomi Valkeinen }
376f76ee892STomi Valkeinen
377f76ee892STomi Valkeinen return 0;
378f76ee892STomi Valkeinen }
379