xref: /rk3399_rockchip-uboot/drivers/clk/rockchip/clk_rk3188.c (revision d177ad999c5c4bbe9d2582086b39405e6e9d0834)
1dcdd3278SHeiko Stübner /*
2dcdd3278SHeiko Stübner  * (C) Copyright 2015 Google, Inc
3dcdd3278SHeiko Stübner  * (C) Copyright 2016 Heiko Stuebner <heiko@sntech.de>
4dcdd3278SHeiko Stübner  *
5dcdd3278SHeiko Stübner  * SPDX-License-Identifier:	GPL-2.0
6dcdd3278SHeiko Stübner  */
7dcdd3278SHeiko Stübner 
8dcdd3278SHeiko Stübner #include <common.h>
9dcdd3278SHeiko Stübner #include <clk-uclass.h>
10dcdd3278SHeiko Stübner #include <dm.h>
11dcdd3278SHeiko Stübner #include <dt-structs.h>
12dcdd3278SHeiko Stübner #include <errno.h>
13dcdd3278SHeiko Stübner #include <mapmem.h>
14dcdd3278SHeiko Stübner #include <syscon.h>
15dcdd3278SHeiko Stübner #include <asm/io.h>
16dcdd3278SHeiko Stübner #include <asm/arch/clock.h>
17dcdd3278SHeiko Stübner #include <asm/arch/cru_rk3188.h>
18dcdd3278SHeiko Stübner #include <asm/arch/grf_rk3188.h>
19dcdd3278SHeiko Stübner #include <asm/arch/hardware.h>
20dcb51bfeSDavid Wu #include <bitfield.h>
21dcdd3278SHeiko Stübner #include <dt-bindings/clock/rk3188-cru.h>
22dcdd3278SHeiko Stübner #include <dm/device-internal.h>
23dcdd3278SHeiko Stübner #include <dm/lists.h>
24dcdd3278SHeiko Stübner #include <dm/uclass-internal.h>
25dcdd3278SHeiko Stübner #include <linux/log2.h>
26dcdd3278SHeiko Stübner 
27dcdd3278SHeiko Stübner DECLARE_GLOBAL_DATA_PTR;
28dcdd3278SHeiko Stübner 
29dcdd3278SHeiko Stübner enum rk3188_clk_type {
30dcdd3278SHeiko Stübner 	RK3188_CRU,
31dcdd3278SHeiko Stübner 	RK3188A_CRU,
32dcdd3278SHeiko Stübner };
33dcdd3278SHeiko Stübner 
34dcdd3278SHeiko Stübner struct rk3188_clk_plat {
35dcdd3278SHeiko Stübner #if CONFIG_IS_ENABLED(OF_PLATDATA)
36dcdd3278SHeiko Stübner 	struct dtd_rockchip_rk3188_cru dtd;
37dcdd3278SHeiko Stübner #endif
38dcdd3278SHeiko Stübner };
39dcdd3278SHeiko Stübner 
40441bfb78SElaine Zhang #ifndef CONFIG_SPL_BUILD
41441bfb78SElaine Zhang #define RK3188_CLK_DUMP(_id, _name, _iscru)	\
42441bfb78SElaine Zhang {						\
43441bfb78SElaine Zhang 	.id = _id,				\
44441bfb78SElaine Zhang 	.name = _name,				\
45441bfb78SElaine Zhang 	.is_cru = _iscru,			\
46441bfb78SElaine Zhang }
47441bfb78SElaine Zhang 
48441bfb78SElaine Zhang static const struct rk3188_clk_info clks_dump[] = {
49441bfb78SElaine Zhang 	RK3188_CLK_DUMP(PLL_APLL, "apll", true),
50441bfb78SElaine Zhang 	RK3188_CLK_DUMP(PLL_DPLL, "dpll", true),
51441bfb78SElaine Zhang 	RK3188_CLK_DUMP(PLL_CPLL, "cpll", true),
52441bfb78SElaine Zhang 	RK3188_CLK_DUMP(PLL_GPLL, "gpll", true),
53441bfb78SElaine Zhang };
54441bfb78SElaine Zhang #endif
55441bfb78SElaine Zhang 
56dcdd3278SHeiko Stübner struct pll_div {
57dcdd3278SHeiko Stübner 	u32 nr;
58dcdd3278SHeiko Stübner 	u32 nf;
59dcdd3278SHeiko Stübner 	u32 no;
60dcdd3278SHeiko Stübner };
61dcdd3278SHeiko Stübner 
62dcdd3278SHeiko Stübner enum {
63dcdd3278SHeiko Stübner 	VCO_MAX_HZ	= 2200U * 1000000,
64dcdd3278SHeiko Stübner 	VCO_MIN_HZ	= 440 * 1000000,
65dcdd3278SHeiko Stübner 	OUTPUT_MAX_HZ	= 2200U * 1000000,
66dcdd3278SHeiko Stübner 	OUTPUT_MIN_HZ	= 30 * 1000000,
67dcdd3278SHeiko Stübner 	FREF_MAX_HZ	= 2200U * 1000000,
68dcdd3278SHeiko Stübner 	FREF_MIN_HZ	= 30 * 1000,
69dcdd3278SHeiko Stübner };
70dcdd3278SHeiko Stübner 
71dcdd3278SHeiko Stübner enum {
72dcdd3278SHeiko Stübner 	/* PLL CON0 */
73dcdd3278SHeiko Stübner 	PLL_OD_MASK		= 0x0f,
74dcdd3278SHeiko Stübner 
75dcdd3278SHeiko Stübner 	/* PLL CON1 */
76dcdd3278SHeiko Stübner 	PLL_NF_MASK		= 0x1fff,
77dcdd3278SHeiko Stübner 
78dcdd3278SHeiko Stübner 	/* PLL CON2 */
79dcdd3278SHeiko Stübner 	PLL_BWADJ_MASK		= 0x0fff,
80dcdd3278SHeiko Stübner 
81dcdd3278SHeiko Stübner 	/* PLL CON3 */
82dcdd3278SHeiko Stübner 	PLL_RESET_SHIFT		= 5,
83dcdd3278SHeiko Stübner 
84dcdd3278SHeiko Stübner 	/* GRF_SOC_STATUS0 */
85dcdd3278SHeiko Stübner 	SOCSTS_DPLL_LOCK	= 1 << 5,
86dcdd3278SHeiko Stübner 	SOCSTS_APLL_LOCK	= 1 << 6,
87dcdd3278SHeiko Stübner 	SOCSTS_CPLL_LOCK	= 1 << 7,
88dcdd3278SHeiko Stübner 	SOCSTS_GPLL_LOCK	= 1 << 8,
89dcdd3278SHeiko Stübner };
90dcdd3278SHeiko Stübner 
91dcdd3278SHeiko Stübner #define DIV_TO_RATE(input_rate, div)	((input_rate) / ((div) + 1))
92dcdd3278SHeiko Stübner 
93dcdd3278SHeiko Stübner #define PLL_DIVISORS(hz, _nr, _no) {\
94dcdd3278SHeiko Stübner 	.nr = _nr, .nf = (u32)((u64)hz * _nr * _no / OSC_HZ), .no = _no};\
95dcdd3278SHeiko Stübner 	_Static_assert(((u64)hz * _nr * _no / OSC_HZ) * OSC_HZ /\
96dcdd3278SHeiko Stübner 		       (_nr * _no) == hz, #hz "Hz cannot be hit with PLL "\
97dcdd3278SHeiko Stübner 		       "divisors on line " __stringify(__LINE__));
98dcdd3278SHeiko Stübner 
99dcdd3278SHeiko Stübner /* Keep divisors as low as possible to reduce jitter and power usage */
100dcdd3278SHeiko Stübner #ifdef CONFIG_SPL_BUILD
101dcdd3278SHeiko Stübner static const struct pll_div gpll_init_cfg = PLL_DIVISORS(GPLL_HZ, 2, 2);
102dcdd3278SHeiko Stübner static const struct pll_div cpll_init_cfg = PLL_DIVISORS(CPLL_HZ, 1, 2);
103dcdd3278SHeiko Stübner #endif
104dcdd3278SHeiko Stübner 
rkclk_set_pll(struct rk3188_cru * cru,enum rk_clk_id clk_id,const struct pll_div * div,bool has_bwadj)105dcdd3278SHeiko Stübner static int rkclk_set_pll(struct rk3188_cru *cru, enum rk_clk_id clk_id,
106dcdd3278SHeiko Stübner 			 const struct pll_div *div, bool has_bwadj)
107dcdd3278SHeiko Stübner {
108dcdd3278SHeiko Stübner 	int pll_id = rk_pll_id(clk_id);
109dcdd3278SHeiko Stübner 	struct rk3188_pll *pll = &cru->pll[pll_id];
110dcdd3278SHeiko Stübner 	/* All PLLs have same VCO and output frequency range restrictions. */
111dcdd3278SHeiko Stübner 	uint vco_hz = OSC_HZ / 1000 * div->nf / div->nr * 1000;
112dcdd3278SHeiko Stübner 	uint output_hz = vco_hz / div->no;
113dcdd3278SHeiko Stübner 
114dcdd3278SHeiko Stübner 	debug("PLL at %x: nf=%d, nr=%d, no=%d, vco=%u Hz, output=%u Hz\n",
115dcdd3278SHeiko Stübner 	      (uint)pll, div->nf, div->nr, div->no, vco_hz, output_hz);
116dcdd3278SHeiko Stübner 	assert(vco_hz >= VCO_MIN_HZ && vco_hz <= VCO_MAX_HZ &&
117dcdd3278SHeiko Stübner 	       output_hz >= OUTPUT_MIN_HZ && output_hz <= OUTPUT_MAX_HZ &&
118dcdd3278SHeiko Stübner 	       (div->no == 1 || !(div->no % 2)));
119dcdd3278SHeiko Stübner 
120dcdd3278SHeiko Stübner 	/* enter reset */
121dcdd3278SHeiko Stübner 	rk_setreg(&pll->con3, 1 << PLL_RESET_SHIFT);
122dcdd3278SHeiko Stübner 
123dcdd3278SHeiko Stübner 	rk_clrsetreg(&pll->con0,
124dcdd3278SHeiko Stübner 		     CLKR_MASK << CLKR_SHIFT | PLL_OD_MASK,
125dcdd3278SHeiko Stübner 		     ((div->nr - 1) << CLKR_SHIFT) | (div->no - 1));
126dcdd3278SHeiko Stübner 	rk_clrsetreg(&pll->con1, CLKF_MASK, div->nf - 1);
127dcdd3278SHeiko Stübner 
128dcdd3278SHeiko Stübner 	if (has_bwadj)
129dcdd3278SHeiko Stübner 		rk_clrsetreg(&pll->con2, PLL_BWADJ_MASK, (div->nf >> 1) - 1);
130dcdd3278SHeiko Stübner 
131dcdd3278SHeiko Stübner 	udelay(10);
132dcdd3278SHeiko Stübner 
133dcdd3278SHeiko Stübner 	/* return from reset */
134dcdd3278SHeiko Stübner 	rk_clrreg(&pll->con3, 1 << PLL_RESET_SHIFT);
135dcdd3278SHeiko Stübner 
136dcdd3278SHeiko Stübner 	return 0;
137dcdd3278SHeiko Stübner }
138dcdd3278SHeiko Stübner 
rkclk_configure_ddr(struct rk3188_cru * cru,struct rk3188_grf * grf,unsigned int hz,bool has_bwadj)139dcdd3278SHeiko Stübner static int rkclk_configure_ddr(struct rk3188_cru *cru, struct rk3188_grf *grf,
140dcdd3278SHeiko Stübner 			       unsigned int hz, bool has_bwadj)
141dcdd3278SHeiko Stübner {
142dcdd3278SHeiko Stübner 	static const struct pll_div dpll_cfg[] = {
143dcdd3278SHeiko Stübner 		{.nf = 25, .nr = 2, .no = 1},
144dcdd3278SHeiko Stübner 		{.nf = 400, .nr = 9, .no = 2},
145dcdd3278SHeiko Stübner 		{.nf = 500, .nr = 9, .no = 2},
146dcdd3278SHeiko Stübner 		{.nf = 100, .nr = 3, .no = 1},
147dcdd3278SHeiko Stübner 	};
148dcdd3278SHeiko Stübner 	int cfg;
149dcdd3278SHeiko Stübner 
150dcdd3278SHeiko Stübner 	switch (hz) {
151dcdd3278SHeiko Stübner 	case 300000000:
152dcdd3278SHeiko Stübner 		cfg = 0;
153dcdd3278SHeiko Stübner 		break;
154dcdd3278SHeiko Stübner 	case 533000000:	/* actually 533.3P MHz */
155dcdd3278SHeiko Stübner 		cfg = 1;
156dcdd3278SHeiko Stübner 		break;
157dcdd3278SHeiko Stübner 	case 666000000:	/* actually 666.6P MHz */
158dcdd3278SHeiko Stübner 		cfg = 2;
159dcdd3278SHeiko Stübner 		break;
160dcdd3278SHeiko Stübner 	case 800000000:
161dcdd3278SHeiko Stübner 		cfg = 3;
162dcdd3278SHeiko Stübner 		break;
163dcdd3278SHeiko Stübner 	default:
164dcdd3278SHeiko Stübner 		debug("Unsupported SDRAM frequency");
165dcdd3278SHeiko Stübner 		return -EINVAL;
166dcdd3278SHeiko Stübner 	}
167dcdd3278SHeiko Stübner 
168dcdd3278SHeiko Stübner 	/* pll enter slow-mode */
169dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con, DPLL_MODE_MASK << DPLL_MODE_SHIFT,
170dcdd3278SHeiko Stübner 		     DPLL_MODE_SLOW << DPLL_MODE_SHIFT);
171dcdd3278SHeiko Stübner 
172dcdd3278SHeiko Stübner 	rkclk_set_pll(cru, CLK_DDR, &dpll_cfg[cfg], has_bwadj);
173dcdd3278SHeiko Stübner 
174dcdd3278SHeiko Stübner 	/* wait for pll lock */
175dcdd3278SHeiko Stübner 	while (!(readl(&grf->soc_status0) & SOCSTS_DPLL_LOCK))
176dcdd3278SHeiko Stübner 		udelay(1);
177dcdd3278SHeiko Stübner 
178dcdd3278SHeiko Stübner 	/* PLL enter normal-mode */
179dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con, DPLL_MODE_MASK << DPLL_MODE_SHIFT,
180dcdd3278SHeiko Stübner 		     DPLL_MODE_NORMAL << DPLL_MODE_SHIFT);
181dcdd3278SHeiko Stübner 
182dcdd3278SHeiko Stübner 	return 0;
183dcdd3278SHeiko Stübner }
184dcdd3278SHeiko Stübner 
rkclk_configure_cpu(struct rk3188_cru * cru,struct rk3188_grf * grf,unsigned int hz,bool has_bwadj)185f7853570SHeiko Stübner static int rkclk_configure_cpu(struct rk3188_cru *cru, struct rk3188_grf *grf,
186f7853570SHeiko Stübner 			      unsigned int hz, bool has_bwadj)
187f7853570SHeiko Stübner {
188f7853570SHeiko Stübner 	static const struct pll_div apll_cfg[] = {
189f7853570SHeiko Stübner 		{.nf = 50, .nr = 1, .no = 2},
190f7853570SHeiko Stübner 		{.nf = 67, .nr = 1, .no = 1},
191f7853570SHeiko Stübner 	};
192f7853570SHeiko Stübner 	int div_core_peri, div_aclk_core, cfg;
193f7853570SHeiko Stübner 
194f7853570SHeiko Stübner 	/*
195f7853570SHeiko Stübner 	 * We support two possible frequencies, the safe 600MHz
196f7853570SHeiko Stübner 	 * which will work with default pmic settings and will
197f7853570SHeiko Stübner 	 * be set in SPL to get away from the 24MHz default and
198f7853570SHeiko Stübner 	 * the maximum of 1.6Ghz, which boards can set if they
199f7853570SHeiko Stübner 	 * were able to get pmic support for it.
200f7853570SHeiko Stübner 	 */
201f7853570SHeiko Stübner 	switch (hz) {
202f7853570SHeiko Stübner 	case APLL_SAFE_HZ:
203f7853570SHeiko Stübner 		cfg = 0;
204f7853570SHeiko Stübner 		div_core_peri = 1;
205f7853570SHeiko Stübner 		div_aclk_core = 3;
206f7853570SHeiko Stübner 		break;
207f7853570SHeiko Stübner 	case APLL_HZ:
208f7853570SHeiko Stübner 		cfg = 1;
209f7853570SHeiko Stübner 		div_core_peri = 2;
210f7853570SHeiko Stübner 		div_aclk_core = 3;
211f7853570SHeiko Stübner 		break;
212f7853570SHeiko Stübner 	default:
213f7853570SHeiko Stübner 		debug("Unsupported ARMCLK frequency");
214f7853570SHeiko Stübner 		return -EINVAL;
215f7853570SHeiko Stübner 	}
216f7853570SHeiko Stübner 
217f7853570SHeiko Stübner 	/* pll enter slow-mode */
218f7853570SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con, APLL_MODE_MASK << APLL_MODE_SHIFT,
219f7853570SHeiko Stübner 		     APLL_MODE_SLOW << APLL_MODE_SHIFT);
220f7853570SHeiko Stübner 
221f7853570SHeiko Stübner 	rkclk_set_pll(cru, CLK_ARM, &apll_cfg[cfg], has_bwadj);
222f7853570SHeiko Stübner 
223f7853570SHeiko Stübner 	/* waiting for pll lock */
224f7853570SHeiko Stübner 	while (!(readl(&grf->soc_status0) & SOCSTS_APLL_LOCK))
225f7853570SHeiko Stübner 		udelay(1);
226f7853570SHeiko Stübner 
227f7853570SHeiko Stübner 	/* Set divider for peripherals attached to the cpu core. */
228f7853570SHeiko Stübner 	rk_clrsetreg(&cru->cru_clksel_con[0],
229f7853570SHeiko Stübner 		CORE_PERI_DIV_MASK << CORE_PERI_DIV_SHIFT,
230f7853570SHeiko Stübner 		div_core_peri << CORE_PERI_DIV_SHIFT);
231f7853570SHeiko Stübner 
232f7853570SHeiko Stübner 	/* set up dependent divisor for aclk_core */
233f7853570SHeiko Stübner 	rk_clrsetreg(&cru->cru_clksel_con[1],
234f7853570SHeiko Stübner 		CORE_ACLK_DIV_MASK << CORE_ACLK_DIV_SHIFT,
235f7853570SHeiko Stübner 		div_aclk_core << CORE_ACLK_DIV_SHIFT);
236f7853570SHeiko Stübner 
237f7853570SHeiko Stübner 	/* PLL enter normal-mode */
238f7853570SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con, APLL_MODE_MASK << APLL_MODE_SHIFT,
239f7853570SHeiko Stübner 		     APLL_MODE_NORMAL << APLL_MODE_SHIFT);
240f7853570SHeiko Stübner 
241f7853570SHeiko Stübner 	return hz;
242f7853570SHeiko Stübner }
243f7853570SHeiko Stübner 
244dcdd3278SHeiko Stübner /* Get pll rate by id */
rkclk_pll_get_rate(struct rk3188_cru * cru,enum rk_clk_id clk_id)245dcdd3278SHeiko Stübner static uint32_t rkclk_pll_get_rate(struct rk3188_cru *cru,
246dcdd3278SHeiko Stübner 				   enum rk_clk_id clk_id)
247dcdd3278SHeiko Stübner {
248dcdd3278SHeiko Stübner 	uint32_t nr, no, nf;
249dcdd3278SHeiko Stübner 	uint32_t con;
250dcdd3278SHeiko Stübner 	int pll_id = rk_pll_id(clk_id);
251dcdd3278SHeiko Stübner 	struct rk3188_pll *pll = &cru->pll[pll_id];
252dcdd3278SHeiko Stübner 	static u8 clk_shift[CLK_COUNT] = {
253dcdd3278SHeiko Stübner 		0xff, APLL_MODE_SHIFT, DPLL_MODE_SHIFT, CPLL_MODE_SHIFT,
254dcdd3278SHeiko Stübner 		GPLL_MODE_SHIFT
255dcdd3278SHeiko Stübner 	};
256dcdd3278SHeiko Stübner 	uint shift;
257dcdd3278SHeiko Stübner 
258dcdd3278SHeiko Stübner 	con = readl(&cru->cru_mode_con);
259dcdd3278SHeiko Stübner 	shift = clk_shift[clk_id];
260dcdd3278SHeiko Stübner 	switch ((con >> shift) & APLL_MODE_MASK) {
261dcdd3278SHeiko Stübner 	case APLL_MODE_SLOW:
262dcdd3278SHeiko Stübner 		return OSC_HZ;
263dcdd3278SHeiko Stübner 	case APLL_MODE_NORMAL:
264dcdd3278SHeiko Stübner 		/* normal mode */
265dcdd3278SHeiko Stübner 		con = readl(&pll->con0);
266dcdd3278SHeiko Stübner 		no = ((con >> CLKOD_SHIFT) & CLKOD_MASK) + 1;
267dcdd3278SHeiko Stübner 		nr = ((con >> CLKR_SHIFT) & CLKR_MASK) + 1;
268dcdd3278SHeiko Stübner 		con = readl(&pll->con1);
269dcdd3278SHeiko Stübner 		nf = ((con >> CLKF_SHIFT) & CLKF_MASK) + 1;
270dcdd3278SHeiko Stübner 
271dcdd3278SHeiko Stübner 		return (24 * nf / (nr * no)) * 1000000;
272dcdd3278SHeiko Stübner 	case APLL_MODE_DEEP:
273dcdd3278SHeiko Stübner 	default:
274dcdd3278SHeiko Stübner 		return 32768;
275dcdd3278SHeiko Stübner 	}
276dcdd3278SHeiko Stübner }
277dcdd3278SHeiko Stübner 
rockchip_mmc_get_clk(struct rk3188_cru * cru,uint gclk_rate,int periph)278dcdd3278SHeiko Stübner static ulong rockchip_mmc_get_clk(struct rk3188_cru *cru, uint gclk_rate,
279dcdd3278SHeiko Stübner 				  int periph)
280dcdd3278SHeiko Stübner {
281dcdd3278SHeiko Stübner 	uint div;
282dcdd3278SHeiko Stübner 	u32 con;
283dcdd3278SHeiko Stübner 
284dcdd3278SHeiko Stübner 	switch (periph) {
285dcdd3278SHeiko Stübner 	case HCLK_EMMC:
2867a25a63cSXu Ziyuan 	case SCLK_EMMC:
287dcdd3278SHeiko Stübner 		con = readl(&cru->cru_clksel_con[12]);
288dcdd3278SHeiko Stübner 		div = (con >> EMMC_DIV_SHIFT) & EMMC_DIV_MASK;
289dcdd3278SHeiko Stübner 		break;
290dcdd3278SHeiko Stübner 	case HCLK_SDMMC:
2917a25a63cSXu Ziyuan 	case SCLK_SDMMC:
292dcdd3278SHeiko Stübner 		con = readl(&cru->cru_clksel_con[11]);
293dcdd3278SHeiko Stübner 		div = (con >> MMC0_DIV_SHIFT) & MMC0_DIV_MASK;
294dcdd3278SHeiko Stübner 		break;
295dcdd3278SHeiko Stübner 	case HCLK_SDIO:
2967a25a63cSXu Ziyuan 	case SCLK_SDIO:
297dcdd3278SHeiko Stübner 		con = readl(&cru->cru_clksel_con[12]);
298dcdd3278SHeiko Stübner 		div = (con >> SDIO_DIV_SHIFT) & SDIO_DIV_MASK;
299dcdd3278SHeiko Stübner 		break;
300dcdd3278SHeiko Stübner 	default:
301dcdd3278SHeiko Stübner 		return -EINVAL;
302dcdd3278SHeiko Stübner 	}
303dcdd3278SHeiko Stübner 
3043a94d75dSKever Yang 	return DIV_TO_RATE(gclk_rate, div) / 2;
305dcdd3278SHeiko Stübner }
306dcdd3278SHeiko Stübner 
rockchip_mmc_set_clk(struct rk3188_cru * cru,uint gclk_rate,int periph,uint freq)307dcdd3278SHeiko Stübner static ulong rockchip_mmc_set_clk(struct rk3188_cru *cru, uint gclk_rate,
308dcdd3278SHeiko Stübner 				  int  periph, uint freq)
309dcdd3278SHeiko Stübner {
310dcdd3278SHeiko Stübner 	int src_clk_div;
311dcdd3278SHeiko Stübner 
312dcdd3278SHeiko Stübner 	debug("%s: gclk_rate=%u\n", __func__, gclk_rate);
3133a94d75dSKever Yang 	/* mmc clock defaulg div 2 internal, need provide double in cru */
314217273cdSKever Yang 	src_clk_div = DIV_ROUND_UP(gclk_rate / 2, freq) - 1;
315dcdd3278SHeiko Stübner 	assert(src_clk_div <= 0x3f);
316dcdd3278SHeiko Stübner 
317dcdd3278SHeiko Stübner 	switch (periph) {
318dcdd3278SHeiko Stübner 	case HCLK_EMMC:
3197a25a63cSXu Ziyuan 	case SCLK_EMMC:
320dcdd3278SHeiko Stübner 		rk_clrsetreg(&cru->cru_clksel_con[12],
321dcdd3278SHeiko Stübner 			     EMMC_DIV_MASK << EMMC_DIV_SHIFT,
322dcdd3278SHeiko Stübner 			     src_clk_div << EMMC_DIV_SHIFT);
323dcdd3278SHeiko Stübner 		break;
324dcdd3278SHeiko Stübner 	case HCLK_SDMMC:
3257a25a63cSXu Ziyuan 	case SCLK_SDMMC:
326dcdd3278SHeiko Stübner 		rk_clrsetreg(&cru->cru_clksel_con[11],
327dcdd3278SHeiko Stübner 			     MMC0_DIV_MASK << MMC0_DIV_SHIFT,
328dcdd3278SHeiko Stübner 			     src_clk_div << MMC0_DIV_SHIFT);
329dcdd3278SHeiko Stübner 		break;
330dcdd3278SHeiko Stübner 	case HCLK_SDIO:
3317a25a63cSXu Ziyuan 	case SCLK_SDIO:
332dcdd3278SHeiko Stübner 		rk_clrsetreg(&cru->cru_clksel_con[12],
333dcdd3278SHeiko Stübner 			     SDIO_DIV_MASK << SDIO_DIV_SHIFT,
334dcdd3278SHeiko Stübner 			     src_clk_div << SDIO_DIV_SHIFT);
335dcdd3278SHeiko Stübner 		break;
336dcdd3278SHeiko Stübner 	default:
337dcdd3278SHeiko Stübner 		return -EINVAL;
338dcdd3278SHeiko Stübner 	}
339dcdd3278SHeiko Stübner 
340dcdd3278SHeiko Stübner 	return rockchip_mmc_get_clk(cru, gclk_rate, periph);
341dcdd3278SHeiko Stübner }
342dcdd3278SHeiko Stübner 
rockchip_spi_get_clk(struct rk3188_cru * cru,uint gclk_rate,int periph)343dcdd3278SHeiko Stübner static ulong rockchip_spi_get_clk(struct rk3188_cru *cru, uint gclk_rate,
344dcdd3278SHeiko Stübner 				  int periph)
345dcdd3278SHeiko Stübner {
346dcdd3278SHeiko Stübner 	uint div;
347dcdd3278SHeiko Stübner 	u32 con;
348dcdd3278SHeiko Stübner 
349dcdd3278SHeiko Stübner 	switch (periph) {
350dcdd3278SHeiko Stübner 	case SCLK_SPI0:
351dcdd3278SHeiko Stübner 		con = readl(&cru->cru_clksel_con[25]);
352dcdd3278SHeiko Stübner 		div = (con >> SPI0_DIV_SHIFT) & SPI0_DIV_MASK;
353dcdd3278SHeiko Stübner 		break;
354dcdd3278SHeiko Stübner 	case SCLK_SPI1:
355dcdd3278SHeiko Stübner 		con = readl(&cru->cru_clksel_con[25]);
356dcdd3278SHeiko Stübner 		div = (con >> SPI1_DIV_SHIFT) & SPI1_DIV_MASK;
357dcdd3278SHeiko Stübner 		break;
358dcdd3278SHeiko Stübner 	default:
359dcdd3278SHeiko Stübner 		return -EINVAL;
360dcdd3278SHeiko Stübner 	}
361dcdd3278SHeiko Stübner 
362dcdd3278SHeiko Stübner 	return DIV_TO_RATE(gclk_rate, div);
363dcdd3278SHeiko Stübner }
364dcdd3278SHeiko Stübner 
rockchip_spi_set_clk(struct rk3188_cru * cru,uint gclk_rate,int periph,uint freq)365dcdd3278SHeiko Stübner static ulong rockchip_spi_set_clk(struct rk3188_cru *cru, uint gclk_rate,
366dcdd3278SHeiko Stübner 				  int periph, uint freq)
367dcdd3278SHeiko Stübner {
368217273cdSKever Yang 	int src_clk_div = DIV_ROUND_UP(gclk_rate, freq) - 1;
369dcdd3278SHeiko Stübner 
370217273cdSKever Yang 	assert(src_clk_div < 128);
371dcdd3278SHeiko Stübner 	switch (periph) {
372dcdd3278SHeiko Stübner 	case SCLK_SPI0:
373dcdd3278SHeiko Stübner 		assert(src_clk_div <= SPI0_DIV_MASK);
374dcdd3278SHeiko Stübner 		rk_clrsetreg(&cru->cru_clksel_con[25],
375dcdd3278SHeiko Stübner 			     SPI0_DIV_MASK << SPI0_DIV_SHIFT,
376dcdd3278SHeiko Stübner 			     src_clk_div << SPI0_DIV_SHIFT);
377dcdd3278SHeiko Stübner 		break;
378dcdd3278SHeiko Stübner 	case SCLK_SPI1:
379dcdd3278SHeiko Stübner 		assert(src_clk_div <= SPI1_DIV_MASK);
380dcdd3278SHeiko Stübner 		rk_clrsetreg(&cru->cru_clksel_con[25],
381dcdd3278SHeiko Stübner 			     SPI1_DIV_MASK << SPI1_DIV_SHIFT,
382dcdd3278SHeiko Stübner 			     src_clk_div << SPI1_DIV_SHIFT);
383dcdd3278SHeiko Stübner 		break;
384dcdd3278SHeiko Stübner 	default:
385dcdd3278SHeiko Stübner 		return -EINVAL;
386dcdd3278SHeiko Stübner 	}
387dcdd3278SHeiko Stübner 
388dcdd3278SHeiko Stübner 	return rockchip_spi_get_clk(cru, gclk_rate, periph);
389dcdd3278SHeiko Stübner }
390dcdd3278SHeiko Stübner 
rk3188_saradc_get_clk(struct rk3188_cru * cru)391dcb51bfeSDavid Wu static ulong rk3188_saradc_get_clk(struct rk3188_cru *cru)
392dcb51bfeSDavid Wu {
393dcb51bfeSDavid Wu 	u32 div, val;
394dcb51bfeSDavid Wu 
395dcb51bfeSDavid Wu 	val = readl(&cru->cru_clksel_con[24]);
396dcb51bfeSDavid Wu 	div = bitfield_extract(val, SARADC_DIV_SHIFT, SARADC_DIV_WIDTH);
397dcb51bfeSDavid Wu 
398dcb51bfeSDavid Wu 	return DIV_TO_RATE(OSC_HZ, div);
399dcb51bfeSDavid Wu }
400dcb51bfeSDavid Wu 
rk3188_saradc_set_clk(struct rk3188_cru * cru,uint hz)401dcb51bfeSDavid Wu static ulong rk3188_saradc_set_clk(struct rk3188_cru *cru, uint hz)
402dcb51bfeSDavid Wu {
403dcb51bfeSDavid Wu 	int src_clk_div;
404dcb51bfeSDavid Wu 
405dcb51bfeSDavid Wu 	src_clk_div = DIV_ROUND_UP(OSC_HZ, hz) - 1;
406dcb51bfeSDavid Wu 	assert(src_clk_div < 128);
407dcb51bfeSDavid Wu 
408dcb51bfeSDavid Wu 	rk_clrsetreg(&cru->cru_clksel_con[24],
409dcb51bfeSDavid Wu 		     SARADC_DIV_MASK,
410dcb51bfeSDavid Wu 		     src_clk_div << SARADC_DIV_SHIFT);
411dcb51bfeSDavid Wu 
412dcb51bfeSDavid Wu 	return rk3188_saradc_get_clk(cru);
413dcb51bfeSDavid Wu }
414dcb51bfeSDavid Wu 
415dcdd3278SHeiko Stübner #ifdef CONFIG_SPL_BUILD
rkclk_init(struct rk3188_cru * cru,struct rk3188_grf * grf,bool has_bwadj)416dcdd3278SHeiko Stübner static void rkclk_init(struct rk3188_cru *cru, struct rk3188_grf *grf,
417dcdd3278SHeiko Stübner 		       bool has_bwadj)
418dcdd3278SHeiko Stübner {
419dcdd3278SHeiko Stübner 	u32 aclk_div, hclk_div, pclk_div, h2p_div;
420dcdd3278SHeiko Stübner 
421dcdd3278SHeiko Stübner 	/* pll enter slow-mode */
422dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con,
423dcdd3278SHeiko Stübner 		     GPLL_MODE_MASK << GPLL_MODE_SHIFT |
424dcdd3278SHeiko Stübner 		     CPLL_MODE_MASK << CPLL_MODE_SHIFT,
425dcdd3278SHeiko Stübner 		     GPLL_MODE_SLOW << GPLL_MODE_SHIFT |
426dcdd3278SHeiko Stübner 		     CPLL_MODE_SLOW << CPLL_MODE_SHIFT);
427dcdd3278SHeiko Stübner 
428dcdd3278SHeiko Stübner 	/* init pll */
429dcdd3278SHeiko Stübner 	rkclk_set_pll(cru, CLK_GENERAL, &gpll_init_cfg, has_bwadj);
430dcdd3278SHeiko Stübner 	rkclk_set_pll(cru, CLK_CODEC, &cpll_init_cfg, has_bwadj);
431dcdd3278SHeiko Stübner 
432dcdd3278SHeiko Stübner 	/* waiting for pll lock */
433dcdd3278SHeiko Stübner 	while ((readl(&grf->soc_status0) &
434dcdd3278SHeiko Stübner 			(SOCSTS_CPLL_LOCK | SOCSTS_GPLL_LOCK)) !=
435dcdd3278SHeiko Stübner 			(SOCSTS_CPLL_LOCK | SOCSTS_GPLL_LOCK))
436dcdd3278SHeiko Stübner 		udelay(1);
437dcdd3278SHeiko Stübner 
438dcdd3278SHeiko Stübner 	/*
439dcdd3278SHeiko Stübner 	 * cpu clock pll source selection and
440dcdd3278SHeiko Stübner 	 * reparent aclk_cpu_pre from apll to gpll
441dcdd3278SHeiko Stübner 	 * set up dependent divisors for PCLK/HCLK and ACLK clocks.
442dcdd3278SHeiko Stübner 	 */
443217273cdSKever Yang 	aclk_div = DIV_ROUND_UP(GPLL_HZ, CPU_ACLK_HZ) - 1;
444*d177ad99SElaine Zhang 	assert((aclk_div + 1) * CPU_ACLK_HZ <= GPLL_HZ && aclk_div <= 0x1f);
445dcdd3278SHeiko Stübner 
446dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_clksel_con[0],
447dcdd3278SHeiko Stübner 		     CPU_ACLK_PLL_MASK << CPU_ACLK_PLL_SHIFT |
448dcdd3278SHeiko Stübner 		     A9_CPU_DIV_MASK << A9_CPU_DIV_SHIFT,
449dcdd3278SHeiko Stübner 		     CPU_ACLK_PLL_SELECT_GPLL << CPU_ACLK_PLL_SHIFT |
450dcdd3278SHeiko Stübner 		     aclk_div << A9_CPU_DIV_SHIFT);
451dcdd3278SHeiko Stübner 
452dcdd3278SHeiko Stübner 	hclk_div = ilog2(CPU_ACLK_HZ / CPU_HCLK_HZ);
453*d177ad99SElaine Zhang 	assert((1 << hclk_div) * CPU_HCLK_HZ <= CPU_ACLK_HZ && hclk_div < 0x3);
454dcdd3278SHeiko Stübner 	pclk_div = ilog2(CPU_ACLK_HZ / CPU_PCLK_HZ);
455*d177ad99SElaine Zhang 	assert((1 << pclk_div) * CPU_PCLK_HZ <= CPU_ACLK_HZ && pclk_div < 0x4);
456dcdd3278SHeiko Stübner 	h2p_div = ilog2(CPU_HCLK_HZ / CPU_H2P_HZ);
457*d177ad99SElaine Zhang 	assert((1 << h2p_div) * CPU_H2P_HZ <= CPU_HCLK_HZ && pclk_div < 0x3);
458dcdd3278SHeiko Stübner 
459dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_clksel_con[1],
460dcdd3278SHeiko Stübner 		     AHB2APB_DIV_MASK << AHB2APB_DIV_SHIFT |
461dcdd3278SHeiko Stübner 		     CPU_PCLK_DIV_MASK << CPU_PCLK_DIV_SHIFT |
462dcdd3278SHeiko Stübner 		     CPU_HCLK_DIV_MASK << CPU_HCLK_DIV_SHIFT,
463dcdd3278SHeiko Stübner 		     h2p_div << AHB2APB_DIV_SHIFT |
464dcdd3278SHeiko Stübner 		     pclk_div << CPU_PCLK_DIV_SHIFT |
465dcdd3278SHeiko Stübner 		     hclk_div << CPU_HCLK_DIV_SHIFT);
466dcdd3278SHeiko Stübner 
467dcdd3278SHeiko Stübner 	/*
468dcdd3278SHeiko Stübner 	 * peri clock pll source selection and
469dcdd3278SHeiko Stübner 	 * set up dependent divisors for PCLK/HCLK and ACLK clocks.
470dcdd3278SHeiko Stübner 	 */
471dcdd3278SHeiko Stübner 	aclk_div = GPLL_HZ / PERI_ACLK_HZ - 1;
472*d177ad99SElaine Zhang 	assert((aclk_div + 1) * PERI_ACLK_HZ <= GPLL_HZ && aclk_div < 0x1f);
473dcdd3278SHeiko Stübner 
474dcdd3278SHeiko Stübner 	hclk_div = ilog2(PERI_ACLK_HZ / PERI_HCLK_HZ);
475*d177ad99SElaine Zhang 	assert((1 << hclk_div) * PERI_HCLK_HZ <=
476dcdd3278SHeiko Stübner 		PERI_ACLK_HZ && (hclk_div < 0x4));
477dcdd3278SHeiko Stübner 
478dcdd3278SHeiko Stübner 	pclk_div = ilog2(PERI_ACLK_HZ / PERI_PCLK_HZ);
479*d177ad99SElaine Zhang 	assert((1 << pclk_div) * PERI_PCLK_HZ <=
480dcdd3278SHeiko Stübner 		PERI_ACLK_HZ && (pclk_div < 0x4));
481dcdd3278SHeiko Stübner 
482dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_clksel_con[10],
483dcdd3278SHeiko Stübner 		     PERI_PCLK_DIV_MASK << PERI_PCLK_DIV_SHIFT |
484dcdd3278SHeiko Stübner 		     PERI_HCLK_DIV_MASK << PERI_HCLK_DIV_SHIFT |
485dcdd3278SHeiko Stübner 		     PERI_ACLK_DIV_MASK << PERI_ACLK_DIV_SHIFT,
486dcdd3278SHeiko Stübner 		     PERI_SEL_GPLL << PERI_SEL_PLL_SHIFT |
487dcdd3278SHeiko Stübner 		     pclk_div << PERI_PCLK_DIV_SHIFT |
488dcdd3278SHeiko Stübner 		     hclk_div << PERI_HCLK_DIV_SHIFT |
489dcdd3278SHeiko Stübner 		     aclk_div << PERI_ACLK_DIV_SHIFT);
490dcdd3278SHeiko Stübner 
491dcdd3278SHeiko Stübner 	/* PLL enter normal-mode */
492dcdd3278SHeiko Stübner 	rk_clrsetreg(&cru->cru_mode_con,
493dcdd3278SHeiko Stübner 		     GPLL_MODE_MASK << GPLL_MODE_SHIFT |
494dcdd3278SHeiko Stübner 		     CPLL_MODE_MASK << CPLL_MODE_SHIFT,
495dcdd3278SHeiko Stübner 		     GPLL_MODE_NORMAL << GPLL_MODE_SHIFT |
496dcdd3278SHeiko Stübner 		     CPLL_MODE_NORMAL << CPLL_MODE_SHIFT);
497dcdd3278SHeiko Stübner 
498dcdd3278SHeiko Stübner 	rockchip_mmc_set_clk(cru, PERI_HCLK_HZ, HCLK_SDMMC, 16000000);
499dcdd3278SHeiko Stübner }
500dcdd3278SHeiko Stübner #endif
501dcdd3278SHeiko Stübner 
rk3188_clk_get_rate(struct clk * clk)502dcdd3278SHeiko Stübner static ulong rk3188_clk_get_rate(struct clk *clk)
503dcdd3278SHeiko Stübner {
504dcdd3278SHeiko Stübner 	struct rk3188_clk_priv *priv = dev_get_priv(clk->dev);
505dcdd3278SHeiko Stübner 	ulong new_rate, gclk_rate;
506dcdd3278SHeiko Stübner 
507dcdd3278SHeiko Stübner 	gclk_rate = rkclk_pll_get_rate(priv->cru, CLK_GENERAL);
508dcdd3278SHeiko Stübner 	switch (clk->id) {
509dcdd3278SHeiko Stübner 	case 1 ... 4:
510dcdd3278SHeiko Stübner 		new_rate = rkclk_pll_get_rate(priv->cru, clk->id);
511dcdd3278SHeiko Stübner 		break;
512dcdd3278SHeiko Stübner 	case HCLK_EMMC:
513dcdd3278SHeiko Stübner 	case HCLK_SDMMC:
514dcdd3278SHeiko Stübner 	case HCLK_SDIO:
5157a25a63cSXu Ziyuan 	case SCLK_EMMC:
5167a25a63cSXu Ziyuan 	case SCLK_SDMMC:
5177a25a63cSXu Ziyuan 	case SCLK_SDIO:
518dcdd3278SHeiko Stübner 		new_rate = rockchip_mmc_get_clk(priv->cru, PERI_HCLK_HZ,
519dcdd3278SHeiko Stübner 						clk->id);
520dcdd3278SHeiko Stübner 		break;
521dcdd3278SHeiko Stübner 	case SCLK_SPI0:
522dcdd3278SHeiko Stübner 	case SCLK_SPI1:
523dcdd3278SHeiko Stübner 		new_rate = rockchip_spi_get_clk(priv->cru, PERI_PCLK_HZ,
524dcdd3278SHeiko Stübner 						clk->id);
525dcdd3278SHeiko Stübner 		break;
526dcdd3278SHeiko Stübner 	case PCLK_I2C0:
527dcdd3278SHeiko Stübner 	case PCLK_I2C1:
528dcdd3278SHeiko Stübner 	case PCLK_I2C2:
529dcdd3278SHeiko Stübner 	case PCLK_I2C3:
530dcdd3278SHeiko Stübner 	case PCLK_I2C4:
531dcdd3278SHeiko Stübner 		return gclk_rate;
532dcb51bfeSDavid Wu 	case SCLK_SARADC:
533dcb51bfeSDavid Wu                 new_rate =  rk3188_saradc_get_clk(priv->cru);
534dcdd3278SHeiko Stübner 	default:
535dcdd3278SHeiko Stübner 		return -ENOENT;
536dcdd3278SHeiko Stübner 	}
537dcdd3278SHeiko Stübner 
538dcdd3278SHeiko Stübner 	return new_rate;
539dcdd3278SHeiko Stübner }
540dcdd3278SHeiko Stübner 
rk3188_clk_set_rate(struct clk * clk,ulong rate)541dcdd3278SHeiko Stübner static ulong rk3188_clk_set_rate(struct clk *clk, ulong rate)
542dcdd3278SHeiko Stübner {
543dcdd3278SHeiko Stübner 	struct rk3188_clk_priv *priv = dev_get_priv(clk->dev);
544dcdd3278SHeiko Stübner 	struct rk3188_cru *cru = priv->cru;
545dcdd3278SHeiko Stübner 	ulong new_rate;
546dcdd3278SHeiko Stübner 
547dcdd3278SHeiko Stübner 	switch (clk->id) {
548f7853570SHeiko Stübner 	case PLL_APLL:
549f7853570SHeiko Stübner 		new_rate = rkclk_configure_cpu(priv->cru, priv->grf, rate,
550f7853570SHeiko Stübner 					       priv->has_bwadj);
551f7853570SHeiko Stübner 		break;
552dcdd3278SHeiko Stübner 	case CLK_DDR:
553dcdd3278SHeiko Stübner 		new_rate = rkclk_configure_ddr(priv->cru, priv->grf, rate,
554dcdd3278SHeiko Stübner 					       priv->has_bwadj);
555dcdd3278SHeiko Stübner 		break;
556dcdd3278SHeiko Stübner 	case HCLK_EMMC:
557dcdd3278SHeiko Stübner 	case HCLK_SDMMC:
558dcdd3278SHeiko Stübner 	case HCLK_SDIO:
5597a25a63cSXu Ziyuan 	case SCLK_EMMC:
5607a25a63cSXu Ziyuan 	case SCLK_SDMMC:
5617a25a63cSXu Ziyuan 	case SCLK_SDIO:
562dcdd3278SHeiko Stübner 		new_rate = rockchip_mmc_set_clk(cru, PERI_HCLK_HZ,
563dcdd3278SHeiko Stübner 						clk->id, rate);
564dcdd3278SHeiko Stübner 		break;
565dcdd3278SHeiko Stübner 	case SCLK_SPI0:
566dcdd3278SHeiko Stübner 	case SCLK_SPI1:
567dcdd3278SHeiko Stübner 		new_rate = rockchip_spi_set_clk(cru, PERI_PCLK_HZ,
568dcdd3278SHeiko Stübner 						clk->id, rate);
569dcdd3278SHeiko Stübner 		break;
570dcb51bfeSDavid Wu 	case SCLK_SARADC:
571dcb51bfeSDavid Wu 		new_rate = rk3188_saradc_set_clk(priv->cru, rate);
572dcb51bfeSDavid Wu 		break;
573dcdd3278SHeiko Stübner 	default:
574dcdd3278SHeiko Stübner 		return -ENOENT;
575dcdd3278SHeiko Stübner 	}
576dcdd3278SHeiko Stübner 
577dcdd3278SHeiko Stübner 	return new_rate;
578dcdd3278SHeiko Stübner }
579dcdd3278SHeiko Stübner 
580dcdd3278SHeiko Stübner static struct clk_ops rk3188_clk_ops = {
581dcdd3278SHeiko Stübner 	.get_rate	= rk3188_clk_get_rate,
582dcdd3278SHeiko Stübner 	.set_rate	= rk3188_clk_set_rate,
583dcdd3278SHeiko Stübner };
584dcdd3278SHeiko Stübner 
rk3188_clk_ofdata_to_platdata(struct udevice * dev)585dcdd3278SHeiko Stübner static int rk3188_clk_ofdata_to_platdata(struct udevice *dev)
586dcdd3278SHeiko Stübner {
587dcdd3278SHeiko Stübner #if !CONFIG_IS_ENABLED(OF_PLATDATA)
588dcdd3278SHeiko Stübner 	struct rk3188_clk_priv *priv = dev_get_priv(dev);
589dcdd3278SHeiko Stübner 
590b1cc17a3SKever Yang 	priv->cru = dev_read_addr_ptr(dev);
591dcdd3278SHeiko Stübner #endif
592dcdd3278SHeiko Stübner 
593dcdd3278SHeiko Stübner 	return 0;
594dcdd3278SHeiko Stübner }
595dcdd3278SHeiko Stübner 
rk3188_clk_probe(struct udevice * dev)596dcdd3278SHeiko Stübner static int rk3188_clk_probe(struct udevice *dev)
597dcdd3278SHeiko Stübner {
598dcdd3278SHeiko Stübner 	struct rk3188_clk_priv *priv = dev_get_priv(dev);
599dcdd3278SHeiko Stübner 	enum rk3188_clk_type type = dev_get_driver_data(dev);
600dcdd3278SHeiko Stübner 
601dcdd3278SHeiko Stübner 	priv->grf = syscon_get_first_range(ROCKCHIP_SYSCON_GRF);
602dcdd3278SHeiko Stübner 	if (IS_ERR(priv->grf))
603dcdd3278SHeiko Stübner 		return PTR_ERR(priv->grf);
604dcdd3278SHeiko Stübner 	priv->has_bwadj = (type == RK3188A_CRU) ? 1 : 0;
605dcdd3278SHeiko Stübner 
606dcdd3278SHeiko Stübner #ifdef CONFIG_SPL_BUILD
607dcdd3278SHeiko Stübner #if CONFIG_IS_ENABLED(OF_PLATDATA)
608dcdd3278SHeiko Stübner 	struct rk3188_clk_plat *plat = dev_get_platdata(dev);
609dcdd3278SHeiko Stübner 
610dcdd3278SHeiko Stübner 	priv->cru = map_sysmem(plat->dtd.reg[0], plat->dtd.reg[1]);
611dcdd3278SHeiko Stübner #endif
612441bfb78SElaine Zhang 	priv->sync_kernel = false;
613441bfb78SElaine Zhang 	if (!priv->armclk_enter_hz)
614441bfb78SElaine Zhang 		priv->armclk_enter_hz = rkclk_pll_get_rate(priv->cru,
615441bfb78SElaine Zhang 							   CLK_ARM);
616dcdd3278SHeiko Stübner 	rkclk_init(priv->cru, priv->grf, priv->has_bwadj);
617441bfb78SElaine Zhang 	if (!priv->armclk_init_hz)
618441bfb78SElaine Zhang 		priv->armclk_init_hz = rkclk_pll_get_rate(priv->cru,
619441bfb78SElaine Zhang 							  CLK_ARM);
620dcdd3278SHeiko Stübner #endif
621dcdd3278SHeiko Stübner 
622dcdd3278SHeiko Stübner 	return 0;
623dcdd3278SHeiko Stübner }
624dcdd3278SHeiko Stübner 
rk3188_clk_bind(struct udevice * dev)625dcdd3278SHeiko Stübner static int rk3188_clk_bind(struct udevice *dev)
626dcdd3278SHeiko Stübner {
627dcdd3278SHeiko Stübner 	int ret;
6283d555d75SElaine Zhang 	struct udevice *sys_child, *sf_child;
629fbdd1558SKever Yang 	struct sysreset_reg *priv;
6303d555d75SElaine Zhang 	struct softreset_reg *sf_priv;
631dcdd3278SHeiko Stübner 
632dcdd3278SHeiko Stübner 	/* The reset driver does not have a device node, so bind it here */
633fbdd1558SKever Yang 	ret = device_bind_driver(dev, "rockchip_sysreset", "sysreset",
634fbdd1558SKever Yang 				 &sys_child);
635fbdd1558SKever Yang 	if (ret) {
636fbdd1558SKever Yang 		debug("Warning: No sysreset driver: ret=%d\n", ret);
637fbdd1558SKever Yang 	} else {
638fbdd1558SKever Yang 		priv = malloc(sizeof(struct sysreset_reg));
639fbdd1558SKever Yang 		priv->glb_srst_fst_value = offsetof(struct rk3188_cru,
640fbdd1558SKever Yang 						    cru_glb_srst_fst_value);
641fbdd1558SKever Yang 		priv->glb_srst_snd_value = offsetof(struct rk3188_cru,
642fbdd1558SKever Yang 						    cru_glb_srst_snd_value);
643fbdd1558SKever Yang 		sys_child->priv = priv;
644fbdd1558SKever Yang 	}
645dcdd3278SHeiko Stübner 
6463d555d75SElaine Zhang 	ret = device_bind_driver_to_node(dev, "rockchip_reset", "reset",
6473d555d75SElaine Zhang 					 dev_ofnode(dev), &sf_child);
6483d555d75SElaine Zhang 	if (ret) {
6493d555d75SElaine Zhang 		debug("Warning: No rockchip reset driver: ret=%d\n", ret);
6503d555d75SElaine Zhang 	} else {
6513d555d75SElaine Zhang 		sf_priv = malloc(sizeof(struct softreset_reg));
6523d555d75SElaine Zhang 		sf_priv->sf_reset_offset = offsetof(struct rk3188_cru,
6533d555d75SElaine Zhang 						    cru_softrst_con[0]);
6543d555d75SElaine Zhang 		sf_priv->sf_reset_num = 9;
6553d555d75SElaine Zhang 		sf_child->priv = sf_priv;
6563d555d75SElaine Zhang 	}
6573d555d75SElaine Zhang 
658dcdd3278SHeiko Stübner 	return 0;
659dcdd3278SHeiko Stübner }
660dcdd3278SHeiko Stübner 
661dcdd3278SHeiko Stübner static const struct udevice_id rk3188_clk_ids[] = {
662dcdd3278SHeiko Stübner 	{ .compatible = "rockchip,rk3188-cru", .data = RK3188_CRU },
663dcdd3278SHeiko Stübner 	{ .compatible = "rockchip,rk3188a-cru", .data = RK3188A_CRU },
664dcdd3278SHeiko Stübner 	{ }
665dcdd3278SHeiko Stübner };
666dcdd3278SHeiko Stübner 
667dcdd3278SHeiko Stübner U_BOOT_DRIVER(rockchip_rk3188_cru) = {
668dcdd3278SHeiko Stübner 	.name			= "rockchip_rk3188_cru",
669dcdd3278SHeiko Stübner 	.id			= UCLASS_CLK,
670dcdd3278SHeiko Stübner 	.of_match		= rk3188_clk_ids,
671dcdd3278SHeiko Stübner 	.priv_auto_alloc_size	= sizeof(struct rk3188_clk_priv),
672dcdd3278SHeiko Stübner 	.platdata_auto_alloc_size = sizeof(struct rk3188_clk_plat),
673dcdd3278SHeiko Stübner 	.ops			= &rk3188_clk_ops,
674dcdd3278SHeiko Stübner 	.bind			= rk3188_clk_bind,
675dcdd3278SHeiko Stübner 	.ofdata_to_platdata	= rk3188_clk_ofdata_to_platdata,
676dcdd3278SHeiko Stübner 	.probe			= rk3188_clk_probe,
677dcdd3278SHeiko Stübner };
678441bfb78SElaine Zhang 
679441bfb78SElaine Zhang #ifndef CONFIG_SPL_BUILD
680441bfb78SElaine Zhang /**
681441bfb78SElaine Zhang  * soc_clk_dump() - Print clock frequencies
682441bfb78SElaine Zhang  * Returns zero on success
683441bfb78SElaine Zhang  *
684441bfb78SElaine Zhang  * Implementation for the clk dump command.
685441bfb78SElaine Zhang  */
soc_clk_dump(void)686441bfb78SElaine Zhang int soc_clk_dump(void)
687441bfb78SElaine Zhang {
688441bfb78SElaine Zhang 	struct udevice *cru_dev;
689441bfb78SElaine Zhang 	struct rk3188_clk_priv *priv;
690441bfb78SElaine Zhang 	const struct rk3188_clk_info *clk_dump;
691441bfb78SElaine Zhang 	struct clk clk;
692441bfb78SElaine Zhang 	unsigned long clk_count = ARRAY_SIZE(clks_dump);
693441bfb78SElaine Zhang 	unsigned long rate;
694441bfb78SElaine Zhang 	int i, ret;
695441bfb78SElaine Zhang 
696441bfb78SElaine Zhang 	ret = uclass_get_device_by_driver(UCLASS_CLK,
697441bfb78SElaine Zhang 					  DM_GET_DRIVER(rockchip_rk3188_cru),
698441bfb78SElaine Zhang 					  &cru_dev);
699441bfb78SElaine Zhang 	if (ret) {
700441bfb78SElaine Zhang 		printf("%s failed to get cru device\n", __func__);
701441bfb78SElaine Zhang 		return ret;
702441bfb78SElaine Zhang 	}
703441bfb78SElaine Zhang 
704441bfb78SElaine Zhang 	priv = dev_get_priv(cru_dev);
705441bfb78SElaine Zhang 	printf("CLK: (%s. arm: enter %lu KHz, init %lu KHz, kernel %lu%s)\n",
706441bfb78SElaine Zhang 	       priv->sync_kernel ? "sync kernel" : "uboot",
707441bfb78SElaine Zhang 	       priv->armclk_enter_hz / 1000,
708441bfb78SElaine Zhang 	       priv->armclk_init_hz / 1000,
709441bfb78SElaine Zhang 	       priv->set_armclk_rate ? priv->armclk_hz / 1000 : 0,
710441bfb78SElaine Zhang 	       priv->set_armclk_rate ? " KHz" : "N/A");
711441bfb78SElaine Zhang 	for (i = 0; i < clk_count; i++) {
712441bfb78SElaine Zhang 		clk_dump = &clks_dump[i];
713441bfb78SElaine Zhang 		if (clk_dump->name) {
714441bfb78SElaine Zhang 			clk.id = clk_dump->id;
715441bfb78SElaine Zhang 			if (clk_dump->is_cru)
716441bfb78SElaine Zhang 				ret = clk_request(cru_dev, &clk);
717441bfb78SElaine Zhang 			if (ret < 0)
718441bfb78SElaine Zhang 				return ret;
719441bfb78SElaine Zhang 
720441bfb78SElaine Zhang 			rate = clk_get_rate(&clk);
721441bfb78SElaine Zhang 			clk_free(&clk);
722441bfb78SElaine Zhang 			if (i == 0) {
723441bfb78SElaine Zhang 				if (rate < 0)
724441bfb78SElaine Zhang 					printf("  %s %s\n", clk_dump->name,
725441bfb78SElaine Zhang 					       "unknown");
726441bfb78SElaine Zhang 				else
727441bfb78SElaine Zhang 					printf("  %s %lu KHz\n", clk_dump->name,
728441bfb78SElaine Zhang 					       rate / 1000);
729441bfb78SElaine Zhang 			} else {
730441bfb78SElaine Zhang 				if (rate < 0)
731441bfb78SElaine Zhang 					printf("  %s %s\n", clk_dump->name,
732441bfb78SElaine Zhang 					       "unknown");
733441bfb78SElaine Zhang 				else
734441bfb78SElaine Zhang 					printf("  %s %lu KHz\n", clk_dump->name,
735441bfb78SElaine Zhang 					       rate / 1000);
736441bfb78SElaine Zhang 			}
737441bfb78SElaine Zhang 		}
738441bfb78SElaine Zhang 	}
739441bfb78SElaine Zhang 
740441bfb78SElaine Zhang 	return 0;
741441bfb78SElaine Zhang }
742441bfb78SElaine Zhang #endif
743441bfb78SElaine Zhang 
744