1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * (C) Copyright 2017 Rockchip Electronics Co., Ltd
4  * Author: Andy Yan <andy.yan@rock-chips.com>
5  * (C) Copyright 2017 Theobroma Systems Design und Consulting GmbH
6  */
7 
8 #include <common.h>
9 #include <clk-uclass.h>
10 #include <dm.h>
11 #include <dt-structs.h>
12 #include <errno.h>
13 #include <log.h>
14 #include <malloc.h>
15 #include <mapmem.h>
16 #include <syscon.h>
17 #include <bitfield.h>
18 #include <asm/arch-rockchip/clock.h>
19 #include <asm/arch-rockchip/cru_rk3368.h>
20 #include <asm/arch-rockchip/hardware.h>
21 #include <asm/io.h>
22 #include <dm/device-internal.h>
23 #include <dm/lists.h>
24 #include <dt-bindings/clock/rk3368-cru.h>
25 #include <linux/delay.h>
26 #include <linux/stringify.h>
27 
28 #if CONFIG_IS_ENABLED(OF_PLATDATA)
29 struct rk3368_clk_plat {
30 	struct dtd_rockchip_rk3368_cru dtd;
31 };
32 #endif
33 
34 struct pll_div {
35 	u32 nr;
36 	u32 nf;
37 	u32 no;
38 };
39 
40 #define OSC_HZ		(24 * 1000 * 1000)
41 #define APLL_L_HZ	(800 * 1000 * 1000)
42 #define APLL_B_HZ	(816 * 1000 * 1000)
43 #define GPLL_HZ		(576 * 1000 * 1000)
44 #define CPLL_HZ		(400 * 1000 * 1000)
45 
46 #define DIV_TO_RATE(input_rate, div)    ((input_rate) / ((div) + 1))
47 
48 #define PLL_DIVISORS(hz, _nr, _no) { \
49 	.nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no}; \
50 	_Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
51 		       (_nr * _no) == hz, #hz "Hz cannot be hit with PLL " \
52 		       "divisors on line " __stringify(__LINE__));
53 
54 #if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
55 static const struct pll_div apll_l_init_cfg = PLL_DIVISORS(APLL_L_HZ, 12, 2);
56 static const struct pll_div apll_b_init_cfg = PLL_DIVISORS(APLL_B_HZ, 1, 2);
57 #if !defined(CONFIG_TPL_BUILD)
58 static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 1, 2);
59 static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 6);
60 #endif
61 #endif
62 
63 static ulong rk3368_clk_get_rate(struct clk *clk);
64 
65 /* Get pll rate by id */
rkclk_pll_get_rate(struct rk3368_cru * cru,enum rk3368_pll_id pll_id)66 static uint32_t rkclk_pll_get_rate(struct rk3368_cru *cru,
67 				   enum rk3368_pll_id pll_id)
68 {
69 	uint32_t nr, no, nf;
70 	uint32_t con;
71 	struct rk3368_pll *pll = &cru->pll[pll_id];
72 
73 	con = readl(&pll->con3);
74 
75 	switch ((con & PLL_MODE_MASK) >> PLL_MODE_SHIFT) {
76 	case PLL_MODE_SLOW:
77 		return OSC_HZ;
78 	case PLL_MODE_NORMAL:
79 		con = readl(&pll->con0);
80 		no = ((con & PLL_OD_MASK) >> PLL_OD_SHIFT) + 1;
81 		nr = ((con & PLL_NR_MASK) >> PLL_NR_SHIFT) + 1;
82 		con = readl(&pll->con1);
83 		nf = ((con & PLL_NF_MASK) >> PLL_NF_SHIFT) + 1;
84 
85 		return (24 * nf / (nr * no)) * 1000000;
86 	case PLL_MODE_DEEP_SLOW:
87 	default:
88 		return 32768;
89 	}
90 }
91 
92 #if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
rkclk_set_pll(struct rk3368_cru * cru,enum rk3368_pll_id pll_id,const struct pll_div * div)93 static int rkclk_set_pll(struct rk3368_cru *cru, enum rk3368_pll_id pll_id,
94 			 const struct pll_div *div)
95 {
96 	struct rk3368_pll *pll = &cru->pll[pll_id];
97 	/* All PLLs have same VCO and output frequency range restrictions*/
98 	uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
99 	uint output_hz = vco_hz / div->no;
100 
101 	debug("PLL at %p: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
102 	      pll, div->nf, div->nr, div->no, vco_hz, output_hz);
103 
104 	/* enter slow mode and reset pll */
105 	rk_clrsetreg(&pll->con3, PLL_MODE_MASK | PLL_RESET_MASK,
106 		     PLL_RESET << PLL_RESET_SHIFT);
107 
108 	rk_clrsetreg(&pll->con0, PLL_NR_MASK | PLL_OD_MASK,
109 		     ((div->nr - 1) << PLL_NR_SHIFT) |
110 		     ((div->no - 1) << PLL_OD_SHIFT));
111 	writel((div->nf - 1) << PLL_NF_SHIFT, &pll->con1);
112 	/*
113 	 * BWADJ should be set to NF / 2 to ensure the nominal bandwidth.
114 	 * Compare the RK3368 TRM, section "3.6.4 PLL Bandwidth Adjustment".
115 	 */
116 	clrsetbits_le32(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);
117 
118 	udelay(10);
119 
120 	/* return from reset */
121 	rk_clrreg(&pll->con3, PLL_RESET_MASK);
122 
123 	/* waiting for pll lock */
124 	while (!(readl(&pll->con1) & PLL_LOCK_STA))
125 		udelay(1);
126 
127 	rk_clrsetreg(&pll->con3, PLL_MODE_MASK,
128 		     PLL_MODE_NORMAL << PLL_MODE_SHIFT);
129 
130 	return 0;
131 }
132 #endif
133 
134 #if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
rkclk_init(struct rk3368_cru * cru)135 static void rkclk_init(struct rk3368_cru *cru)
136 {
137 	u32 apllb, aplll, dpll, cpll, gpll;
138 
139 	rkclk_set_pll(cru, APLLB, &apll_b_init_cfg);
140 	rkclk_set_pll(cru, APLLL, &apll_l_init_cfg);
141 #if !defined(CONFIG_TPL_BUILD)
142 	/*
143 	 * If we plan to return to the boot ROM, we can't increase the
144 	 * GPLL rate from the SPL stage.
145 	 */
146 	rkclk_set_pll(cru, GPLL, &gpll_init_cfg);
147 	rkclk_set_pll(cru, CPLL, &cpll_init_cfg);
148 #endif
149 
150 	apllb = rkclk_pll_get_rate(cru, APLLB);
151 	aplll = rkclk_pll_get_rate(cru, APLLL);
152 	dpll = rkclk_pll_get_rate(cru, DPLL);
153 	cpll = rkclk_pll_get_rate(cru, CPLL);
154 	gpll = rkclk_pll_get_rate(cru, GPLL);
155 
156 	debug("%s apllb(%d) apll(%d) dpll(%d) cpll(%d) gpll(%d)\n",
157 	       __func__, apllb, aplll, dpll, cpll, gpll);
158 }
159 #endif
160 
161 #if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
rk3368_mmc_get_clk(struct rk3368_cru * cru,uint clk_id)162 static ulong rk3368_mmc_get_clk(struct rk3368_cru *cru, uint clk_id)
163 {
164 	u32 div, con, con_id, rate;
165 	u32 pll_rate;
166 
167 	switch (clk_id) {
168 	case HCLK_SDMMC:
169 		con_id = 50;
170 		break;
171 	case HCLK_EMMC:
172 		con_id = 51;
173 		break;
174 	case SCLK_SDIO0:
175 		con_id = 48;
176 		break;
177 	default:
178 		return -EINVAL;
179 	}
180 
181 	con = readl(&cru->clksel_con[con_id]);
182 	switch (con & MMC_PLL_SEL_MASK) {
183 	case MMC_PLL_SEL_GPLL:
184 		pll_rate = rkclk_pll_get_rate(cru, GPLL);
185 		break;
186 	case MMC_PLL_SEL_24M:
187 		pll_rate = OSC_HZ;
188 		break;
189 	case MMC_PLL_SEL_CPLL:
190 		pll_rate = rkclk_pll_get_rate(cru, CPLL);
191 		break;
192 	case MMC_PLL_SEL_USBPHY_480M:
193 	default:
194 		return -EINVAL;
195 	}
196 	div = (con & MMC_CLK_DIV_MASK) >> MMC_CLK_DIV_SHIFT;
197 	rate = DIV_TO_RATE(pll_rate, div);
198 
199 	debug("%s: raw rate %d (post-divide by 2)\n", __func__, rate);
200 	return rate >> 1;
201 }
202 
rk3368_mmc_find_best_rate_and_parent(struct clk * clk,ulong rate,u32 * best_mux,u32 * best_div)203 static ulong rk3368_mmc_find_best_rate_and_parent(struct clk *clk,
204 						  ulong rate,
205 						  u32 *best_mux,
206 						  u32 *best_div)
207 {
208 	int i;
209 	ulong best_rate = 0;
210 	const ulong MHz = 1000000;
211 	const struct {
212 		u32 mux;
213 		ulong rate;
214 	} parents[] = {
215 		{ .mux = MMC_PLL_SEL_CPLL, .rate = CPLL_HZ },
216 		{ .mux = MMC_PLL_SEL_GPLL, .rate = GPLL_HZ },
217 		{ .mux = MMC_PLL_SEL_24M,  .rate = 24 * MHz }
218 	};
219 
220 	debug("%s: target rate %ld\n", __func__, rate);
221 	for (i = 0; i < ARRAY_SIZE(parents); ++i) {
222 		/*
223 		 * Find the largest rate no larger than the target-rate for
224 		 * the current parent.
225 		 */
226 		ulong parent_rate = parents[i].rate;
227 		u32 div = DIV_ROUND_UP(parent_rate, rate);
228 		u32 adj_div = div;
229 		ulong new_rate = parent_rate / adj_div;
230 
231 		debug("%s: rate %ld, parent-mux %d, parent-rate %ld, div %d\n",
232 		      __func__, rate, parents[i].mux, parents[i].rate, div);
233 
234 		/* Skip, if not representable */
235 		if ((div - 1) > MMC_CLK_DIV_MASK)
236 			continue;
237 
238 		/* Skip, if we already have a better (or equal) solution */
239 		if (new_rate <= best_rate)
240 			continue;
241 
242 		/* This is our new best rate. */
243 		best_rate = new_rate;
244 		*best_mux = parents[i].mux;
245 		*best_div = div - 1;
246 	}
247 
248 	debug("%s: best_mux = %x, best_div = %d, best_rate = %ld\n",
249 	      __func__, *best_mux, *best_div, best_rate);
250 
251 	return best_rate;
252 }
253 
rk3368_mmc_set_clk(struct clk * clk,ulong rate)254 static ulong rk3368_mmc_set_clk(struct clk *clk, ulong rate)
255 {
256 	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
257 	struct rk3368_cru *cru = priv->cru;
258 	ulong clk_id = clk->id;
259 	u32 con_id, mux = 0, div = 0;
260 
261 	/* Find the best parent and rate */
262 	rk3368_mmc_find_best_rate_and_parent(clk, rate << 1, &mux, &div);
263 
264 	switch (clk_id) {
265 	case HCLK_SDMMC:
266 		con_id = 50;
267 		break;
268 	case HCLK_EMMC:
269 		con_id = 51;
270 		break;
271 	case SCLK_SDIO0:
272 		con_id = 48;
273 		break;
274 	default:
275 		return -EINVAL;
276 	}
277 
278 	rk_clrsetreg(&cru->clksel_con[con_id],
279 		     MMC_PLL_SEL_MASK | MMC_CLK_DIV_MASK,
280 		     mux | div);
281 
282 	return rk3368_mmc_get_clk(cru, clk_id);
283 }
284 #endif
285 
286 #if IS_ENABLED(CONFIG_TPL_BUILD)
rk3368_ddr_set_clk(struct rk3368_cru * cru,ulong set_rate)287 static ulong rk3368_ddr_set_clk(struct rk3368_cru *cru, ulong set_rate)
288 {
289 	const struct pll_div *dpll_cfg = NULL;
290 	const ulong MHz = 1000000;
291 
292 	/* Fout = ((Fin /NR) * NF )/ NO */
293 	static const struct pll_div dpll_1200 = PLL_DIVISORS(1200 * MHz, 1, 1);
294 	static const struct pll_div dpll_1332 =	PLL_DIVISORS(1332 * MHz, 2, 1);
295 	static const struct pll_div dpll_1600 =	PLL_DIVISORS(1600 * MHz, 3, 2);
296 
297 	switch (set_rate) {
298 	case 1200*MHz:
299 		dpll_cfg = &dpll_1200;
300 		break;
301 	case 1332*MHz:
302 		dpll_cfg = &dpll_1332;
303 		break;
304 	case 1600*MHz:
305 		dpll_cfg = &dpll_1600;
306 		break;
307 	default:
308 		pr_err("Unsupported SDRAM frequency!,%ld\n", set_rate);
309 	}
310 	rkclk_set_pll(cru, DPLL, dpll_cfg);
311 
312 	return set_rate;
313 }
314 #endif
315 
316 #if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
rk3368_gmac_set_clk(struct rk3368_cru * cru,ulong set_rate)317 static ulong rk3368_gmac_set_clk(struct rk3368_cru *cru, ulong set_rate)
318 {
319 	ulong ret;
320 
321 	/*
322 	 * The gmac clock can be derived either from an external clock
323 	 * or can be generated from internally by a divider from SCLK_MAC.
324 	 */
325 	if (readl(&cru->clksel_con[43]) & GMAC_MUX_SEL_EXTCLK) {
326 		/* An external clock will always generate the right rate... */
327 		ret = set_rate;
328 	} else {
329 		u32 con = readl(&cru->clksel_con[43]);
330 		ulong pll_rate;
331 		u8 div;
332 
333 		if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
334 		    GMAC_PLL_SELECT_GENERAL)
335 			pll_rate = GPLL_HZ;
336 		else if (((con >> GMAC_PLL_SHIFT) & GMAC_PLL_MASK) ==
337 			 GMAC_PLL_SELECT_CODEC)
338 			pll_rate = CPLL_HZ;
339 		else
340 			/* CPLL is not set */
341 			return -EPERM;
342 
343 		div = DIV_ROUND_UP(pll_rate, set_rate) - 1;
344 		if (div <= 0x1f)
345 			rk_clrsetreg(&cru->clksel_con[43], GMAC_DIV_CON_MASK,
346 				     div << GMAC_DIV_CON_SHIFT);
347 		else
348 			debug("Unsupported div for gmac:%d\n", div);
349 
350 		return DIV_TO_RATE(pll_rate, div);
351 	}
352 
353 	return ret;
354 }
355 #endif
356 
357 /*
358  * RK3368 SPI clocks have a common divider-width (7 bits) and a single bit
359  * to select either CPLL or GPLL as the clock-parent. The location within
360  * the enclosing CLKSEL_CON (i.e. div_shift and sel_shift) are variable.
361  */
362 
363 struct spi_clkreg {
364 	uint8_t reg;  /* CLKSEL_CON[reg] register in CRU */
365 	uint8_t div_shift;
366 	uint8_t sel_shift;
367 };
368 
369 /*
370  * The entries are numbered relative to their offset from SCLK_SPI0.
371  */
372 static const struct spi_clkreg spi_clkregs[] = {
373 	[0] = { .reg = 45, .div_shift = 0, .sel_shift = 7, },
374 	[1] = { .reg = 45, .div_shift = 8, .sel_shift = 15, },
375 	[2] = { .reg = 46, .div_shift = 8, .sel_shift = 15, },
376 };
377 
extract_bits(u32 val,unsigned width,unsigned shift)378 static inline u32 extract_bits(u32 val, unsigned width, unsigned shift)
379 {
380 	return (val >> shift) & ((1 << width) - 1);
381 }
382 
rk3368_spi_get_clk(struct rk3368_cru * cru,ulong clk_id)383 static ulong rk3368_spi_get_clk(struct rk3368_cru *cru, ulong clk_id)
384 {
385 	const struct spi_clkreg *spiclk = NULL;
386 	u32 div, val;
387 
388 	switch (clk_id) {
389 	case SCLK_SPI0 ... SCLK_SPI2:
390 		spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
391 		break;
392 
393 	default:
394 		pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
395 		return -EINVAL;
396 	}
397 
398 	val = readl(&cru->clksel_con[spiclk->reg]);
399 	div = extract_bits(val, 7, spiclk->div_shift);
400 
401 	debug("%s: div 0x%x\n", __func__, div);
402 	return DIV_TO_RATE(GPLL_HZ, div);
403 }
404 
rk3368_spi_set_clk(struct rk3368_cru * cru,ulong clk_id,uint hz)405 static ulong rk3368_spi_set_clk(struct rk3368_cru *cru, ulong clk_id, uint hz)
406 {
407 	const struct spi_clkreg *spiclk = NULL;
408 	int src_clk_div;
409 
410 	src_clk_div = DIV_ROUND_UP(GPLL_HZ, hz);
411 	assert(src_clk_div < 127);
412 
413 	switch (clk_id) {
414 	case SCLK_SPI0 ... SCLK_SPI2:
415 		spiclk = &spi_clkregs[clk_id - SCLK_SPI0];
416 		break;
417 
418 	default:
419 		pr_err("%s: SPI clk-id %ld not supported\n", __func__, clk_id);
420 		return -EINVAL;
421 	}
422 
423 	rk_clrsetreg(&cru->clksel_con[spiclk->reg],
424 		     ((0x7f << spiclk->div_shift) |
425 		      (0x1 << spiclk->sel_shift)),
426 		     ((src_clk_div << spiclk->div_shift) |
427 		      (1 << spiclk->sel_shift)));
428 
429 	return rk3368_spi_get_clk(cru, clk_id);
430 }
431 
rk3368_saradc_get_clk(struct rk3368_cru * cru)432 static ulong rk3368_saradc_get_clk(struct rk3368_cru *cru)
433 {
434 	u32 div, val;
435 
436 	val = readl(&cru->clksel_con[25]);
437 	div = bitfield_extract(val, CLK_SARADC_DIV_CON_SHIFT,
438 			       CLK_SARADC_DIV_CON_WIDTH);
439 
440 	return DIV_TO_RATE(OSC_HZ, div);
441 }
442 
rk3368_saradc_set_clk(struct rk3368_cru * cru,uint hz)443 static ulong rk3368_saradc_set_clk(struct rk3368_cru *cru, uint hz)
444 {
445 	int src_clk_div;
446 
447 	src_clk_div = DIV_ROUND_UP(OSC_HZ, hz) - 1;
448 	assert(src_clk_div < 128);
449 
450 	rk_clrsetreg(&cru->clksel_con[25],
451 		     CLK_SARADC_DIV_CON_MASK,
452 		     src_clk_div << CLK_SARADC_DIV_CON_SHIFT);
453 
454 	return rk3368_saradc_get_clk(cru);
455 }
456 
rk3368_clk_get_rate(struct clk * clk)457 static ulong rk3368_clk_get_rate(struct clk *clk)
458 {
459 	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
460 	ulong rate = 0;
461 
462 	debug("%s: id %ld\n", __func__, clk->id);
463 	switch (clk->id) {
464 	case PLL_CPLL:
465 		rate = rkclk_pll_get_rate(priv->cru, CPLL);
466 		break;
467 	case PLL_GPLL:
468 		rate = rkclk_pll_get_rate(priv->cru, GPLL);
469 		break;
470 	case SCLK_SPI0 ... SCLK_SPI2:
471 		rate = rk3368_spi_get_clk(priv->cru, clk->id);
472 		break;
473 #if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
474 	case HCLK_SDMMC:
475 	case HCLK_EMMC:
476 		rate = rk3368_mmc_get_clk(priv->cru, clk->id);
477 		break;
478 #endif
479 	case SCLK_SARADC:
480 		rate = rk3368_saradc_get_clk(priv->cru);
481 		break;
482 	default:
483 		return -ENOENT;
484 	}
485 
486 	return rate;
487 }
488 
rk3368_clk_set_rate(struct clk * clk,ulong rate)489 static ulong rk3368_clk_set_rate(struct clk *clk, ulong rate)
490 {
491 	__maybe_unused struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
492 	ulong ret = 0;
493 
494 	debug("%s id:%ld rate:%ld\n", __func__, clk->id, rate);
495 	switch (clk->id) {
496 	case SCLK_SPI0 ... SCLK_SPI2:
497 		ret = rk3368_spi_set_clk(priv->cru, clk->id, rate);
498 		break;
499 #if IS_ENABLED(CONFIG_TPL_BUILD)
500 	case CLK_DDR:
501 		ret = rk3368_ddr_set_clk(priv->cru, rate);
502 		break;
503 #endif
504 #if !IS_ENABLED(CONFIG_SPL_BUILD) || CONFIG_IS_ENABLED(MMC_SUPPORT)
505 	case HCLK_SDMMC:
506 	case HCLK_EMMC:
507 		ret = rk3368_mmc_set_clk(clk, rate);
508 		break;
509 #endif
510 #if CONFIG_IS_ENABLED(GMAC_ROCKCHIP)
511 	case SCLK_MAC:
512 		/* select the external clock */
513 		ret = rk3368_gmac_set_clk(priv->cru, rate);
514 		break;
515 #endif
516 	case SCLK_SARADC:
517 		ret =  rk3368_saradc_set_clk(priv->cru, rate);
518 		break;
519 	default:
520 		return -ENOENT;
521 	}
522 
523 	return ret;
524 }
525 
rk3368_gmac_set_parent(struct clk * clk,struct clk * parent)526 static int __maybe_unused rk3368_gmac_set_parent(struct clk *clk, struct clk *parent)
527 {
528 	struct rk3368_clk_priv *priv = dev_get_priv(clk->dev);
529 	struct rk3368_cru *cru = priv->cru;
530 	const char *clock_output_name;
531 	int ret;
532 
533 	/*
534 	 * If the requested parent is in the same clock-controller and
535 	 * the id is SCLK_MAC ("sclk_mac"), switch to the internal
536 	 * clock.
537 	 */
538 	if ((parent->dev == clk->dev) && (parent->id == SCLK_MAC)) {
539 		debug("%s: switching GAMC to SCLK_MAC\n", __func__);
540 		rk_clrreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
541 		return 0;
542 	}
543 
544 	/*
545 	 * Otherwise, we need to check the clock-output-names of the
546 	 * requested parent to see if the requested id is "ext_gmac".
547 	 */
548 	ret = dev_read_string_index(parent->dev, "clock-output-names",
549 				    parent->id, &clock_output_name);
550 	if (ret < 0)
551 		return -ENODATA;
552 
553 	/* If this is "ext_gmac", switch to the external clock input */
554 	if (!strcmp(clock_output_name, "ext_gmac")) {
555 		debug("%s: switching GMAC to external clock\n", __func__);
556 		rk_setreg(&cru->clksel_con[43], GMAC_MUX_SEL_EXTCLK);
557 		return 0;
558 	}
559 
560 	return -EINVAL;
561 }
562 
rk3368_clk_set_parent(struct clk * clk,struct clk * parent)563 static int __maybe_unused rk3368_clk_set_parent(struct clk *clk, struct clk *parent)
564 {
565 	switch (clk->id) {
566 	case SCLK_MAC:
567 		return rk3368_gmac_set_parent(clk, parent);
568 	}
569 
570 	debug("%s: unsupported clk %ld\n", __func__, clk->id);
571 	return -ENOENT;
572 }
573 
574 static struct clk_ops rk3368_clk_ops = {
575 	.get_rate = rk3368_clk_get_rate,
576 	.set_rate = rk3368_clk_set_rate,
577 #if CONFIG_IS_ENABLED(OF_CONTROL) && !CONFIG_IS_ENABLED(OF_PLATDATA)
578 	.set_parent = rk3368_clk_set_parent,
579 #endif
580 };
581 
rk3368_clk_probe(struct udevice * dev)582 static int rk3368_clk_probe(struct udevice *dev)
583 {
584 	struct rk3368_clk_priv __maybe_unused *priv = dev_get_priv(dev);
585 #if CONFIG_IS_ENABLED(OF_PLATDATA)
586 	struct rk3368_clk_plat *plat = dev_get_plat(dev);
587 
588 	priv->cru = map_sysmem(plat->dtd.reg[0], plat->dtd.reg[1]);
589 #endif
590 #if IS_ENABLED(CONFIG_SPL_BUILD) || IS_ENABLED(CONFIG_TPL_BUILD)
591 	rkclk_init(priv->cru);
592 #endif
593 
594 	return 0;
595 }
596 
rk3368_clk_of_to_plat(struct udevice * dev)597 static int rk3368_clk_of_to_plat(struct udevice *dev)
598 {
599 #if !CONFIG_IS_ENABLED(OF_PLATDATA)
600 	struct rk3368_clk_priv *priv = dev_get_priv(dev);
601 
602 	priv->cru = dev_read_addr_ptr(dev);
603 #endif
604 
605 	return 0;
606 }
607 
rk3368_clk_bind(struct udevice * dev)608 static int rk3368_clk_bind(struct udevice *dev)
609 {
610 	int ret;
611 	struct udevice *sys_child;
612 	struct sysreset_reg *priv;
613 
614 	/* The reset driver does not have a device node, so bind it here */
615 	ret = device_bind_driver(dev, "rockchip_sysreset", "sysreset",
616 				 &sys_child);
617 	if (ret) {
618 		debug("Warning: No sysreset driver: ret=%d\n", ret);
619 	} else {
620 		priv = malloc(sizeof(struct sysreset_reg));
621 		priv->glb_srst_fst_value = offsetof(struct rk3368_cru,
622 						    glb_srst_fst_val);
623 		priv->glb_srst_snd_value = offsetof(struct rk3368_cru,
624 						    glb_srst_snd_val);
625 		dev_set_priv(sys_child, priv);
626 	}
627 
628 #if CONFIG_IS_ENABLED(RESET_ROCKCHIP)
629 	ret = offsetof(struct rk3368_cru, softrst_con[0]);
630 	ret = rockchip_reset_bind(dev, ret, 15);
631 	if (ret)
632 		debug("Warning: software reset driver bind faile\n");
633 #endif
634 
635 	return ret;
636 }
637 
638 static const struct udevice_id rk3368_clk_ids[] = {
639 	{ .compatible = "rockchip,rk3368-cru" },
640 	{ }
641 };
642 
643 U_BOOT_DRIVER(rockchip_rk3368_cru) = {
644 	.name		= "rockchip_rk3368_cru",
645 	.id		= UCLASS_CLK,
646 	.of_match	= rk3368_clk_ids,
647 	.priv_auto	= sizeof(struct rk3368_clk_priv),
648 #if CONFIG_IS_ENABLED(OF_PLATDATA)
649 	.plat_auto	= sizeof(struct rk3368_clk_plat),
650 #endif
651 	.of_to_plat = rk3368_clk_of_to_plat,
652 	.ops		= &rk3368_clk_ops,
653 	.bind		= rk3368_clk_bind,
654 	.probe		= rk3368_clk_probe,
655 };
656