2 * (C) Copyright 2017 Rockchip Electronics Co., Ltd
3 * Author: Andy Yan <andy.yan@rock-chips.com>
4 * (C) Copyright 2017 Theobroma Systems Design und Consulting GmbH
5 * SPDX-License-Identifier: GPL-2.0
9 #include <clk-uclass.h>
13 #include <asm/arch/clock.h>
14 #include <asm/arch/cru_rk3368.h>
15 #include <asm/arch/hardware.h>
18 #include <dt-bindings/clock/rk3368-cru.h>
20 DECLARE_GLOBAL_DATA_PTR;
28 #define OSC_HZ (24 * 1000 * 1000)
29 #define APLL_L_HZ (800 * 1000 * 1000)
30 #define APLL_B_HZ (816 * 1000 * 1000)
31 #define GPLL_HZ (576 * 1000 * 1000)
32 #define CPLL_HZ (400 * 1000 * 1000)
34 #define RATE_TO_DIV(input_rate, output_rate) \
35 ((input_rate) / (output_rate) - 1);
37 #define DIV_TO_RATE(input_rate, div) ((input_rate) / ((div) + 1))
39 #define PLL_DIVISORS(hz, _nr, _no) { \
40 .nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no}; \
41 _Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
42 (_nr * _no) == hz, #hz "Hz cannot be hit with PLL " \
43 "divisors on line " __stringify(__LINE__));
45 static const struct pll_div apll_l_init_cfg = PLL_DIVISORS(APLL_L_HZ, 12, 2);
46 static const struct pll_div apll_b_init_cfg = PLL_DIVISORS(APLL_B_HZ, 1, 2);
47 static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 1, 2);
48 static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 6);
50 /* Get pll rate by id */
51 static uint32_t rkclk_pll_get_rate(struct rk3368_cru *cru,
52 enum rk3368_pll_id pll_id)
56 struct rk3368_pll *pll = &cru->pll[pll_id];
58 con = readl(&pll->con3);
60 switch ((con & PLL_MODE_MASK) >> PLL_MODE_SHIFT) {
64 con = readl(&pll->con0);
65 no = ((con & PLL_OD_MASK) >> PLL_OD_SHIFT) + 1;
66 nr = ((con & PLL_NR_MASK) >> PLL_NR_SHIFT) + 1;
67 con = readl(&pll->con1);
68 nf = ((con & PLL_NF_MASK) >> PLL_NF_SHIFT) + 1;
70 return (24 * nf / (nr * no)) * 1000000;
71 case PLL_MODE_DEEP_SLOW:
77 static int rkclk_set_pll(struct rk3368_cru *cru, enum rk3368_pll_id pll_id,
78 const struct pll_div *div)
80 struct rk3368_pll *pll = &cru->pll[pll_id];
81 /* All PLLs have same VCO and output frequency range restrictions*/
82 uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
83 uint output_hz = vco_hz / div->no;
85 debug("PLL at %p: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
86 pll, div->nf, div->nr, div->no, vco_hz, output_hz);
88 /* enter slow mode and reset pll */
89 rk_clrsetreg(&pll->con3, PLL_MODE_MASK | PLL_RESET_MASK,
90 PLL_RESET << PLL_RESET_SHIFT);
92 rk_clrsetreg(&pll->con0, PLL_NR_MASK | PLL_OD_MASK,
93 ((div->nr - 1) << PLL_NR_SHIFT) |
94 ((div->no - 1) << PLL_OD_SHIFT));
95 writel((div->nf - 1) << PLL_NF_SHIFT, &pll->con1);
97 * BWADJ should be set to NF / 2 to ensure the nominal bandwidth.
98 * Compare the RK3368 TRM, section "3.6.4 PLL Bandwidth Adjustment".
100 clrsetbits_le32(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);
104 /* return from reset */
105 rk_clrreg(&pll->con3, PLL_RESET_MASK);
107 /* waiting for pll lock */
108 while (!(readl(&pll->con1) & PLL_LOCK_STA))
111 rk_clrsetreg(&pll->con3, PLL_MODE_MASK,
112 PLL_MODE_NORMAL << PLL_MODE_SHIFT);
117 static void rkclk_init(struct rk3368_cru *cru)
119 u32 apllb, aplll, dpll, cpll, gpll;
121 rkclk_set_pll(cru, APLLB, &apll_b_init_cfg);
122 rkclk_set_pll(cru, APLLL, &apll_l_init_cfg);
123 rkclk_set_pll(cru, GPLL, &gpll_init_cfg);
124 rkclk_set_pll(cru, CPLL, &cpll_init_cfg);
126 apllb = rkclk_pll_get_rate(cru, APLLB);
127 aplll = rkclk_pll_get_rate(cru, APLLL);
128 dpll = rkclk_pll_get_rate(cru, DPLL);
129 cpll = rkclk_pll_get_rate(cru, CPLL);
130 gpll = rkclk_pll_get_rate(cru, GPLL);
132 debug("%s apllb(%d) apll(%d) dpll(%d) cpll(%d) gpll(%d)\n",
133 __func__, apllb, aplll, dpll, cpll, gpll);
136 static ulong rk3368_mmc_get_clk(struct rk3368_cru *cru, uint clk_id)
138 u32 div, con, con_id, rate;
155 con = readl(&cru->clksel_con[con_id]);
156 switch ((con & MMC_PLL_SEL_MASK) >> MMC_PLL_SEL_SHIFT) {
157 case MMC_PLL_SEL_GPLL:
158 pll_rate = rkclk_pll_get_rate(cru, GPLL);
160 case MMC_PLL_SEL_24M:
163 case MMC_PLL_SEL_CPLL:
164 case MMC_PLL_SEL_USBPHY_480M:
168 div = (con & MMC_CLK_DIV_MASK) >> MMC_CLK_DIV_SHIFT;
169 rate = DIV_TO_RATE(pll_rate, div);
174 static ulong rk3368_mmc_set_clk(struct rk3368_cru *cru,
175 ulong clk_id, ulong rate)
179 u32 gpll_rate = rkclk_pll_get_rate(cru, GPLL);
181 div = RATE_TO_DIV(gpll_rate, rate << 1);
198 div = RATE_TO_DIV(OSC_HZ, rate);
199 rk_clrsetreg(&cru->clksel_con[con_id],
200 MMC_PLL_SEL_MASK | MMC_CLK_DIV_MASK,
201 (MMC_PLL_SEL_24M << MMC_PLL_SEL_SHIFT) |
202 (div << MMC_CLK_DIV_SHIFT));
204 rk_clrsetreg(&cru->clksel_con[con_id],
205 MMC_PLL_SEL_MASK | MMC_CLK_DIV_MASK,
206 (MMC_PLL_SEL_GPLL << MMC_PLL_SEL_SHIFT) |
207 div << MMC_CLK_DIV_SHIFT);
210 return rk3368_mmc_get_clk(cru, clk_id);
213 static ulong rk3368_clk_get_rate(struct clk *clk)
215 struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
218 debug("%s id:%ld\n", __func__, clk->id);
222 rate = rk3368_mmc_get_clk(priv->cru, clk->id);
231 static ulong rk3368_clk_set_rate(struct clk *clk, ulong rate)
233 struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
236 debug("%s id:%ld rate:%ld\n", __func__, clk->id, rate);
240 ret = rk3368_mmc_set_clk(priv->cru, clk->id, rate);
249 static struct clk_ops rk3368_clk_ops = {
250 .get_rate = rk3368_clk_get_rate,
251 .set_rate = rk3368_clk_set_rate,
254 static int rk3368_clk_probe(struct udevice *dev)
256 struct rk3368_clk_priv *priv = dev_get_priv(dev);
258 rkclk_init(priv->cru);
263 static int rk3368_clk_ofdata_to_platdata(struct udevice *dev)
265 struct rk3368_clk_priv *priv = dev_get_priv(dev);
267 priv->cru = (struct rk3368_cru *)devfdt_get_addr(dev);
272 static int rk3368_clk_bind(struct udevice *dev)
276 /* The reset driver does not have a device node, so bind it here */
277 ret = device_bind_driver(gd->dm_root, "rk3368_sysreset", "reset", &dev);
279 error("bind RK3368 reset driver failed: ret=%d\n", ret);
284 static const struct udevice_id rk3368_clk_ids[] = {
285 { .compatible = "rockchip,rk3368-cru" },
289 U_BOOT_DRIVER(rockchip_rk3368_cru) = {
290 .name = "rockchip_rk3368_cru",
292 .of_match = rk3368_clk_ids,
293 .priv_auto_alloc_size = sizeof(struct rk3368_clk_priv),
294 .ofdata_to_platdata = rk3368_clk_ofdata_to_platdata,
295 .ops = &rk3368_clk_ops,
296 .bind = rk3368_clk_bind,
297 .probe = rk3368_clk_probe,