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