xref: /openbmc/u-boot/drivers/clk/aspeed/clk_ast2600.c (revision de49ffa7f590c559c6c105b61b443bd8b2b17050)
1550e691bSryan_chen // SPDX-License-Identifier: GPL-2.0
2550e691bSryan_chen /*
3550e691bSryan_chen  * Copyright (C) ASPEED Technology Inc.
4550e691bSryan_chen  */
5550e691bSryan_chen 
6550e691bSryan_chen #include <common.h>
7550e691bSryan_chen #include <clk-uclass.h>
8550e691bSryan_chen #include <dm.h>
9550e691bSryan_chen #include <asm/io.h>
10550e691bSryan_chen #include <dm/lists.h>
1162a6bcbfSryan_chen #include <asm/arch/scu_ast2600.h>
12d6e349c7Sryan_chen #include <dt-bindings/clock/ast2600-clock.h>
1339283ea7Sryan_chen #include <dt-bindings/reset/ast2600-reset.h>
14550e691bSryan_chen 
15550e691bSryan_chen /*
16a8fc7648SRyan Chen  * MAC Clock Delay settings
17550e691bSryan_chen  */
18550e691bSryan_chen #define RGMII_TXCLK_ODLY		8
19550e691bSryan_chen #define RMII_RXCLK_IDLY			2
20550e691bSryan_chen 
213dc90377SDylan Hung #define MAC_DEF_DELAY_1G		0x0041b75d
2275605a4bSDylan Hung #define MAC_DEF_DELAY_100M		0x00417410
2375605a4bSDylan Hung #define MAC_DEF_DELAY_10M		0x00417410
2454f9cba1SDylan Hung 
253dc90377SDylan Hung #define MAC34_DEF_DELAY_1G		0x0010438a
2654f9cba1SDylan Hung #define MAC34_DEF_DELAY_100M	0x00104208
2754f9cba1SDylan Hung #define MAC34_DEF_DELAY_10M		0x00104208
284760b3f8SDylan Hung 
29550e691bSryan_chen /*
30550e691bSryan_chen  * TGMII Clock Duty constants, taken from Aspeed SDK
31550e691bSryan_chen  */
32550e691bSryan_chen #define RGMII2_TXCK_DUTY		0x66
33550e691bSryan_chen #define RGMII1_TXCK_DUTY		0x64
34550e691bSryan_chen #define D2PLL_DEFAULT_RATE		(250 * 1000 * 1000)
3585d48d8cSryan_chen #define CHIP_REVISION_ID		GENMASK(23, 16)
3685d48d8cSryan_chen 
37550e691bSryan_chen DECLARE_GLOBAL_DATA_PTR;
38550e691bSryan_chen 
39550e691bSryan_chen /*
40550e691bSryan_chen  * Clock divider/multiplier configuration struct.
41550e691bSryan_chen  * For H-PLL and M-PLL the formula is
42550e691bSryan_chen  * (Output Frequency) = CLKIN * ((M + 1) / (N + 1)) / (P + 1)
43550e691bSryan_chen  * M - Numerator
44550e691bSryan_chen  * N - Denumerator
45550e691bSryan_chen  * P - Post Divider
46550e691bSryan_chen  * They have the same layout in their control register.
47550e691bSryan_chen  *
48550e691bSryan_chen  * D-PLL and D2-PLL have extra divider (OD + 1), which is not
49550e691bSryan_chen  * yet needed and ignored by clock configurations.
50550e691bSryan_chen  */
51577fcdaeSDylan Hung union ast2600_pll_reg {
52334bd202SDylan Hung 	u32 w;
53577fcdaeSDylan Hung 	struct {
54fd52be0bSDylan Hung 		unsigned int m : 13;		/* bit[12:0]	*/
55fd52be0bSDylan Hung 		unsigned int n : 6;		/* bit[18:13]	*/
56fd52be0bSDylan Hung 		unsigned int p : 4;		/* bit[22:19]	*/
57fd52be0bSDylan Hung 		unsigned int off : 1;		/* bit[23]	*/
58fd52be0bSDylan Hung 		unsigned int bypass : 1;	/* bit[24]	*/
59fd52be0bSDylan Hung 		unsigned int reset : 1;		/* bit[25]	*/
60fd52be0bSDylan Hung 		unsigned int reserved : 6;	/* bit[31:26]	*/
61577fcdaeSDylan Hung 	} b;
62577fcdaeSDylan Hung };
63577fcdaeSDylan Hung 
64577fcdaeSDylan Hung struct ast2600_pll_cfg {
65577fcdaeSDylan Hung 	union ast2600_pll_reg reg;
66334bd202SDylan Hung 	u32 ext_reg;
67577fcdaeSDylan Hung };
68577fcdaeSDylan Hung 
69577fcdaeSDylan Hung struct ast2600_pll_desc {
70577fcdaeSDylan Hung 	u32 in;
71577fcdaeSDylan Hung 	u32 out;
72577fcdaeSDylan Hung 	struct ast2600_pll_cfg cfg;
73577fcdaeSDylan Hung };
74577fcdaeSDylan Hung 
75577fcdaeSDylan Hung static const struct ast2600_pll_desc ast2600_pll_lookup[] = {
76a8fc7648SRyan Chen 	{
775d05f4fcSRyan Chen 		.in = AST2600_CLK_IN,
785d05f4fcSRyan Chen 		.out = 400000000,
795d05f4fcSRyan Chen 		.cfg.reg.b.m = 95,
805d05f4fcSRyan Chen 		.cfg.reg.b.n = 2,
815d05f4fcSRyan Chen 		.cfg.reg.b.p = 1,
82577fcdaeSDylan Hung 		.cfg.ext_reg = 0x31,
83fa59add1SRyan Chen 	}, {
84fa59add1SRyan Chen 		.in = AST2600_CLK_IN,
855d05f4fcSRyan Chen 		.out = 200000000,
865d05f4fcSRyan Chen 		.cfg.reg.b.m = 127,
875d05f4fcSRyan Chen 		.cfg.reg.b.n = 0,
885d05f4fcSRyan Chen 		.cfg.reg.b.p = 15,
89fa59add1SRyan Chen 		.cfg.ext_reg = 0x3f,
90fa59add1SRyan Chen 	}, {
91fa59add1SRyan Chen 		.in = AST2600_CLK_IN,
925d05f4fcSRyan Chen 		.out = 334000000,
935d05f4fcSRyan Chen 		.cfg.reg.b.m = 667,
945d05f4fcSRyan Chen 		.cfg.reg.b.n = 4,
955d05f4fcSRyan Chen 		.cfg.reg.b.p = 9,
96fa59add1SRyan Chen 		.cfg.ext_reg = 0x14d,
97fa59add1SRyan Chen 	}, {
98fa59add1SRyan Chen 		.in = AST2600_CLK_IN,
995d05f4fcSRyan Chen 		.out = 1000000000,
1005d05f4fcSRyan Chen 		.cfg.reg.b.m = 119,
1015d05f4fcSRyan Chen 		.cfg.reg.b.n = 2,
1025d05f4fcSRyan Chen 		.cfg.reg.b.p = 0,
103fa59add1SRyan Chen 		.cfg.ext_reg = 0x3d,
104fa59add1SRyan Chen 	}, {
105fa59add1SRyan Chen 		.in = AST2600_CLK_IN,
1065d05f4fcSRyan Chen 		.out = 50000000,
1075d05f4fcSRyan Chen 		.cfg.reg.b.m = 95,
1085d05f4fcSRyan Chen 		.cfg.reg.b.n = 2,
1095d05f4fcSRyan Chen 		.cfg.reg.b.p = 15,
110fa59add1SRyan Chen 		.cfg.ext_reg = 0x31,
111fa59add1SRyan Chen 	},
112550e691bSryan_chen };
113550e691bSryan_chen 
114a98c71fbSDylan Hung union mac_delay_1g {
115a98c71fbSDylan Hung 	u32 w;
116a98c71fbSDylan Hung 	struct {
117a98c71fbSDylan Hung 		unsigned int tx_delay_1		: 6;	/* bit[5:0] */
118a98c71fbSDylan Hung 		unsigned int tx_delay_2		: 6;	/* bit[11:6] */
119a98c71fbSDylan Hung 		unsigned int rx_delay_1		: 6;	/* bit[17:12] */
120a98c71fbSDylan Hung 		unsigned int rx_delay_2		: 6;	/* bit[23:18] */
121a98c71fbSDylan Hung 		unsigned int rx_clk_inv_1 	: 1;	/* bit[24] */
122a98c71fbSDylan Hung 		unsigned int rx_clk_inv_2 	: 1;	/* bit[25] */
123a98c71fbSDylan Hung 		unsigned int rmii_tx_data_at_falling_1 : 1; /* bit[26] */
124a98c71fbSDylan Hung 		unsigned int rmii_tx_data_at_falling_2 : 1; /* bit[27] */
125a98c71fbSDylan Hung 		unsigned int rgmiick_pad_dir	: 1;	/* bit[28] */
126a98c71fbSDylan Hung 		unsigned int rmii_50m_oe_1 	: 1;	/* bit[29] */
127a98c71fbSDylan Hung 		unsigned int rmii_50m_oe_2	: 1;	/* bit[30] */
128a98c71fbSDylan Hung 		unsigned int rgmii_125m_o_sel 	: 1;	/* bit[31] */
129a98c71fbSDylan Hung 	} b;
130a98c71fbSDylan Hung };
131a98c71fbSDylan Hung 
132a98c71fbSDylan Hung union mac_delay_100_10 {
133a98c71fbSDylan Hung 	u32 w;
134a98c71fbSDylan Hung 	struct {
135a98c71fbSDylan Hung 		unsigned int tx_delay_1		: 6;	/* bit[5:0] */
136a98c71fbSDylan Hung 		unsigned int tx_delay_2		: 6;	/* bit[11:6] */
137a98c71fbSDylan Hung 		unsigned int rx_delay_1		: 6;	/* bit[17:12] */
138a98c71fbSDylan Hung 		unsigned int rx_delay_2		: 6;	/* bit[23:18] */
139a98c71fbSDylan Hung 		unsigned int rx_clk_inv_1 	: 1;	/* bit[24] */
140a98c71fbSDylan Hung 		unsigned int rx_clk_inv_2 	: 1;	/* bit[25] */
141a98c71fbSDylan Hung 		unsigned int reserved_0 	: 6;	/* bit[31:26] */
142a98c71fbSDylan Hung 	} b;
143a98c71fbSDylan Hung };
144a98c71fbSDylan Hung 
145a98c71fbSDylan Hung struct mac_delay_config {
146a98c71fbSDylan Hung 	u32 tx_delay_1000;
147a98c71fbSDylan Hung 	u32 rx_delay_1000;
148a98c71fbSDylan Hung 	u32 tx_delay_100;
149a98c71fbSDylan Hung 	u32 rx_delay_100;
150a98c71fbSDylan Hung 	u32 tx_delay_10;
151a98c71fbSDylan Hung 	u32 rx_delay_10;
152a98c71fbSDylan Hung };
153a98c71fbSDylan Hung 
154bbbfb0c5Sryan_chen extern u32 ast2600_get_pll_rate(struct ast2600_scu *scu, int pll_idx)
155550e691bSryan_chen {
156d6e349c7Sryan_chen 	u32 clkin = AST2600_CLK_IN;
157bbbfb0c5Sryan_chen 	u32 pll_reg = 0;
1589639db61Sryan_chen 	unsigned int mult, div = 1;
159550e691bSryan_chen 
160bbbfb0c5Sryan_chen 	switch (pll_idx) {
161bbbfb0c5Sryan_chen 	case ASPEED_CLK_HPLL:
162bbbfb0c5Sryan_chen 		pll_reg = readl(&scu->h_pll_param);
163bbbfb0c5Sryan_chen 		break;
164bbbfb0c5Sryan_chen 	case ASPEED_CLK_MPLL:
165bbbfb0c5Sryan_chen 		pll_reg = readl(&scu->m_pll_param);
166bbbfb0c5Sryan_chen 		break;
167bbbfb0c5Sryan_chen 	case ASPEED_CLK_DPLL:
168bbbfb0c5Sryan_chen 		pll_reg = readl(&scu->d_pll_param);
169bbbfb0c5Sryan_chen 		break;
170bbbfb0c5Sryan_chen 	case ASPEED_CLK_EPLL:
171bbbfb0c5Sryan_chen 		pll_reg = readl(&scu->e_pll_param);
172bbbfb0c5Sryan_chen 		break;
173bbbfb0c5Sryan_chen 	}
174bbbfb0c5Sryan_chen 	if (pll_reg & BIT(24)) {
1759639db61Sryan_chen 		/* Pass through mode */
176ed3899c5SRyan Chen 		mult = 1;
177ed3899c5SRyan Chen 		div = 1;
1789639db61Sryan_chen 	} else {
17975ced45aSDylan Hung 		union ast2600_pll_reg reg;
180ed3899c5SRyan Chen 		/* F = 25Mhz * [(M + 2) / (n + 1)] / (p + 1)
181ed3899c5SRyan Chen 		 * HPLL Numerator (M) = fix 0x5F when SCU500[10]=1
182ed3899c5SRyan Chen 		 * Fixed 0xBF when SCU500[10]=0 and SCU500[8]=1
183ed3899c5SRyan Chen 		 * SCU200[12:0] (default 0x8F) when SCU510[10]=0 and SCU510[8]=0
184ed3899c5SRyan Chen 		 * HPLL Denumerator (N) =	SCU200[18:13] (default 0x2)
185ed3899c5SRyan Chen 		 * HPLL Divider (P)	 =	SCU200[22:19] (default 0x0)
186ed3899c5SRyan Chen 		 * HPLL Bandwidth Adj (NB) =  fix 0x2F when SCU500[10]=1
187ed3899c5SRyan Chen 		 * Fixed 0x5F when SCU500[10]=0 and SCU500[8]=1
188ed3899c5SRyan Chen 		 * SCU204[11:0] (default 0x31) when SCU500[10]=0 and SCU500[8]=0
189e5c4f4dfSryan_chen 		 */
190ed3899c5SRyan Chen 		reg.w = pll_reg;
191f27685ebSRyan Chen 		if (pll_idx == ASPEED_CLK_HPLL) {
192e5c4f4dfSryan_chen 			u32 hwstrap1 = readl(&scu->hwstrap1.hwstrap);
193ed3899c5SRyan Chen 
194ed3899c5SRyan Chen 			if (hwstrap1 & BIT(10)) {
195e5c4f4dfSryan_chen 				reg.b.m = 0x5F;
196ed3899c5SRyan Chen 			} else {
197e5c4f4dfSryan_chen 				if (hwstrap1 & BIT(8))
198e5c4f4dfSryan_chen 					reg.b.m = 0xBF;
199a8fc7648SRyan Chen 				/* Otherwise keep default 0x8F */
200e5c4f4dfSryan_chen 			}
201e5c4f4dfSryan_chen 		}
20275ced45aSDylan Hung 		mult = (reg.b.m + 1) / (reg.b.n + 1);
20375ced45aSDylan Hung 		div = (reg.b.p + 1);
2049639db61Sryan_chen 	}
205a8fc7648SRyan Chen 
2069639db61Sryan_chen 	return ((clkin * mult) / div);
207550e691bSryan_chen }
208550e691bSryan_chen 
2094f22e838Sryan_chen extern u32 ast2600_get_apll_rate(struct ast2600_scu *scu)
210550e691bSryan_chen {
21185d48d8cSryan_chen 	u32 hw_rev = readl(&scu->chip_id1);
212bbbfb0c5Sryan_chen 	u32 clkin = AST2600_CLK_IN;
21339283ea7Sryan_chen 	u32 apll_reg = readl(&scu->a_pll_param);
21439283ea7Sryan_chen 	unsigned int mult, div = 1;
215d6e349c7Sryan_chen 
2168d615c79SRyan Chen 	if (((hw_rev & CHIP_REVISION_ID) >> 16) >= 2) {
217a8fc7648SRyan Chen 		//after A2 version
21885d48d8cSryan_chen 		if (apll_reg & BIT(24)) {
21985d48d8cSryan_chen 			/* Pass through mode */
220ed3899c5SRyan Chen 			mult = 1;
221ed3899c5SRyan Chen 			div = 1;
22285d48d8cSryan_chen 		} else {
22385d48d8cSryan_chen 			/* F = 25Mhz * [(m + 1) / (n + 1)] / (p + 1) */
22485d48d8cSryan_chen 			u32 m = apll_reg & 0x1fff;
22585d48d8cSryan_chen 			u32 n = (apll_reg >> 13) & 0x3f;
22685d48d8cSryan_chen 			u32 p = (apll_reg >> 19) & 0xf;
22785d48d8cSryan_chen 
22885d48d8cSryan_chen 			mult = (m + 1);
22985d48d8cSryan_chen 			div = (n + 1) * (p + 1);
23085d48d8cSryan_chen 		}
23185d48d8cSryan_chen 	} else {
23239283ea7Sryan_chen 		if (apll_reg & BIT(20)) {
233d6e349c7Sryan_chen 			/* Pass through mode */
234ed3899c5SRyan Chen 			mult = 1;
235ed3899c5SRyan Chen 			div = 1;
236d6e349c7Sryan_chen 		} else {
237bbbfb0c5Sryan_chen 			/* F = 25Mhz * (2-od) * [(m + 2) / (n + 1)] */
23839283ea7Sryan_chen 			u32 m = (apll_reg >> 5) & 0x3f;
23939283ea7Sryan_chen 			u32 od = (apll_reg >> 4) & 0x1;
24039283ea7Sryan_chen 			u32 n = apll_reg & 0xf;
241d6e349c7Sryan_chen 
242bbbfb0c5Sryan_chen 			mult = (2 - od) * (m + 2);
243bbbfb0c5Sryan_chen 			div = n + 1;
244d6e349c7Sryan_chen 		}
24585d48d8cSryan_chen 	}
246a8fc7648SRyan Chen 
247bbbfb0c5Sryan_chen 	return ((clkin * mult) / div);
24839283ea7Sryan_chen }
24939283ea7Sryan_chen 
250d812df15Sryan_chen static u32 ast2600_a0_axi_ahb_div_table[] = {
2515d05f4fcSRyan Chen 	2,
2525d05f4fcSRyan Chen 	2,
2535d05f4fcSRyan Chen 	3,
2545d05f4fcSRyan Chen 	4,
255d812df15Sryan_chen };
256d812df15Sryan_chen 
25745e0908aSryan_chen static u32 ast2600_a1_axi_ahb_div0_table[] = {
2585d05f4fcSRyan Chen 	3,
2595d05f4fcSRyan Chen 	2,
2605d05f4fcSRyan Chen 	3,
2615d05f4fcSRyan Chen 	4,
26245e0908aSryan_chen };
26345e0908aSryan_chen 
26445e0908aSryan_chen static u32 ast2600_a1_axi_ahb_div1_table[] = {
2655d05f4fcSRyan Chen 	3,
2665d05f4fcSRyan Chen 	4,
2675d05f4fcSRyan Chen 	6,
2685d05f4fcSRyan Chen 	8,
269e29dc694Sryan_chen };
270e29dc694Sryan_chen 
271e29dc694Sryan_chen static u32 ast2600_a1_axi_ahb_default_table[] = {
272e29dc694Sryan_chen 	3, 4, 3, 4, 2, 2, 2, 2,
273d812df15Sryan_chen };
274d812df15Sryan_chen 
275d812df15Sryan_chen static u32 ast2600_get_hclk(struct ast2600_scu *scu)
276d812df15Sryan_chen {
27785d48d8cSryan_chen 	u32 hw_rev = readl(&scu->chip_id1);
27845e0908aSryan_chen 	u32 hwstrap1 = readl(&scu->hwstrap1.hwstrap);
279d812df15Sryan_chen 	u32 axi_div = 1;
280d812df15Sryan_chen 	u32 ahb_div = 0;
281d812df15Sryan_chen 	u32 rate = 0;
282d812df15Sryan_chen 
28385d48d8cSryan_chen 	if ((hw_rev & CHIP_REVISION_ID) >> 16) {
284a8fc7648SRyan Chen 		//After A0
28545e0908aSryan_chen 		if (hwstrap1 & BIT(16)) {
286a8fc7648SRyan Chen 			ast2600_a1_axi_ahb_div1_table[0] =
2875d05f4fcSRyan Chen 				ast2600_a1_axi_ahb_default_table[(hwstrap1 >> 8) &
28822545706SRyan Chen 								 0x7] * 2;
289d812df15Sryan_chen 			axi_div = 1;
2905d05f4fcSRyan Chen 			ahb_div =
2915d05f4fcSRyan Chen 				ast2600_a1_axi_ahb_div1_table[(hwstrap1 >> 11) &
2925d05f4fcSRyan Chen 							      0x3];
29345e0908aSryan_chen 		} else {
294a8fc7648SRyan Chen 			ast2600_a1_axi_ahb_div0_table[0] =
2955d05f4fcSRyan Chen 				ast2600_a1_axi_ahb_default_table[(hwstrap1 >> 8) &
29622545706SRyan Chen 								 0x7];
297d812df15Sryan_chen 			axi_div = 2;
2985d05f4fcSRyan Chen 			ahb_div =
2995d05f4fcSRyan Chen 				ast2600_a1_axi_ahb_div0_table[(hwstrap1 >> 11) &
3005d05f4fcSRyan Chen 							      0x3];
30145e0908aSryan_chen 		}
30245e0908aSryan_chen 	} else {
303a8fc7648SRyan Chen 		//A0 : fix axi = hpll / 2
30445e0908aSryan_chen 		axi_div = 2;
305d812df15Sryan_chen 		ahb_div = ast2600_a0_axi_ahb_div_table[(hwstrap1 >> 11) & 0x3];
30645e0908aSryan_chen 	}
307bbbfb0c5Sryan_chen 	rate = ast2600_get_pll_rate(scu, ASPEED_CLK_HPLL);
308a8fc7648SRyan Chen 
3092717883aSryan_chen 	return (rate / axi_div / ahb_div);
3102717883aSryan_chen }
3112717883aSryan_chen 
312c304f173Sryan_chen static u32 ast2600_get_bclk_rate(struct ast2600_scu *scu)
313c304f173Sryan_chen {
314c304f173Sryan_chen 	u32 rate;
315c304f173Sryan_chen 	u32 bclk_sel = (readl(&scu->clk_sel1) >> 20) & 0x7;
316ed3899c5SRyan Chen 
317c304f173Sryan_chen 	rate = ast2600_get_pll_rate(scu, ASPEED_CLK_HPLL);
318c304f173Sryan_chen 
319c304f173Sryan_chen 	return (rate / ((bclk_sel + 1) * 4));
320c304f173Sryan_chen }
321c304f173Sryan_chen 
3226fa1ef3dSryan_chen static u32 ast2600_hpll_pclk1_div_table[] = {
3232717883aSryan_chen 	4, 8, 12, 16, 20, 24, 28, 32,
3242717883aSryan_chen };
3252717883aSryan_chen 
3266fa1ef3dSryan_chen static u32 ast2600_hpll_pclk2_div_table[] = {
3276fa1ef3dSryan_chen 	2, 4, 6, 8, 10, 12, 14, 16,
3286fa1ef3dSryan_chen };
3296fa1ef3dSryan_chen 
3306fa1ef3dSryan_chen static u32 ast2600_get_pclk1(struct ast2600_scu *scu)
3312717883aSryan_chen {
3322717883aSryan_chen 	u32 clk_sel1 = readl(&scu->clk_sel1);
3336fa1ef3dSryan_chen 	u32 apb_div = ast2600_hpll_pclk1_div_table[((clk_sel1 >> 23) & 0x7)];
334bbbfb0c5Sryan_chen 	u32 rate = ast2600_get_pll_rate(scu, ASPEED_CLK_HPLL);
3352717883aSryan_chen 
3362717883aSryan_chen 	return (rate / apb_div);
337d812df15Sryan_chen }
338d812df15Sryan_chen 
3396fa1ef3dSryan_chen static u32 ast2600_get_pclk2(struct ast2600_scu *scu)
3406fa1ef3dSryan_chen {
3416fa1ef3dSryan_chen 	u32 clk_sel4 = readl(&scu->clk_sel4);
3426fa1ef3dSryan_chen 	u32 apb_div = ast2600_hpll_pclk2_div_table[((clk_sel4 >> 9) & 0x7)];
3436fa1ef3dSryan_chen 	u32 rate = ast2600_get_hclk(scu);
3446fa1ef3dSryan_chen 
3456fa1ef3dSryan_chen 	return (rate / apb_div);
3466fa1ef3dSryan_chen }
3476fa1ef3dSryan_chen 
3482e195992Sryan_chen static u32 ast2600_get_uxclk_in_rate(struct ast2600_scu *scu)
349d6e349c7Sryan_chen {
35027881d20Sryan_chen 	u32 clk_in = 0;
3512e195992Sryan_chen 	u32 uxclk_sel = readl(&scu->clk_sel5);
352550e691bSryan_chen 
35327881d20Sryan_chen 	uxclk_sel &= 0x3;
35427881d20Sryan_chen 	switch (uxclk_sel) {
35527881d20Sryan_chen 	case 0:
35627881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu) / 4;
35727881d20Sryan_chen 		break;
35827881d20Sryan_chen 	case 1:
35927881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu) / 2;
36027881d20Sryan_chen 		break;
36127881d20Sryan_chen 	case 2:
36227881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu);
36327881d20Sryan_chen 		break;
36427881d20Sryan_chen 	case 3:
36527881d20Sryan_chen 		clk_in = ast2600_get_hclk(scu);
36627881d20Sryan_chen 		break;
36727881d20Sryan_chen 	}
368d6e349c7Sryan_chen 
36927881d20Sryan_chen 	return clk_in;
37027881d20Sryan_chen }
37127881d20Sryan_chen 
3722e195992Sryan_chen static u32 ast2600_get_huxclk_in_rate(struct ast2600_scu *scu)
37327881d20Sryan_chen {
37427881d20Sryan_chen 	u32 clk_in = 0;
3752e195992Sryan_chen 	u32 huclk_sel = readl(&scu->clk_sel5);
37627881d20Sryan_chen 
37727881d20Sryan_chen 	huclk_sel = ((huclk_sel >> 3) & 0x3);
37827881d20Sryan_chen 	switch (huclk_sel) {
37927881d20Sryan_chen 	case 0:
38027881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu) / 4;
38127881d20Sryan_chen 		break;
38227881d20Sryan_chen 	case 1:
38327881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu) / 2;
38427881d20Sryan_chen 		break;
38527881d20Sryan_chen 	case 2:
38627881d20Sryan_chen 		clk_in = ast2600_get_apll_rate(scu);
38727881d20Sryan_chen 		break;
38827881d20Sryan_chen 	case 3:
38927881d20Sryan_chen 		clk_in = ast2600_get_hclk(scu);
39027881d20Sryan_chen 		break;
39127881d20Sryan_chen 	}
39227881d20Sryan_chen 
39327881d20Sryan_chen 	return clk_in;
39427881d20Sryan_chen }
39527881d20Sryan_chen 
3962e195992Sryan_chen static u32 ast2600_get_uart_uxclk_rate(struct ast2600_scu *scu)
39727881d20Sryan_chen {
3982e195992Sryan_chen 	u32 clk_in = ast2600_get_uxclk_in_rate(scu);
39927881d20Sryan_chen 	u32 div_reg = readl(&scu->uart_24m_ref_uxclk);
40027881d20Sryan_chen 	unsigned int mult, div;
40127881d20Sryan_chen 
40227881d20Sryan_chen 	u32 n = (div_reg >> 8) & 0x3ff;
40327881d20Sryan_chen 	u32 r = div_reg & 0xff;
40427881d20Sryan_chen 
40527881d20Sryan_chen 	mult = r;
4062e195992Sryan_chen 	div = (n * 2);
40727881d20Sryan_chen 	return (clk_in * mult) / div;
40827881d20Sryan_chen }
40927881d20Sryan_chen 
4102e195992Sryan_chen static u32 ast2600_get_uart_huxclk_rate(struct ast2600_scu *scu)
41127881d20Sryan_chen {
4122e195992Sryan_chen 	u32 clk_in = ast2600_get_huxclk_in_rate(scu);
41327881d20Sryan_chen 	u32 div_reg = readl(&scu->uart_24m_ref_huxclk);
41427881d20Sryan_chen 
41527881d20Sryan_chen 	unsigned int mult, div;
41627881d20Sryan_chen 
41727881d20Sryan_chen 	u32 n = (div_reg >> 8) & 0x3ff;
41827881d20Sryan_chen 	u32 r = div_reg & 0xff;
41927881d20Sryan_chen 
42027881d20Sryan_chen 	mult = r;
4212e195992Sryan_chen 	div = (n * 2);
42227881d20Sryan_chen 	return (clk_in * mult) / div;
42327881d20Sryan_chen }
42427881d20Sryan_chen 
425f51926eeSryan_chen static u32 ast2600_get_sdio_clk_rate(struct ast2600_scu *scu)
426f51926eeSryan_chen {
427f51926eeSryan_chen 	u32 clkin = 0;
428f51926eeSryan_chen 	u32 clk_sel = readl(&scu->clk_sel4);
429f51926eeSryan_chen 	u32 div = (clk_sel >> 28) & 0x7;
4308004dfdeSChin-Ting Kuo 	u32 hw_rev = readl(&scu->chip_id1);
431f51926eeSryan_chen 
432ed3899c5SRyan Chen 	if (clk_sel & BIT(8))
433f51926eeSryan_chen 		clkin = ast2600_get_apll_rate(scu);
434ed3899c5SRyan Chen 	else
43510069884Sryan_chen 		clkin = ast2600_get_hclk(scu);
436ed3899c5SRyan Chen 
4378004dfdeSChin-Ting Kuo 	div = (1 + div) * 2;
4388004dfdeSChin-Ting Kuo 	if (((hw_rev & GENMASK(23, 16)) >> 16) >= 2)
4398004dfdeSChin-Ting Kuo 		div = (div & 0xf) ? div : 1;
440f51926eeSryan_chen 
441f51926eeSryan_chen 	return (clkin / div);
442f51926eeSryan_chen }
443f51926eeSryan_chen 
444f51926eeSryan_chen static u32 ast2600_get_emmc_clk_rate(struct ast2600_scu *scu)
445f51926eeSryan_chen {
446125f2e11SChin-Ting Kuo 	u32 mmc_clk_src = readl(&scu->clk_sel1);
447125f2e11SChin-Ting Kuo 	u32 clkin;
448f51926eeSryan_chen 	u32 clk_sel = readl(&scu->clk_sel1);
449f51926eeSryan_chen 	u32 div = (clk_sel >> 12) & 0x7;
450f51926eeSryan_chen 
451125f2e11SChin-Ting Kuo 	if (mmc_clk_src & BIT(11)) {
452125f2e11SChin-Ting Kuo 		/* emmc clock comes from MPLL */
453125f2e11SChin-Ting Kuo 		clkin = ast2600_get_pll_rate(scu, ASPEED_CLK_MPLL);
454125f2e11SChin-Ting Kuo 		div = (div + 1) * 2;
455125f2e11SChin-Ting Kuo 	} else {
456125f2e11SChin-Ting Kuo 		clkin = ast2600_get_pll_rate(scu, ASPEED_CLK_HPLL);
457f51926eeSryan_chen 		div = (div + 1) << 2;
458125f2e11SChin-Ting Kuo 	}
459f51926eeSryan_chen 
460f51926eeSryan_chen 	return (clkin / div);
461f51926eeSryan_chen }
462f51926eeSryan_chen 
463f51926eeSryan_chen static u32 ast2600_get_uart_clk_rate(struct ast2600_scu *scu, int uart_idx)
46427881d20Sryan_chen {
465*de49ffa7SChia-Wei Wang 	u32 hicr9 = readl(0x1e789098);
46627881d20Sryan_chen 	u32 uart_sel = readl(&scu->clk_sel4);
46727881d20Sryan_chen 	u32 uart_sel5 = readl(&scu->clk_sel5);
46827881d20Sryan_chen 	ulong uart_clk = 0;
46927881d20Sryan_chen 
47027881d20Sryan_chen 	switch (uart_idx) {
47127881d20Sryan_chen 	case 1:
47227881d20Sryan_chen 	case 2:
47327881d20Sryan_chen 	case 3:
47427881d20Sryan_chen 	case 4:
475*de49ffa7SChia-Wei Wang 		hicr9 &= ~(BIT(uart_idx + 3));
476*de49ffa7SChia-Wei Wang 		writel(hicr9, 0x1e789098);
47727881d20Sryan_chen 	case 6:
47827881d20Sryan_chen 		if (uart_sel & BIT(uart_idx - 1))
4792e195992Sryan_chen 			uart_clk = ast2600_get_uart_huxclk_rate(scu);
480550e691bSryan_chen 		else
4812e195992Sryan_chen 			uart_clk = ast2600_get_uart_uxclk_rate(scu);
48227881d20Sryan_chen 		break;
48327881d20Sryan_chen 	case 5: //24mhz is come form usb phy 48Mhz
48427881d20Sryan_chen 	{
48527881d20Sryan_chen 		u8 uart5_clk_sel = 0;
48627881d20Sryan_chen 		//high bit
48727881d20Sryan_chen 		if (readl(&scu->misc_ctrl1) & BIT(12))
48827881d20Sryan_chen 			uart5_clk_sel = 0x2;
48927881d20Sryan_chen 		else
49027881d20Sryan_chen 			uart5_clk_sel = 0x0;
491550e691bSryan_chen 
49227881d20Sryan_chen 		if (readl(&scu->clk_sel2) & BIT(14))
49327881d20Sryan_chen 			uart5_clk_sel |= 0x1;
494550e691bSryan_chen 
49527881d20Sryan_chen 		switch (uart5_clk_sel) {
49627881d20Sryan_chen 		case 0:
49727881d20Sryan_chen 			uart_clk = 24000000;
49827881d20Sryan_chen 			break;
49927881d20Sryan_chen 		case 1:
500def99fcbSryan_chen 			uart_clk = 192000000;
50127881d20Sryan_chen 			break;
50227881d20Sryan_chen 		case 2:
50327881d20Sryan_chen 			uart_clk = 24000000 / 13;
50427881d20Sryan_chen 			break;
50527881d20Sryan_chen 		case 3:
50627881d20Sryan_chen 			uart_clk = 192000000 / 13;
50727881d20Sryan_chen 			break;
50827881d20Sryan_chen 		}
5095d05f4fcSRyan Chen 	} break;
51027881d20Sryan_chen 	case 7:
51127881d20Sryan_chen 	case 8:
51227881d20Sryan_chen 	case 9:
51327881d20Sryan_chen 	case 10:
51427881d20Sryan_chen 	case 11:
51527881d20Sryan_chen 	case 12:
51627881d20Sryan_chen 	case 13:
51727881d20Sryan_chen 		if (uart_sel5 & BIT(uart_idx - 1))
5182e195992Sryan_chen 			uart_clk = ast2600_get_uart_huxclk_rate(scu);
51927881d20Sryan_chen 		else
5202e195992Sryan_chen 			uart_clk = ast2600_get_uart_uxclk_rate(scu);
52127881d20Sryan_chen 		break;
52227881d20Sryan_chen 	}
52327881d20Sryan_chen 
52427881d20Sryan_chen 	return uart_clk;
525550e691bSryan_chen }
526550e691bSryan_chen 
527feb42054Sryan_chen static ulong ast2600_clk_get_rate(struct clk *clk)
528feb42054Sryan_chen {
529feb42054Sryan_chen 	struct ast2600_clk_priv *priv = dev_get_priv(clk->dev);
530feb42054Sryan_chen 	ulong rate = 0;
531feb42054Sryan_chen 
532feb42054Sryan_chen 	switch (clk->id) {
533feb42054Sryan_chen 	case ASPEED_CLK_HPLL:
534bbbfb0c5Sryan_chen 	case ASPEED_CLK_EPLL:
535bbbfb0c5Sryan_chen 	case ASPEED_CLK_DPLL:
536d812df15Sryan_chen 	case ASPEED_CLK_MPLL:
537bbbfb0c5Sryan_chen 		rate = ast2600_get_pll_rate(priv->scu, clk->id);
538d812df15Sryan_chen 		break;
539feb42054Sryan_chen 	case ASPEED_CLK_AHB:
540feb42054Sryan_chen 		rate = ast2600_get_hclk(priv->scu);
541feb42054Sryan_chen 		break;
5426fa1ef3dSryan_chen 	case ASPEED_CLK_APB1:
5436fa1ef3dSryan_chen 		rate = ast2600_get_pclk1(priv->scu);
5446fa1ef3dSryan_chen 		break;
5456fa1ef3dSryan_chen 	case ASPEED_CLK_APB2:
5466fa1ef3dSryan_chen 		rate = ast2600_get_pclk2(priv->scu);
547feb42054Sryan_chen 		break;
548bbbfb0c5Sryan_chen 	case ASPEED_CLK_APLL:
549bbbfb0c5Sryan_chen 		rate = ast2600_get_apll_rate(priv->scu);
550bbbfb0c5Sryan_chen 		break;
551feb42054Sryan_chen 	case ASPEED_CLK_GATE_UART1CLK:
552feb42054Sryan_chen 		rate = ast2600_get_uart_clk_rate(priv->scu, 1);
553feb42054Sryan_chen 		break;
554feb42054Sryan_chen 	case ASPEED_CLK_GATE_UART2CLK:
555feb42054Sryan_chen 		rate = ast2600_get_uart_clk_rate(priv->scu, 2);
556feb42054Sryan_chen 		break;
557feb42054Sryan_chen 	case ASPEED_CLK_GATE_UART3CLK:
558feb42054Sryan_chen 		rate = ast2600_get_uart_clk_rate(priv->scu, 3);
559feb42054Sryan_chen 		break;
560feb42054Sryan_chen 	case ASPEED_CLK_GATE_UART4CLK:
561feb42054Sryan_chen 		rate = ast2600_get_uart_clk_rate(priv->scu, 4);
562feb42054Sryan_chen 		break;
563feb42054Sryan_chen 	case ASPEED_CLK_GATE_UART5CLK:
564feb42054Sryan_chen 		rate = ast2600_get_uart_clk_rate(priv->scu, 5);
565feb42054Sryan_chen 		break;
566c304f173Sryan_chen 	case ASPEED_CLK_BCLK:
567c304f173Sryan_chen 		rate = ast2600_get_bclk_rate(priv->scu);
568c304f173Sryan_chen 		break;
569f51926eeSryan_chen 	case ASPEED_CLK_SDIO:
570f51926eeSryan_chen 		rate = ast2600_get_sdio_clk_rate(priv->scu);
571f51926eeSryan_chen 		break;
572f51926eeSryan_chen 	case ASPEED_CLK_EMMC:
573f51926eeSryan_chen 		rate = ast2600_get_emmc_clk_rate(priv->scu);
574f51926eeSryan_chen 		break;
5752e195992Sryan_chen 	case ASPEED_CLK_UARTX:
5762e195992Sryan_chen 		rate = ast2600_get_uart_uxclk_rate(priv->scu);
5772e195992Sryan_chen 		break;
5780998ddefSryan_chen 	case ASPEED_CLK_HUARTX:
5792e195992Sryan_chen 		rate = ast2600_get_uart_huxclk_rate(priv->scu);
5802e195992Sryan_chen 		break;
581feb42054Sryan_chen 	default:
582d812df15Sryan_chen 		pr_debug("can't get clk rate\n");
583feb42054Sryan_chen 		return -ENOENT;
584feb42054Sryan_chen 	}
585feb42054Sryan_chen 
586feb42054Sryan_chen 	return rate;
587feb42054Sryan_chen }
588feb42054Sryan_chen 
589577fcdaeSDylan Hung /**
590577fcdaeSDylan Hung  * @brief	lookup PLL divider config by input/output rate
591577fcdaeSDylan Hung  * @param[in]	*pll - PLL descriptor
592577fcdaeSDylan Hung  * @return	true - if PLL divider config is found, false - else
593a8fc7648SRyan Chen  * The function caller shall fill "pll->in" and "pll->out",
594a8fc7648SRyan Chen  * then this function will search the lookup table
595a8fc7648SRyan Chen  * to find a valid PLL divider configuration.
596550e691bSryan_chen  */
597577fcdaeSDylan Hung static bool ast2600_search_clock_config(struct ast2600_pll_desc *pll)
598550e691bSryan_chen {
599577fcdaeSDylan Hung 	u32 i;
600577fcdaeSDylan Hung 	bool is_found = false;
601550e691bSryan_chen 
602577fcdaeSDylan Hung 	for (i = 0; i < ARRAY_SIZE(ast2600_pll_lookup); i++) {
603577fcdaeSDylan Hung 		const struct ast2600_pll_desc *def_cfg = &ast2600_pll_lookup[i];
604ed3899c5SRyan Chen 
605ed3899c5SRyan Chen 		if (def_cfg->in == pll->in && def_cfg->out == pll->out) {
606577fcdaeSDylan Hung 			is_found = true;
607577fcdaeSDylan Hung 			pll->cfg.reg.w = def_cfg->cfg.reg.w;
608577fcdaeSDylan Hung 			pll->cfg.ext_reg = def_cfg->cfg.ext_reg;
609577fcdaeSDylan Hung 			break;
610550e691bSryan_chen 		}
611550e691bSryan_chen 	}
612577fcdaeSDylan Hung 	return is_found;
613550e691bSryan_chen }
614ed3899c5SRyan Chen 
615fd52be0bSDylan Hung static u32 ast2600_configure_pll(struct ast2600_scu *scu,
616fd52be0bSDylan Hung 				 struct ast2600_pll_cfg *p_cfg, int pll_idx)
617fd52be0bSDylan Hung {
618fd52be0bSDylan Hung 	u32 addr, addr_ext;
619fd52be0bSDylan Hung 	u32 reg;
620550e691bSryan_chen 
621fd52be0bSDylan Hung 	switch (pll_idx) {
622fd52be0bSDylan Hung 	case ASPEED_CLK_HPLL:
623fd52be0bSDylan Hung 		addr = (u32)(&scu->h_pll_param);
624fd52be0bSDylan Hung 		addr_ext = (u32)(&scu->h_pll_ext_param);
625fd52be0bSDylan Hung 		break;
626fd52be0bSDylan Hung 	case ASPEED_CLK_MPLL:
627fd52be0bSDylan Hung 		addr = (u32)(&scu->m_pll_param);
628fd52be0bSDylan Hung 		addr_ext = (u32)(&scu->m_pll_ext_param);
629fd52be0bSDylan Hung 		break;
630fd52be0bSDylan Hung 	case ASPEED_CLK_DPLL:
631fd52be0bSDylan Hung 		addr = (u32)(&scu->d_pll_param);
632fd52be0bSDylan Hung 		addr_ext = (u32)(&scu->d_pll_ext_param);
633fd52be0bSDylan Hung 		break;
634fd52be0bSDylan Hung 	case ASPEED_CLK_EPLL:
635fd52be0bSDylan Hung 		addr = (u32)(&scu->e_pll_param);
636fd52be0bSDylan Hung 		addr_ext = (u32)(&scu->e_pll_ext_param);
637fd52be0bSDylan Hung 		break;
638fd52be0bSDylan Hung 	default:
639fd52be0bSDylan Hung 		debug("unknown PLL index\n");
640fd52be0bSDylan Hung 		return 1;
641fd52be0bSDylan Hung 	}
642fd52be0bSDylan Hung 
643fd52be0bSDylan Hung 	p_cfg->reg.b.bypass = 0;
644fd52be0bSDylan Hung 	p_cfg->reg.b.off = 1;
645fd52be0bSDylan Hung 	p_cfg->reg.b.reset = 1;
646fd52be0bSDylan Hung 
647fd52be0bSDylan Hung 	reg = readl(addr);
648fd52be0bSDylan Hung 	reg &= ~GENMASK(25, 0);
649fd52be0bSDylan Hung 	reg |= p_cfg->reg.w;
650fd52be0bSDylan Hung 	writel(reg, addr);
651fd52be0bSDylan Hung 
652fd52be0bSDylan Hung 	/* write extend parameter */
653fd52be0bSDylan Hung 	writel(p_cfg->ext_reg, addr_ext);
654fd52be0bSDylan Hung 	udelay(100);
655fd52be0bSDylan Hung 	p_cfg->reg.b.off = 0;
656fd52be0bSDylan Hung 	p_cfg->reg.b.reset = 0;
657fd52be0bSDylan Hung 	reg &= ~GENMASK(25, 0);
658fd52be0bSDylan Hung 	reg |= p_cfg->reg.w;
659fd52be0bSDylan Hung 	writel(reg, addr);
660ed3899c5SRyan Chen 	while (!(readl(addr_ext) & BIT(31)))
661ed3899c5SRyan Chen 		;
662fd52be0bSDylan Hung 
663fd52be0bSDylan Hung 	return 0;
664fd52be0bSDylan Hung }
665ed3899c5SRyan Chen 
666feb42054Sryan_chen static u32 ast2600_configure_ddr(struct ast2600_scu *scu, ulong rate)
667550e691bSryan_chen {
668577fcdaeSDylan Hung 	struct ast2600_pll_desc mpll;
669550e691bSryan_chen 
670577fcdaeSDylan Hung 	mpll.in = AST2600_CLK_IN;
671577fcdaeSDylan Hung 	mpll.out = rate;
672f27685ebSRyan Chen 	if (ast2600_search_clock_config(&mpll) == false) {
673577fcdaeSDylan Hung 		printf("error!! unable to find valid DDR clock setting\n");
674577fcdaeSDylan Hung 		return 0;
675577fcdaeSDylan Hung 	}
676ed3899c5SRyan Chen 	ast2600_configure_pll(scu, &mpll.cfg, ASPEED_CLK_MPLL);
677577fcdaeSDylan Hung 
678cc476ffcSDylan Hung 	return ast2600_get_pll_rate(scu, ASPEED_CLK_MPLL);
679d6e349c7Sryan_chen }
680d6e349c7Sryan_chen 
681d6e349c7Sryan_chen static ulong ast2600_clk_set_rate(struct clk *clk, ulong rate)
682550e691bSryan_chen {
683f0d895afSryan_chen 	struct ast2600_clk_priv *priv = dev_get_priv(clk->dev);
684550e691bSryan_chen 	ulong new_rate;
685ed3899c5SRyan Chen 
686550e691bSryan_chen 	switch (clk->id) {
687f0d895afSryan_chen 	case ASPEED_CLK_MPLL:
688feb42054Sryan_chen 		new_rate = ast2600_configure_ddr(priv->scu, rate);
689550e691bSryan_chen 		break;
690550e691bSryan_chen 	default:
691550e691bSryan_chen 		return -ENOENT;
692550e691bSryan_chen 	}
693550e691bSryan_chen 
694550e691bSryan_chen 	return new_rate;
695550e691bSryan_chen }
696feb42054Sryan_chen 
697f9aa0ee1Sryan_chen #define SCU_CLKSTOP_MAC1	(20)
698f9aa0ee1Sryan_chen #define SCU_CLKSTOP_MAC2	(21)
699f9aa0ee1Sryan_chen #define SCU_CLKSTOP_MAC3	(20)
700f9aa0ee1Sryan_chen #define SCU_CLKSTOP_MAC4	(21)
701f9aa0ee1Sryan_chen 
702a98c71fbSDylan Hung static u32 ast2600_configure_mac12_clk(struct ast2600_scu *scu, struct udevice *dev)
703cc476ffcSDylan Hung {
704a98c71fbSDylan Hung 	union mac_delay_1g reg_1g;
705a98c71fbSDylan Hung 	union mac_delay_100_10 reg_100, reg_10;
706a98c71fbSDylan Hung 	struct mac_delay_config mac1_cfg, mac2_cfg;
707a98c71fbSDylan Hung 	int ret;
7084760b3f8SDylan Hung 
709a98c71fbSDylan Hung 	reg_1g.w = (readl(&scu->mac12_clk_delay) & ~GENMASK(25, 0)) |
710a98c71fbSDylan Hung 		   MAC_DEF_DELAY_1G;
711a98c71fbSDylan Hung 	reg_100.w = MAC_DEF_DELAY_100M;
712a98c71fbSDylan Hung 	reg_10.w = MAC_DEF_DELAY_10M;
713a98c71fbSDylan Hung 
714a98c71fbSDylan Hung 	ret = dev_read_u32_array(dev, "mac0-clk-delay", (u32 *)&mac1_cfg, sizeof(mac1_cfg) / sizeof(u32));
715a98c71fbSDylan Hung 	if (!ret) {
716a98c71fbSDylan Hung 		reg_1g.b.tx_delay_1 = mac1_cfg.tx_delay_1000;
717a98c71fbSDylan Hung 		reg_1g.b.rx_delay_1 = mac1_cfg.rx_delay_1000;
718a98c71fbSDylan Hung 		reg_100.b.tx_delay_1 = mac1_cfg.tx_delay_100;
719a98c71fbSDylan Hung 		reg_100.b.rx_delay_1 = mac1_cfg.rx_delay_100;
720a98c71fbSDylan Hung 		reg_10.b.tx_delay_1 = mac1_cfg.tx_delay_10;
721a98c71fbSDylan Hung 		reg_10.b.rx_delay_1 = mac1_cfg.rx_delay_10;
722a98c71fbSDylan Hung 	}
723a98c71fbSDylan Hung 
724a98c71fbSDylan Hung 	ret = dev_read_u32_array(dev, "mac1-clk-delay", (u32 *)&mac2_cfg, sizeof(mac2_cfg) / sizeof(u32));
725a98c71fbSDylan Hung 	if (!ret) {
726a98c71fbSDylan Hung 		reg_1g.b.tx_delay_2 = mac2_cfg.tx_delay_1000;
727a98c71fbSDylan Hung 		reg_1g.b.rx_delay_2 = mac2_cfg.rx_delay_1000;
728a98c71fbSDylan Hung 		reg_100.b.tx_delay_2 = mac2_cfg.tx_delay_100;
729a98c71fbSDylan Hung 		reg_100.b.rx_delay_2 = mac2_cfg.rx_delay_100;
730a98c71fbSDylan Hung 		reg_10.b.tx_delay_2 = mac2_cfg.tx_delay_10;
731a98c71fbSDylan Hung 		reg_10.b.rx_delay_2 = mac2_cfg.rx_delay_10;
732a98c71fbSDylan Hung 	}
733a98c71fbSDylan Hung 
734a98c71fbSDylan Hung 	writel(reg_1g.w, &scu->mac12_clk_delay);
735a98c71fbSDylan Hung 	writel(reg_100.w, &scu->mac12_clk_delay_100M);
736a98c71fbSDylan Hung 	writel(reg_10.w, &scu->mac12_clk_delay_10M);
737cc476ffcSDylan Hung 
738ed30249cSDylan Hung 	/* MAC AHB = HPLL / 6 */
739eff28274SJohnny Huang 	clrsetbits_le32(&scu->clk_sel1, GENMASK(18, 16), (0x2 << 16));
740894c19cfSDylan Hung 
741cc476ffcSDylan Hung 	return 0;
742cc476ffcSDylan Hung }
743cc476ffcSDylan Hung 
744a98c71fbSDylan Hung static u32 ast2600_configure_mac34_clk(struct ast2600_scu *scu, struct udevice *dev)
74554f9cba1SDylan Hung {
746a98c71fbSDylan Hung 	union mac_delay_1g reg_1g;
747a98c71fbSDylan Hung 	union mac_delay_100_10 reg_100, reg_10;
748a98c71fbSDylan Hung 	struct mac_delay_config mac3_cfg, mac4_cfg;
749a98c71fbSDylan Hung 	int ret;
750a98c71fbSDylan Hung 
75154f9cba1SDylan Hung 	/*
752eff28274SJohnny Huang 	 * scu350[31]   RGMII 125M source: 0 = from IO pin
753eff28274SJohnny Huang 	 * scu350[25:0] MAC 1G delay
75454f9cba1SDylan Hung 	 */
755a98c71fbSDylan Hung 	reg_1g.w = (readl(&scu->mac34_clk_delay) & ~GENMASK(25, 0)) |
756a98c71fbSDylan Hung 		   MAC34_DEF_DELAY_1G;
757a98c71fbSDylan Hung 	reg_1g.b.rgmii_125m_o_sel = 0;
758a98c71fbSDylan Hung 	reg_100.w = MAC34_DEF_DELAY_100M;
759a98c71fbSDylan Hung 	reg_10.w = MAC34_DEF_DELAY_10M;
760a98c71fbSDylan Hung 
761a98c71fbSDylan Hung 	ret = dev_read_u32_array(dev, "mac2-clk-delay", (u32 *)&mac3_cfg, sizeof(mac3_cfg) / sizeof(u32));
762a98c71fbSDylan Hung 	if (!ret) {
763a98c71fbSDylan Hung 		reg_1g.b.tx_delay_1 = mac3_cfg.tx_delay_1000;
764a98c71fbSDylan Hung 		reg_1g.b.rx_delay_1 = mac3_cfg.rx_delay_1000;
765a98c71fbSDylan Hung 		reg_100.b.tx_delay_1 = mac3_cfg.tx_delay_100;
766a98c71fbSDylan Hung 		reg_100.b.rx_delay_1 = mac3_cfg.rx_delay_100;
767a98c71fbSDylan Hung 		reg_10.b.tx_delay_1 = mac3_cfg.tx_delay_10;
768a98c71fbSDylan Hung 		reg_10.b.rx_delay_1 = mac3_cfg.rx_delay_10;
769a98c71fbSDylan Hung 	}
770a98c71fbSDylan Hung 
771a98c71fbSDylan Hung 	ret = dev_read_u32_array(dev, "mac3-clk-delay", (u32 *)&mac4_cfg, sizeof(mac4_cfg) / sizeof(u32));
772a98c71fbSDylan Hung 	if (!ret) {
773a98c71fbSDylan Hung 		reg_1g.b.tx_delay_2 = mac4_cfg.tx_delay_1000;
774a98c71fbSDylan Hung 		reg_1g.b.rx_delay_2 = mac4_cfg.rx_delay_1000;
775a98c71fbSDylan Hung 		reg_100.b.tx_delay_2 = mac4_cfg.tx_delay_100;
776a98c71fbSDylan Hung 		reg_100.b.rx_delay_2 = mac4_cfg.rx_delay_100;
777a98c71fbSDylan Hung 		reg_10.b.tx_delay_2 = mac4_cfg.tx_delay_10;
778a98c71fbSDylan Hung 		reg_10.b.rx_delay_2 = mac4_cfg.rx_delay_10;
779a98c71fbSDylan Hung 	}
780a98c71fbSDylan Hung 
781a98c71fbSDylan Hung 	writel(reg_1g.w, &scu->mac34_clk_delay);
782a98c71fbSDylan Hung 	writel(reg_100.w, &scu->mac34_clk_delay_100M);
783a98c71fbSDylan Hung 	writel(reg_10.w, &scu->mac34_clk_delay_10M);
78454f9cba1SDylan Hung 
785eff28274SJohnny Huang 	/*
786eff28274SJohnny Huang 	 * clock source seletion and divider
787eff28274SJohnny Huang 	 * scu310[26:24] : MAC AHB bus clock = HCLK / 2
788eff28274SJohnny Huang 	 * scu310[18:16] : RMII 50M = HCLK_200M / 4
789eff28274SJohnny Huang 	 */
790eff28274SJohnny Huang 	clrsetbits_le32(&scu->clk_sel4, (GENMASK(26, 24) | GENMASK(18, 16)),
791eff28274SJohnny Huang 			((0x0 << 24) | (0x3 << 16)));
79254f9cba1SDylan Hung 
793eff28274SJohnny Huang 	/*
794eff28274SJohnny Huang 	 * set driving strength
795eff28274SJohnny Huang 	 * scu458[3:2] : MAC4 driving strength
796eff28274SJohnny Huang 	 * scu458[1:0] : MAC3 driving strength
797eff28274SJohnny Huang 	 */
798eff28274SJohnny Huang 	clrsetbits_le32(&scu->pinmux_ctrl16, GENMASK(3, 0),
799a961159eSDylan Hung 			(0x3 << 2) | (0x3 << 0));
80054f9cba1SDylan Hung 
80154f9cba1SDylan Hung 	return 0;
80254f9cba1SDylan Hung }
803eff28274SJohnny Huang 
80454f9cba1SDylan Hung /**
8055b5c3d44SDylan Hung  * ast2600 RGMII clock source tree
80654f9cba1SDylan Hung  * 125M from external PAD -------->|\
80754f9cba1SDylan Hung  * HPLL -->|\                      | |---->RGMII 125M for MAC#1 & MAC#2
80854f9cba1SDylan Hung  *         | |---->| divider |---->|/                             +
80954f9cba1SDylan Hung  * EPLL -->|/                                                     |
81054f9cba1SDylan Hung  *                                                                |
811eff28274SJohnny Huang  * +---------<-----------|RGMIICK PAD output enable|<-------------+
81254f9cba1SDylan Hung  * |
813eff28274SJohnny Huang  * +--------------------------->|\
81454f9cba1SDylan Hung  *                              | |----> RGMII 125M for MAC#3 & MAC#4
815eff28274SJohnny Huang  * HCLK 200M ---->|divider|---->|/
816eff28274SJohnny Huang  * To simplify the control flow:
817eff28274SJohnny Huang  * 1. RGMII 1/2 always use EPLL as the internal clock source
818eff28274SJohnny Huang  * 2. RGMII 3/4 always use RGMIICK pad as the RGMII 125M source
819eff28274SJohnny Huang  * 125M from external PAD -------->|\
820eff28274SJohnny Huang  *                                 | |---->RGMII 125M for MAC#1 & MAC#2
821eff28274SJohnny Huang  *         EPLL---->| divider |--->|/                             +
822eff28274SJohnny Huang  *                                                                |
823eff28274SJohnny Huang  * +<--------------------|RGMIICK PAD output enable|<-------------+
824eff28274SJohnny Huang  * |
825eff28274SJohnny Huang  * +--------------------------->RGMII 125M for MAC#3 & MAC#4
826eff28274SJohnny Huang  */
827eff28274SJohnny Huang #define RGMIICK_SRC_PAD		0
828eff28274SJohnny Huang #define RGMIICK_SRC_EPLL	1 /* recommended */
829eff28274SJohnny Huang #define RGMIICK_SRC_HPLL	2
830eff28274SJohnny Huang 
831eff28274SJohnny Huang #define RGMIICK_DIV2	1
832eff28274SJohnny Huang #define RGMIICK_DIV3	2
833eff28274SJohnny Huang #define RGMIICK_DIV4	3
834eff28274SJohnny Huang #define RGMIICK_DIV5	4
835eff28274SJohnny Huang #define RGMIICK_DIV6	5
836eff28274SJohnny Huang #define RGMIICK_DIV7	6
837eff28274SJohnny Huang #define RGMIICK_DIV8	7 /* recommended */
838eff28274SJohnny Huang 
839eff28274SJohnny Huang #define RMIICK_DIV4		0
840eff28274SJohnny Huang #define RMIICK_DIV8		1
841eff28274SJohnny Huang #define RMIICK_DIV12	2
842eff28274SJohnny Huang #define RMIICK_DIV16	3
843eff28274SJohnny Huang #define RMIICK_DIV20	4 /* recommended */
844eff28274SJohnny Huang #define RMIICK_DIV24	5
845eff28274SJohnny Huang #define RMIICK_DIV28	6
846eff28274SJohnny Huang #define RMIICK_DIV32	7
847eff28274SJohnny Huang 
848eff28274SJohnny Huang struct ast2600_mac_clk_div {
849eff28274SJohnny Huang 	u32 src; /* 0=external PAD, 1=internal PLL */
850eff28274SJohnny Huang 	u32 fin; /* divider input speed */
851eff28274SJohnny Huang 	u32 n; /* 0=div2, 1=div2, 2=div3, 3=div4,...,7=div8 */
852eff28274SJohnny Huang 	u32 fout; /* fout = fin / n */
853eff28274SJohnny Huang };
854eff28274SJohnny Huang 
855eff28274SJohnny Huang struct ast2600_mac_clk_div rgmii_clk_defconfig = {
856eff28274SJohnny Huang 	.src = ASPEED_CLK_EPLL,
857eff28274SJohnny Huang 	.fin = 1000000000,
858eff28274SJohnny Huang 	.n = RGMIICK_DIV8,
859eff28274SJohnny Huang 	.fout = 125000000,
860eff28274SJohnny Huang };
861eff28274SJohnny Huang 
862eff28274SJohnny Huang struct ast2600_mac_clk_div rmii_clk_defconfig = {
863eff28274SJohnny Huang 	.src = ASPEED_CLK_EPLL,
864eff28274SJohnny Huang 	.fin = 1000000000,
865eff28274SJohnny Huang 	.n = RMIICK_DIV20,
866eff28274SJohnny Huang 	.fout = 50000000,
867eff28274SJohnny Huang };
868ed3899c5SRyan Chen 
869eff28274SJohnny Huang static void ast2600_init_mac_pll(struct ast2600_scu *p_scu,
870eff28274SJohnny Huang 				 struct ast2600_mac_clk_div *p_cfg)
871eff28274SJohnny Huang {
872eff28274SJohnny Huang 	struct ast2600_pll_desc pll;
873eff28274SJohnny Huang 
874eff28274SJohnny Huang 	pll.in = AST2600_CLK_IN;
875eff28274SJohnny Huang 	pll.out = p_cfg->fin;
876ed3899c5SRyan Chen 	if (ast2600_search_clock_config(&pll) == false) {
877ed3899c5SRyan Chen 		pr_err("unable to find valid ETHNET MAC clock setting\n");
8783f295164SRyan Chen 		debug("%s: pll cfg = 0x%08x 0x%08x\n", __func__, pll.cfg.reg.w,
8793f295164SRyan Chen 		      pll.cfg.ext_reg);
8803f295164SRyan Chen 		debug("%s: pll cfg = %02x %02x %02x\n", __func__,
8813f295164SRyan Chen 		      pll.cfg.reg.b.m, pll.cfg.reg.b.n, pll.cfg.reg.b.p);
882eff28274SJohnny Huang 		return;
883eff28274SJohnny Huang 	}
884ed3899c5SRyan Chen 	ast2600_configure_pll(p_scu, &pll.cfg, p_cfg->src);
885eff28274SJohnny Huang }
886eff28274SJohnny Huang 
887eff28274SJohnny Huang static void ast2600_init_rgmii_clk(struct ast2600_scu *p_scu,
888eff28274SJohnny Huang 				   struct ast2600_mac_clk_div *p_cfg)
889eff28274SJohnny Huang {
890eff28274SJohnny Huang 	u32 reg_304 = readl(&p_scu->clk_sel2);
891eff28274SJohnny Huang 	u32 reg_340 = readl(&p_scu->mac12_clk_delay);
892eff28274SJohnny Huang 	u32 reg_350 = readl(&p_scu->mac34_clk_delay);
893eff28274SJohnny Huang 
894eff28274SJohnny Huang 	reg_340 &= ~GENMASK(31, 29);
895eff28274SJohnny Huang 	/* scu340[28]: RGMIICK PAD output enable (to MAC 3/4) */
896eff28274SJohnny Huang 	reg_340 |= BIT(28);
8973f295164SRyan Chen 	if (p_cfg->src == ASPEED_CLK_EPLL || p_cfg->src == ASPEED_CLK_HPLL) {
898eff28274SJohnny Huang 		/*
899eff28274SJohnny Huang 		 * re-init PLL if the current PLL output frequency doesn't match
900eff28274SJohnny Huang 		 * the divider setting
901eff28274SJohnny Huang 		 */
902ed3899c5SRyan Chen 		if (p_cfg->fin != ast2600_get_pll_rate(p_scu, p_cfg->src))
903eff28274SJohnny Huang 			ast2600_init_mac_pll(p_scu, p_cfg);
904eff28274SJohnny Huang 		/* scu340[31]: select RGMII 125M from internal source */
905eff28274SJohnny Huang 		reg_340 |= BIT(31);
906eff28274SJohnny Huang 	}
907eff28274SJohnny Huang 
908eff28274SJohnny Huang 	reg_304 &= ~GENMASK(23, 20);
909eff28274SJohnny Huang 
910eff28274SJohnny Huang 	/* set clock divider */
911eff28274SJohnny Huang 	reg_304 |= (p_cfg->n & 0x7) << 20;
912eff28274SJohnny Huang 
913eff28274SJohnny Huang 	/* select internal clock source */
914ed3899c5SRyan Chen 	if (p_cfg->src == ASPEED_CLK_HPLL)
915eff28274SJohnny Huang 		reg_304 |= BIT(23);
916eff28274SJohnny Huang 
917eff28274SJohnny Huang 	/* RGMII 3/4 clock source select */
918eff28274SJohnny Huang 	reg_350 &= ~BIT(31);
919eff28274SJohnny Huang 
920eff28274SJohnny Huang 	writel(reg_304, &p_scu->clk_sel2);
921eff28274SJohnny Huang 	writel(reg_340, &p_scu->mac12_clk_delay);
922eff28274SJohnny Huang 	writel(reg_350, &p_scu->mac34_clk_delay);
923eff28274SJohnny Huang }
924eff28274SJohnny Huang 
925eff28274SJohnny Huang /**
9265b5c3d44SDylan Hung  * ast2600 RMII/NCSI clock source tree
9275b5c3d44SDylan Hung  * HPLL -->|\
9285b5c3d44SDylan Hung  *         | |---->| divider |----> RMII 50M for MAC#1 & MAC#2
9295b5c3d44SDylan Hung  * EPLL -->|/
9305b5c3d44SDylan Hung  * HCLK(SCLICLK)---->| divider |----> RMII 50M for MAC#3 & MAC#4
93154f9cba1SDylan Hung  */
932eff28274SJohnny Huang static void ast2600_init_rmii_clk(struct ast2600_scu *p_scu,
933eff28274SJohnny Huang 				  struct ast2600_mac_clk_div *p_cfg)
93454f9cba1SDylan Hung {
935eff28274SJohnny Huang 	u32 reg_304;
936eff28274SJohnny Huang 	u32 reg_310;
937eff28274SJohnny Huang 
9383f295164SRyan Chen 	if (p_cfg->src == ASPEED_CLK_EPLL || p_cfg->src == ASPEED_CLK_HPLL) {
939eff28274SJohnny Huang 		/*
940eff28274SJohnny Huang 		 * re-init PLL if the current PLL output frequency doesn't match
941eff28274SJohnny Huang 		 * the divider setting
942eff28274SJohnny Huang 		 */
943ed3899c5SRyan Chen 		if (p_cfg->fin != ast2600_get_pll_rate(p_scu, p_cfg->src))
944eff28274SJohnny Huang 			ast2600_init_mac_pll(p_scu, p_cfg);
945eff28274SJohnny Huang 	}
94654f9cba1SDylan Hung 
947eff28274SJohnny Huang 	reg_304 = readl(&p_scu->clk_sel2);
948eff28274SJohnny Huang 	reg_310 = readl(&p_scu->clk_sel4);
949eff28274SJohnny Huang 
950eff28274SJohnny Huang 	reg_304 &= ~GENMASK(19, 16);
951eff28274SJohnny Huang 
952eff28274SJohnny Huang 	/* set RMII 1/2 clock divider */
953eff28274SJohnny Huang 	reg_304 |= (p_cfg->n & 0x7) << 16;
954eff28274SJohnny Huang 
955eff28274SJohnny Huang 	/* RMII clock source selection */
956ed3899c5SRyan Chen 	if (p_cfg->src == ASPEED_CLK_HPLL)
957eff28274SJohnny Huang 		reg_304 |= BIT(19);
958eff28274SJohnny Huang 
959eff28274SJohnny Huang 	/* set RMII 3/4 clock divider */
960eff28274SJohnny Huang 	reg_310 &= ~GENMASK(18, 16);
961eff28274SJohnny Huang 	reg_310 |= (0x3 << 16);
962eff28274SJohnny Huang 
963eff28274SJohnny Huang 	writel(reg_304, &p_scu->clk_sel2);
964eff28274SJohnny Huang 	writel(reg_310, &p_scu->clk_sel4);
965eff28274SJohnny Huang }
966eff28274SJohnny Huang 
967f9aa0ee1Sryan_chen static u32 ast2600_configure_mac(struct ast2600_scu *scu, int index)
968f9aa0ee1Sryan_chen {
969f9aa0ee1Sryan_chen 	u32 reset_bit;
970f9aa0ee1Sryan_chen 	u32 clkstop_bit;
971f9aa0ee1Sryan_chen 
972f9aa0ee1Sryan_chen 	switch (index) {
973f9aa0ee1Sryan_chen 	case 1:
974f9aa0ee1Sryan_chen 		reset_bit = BIT(ASPEED_RESET_MAC1);
975f9aa0ee1Sryan_chen 		clkstop_bit = BIT(SCU_CLKSTOP_MAC1);
976f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_ctrl1);
977f9aa0ee1Sryan_chen 		udelay(100);
978f9aa0ee1Sryan_chen 		writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
979f9aa0ee1Sryan_chen 		mdelay(10);
980f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_clr_ctrl1);
981f9aa0ee1Sryan_chen 		break;
982f9aa0ee1Sryan_chen 	case 2:
983f9aa0ee1Sryan_chen 		reset_bit = BIT(ASPEED_RESET_MAC2);
984f9aa0ee1Sryan_chen 		clkstop_bit = BIT(SCU_CLKSTOP_MAC2);
985f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_ctrl1);
986f9aa0ee1Sryan_chen 		udelay(100);
987f9aa0ee1Sryan_chen 		writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
988f9aa0ee1Sryan_chen 		mdelay(10);
989f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_clr_ctrl1);
990f9aa0ee1Sryan_chen 		break;
991f9aa0ee1Sryan_chen 	case 3:
992f9aa0ee1Sryan_chen 		reset_bit = BIT(ASPEED_RESET_MAC3 - 32);
993f9aa0ee1Sryan_chen 		clkstop_bit = BIT(SCU_CLKSTOP_MAC3);
994f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_ctrl2);
995f9aa0ee1Sryan_chen 		udelay(100);
996f9aa0ee1Sryan_chen 		writel(clkstop_bit, &scu->clk_stop_clr_ctrl2);
997f9aa0ee1Sryan_chen 		mdelay(10);
998f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_clr_ctrl2);
999f9aa0ee1Sryan_chen 		break;
1000f9aa0ee1Sryan_chen 	case 4:
1001f9aa0ee1Sryan_chen 		reset_bit = BIT(ASPEED_RESET_MAC4 - 32);
1002f9aa0ee1Sryan_chen 		clkstop_bit = BIT(SCU_CLKSTOP_MAC4);
1003f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_ctrl2);
1004f9aa0ee1Sryan_chen 		udelay(100);
1005f9aa0ee1Sryan_chen 		writel(clkstop_bit, &scu->clk_stop_clr_ctrl2);
1006f9aa0ee1Sryan_chen 		mdelay(10);
1007f9aa0ee1Sryan_chen 		writel(reset_bit, &scu->sysreset_clr_ctrl2);
1008f9aa0ee1Sryan_chen 		break;
1009f9aa0ee1Sryan_chen 	default:
1010f9aa0ee1Sryan_chen 		return -EINVAL;
1011f9aa0ee1Sryan_chen 	}
1012f9aa0ee1Sryan_chen 
1013f9aa0ee1Sryan_chen 	return 0;
1014f9aa0ee1Sryan_chen }
1015550e691bSryan_chen 
1016a8fc7648SRyan Chen #define SCU_CLK_ECC_RSA_FROM_HPLL_CLK	BIT(19)
1017a8fc7648SRyan Chen #define SCU_CLK_ECC_RSA_CLK_MASK		GENMASK(27, 26)
1018ed3899c5SRyan Chen #define SCU_CLK_ECC_RSA_CLK_DIV(x)		((x) << 26)
1019a8fc7648SRyan Chen static void ast2600_configure_rsa_ecc_clk(struct ast2600_scu *scu)
1020a8fc7648SRyan Chen {
1021a8fc7648SRyan Chen 	u32 clk_sel = readl(&scu->clk_sel1);
1022a8fc7648SRyan Chen 
10237e3c964cSJohnny Huang 	/* Configure RSA clock = HPLL/4 */
1024a8fc7648SRyan Chen 	clk_sel |= SCU_CLK_ECC_RSA_FROM_HPLL_CLK;
1025a8fc7648SRyan Chen 	clk_sel &= ~SCU_CLK_ECC_RSA_CLK_MASK;
10267e3c964cSJohnny Huang 	clk_sel |= SCU_CLK_ECC_RSA_CLK_DIV(3);
1027a8fc7648SRyan Chen 
1028a8fc7648SRyan Chen 	writel(clk_sel, &scu->clk_sel1);
1029a8fc7648SRyan Chen }
1030a8fc7648SRyan Chen 
1031f51926eeSryan_chen #define SCU_CLKSTOP_SDIO 4
1032f51926eeSryan_chen static ulong ast2600_enable_sdclk(struct ast2600_scu *scu)
1033f51926eeSryan_chen {
1034f51926eeSryan_chen 	u32 reset_bit;
1035f51926eeSryan_chen 	u32 clkstop_bit;
1036f51926eeSryan_chen 
1037f51926eeSryan_chen 	reset_bit = BIT(ASPEED_RESET_SD - 32);
1038f51926eeSryan_chen 	clkstop_bit = BIT(SCU_CLKSTOP_SDIO);
1039f51926eeSryan_chen 
1040fc9f12e6Sryan_chen 	writel(reset_bit, &scu->sysreset_ctrl2);
1041fc9f12e6Sryan_chen 
1042f51926eeSryan_chen 	udelay(100);
1043f51926eeSryan_chen 	//enable clk
1044f51926eeSryan_chen 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl2);
1045f51926eeSryan_chen 	mdelay(10);
1046fc9f12e6Sryan_chen 	writel(reset_bit, &scu->sysreset_clr_ctrl2);
1047f51926eeSryan_chen 
1048f51926eeSryan_chen 	return 0;
1049f51926eeSryan_chen }
1050f51926eeSryan_chen 
1051f51926eeSryan_chen #define SCU_CLKSTOP_EXTSD			31
1052f51926eeSryan_chen #define SCU_CLK_SD_MASK				(0x7 << 28)
1053ed3899c5SRyan Chen #define SCU_CLK_SD_DIV(x)			((x) << 28)
10542cd7cba2Sryan_chen #define SCU_CLK_SD_FROM_APLL_CLK	BIT(8)
1055f51926eeSryan_chen 
1056f51926eeSryan_chen static ulong ast2600_enable_extsdclk(struct ast2600_scu *scu)
1057f51926eeSryan_chen {
1058f51926eeSryan_chen 	u32 clk_sel = readl(&scu->clk_sel4);
1059f51926eeSryan_chen 	u32 enableclk_bit;
10602cd7cba2Sryan_chen 	u32 rate = 0;
10612cd7cba2Sryan_chen 	u32 div = 0;
10622cd7cba2Sryan_chen 	int i = 0;
1063f51926eeSryan_chen 
1064f51926eeSryan_chen 	enableclk_bit = BIT(SCU_CLKSTOP_EXTSD);
1065f51926eeSryan_chen 
1066a8fc7648SRyan Chen 	/* ast2600 sd controller max clk is 200Mhz :
1067a8fc7648SRyan Chen 	 * use apll for clock source 800/4 = 200 : controller max is 200mhz
1068a8fc7648SRyan Chen 	 */
10692cd7cba2Sryan_chen 	rate = ast2600_get_apll_rate(scu);
10702cd7cba2Sryan_chen 	for (i = 0; i < 8; i++) {
10712cd7cba2Sryan_chen 		div = (i + 1) * 2;
10722cd7cba2Sryan_chen 		if ((rate / div) <= 200000000)
10732cd7cba2Sryan_chen 			break;
10742cd7cba2Sryan_chen 	}
1075f51926eeSryan_chen 	clk_sel &= ~SCU_CLK_SD_MASK;
10762cd7cba2Sryan_chen 	clk_sel |= SCU_CLK_SD_DIV(i) | SCU_CLK_SD_FROM_APLL_CLK;
1077f51926eeSryan_chen 	writel(clk_sel, &scu->clk_sel4);
1078f51926eeSryan_chen 
1079f51926eeSryan_chen 	//enable clk
1080f51926eeSryan_chen 	setbits_le32(&scu->clk_sel4, enableclk_bit);
1081f51926eeSryan_chen 
1082f51926eeSryan_chen 	return 0;
1083f51926eeSryan_chen }
1084f51926eeSryan_chen 
1085f51926eeSryan_chen #define SCU_CLKSTOP_EMMC 27
1086f51926eeSryan_chen static ulong ast2600_enable_emmcclk(struct ast2600_scu *scu)
1087f51926eeSryan_chen {
1088f51926eeSryan_chen 	u32 reset_bit;
1089f51926eeSryan_chen 	u32 clkstop_bit;
1090f51926eeSryan_chen 
1091f51926eeSryan_chen 	reset_bit = BIT(ASPEED_RESET_EMMC);
1092f51926eeSryan_chen 	clkstop_bit = BIT(SCU_CLKSTOP_EMMC);
1093f51926eeSryan_chen 
1094fc9f12e6Sryan_chen 	writel(reset_bit, &scu->sysreset_ctrl1);
1095f51926eeSryan_chen 	udelay(100);
1096f51926eeSryan_chen 	//enable clk
1097f51926eeSryan_chen 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
1098f51926eeSryan_chen 	mdelay(10);
1099fc9f12e6Sryan_chen 	writel(reset_bit, &scu->sysreset_clr_ctrl1);
1100f51926eeSryan_chen 
1101f51926eeSryan_chen 	return 0;
1102f51926eeSryan_chen }
1103f51926eeSryan_chen 
1104f51926eeSryan_chen #define SCU_CLKSTOP_EXTEMMC			15
1105f51926eeSryan_chen #define SCU_CLK_EMMC_MASK			(0x7 << 12)
1106ed3899c5SRyan Chen #define SCU_CLK_EMMC_DIV(x)			((x) << 12)
1107a8fc7648SRyan Chen #define SCU_CLK_EMMC_FROM_MPLL_CLK	BIT(11)
1108f51926eeSryan_chen 
1109f51926eeSryan_chen static ulong ast2600_enable_extemmcclk(struct ast2600_scu *scu)
1110f51926eeSryan_chen {
111185d48d8cSryan_chen 	u32 revision_id = readl(&scu->chip_id1);
1112f51926eeSryan_chen 	u32 clk_sel = readl(&scu->clk_sel1);
1113ed3899c5SRyan Chen 	u32 enableclk_bit = BIT(SCU_CLKSTOP_EXTEMMC);
1114f4c4ddb1Sryan_chen 	u32 rate = 0;
1115f4c4ddb1Sryan_chen 	u32 div = 0;
1116f4c4ddb1Sryan_chen 	int i = 0;
1117f51926eeSryan_chen 
1118ed3899c5SRyan Chen 	/*
1119ed3899c5SRyan Chen 	 * ast2600 eMMC controller max clk is 200Mhz
1120ed3899c5SRyan Chen 	 * HPll->1/2->|\
1121ed3899c5SRyan Chen 	 *				|->SCU300[11]->SCU300[14:12][1/N] +
1122ed3899c5SRyan Chen 	 * MPLL------>|/								  |
1123ed3899c5SRyan Chen 	 * +----------------------------------------------+
1124ed3899c5SRyan Chen 	 * |
1125ed3899c5SRyan Chen 	 * +---------> EMMC12C[15:8][1/N]-> eMMC clk
1126a8fc7648SRyan Chen 	 */
112785d48d8cSryan_chen 	if (((revision_id & CHIP_REVISION_ID) >> 16)) {
11288c32294fSryan_chen 		//AST2600A1 : use mpll to be clk source
1129b0c30ea3Sryan_chen 		rate = ast2600_get_pll_rate(scu, ASPEED_CLK_MPLL);
1130b0c30ea3Sryan_chen 		for (i = 0; i < 8; i++) {
1131b0c30ea3Sryan_chen 			div = (i + 1) * 2;
1132b0c30ea3Sryan_chen 			if ((rate / div) <= 200000000)
1133b0c30ea3Sryan_chen 				break;
1134b0c30ea3Sryan_chen 		}
1135b0c30ea3Sryan_chen 
1136b0c30ea3Sryan_chen 		clk_sel &= ~SCU_CLK_EMMC_MASK;
11372cd7cba2Sryan_chen 		clk_sel |= SCU_CLK_EMMC_DIV(i) | SCU_CLK_EMMC_FROM_MPLL_CLK;
1138b0c30ea3Sryan_chen 		writel(clk_sel, &scu->clk_sel1);
1139b0c30ea3Sryan_chen 
1140b0c30ea3Sryan_chen 	} else {
11412cd7cba2Sryan_chen 		//AST2600A0 : use hpll to be clk source
1142f4c4ddb1Sryan_chen 		rate = ast2600_get_pll_rate(scu, ASPEED_CLK_HPLL);
1143f4c4ddb1Sryan_chen 
1144f4c4ddb1Sryan_chen 		for (i = 0; i < 8; i++) {
1145f4c4ddb1Sryan_chen 			div = (i + 1) * 4;
1146f4c4ddb1Sryan_chen 			if ((rate / div) <= 200000000)
1147f4c4ddb1Sryan_chen 				break;
1148f4c4ddb1Sryan_chen 		}
1149f4c4ddb1Sryan_chen 
1150f4c4ddb1Sryan_chen 		clk_sel &= ~SCU_CLK_EMMC_MASK;
1151f4c4ddb1Sryan_chen 		clk_sel |= SCU_CLK_EMMC_DIV(i);
1152f51926eeSryan_chen 		writel(clk_sel, &scu->clk_sel1);
1153b0c30ea3Sryan_chen 	}
1154f51926eeSryan_chen 	setbits_le32(&scu->clk_sel1, enableclk_bit);
1155f51926eeSryan_chen 
1156f51926eeSryan_chen 	return 0;
1157f51926eeSryan_chen }
1158f51926eeSryan_chen 
1159baf00c26Sryan_chen #define SCU_CLKSTOP_FSICLK 30
1160baf00c26Sryan_chen 
1161baf00c26Sryan_chen static ulong ast2600_enable_fsiclk(struct ast2600_scu *scu)
1162baf00c26Sryan_chen {
1163baf00c26Sryan_chen 	u32 reset_bit;
1164baf00c26Sryan_chen 	u32 clkstop_bit;
1165baf00c26Sryan_chen 
1166baf00c26Sryan_chen 	reset_bit = BIT(ASPEED_RESET_FSI % 32);
1167baf00c26Sryan_chen 	clkstop_bit = BIT(SCU_CLKSTOP_FSICLK);
1168baf00c26Sryan_chen 
1169baf00c26Sryan_chen 	/* The FSI clock is shared between masters. If it's already on
1170ed3899c5SRyan Chen 	 * don't touch it, as that will reset the existing master.
1171ed3899c5SRyan Chen 	 */
1172baf00c26Sryan_chen 	if (!(readl(&scu->clk_stop_ctrl2) & clkstop_bit)) {
1173baf00c26Sryan_chen 		debug("%s: already running, not touching it\n", __func__);
1174baf00c26Sryan_chen 		return 0;
1175baf00c26Sryan_chen 	}
1176baf00c26Sryan_chen 
1177baf00c26Sryan_chen 	writel(reset_bit, &scu->sysreset_ctrl2);
1178baf00c26Sryan_chen 	udelay(100);
1179baf00c26Sryan_chen 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl2);
1180baf00c26Sryan_chen 	mdelay(10);
1181baf00c26Sryan_chen 	writel(reset_bit, &scu->sysreset_clr_ctrl2);
1182baf00c26Sryan_chen 
1183baf00c26Sryan_chen 	return 0;
1184baf00c26Sryan_chen }
1185baf00c26Sryan_chen 
1186b8ec5ceaSryan_chen static ulong ast2600_enable_usbahclk(struct ast2600_scu *scu)
1187b8ec5ceaSryan_chen {
1188b8ec5ceaSryan_chen 	u32 reset_bit;
1189b8ec5ceaSryan_chen 	u32 clkstop_bit;
1190b8ec5ceaSryan_chen 
1191b8ec5ceaSryan_chen 	reset_bit = BIT(ASPEED_RESET_EHCI_P1);
1192b8ec5ceaSryan_chen 	clkstop_bit = BIT(14);
1193b8ec5ceaSryan_chen 
1194b8ec5ceaSryan_chen 	writel(reset_bit, &scu->sysreset_ctrl1);
1195b8ec5ceaSryan_chen 	udelay(100);
1196b8ec5ceaSryan_chen 	writel(clkstop_bit, &scu->clk_stop_ctrl1);
1197b8ec5ceaSryan_chen 	mdelay(20);
1198b8ec5ceaSryan_chen 	writel(reset_bit, &scu->sysreset_clr_ctrl1);
1199b8ec5ceaSryan_chen 
1200b8ec5ceaSryan_chen 	return 0;
1201b8ec5ceaSryan_chen }
1202b8ec5ceaSryan_chen 
1203b8ec5ceaSryan_chen static ulong ast2600_enable_usbbhclk(struct ast2600_scu *scu)
1204b8ec5ceaSryan_chen {
1205b8ec5ceaSryan_chen 	u32 reset_bit;
1206b8ec5ceaSryan_chen 	u32 clkstop_bit;
1207b8ec5ceaSryan_chen 
1208b8ec5ceaSryan_chen 	reset_bit = BIT(ASPEED_RESET_EHCI_P2);
1209b8ec5ceaSryan_chen 	clkstop_bit = BIT(7);
1210b8ec5ceaSryan_chen 
1211b8ec5ceaSryan_chen 	writel(reset_bit, &scu->sysreset_ctrl1);
1212b8ec5ceaSryan_chen 	udelay(100);
1213b8ec5ceaSryan_chen 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
1214b8ec5ceaSryan_chen 	mdelay(20);
1215b8ec5ceaSryan_chen 
1216b8ec5ceaSryan_chen 	writel(reset_bit, &scu->sysreset_clr_ctrl1);
1217b8ec5ceaSryan_chen 
1218b8ec5ceaSryan_chen 	return 0;
1219b8ec5ceaSryan_chen }
1220b8ec5ceaSryan_chen 
1221089713adSJoel Stanley /* also known as yclk */
1222089713adSJoel Stanley static ulong ast2600_enable_haceclk(struct ast2600_scu *scu)
1223089713adSJoel Stanley {
1224089713adSJoel Stanley 	u32 reset_bit;
1225089713adSJoel Stanley 	u32 clkstop_bit;
1226089713adSJoel Stanley 
1227089713adSJoel Stanley 	reset_bit = BIT(ASPEED_RESET_HACE);
1228089713adSJoel Stanley 	clkstop_bit = BIT(13);
1229089713adSJoel Stanley 
1230089713adSJoel Stanley 	writel(reset_bit, &scu->sysreset_ctrl1);
1231089713adSJoel Stanley 	udelay(100);
1232089713adSJoel Stanley 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
1233089713adSJoel Stanley 	mdelay(20);
1234089713adSJoel Stanley 
1235089713adSJoel Stanley 	writel(reset_bit, &scu->sysreset_clr_ctrl1);
1236089713adSJoel Stanley 
1237089713adSJoel Stanley 	return 0;
1238089713adSJoel Stanley }
1239089713adSJoel Stanley 
1240f6110ecdSChia-Wei Wang static ulong ast2600_enable_rsaeccclk(struct ast2600_scu *scu)
1241f6110ecdSChia-Wei Wang {
1242f6110ecdSChia-Wei Wang 	u32 clkstop_bit;
1243f6110ecdSChia-Wei Wang 
1244f6110ecdSChia-Wei Wang 	clkstop_bit = BIT(24);
1245f6110ecdSChia-Wei Wang 
1246f6110ecdSChia-Wei Wang 	writel(clkstop_bit, &scu->clk_stop_clr_ctrl1);
1247f6110ecdSChia-Wei Wang 	mdelay(20);
1248f6110ecdSChia-Wei Wang 
1249f6110ecdSChia-Wei Wang 	return 0;
1250f6110ecdSChia-Wei Wang }
1251f6110ecdSChia-Wei Wang 
1252d6e349c7Sryan_chen static int ast2600_clk_enable(struct clk *clk)
1253550e691bSryan_chen {
1254f0d895afSryan_chen 	struct ast2600_clk_priv *priv = dev_get_priv(clk->dev);
1255550e691bSryan_chen 
1256550e691bSryan_chen 	switch (clk->id) {
125786f91560Sryan_chen 	case ASPEED_CLK_GATE_MAC1CLK:
125886f91560Sryan_chen 		ast2600_configure_mac(priv->scu, 1);
1259550e691bSryan_chen 		break;
126086f91560Sryan_chen 	case ASPEED_CLK_GATE_MAC2CLK:
126186f91560Sryan_chen 		ast2600_configure_mac(priv->scu, 2);
1262550e691bSryan_chen 		break;
126377843939Sryan_chen 	case ASPEED_CLK_GATE_MAC3CLK:
126477843939Sryan_chen 		ast2600_configure_mac(priv->scu, 3);
126577843939Sryan_chen 		break;
126677843939Sryan_chen 	case ASPEED_CLK_GATE_MAC4CLK:
126777843939Sryan_chen 		ast2600_configure_mac(priv->scu, 4);
126877843939Sryan_chen 		break;
1269f51926eeSryan_chen 	case ASPEED_CLK_GATE_SDCLK:
1270f51926eeSryan_chen 		ast2600_enable_sdclk(priv->scu);
1271f51926eeSryan_chen 		break;
1272f51926eeSryan_chen 	case ASPEED_CLK_GATE_SDEXTCLK:
1273f51926eeSryan_chen 		ast2600_enable_extsdclk(priv->scu);
1274f51926eeSryan_chen 		break;
1275f51926eeSryan_chen 	case ASPEED_CLK_GATE_EMMCCLK:
1276f51926eeSryan_chen 		ast2600_enable_emmcclk(priv->scu);
1277f51926eeSryan_chen 		break;
1278f51926eeSryan_chen 	case ASPEED_CLK_GATE_EMMCEXTCLK:
1279f51926eeSryan_chen 		ast2600_enable_extemmcclk(priv->scu);
1280f51926eeSryan_chen 		break;
1281baf00c26Sryan_chen 	case ASPEED_CLK_GATE_FSICLK:
1282baf00c26Sryan_chen 		ast2600_enable_fsiclk(priv->scu);
1283baf00c26Sryan_chen 		break;
1284b8ec5ceaSryan_chen 	case ASPEED_CLK_GATE_USBPORT1CLK:
1285b8ec5ceaSryan_chen 		ast2600_enable_usbahclk(priv->scu);
1286b8ec5ceaSryan_chen 		break;
1287b8ec5ceaSryan_chen 	case ASPEED_CLK_GATE_USBPORT2CLK:
1288b8ec5ceaSryan_chen 		ast2600_enable_usbbhclk(priv->scu);
1289b8ec5ceaSryan_chen 		break;
1290089713adSJoel Stanley 	case ASPEED_CLK_GATE_YCLK:
1291089713adSJoel Stanley 		ast2600_enable_haceclk(priv->scu);
1292089713adSJoel Stanley 		break;
1293f6110ecdSChia-Wei Wang 	case ASPEED_CLK_GATE_RSAECCCLK:
1294f6110ecdSChia-Wei Wang 		ast2600_enable_rsaeccclk(priv->scu);
1295f6110ecdSChia-Wei Wang 		break;
1296550e691bSryan_chen 	default:
1297ed3899c5SRyan Chen 		pr_err("can't enable clk\n");
1298550e691bSryan_chen 		return -ENOENT;
1299550e691bSryan_chen 	}
1300550e691bSryan_chen 
1301550e691bSryan_chen 	return 0;
1302550e691bSryan_chen }
1303550e691bSryan_chen 
1304f9aa0ee1Sryan_chen struct clk_ops ast2600_clk_ops = {
1305d6e349c7Sryan_chen 	.get_rate = ast2600_clk_get_rate,
1306d6e349c7Sryan_chen 	.set_rate = ast2600_clk_set_rate,
1307d6e349c7Sryan_chen 	.enable = ast2600_clk_enable,
1308550e691bSryan_chen };
1309550e691bSryan_chen 
1310d6e349c7Sryan_chen static int ast2600_clk_probe(struct udevice *dev)
1311550e691bSryan_chen {
1312f0d895afSryan_chen 	struct ast2600_clk_priv *priv = dev_get_priv(dev);
131361ab9607Sryan_chen 	u32 uart_clk_source;
1314550e691bSryan_chen 
1315f0d895afSryan_chen 	priv->scu = devfdt_get_addr_ptr(dev);
1316f0d895afSryan_chen 	if (IS_ERR(priv->scu))
1317f0d895afSryan_chen 		return PTR_ERR(priv->scu);
1318550e691bSryan_chen 
13195d05f4fcSRyan Chen 	uart_clk_source = dev_read_u32_default(dev, "uart-clk-source", 0x0);
132061ab9607Sryan_chen 
132161ab9607Sryan_chen 	if (uart_clk_source) {
132256dd3e85Sryan_chen 		if (uart_clk_source & GENMASK(5, 0))
13235d05f4fcSRyan Chen 			setbits_le32(&priv->scu->clk_sel4,
13245d05f4fcSRyan Chen 				     uart_clk_source & GENMASK(5, 0));
132556dd3e85Sryan_chen 		if (uart_clk_source & GENMASK(12, 6))
13265d05f4fcSRyan Chen 			setbits_le32(&priv->scu->clk_sel5,
13275d05f4fcSRyan Chen 				     uart_clk_source & GENMASK(12, 6));
132861ab9607Sryan_chen 	}
132961ab9607Sryan_chen 
1330b89500a2SDylan Hung 	ast2600_init_rgmii_clk(priv->scu, &rgmii_clk_defconfig);
1331b89500a2SDylan Hung 	ast2600_init_rmii_clk(priv->scu, &rmii_clk_defconfig);
1332a98c71fbSDylan Hung 	ast2600_configure_mac12_clk(priv->scu, dev);
1333a98c71fbSDylan Hung 	ast2600_configure_mac34_clk(priv->scu, dev);
1334a8fc7648SRyan Chen 	ast2600_configure_rsa_ecc_clk(priv->scu);
1335fd0306aaSJohnny Huang 
1336550e691bSryan_chen 	return 0;
1337550e691bSryan_chen }
1338550e691bSryan_chen 
1339d6e349c7Sryan_chen static int ast2600_clk_bind(struct udevice *dev)
1340550e691bSryan_chen {
1341550e691bSryan_chen 	int ret;
1342550e691bSryan_chen 
1343550e691bSryan_chen 	/* The reset driver does not have a device node, so bind it here */
1344550e691bSryan_chen 	ret = device_bind_driver(gd->dm_root, "ast_sysreset", "reset", &dev);
1345550e691bSryan_chen 	if (ret)
1346550e691bSryan_chen 		debug("Warning: No reset driver: ret=%d\n", ret);
1347550e691bSryan_chen 
1348550e691bSryan_chen 	return 0;
1349550e691bSryan_chen }
1350550e691bSryan_chen 
1351d35ac78cSryan_chen struct aspeed_clks {
1352d35ac78cSryan_chen 	ulong id;
1353d35ac78cSryan_chen 	const char *name;
1354d35ac78cSryan_chen };
1355d35ac78cSryan_chen 
1356d35ac78cSryan_chen static struct aspeed_clks aspeed_clk_names[] = {
13575d05f4fcSRyan Chen 	{ ASPEED_CLK_HPLL, "hpll" },     { ASPEED_CLK_MPLL, "mpll" },
13585d05f4fcSRyan Chen 	{ ASPEED_CLK_APLL, "apll" },     { ASPEED_CLK_EPLL, "epll" },
13595d05f4fcSRyan Chen 	{ ASPEED_CLK_DPLL, "dpll" },     { ASPEED_CLK_AHB, "hclk" },
13605d05f4fcSRyan Chen 	{ ASPEED_CLK_APB1, "pclk1" },    { ASPEED_CLK_APB2, "pclk2" },
13615d05f4fcSRyan Chen 	{ ASPEED_CLK_BCLK, "bclk" },     { ASPEED_CLK_UARTX, "uxclk" },
1362def99fcbSryan_chen 	{ ASPEED_CLK_HUARTX, "huxclk" },
1363d35ac78cSryan_chen };
1364d35ac78cSryan_chen 
1365d35ac78cSryan_chen int soc_clk_dump(void)
1366d35ac78cSryan_chen {
1367d35ac78cSryan_chen 	struct udevice *dev;
1368d35ac78cSryan_chen 	struct clk clk;
1369d35ac78cSryan_chen 	unsigned long rate;
1370d35ac78cSryan_chen 	int i, ret;
1371d35ac78cSryan_chen 
13725d05f4fcSRyan Chen 	ret = uclass_get_device_by_driver(UCLASS_CLK, DM_GET_DRIVER(aspeed_scu),
13735d05f4fcSRyan Chen 					  &dev);
1374d35ac78cSryan_chen 	if (ret)
1375d35ac78cSryan_chen 		return ret;
1376d35ac78cSryan_chen 
1377d35ac78cSryan_chen 	printf("Clk\t\tHz\n");
1378d35ac78cSryan_chen 
1379d35ac78cSryan_chen 	for (i = 0; i < ARRAY_SIZE(aspeed_clk_names); i++) {
1380d35ac78cSryan_chen 		clk.id = aspeed_clk_names[i].id;
1381d35ac78cSryan_chen 		ret = clk_request(dev, &clk);
1382d35ac78cSryan_chen 		if (ret < 0) {
1383d35ac78cSryan_chen 			debug("%s clk_request() failed: %d\n", __func__, ret);
1384d35ac78cSryan_chen 			continue;
1385d35ac78cSryan_chen 		}
1386d35ac78cSryan_chen 
1387d35ac78cSryan_chen 		ret = clk_get_rate(&clk);
1388d35ac78cSryan_chen 		rate = ret;
1389d35ac78cSryan_chen 
1390d35ac78cSryan_chen 		clk_free(&clk);
1391d35ac78cSryan_chen 
1392d35ac78cSryan_chen 		if (ret == -ENOTSUPP) {
1393d35ac78cSryan_chen 			printf("clk ID %lu not supported yet\n",
1394d35ac78cSryan_chen 			       aspeed_clk_names[i].id);
1395d35ac78cSryan_chen 			continue;
1396d35ac78cSryan_chen 		}
1397d35ac78cSryan_chen 		if (ret < 0) {
13985d05f4fcSRyan Chen 			printf("%s %lu: get_rate err: %d\n", __func__,
13995d05f4fcSRyan Chen 			       aspeed_clk_names[i].id, ret);
1400d35ac78cSryan_chen 			continue;
1401d35ac78cSryan_chen 		}
1402d35ac78cSryan_chen 
14035d05f4fcSRyan Chen 		printf("%s(%3lu):\t%lu\n", aspeed_clk_names[i].name,
14045d05f4fcSRyan Chen 		       aspeed_clk_names[i].id, rate);
1405d35ac78cSryan_chen 	}
1406d35ac78cSryan_chen 
1407d35ac78cSryan_chen 	return 0;
1408d35ac78cSryan_chen }
1409d35ac78cSryan_chen 
1410d6e349c7Sryan_chen static const struct udevice_id ast2600_clk_ids[] = {
14115d05f4fcSRyan Chen 	{
14125d05f4fcSRyan Chen 		.compatible = "aspeed,ast2600-scu",
14135d05f4fcSRyan Chen 	},
1414550e691bSryan_chen 	{}
1415550e691bSryan_chen };
1416550e691bSryan_chen 
1417aa36597fSDylan Hung U_BOOT_DRIVER(aspeed_scu) = {
1418aa36597fSDylan Hung 	.name = "aspeed_scu",
1419550e691bSryan_chen 	.id = UCLASS_CLK,
1420d6e349c7Sryan_chen 	.of_match = ast2600_clk_ids,
1421f0d895afSryan_chen 	.priv_auto_alloc_size = sizeof(struct ast2600_clk_priv),
1422f9aa0ee1Sryan_chen 	.ops = &ast2600_clk_ops,
1423d6e349c7Sryan_chen 	.bind = ast2600_clk_bind,
1424d6e349c7Sryan_chen 	.probe = ast2600_clk_probe,
1425550e691bSryan_chen };
1426