]>
Commit | Line | Data |
---|---|---|
bae2f282 AY |
1 | /* |
2 | * (C) Copyright 2016 Rockchip Electronics Co., Ltd | |
3 | * Author: Andy Yan <andy.yan@rock-chips.com> | |
4 | * SPDX-License-Identifier: GPL-2.0 | |
5 | */ | |
6 | ||
7 | #include <common.h> | |
2e4ce50d | 8 | #include <bitfield.h> |
bae2f282 AY |
9 | #include <clk-uclass.h> |
10 | #include <dm.h> | |
11 | #include <errno.h> | |
12 | #include <syscon.h> | |
13 | #include <asm/io.h> | |
14 | #include <asm/arch/clock.h> | |
15 | #include <asm/arch/cru_rv1108.h> | |
16 | #include <asm/arch/hardware.h> | |
17 | #include <dm/lists.h> | |
18 | #include <dt-bindings/clock/rv1108-cru.h> | |
19 | ||
20 | DECLARE_GLOBAL_DATA_PTR; | |
21 | ||
22 | enum { | |
23 | VCO_MAX_HZ = 2400U * 1000000, | |
24 | VCO_MIN_HZ = 600 * 1000000, | |
25 | OUTPUT_MAX_HZ = 2400U * 1000000, | |
26 | OUTPUT_MIN_HZ = 24 * 1000000, | |
27 | }; | |
28 | ||
bae2f282 AY |
29 | #define DIV_TO_RATE(input_rate, div) ((input_rate) / ((div) + 1)) |
30 | ||
31 | #define PLL_DIVISORS(hz, _refdiv, _postdiv1, _postdiv2) {\ | |
32 | .refdiv = _refdiv,\ | |
33 | .fbdiv = (u32)((u64)hz * _refdiv * _postdiv1 * _postdiv2 / OSC_HZ),\ | |
34 | .postdiv1 = _postdiv1, .postdiv2 = _postdiv2};\ | |
35 | _Static_assert(((u64)hz * _refdiv * _postdiv1 * _postdiv2 / OSC_HZ) *\ | |
36 | OSC_HZ / (_refdiv * _postdiv1 * _postdiv2) == hz,\ | |
37 | #hz "Hz cannot be hit with PLL "\ | |
38 | "divisors on line " __stringify(__LINE__)); | |
39 | ||
2e4ce50d | 40 | /* use integer mode */ |
bae2f282 AY |
41 | static inline int rv1108_pll_id(enum rk_clk_id clk_id) |
42 | { | |
43 | int id = 0; | |
44 | ||
45 | switch (clk_id) { | |
46 | case CLK_ARM: | |
47 | case CLK_DDR: | |
48 | id = clk_id - 1; | |
49 | break; | |
50 | case CLK_GENERAL: | |
51 | id = 2; | |
52 | break; | |
53 | default: | |
54 | printf("invalid pll id:%d\n", clk_id); | |
55 | id = -1; | |
56 | break; | |
57 | } | |
58 | ||
59 | return id; | |
60 | } | |
61 | ||
62 | static uint32_t rkclk_pll_get_rate(struct rv1108_cru *cru, | |
63 | enum rk_clk_id clk_id) | |
64 | { | |
65 | uint32_t refdiv, fbdiv, postdiv1, postdiv2; | |
66 | uint32_t con0, con1, con3; | |
67 | int pll_id = rv1108_pll_id(clk_id); | |
68 | struct rv1108_pll *pll = &cru->pll[pll_id]; | |
69 | uint32_t freq; | |
70 | ||
71 | con3 = readl(&pll->con3); | |
72 | ||
73 | if (con3 & WORK_MODE_MASK) { | |
74 | con0 = readl(&pll->con0); | |
75 | con1 = readl(&pll->con1); | |
76 | fbdiv = (con0 >> FBDIV_SHIFT) & FBDIV_MASK; | |
77 | postdiv1 = (con1 & POSTDIV1_MASK) >> POSTDIV1_SHIFT; | |
78 | postdiv2 = (con1 & POSTDIV2_MASK) >> POSTDIV2_SHIFT; | |
79 | refdiv = (con1 & REFDIV_MASK) >> REFDIV_SHIFT; | |
80 | freq = (24 * fbdiv / (refdiv * postdiv1 * postdiv2)) * 1000000; | |
81 | } else { | |
82 | freq = OSC_HZ; | |
83 | } | |
84 | ||
85 | return freq; | |
86 | } | |
87 | ||
88 | static int rv1108_mac_set_clk(struct rv1108_cru *cru, ulong rate) | |
89 | { | |
90 | uint32_t con = readl(&cru->clksel_con[24]); | |
91 | ulong pll_rate; | |
92 | uint8_t div; | |
93 | ||
94 | if ((con >> MAC_PLL_SEL_SHIFT) & MAC_PLL_SEL_GPLL) | |
95 | pll_rate = rkclk_pll_get_rate(cru, CLK_GENERAL); | |
96 | else | |
97 | pll_rate = rkclk_pll_get_rate(cru, CLK_ARM); | |
98 | ||
99 | /*default set 50MHZ for gmac*/ | |
100 | if (!rate) | |
101 | rate = 50000000; | |
102 | ||
103 | div = DIV_ROUND_UP(pll_rate, rate) - 1; | |
104 | if (div <= 0x1f) | |
105 | rk_clrsetreg(&cru->clksel_con[24], MAC_CLK_DIV_MASK, | |
106 | div << MAC_CLK_DIV_SHIFT); | |
107 | else | |
108 | debug("Unsupported div for gmac:%d\n", div); | |
109 | ||
110 | return DIV_TO_RATE(pll_rate, div); | |
111 | } | |
112 | ||
113 | static int rv1108_sfc_set_clk(struct rv1108_cru *cru, uint rate) | |
114 | { | |
115 | u32 con = readl(&cru->clksel_con[27]); | |
116 | u32 pll_rate; | |
117 | u32 div; | |
118 | ||
119 | if ((con >> SFC_PLL_SEL_SHIFT) && SFC_PLL_SEL_GPLL) | |
120 | pll_rate = rkclk_pll_get_rate(cru, CLK_GENERAL); | |
121 | else | |
122 | pll_rate = rkclk_pll_get_rate(cru, CLK_DDR); | |
123 | ||
124 | div = DIV_ROUND_UP(pll_rate, rate) - 1; | |
125 | if (div <= 0x3f) | |
126 | rk_clrsetreg(&cru->clksel_con[27], SFC_CLK_DIV_MASK, | |
127 | div << SFC_CLK_DIV_SHIFT); | |
128 | else | |
129 | debug("Unsupported sfc clk rate:%d\n", rate); | |
130 | ||
131 | return DIV_TO_RATE(pll_rate, div); | |
132 | } | |
133 | ||
2e4ce50d DW |
134 | static ulong rv1108_saradc_get_clk(struct rv1108_cru *cru) |
135 | { | |
136 | u32 div, val; | |
137 | ||
138 | val = readl(&cru->clksel_con[22]); | |
139 | div = bitfield_extract(val, CLK_SARADC_DIV_CON_SHIFT, | |
140 | CLK_SARADC_DIV_CON_WIDTH); | |
141 | ||
142 | return DIV_TO_RATE(OSC_HZ, div); | |
143 | } | |
144 | ||
145 | static ulong rv1108_saradc_set_clk(struct rv1108_cru *cru, uint hz) | |
146 | { | |
147 | int src_clk_div; | |
148 | ||
149 | src_clk_div = DIV_ROUND_UP(OSC_HZ, hz) - 1; | |
150 | assert(src_clk_div < 128); | |
151 | ||
152 | rk_clrsetreg(&cru->clksel_con[22], | |
153 | CLK_SARADC_DIV_CON_MASK, | |
154 | src_clk_div << CLK_SARADC_DIV_CON_SHIFT); | |
155 | ||
156 | return rv1108_saradc_get_clk(cru); | |
157 | } | |
158 | ||
bae2f282 AY |
159 | static ulong rv1108_clk_get_rate(struct clk *clk) |
160 | { | |
161 | struct rv1108_clk_priv *priv = dev_get_priv(clk->dev); | |
162 | ||
163 | switch (clk->id) { | |
164 | case 0 ... 63: | |
165 | return rkclk_pll_get_rate(priv->cru, clk->id); | |
2e4ce50d DW |
166 | case SCLK_SARADC: |
167 | return rv1108_saradc_get_clk(priv->cru); | |
bae2f282 AY |
168 | default: |
169 | return -ENOENT; | |
170 | } | |
171 | } | |
172 | ||
173 | static ulong rv1108_clk_set_rate(struct clk *clk, ulong rate) | |
174 | { | |
175 | struct rv1108_clk_priv *priv = dev_get_priv(clk->dev); | |
176 | ulong new_rate; | |
177 | ||
178 | switch (clk->id) { | |
179 | case SCLK_MAC: | |
180 | new_rate = rv1108_mac_set_clk(priv->cru, rate); | |
181 | break; | |
182 | case SCLK_SFC: | |
183 | new_rate = rv1108_sfc_set_clk(priv->cru, rate); | |
184 | break; | |
2e4ce50d DW |
185 | case SCLK_SARADC: |
186 | new_rate = rv1108_saradc_set_clk(priv->cru, rate); | |
187 | break; | |
bae2f282 AY |
188 | default: |
189 | return -ENOENT; | |
190 | } | |
191 | ||
192 | return new_rate; | |
193 | } | |
194 | ||
195 | static const struct clk_ops rv1108_clk_ops = { | |
196 | .get_rate = rv1108_clk_get_rate, | |
197 | .set_rate = rv1108_clk_set_rate, | |
198 | }; | |
199 | ||
200 | static void rkclk_init(struct rv1108_cru *cru) | |
201 | { | |
202 | unsigned int apll = rkclk_pll_get_rate(cru, CLK_ARM); | |
203 | unsigned int dpll = rkclk_pll_get_rate(cru, CLK_DDR); | |
204 | unsigned int gpll = rkclk_pll_get_rate(cru, CLK_GENERAL); | |
205 | ||
206 | rk_clrsetreg(&cru->clksel_con[0], CORE_CLK_DIV_MASK, | |
207 | 0 << MAC_CLK_DIV_SHIFT); | |
208 | ||
209 | printf("APLL: %d DPLL:%d GPLL:%d\n", apll, dpll, gpll); | |
210 | } | |
211 | ||
212 | static int rv1108_clk_probe(struct udevice *dev) | |
213 | { | |
214 | struct rv1108_clk_priv *priv = dev_get_priv(dev); | |
215 | ||
216 | priv->cru = (struct rv1108_cru *)devfdt_get_addr(dev); | |
217 | ||
218 | rkclk_init(priv->cru); | |
219 | ||
220 | return 0; | |
221 | } | |
222 | ||
223 | static int rv1108_clk_bind(struct udevice *dev) | |
224 | { | |
225 | int ret; | |
f24e36da KY |
226 | struct udevice *sys_child; |
227 | struct sysreset_reg *priv; | |
bae2f282 AY |
228 | |
229 | /* The reset driver does not have a device node, so bind it here */ | |
f24e36da KY |
230 | ret = device_bind_driver(dev, "rockchip_sysreset", "sysreset", |
231 | &sys_child); | |
232 | if (ret) { | |
233 | debug("Warning: No sysreset driver: ret=%d\n", ret); | |
234 | } else { | |
235 | priv = malloc(sizeof(struct sysreset_reg)); | |
236 | priv->glb_srst_fst_value = offsetof(struct rv1108_cru, | |
237 | glb_srst_fst_val); | |
238 | priv->glb_srst_snd_value = offsetof(struct rv1108_cru, | |
239 | glb_srst_snd_val); | |
240 | sys_child->priv = priv; | |
241 | } | |
bae2f282 AY |
242 | |
243 | return 0; | |
244 | } | |
245 | ||
246 | static const struct udevice_id rv1108_clk_ids[] = { | |
247 | { .compatible = "rockchip,rv1108-cru" }, | |
248 | { } | |
249 | }; | |
250 | ||
251 | U_BOOT_DRIVER(clk_rv1108) = { | |
252 | .name = "clk_rv1108", | |
253 | .id = UCLASS_CLK, | |
254 | .of_match = rv1108_clk_ids, | |
255 | .priv_auto_alloc_size = sizeof(struct rv1108_clk_priv), | |
256 | .ops = &rv1108_clk_ops, | |
257 | .bind = rv1108_clk_bind, | |
258 | .probe = rv1108_clk_probe, | |
259 | }; |