Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
| 2 | /* |
| 3 | * Copyright 2020 NXP |
| 4 | */ |
| 5 | |
| 6 | #include <common.h> |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 7 | #include <command.h> |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 8 | #include <div64.h> |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 9 | #include <asm/arch/imx-regs.h> |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 10 | #include <asm/io.h> |
| 11 | #include <errno.h> |
| 12 | #include <asm/arch/clock.h> |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 13 | #include <asm/arch/pcc.h> |
| 14 | #include <asm/arch/cgc.h> |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 15 | #include <asm/arch/sys_proto.h> |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 16 | #include <asm/global_data.h> |
| 17 | #include <linux/delay.h> |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 18 | |
| 19 | DECLARE_GLOBAL_DATA_PTR; |
| 20 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 21 | #define PLL_USB_EN_USB_CLKS_MASK (0x01 << 6) |
| 22 | #define PLL_USB_PWR_MASK (0x01 << 12) |
| 23 | #define PLL_USB_ENABLE_MASK (0x01 << 13) |
| 24 | #define PLL_USB_BYPASS_MASK (0x01 << 16) |
| 25 | #define PLL_USB_REG_ENABLE_MASK (0x01 << 21) |
| 26 | #define PLL_USB_DIV_SEL_MASK (0x07 << 22) |
| 27 | #define PLL_USB_LOCK_MASK (0x01 << 31) |
| 28 | #define PCC5_LPDDR4_ADDR 0x2da70108 |
| 29 | |
Ye Li | da0469d | 2021-10-29 09:46:18 +0800 | [diff] [blame] | 30 | static void lpuart_set_clk(u32 index, enum cgc_clk clk) |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 31 | { |
| 32 | const u32 lpuart_pcc_slots[] = { |
| 33 | LPUART4_PCC3_SLOT, |
| 34 | LPUART5_PCC3_SLOT, |
| 35 | LPUART6_PCC4_SLOT, |
| 36 | LPUART7_PCC4_SLOT, |
| 37 | }; |
| 38 | |
| 39 | const u32 lpuart_pcc[] = { |
| 40 | 3, 3, 4, 4, |
| 41 | }; |
| 42 | |
| 43 | if (index > 3) |
| 44 | return; |
| 45 | |
| 46 | pcc_clock_enable(lpuart_pcc[index], lpuart_pcc_slots[index], false); |
| 47 | pcc_clock_sel(lpuart_pcc[index], lpuart_pcc_slots[index], clk); |
| 48 | pcc_clock_enable(lpuart_pcc[index], lpuart_pcc_slots[index], true); |
| 49 | |
| 50 | pcc_reset_peripheral(lpuart_pcc[index], lpuart_pcc_slots[index], false); |
| 51 | } |
| 52 | |
| 53 | static void init_clk_lpuart(void) |
| 54 | { |
| 55 | u32 index = 0, i; |
| 56 | |
| 57 | const u32 lpuart_array[] = { |
| 58 | LPUART4_RBASE, |
| 59 | LPUART5_RBASE, |
| 60 | LPUART6_RBASE, |
| 61 | LPUART7_RBASE, |
| 62 | }; |
| 63 | |
| 64 | for (i = 0; i < 4; i++) { |
| 65 | if (lpuart_array[i] == LPUART_BASE) { |
| 66 | index = i; |
| 67 | break; |
| 68 | } |
| 69 | } |
| 70 | |
| 71 | lpuart_set_clk(index, SOSC_DIV2); |
| 72 | } |
| 73 | |
| 74 | void init_clk_fspi(int index) |
| 75 | { |
| 76 | pcc_clock_enable(4, FLEXSPI2_PCC4_SLOT, false); |
| 77 | pcc_clock_sel(4, FLEXSPI2_PCC4_SLOT, PLL3_PFD2_DIV1); |
| 78 | pcc_clock_div_config(4, FLEXSPI2_PCC4_SLOT, false, 8); |
| 79 | pcc_clock_enable(4, FLEXSPI2_PCC4_SLOT, true); |
| 80 | pcc_reset_peripheral(4, FLEXSPI2_PCC4_SLOT, false); |
| 81 | } |
| 82 | |
| 83 | void setclkout_ddr(void) |
| 84 | { |
| 85 | writel(0x12800000, 0x2DA60020); |
| 86 | writel(0xa00, 0x298C0000); /* PTD0 */ |
| 87 | } |
| 88 | |
| 89 | void ddrphy_pll_lock(void) |
| 90 | { |
| 91 | writel(0x00011542, 0x2E065964); |
| 92 | writel(0x00011542, 0x2E06586C); |
| 93 | |
| 94 | writel(0x00000B01, 0x2E062000); |
| 95 | writel(0x00000B01, 0x2E060000); |
| 96 | } |
| 97 | |
| 98 | void init_clk_ddr(void) |
| 99 | { |
Ye Li | 328f201 | 2021-10-29 09:46:26 +0800 | [diff] [blame] | 100 | /* disable the ddr pcc */ |
| 101 | writel(0xc0000000, PCC5_LPDDR4_ADDR); |
| 102 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 103 | /* enable pll4 and ddrclk*/ |
Ye Li | 8c0c8d0 | 2022-04-06 14:30:13 +0800 | [diff] [blame^] | 104 | cgc2_pll4_init(true); |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 105 | cgc2_ddrclk_config(4, 1); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 106 | |
| 107 | /* enable ddr pcc */ |
| 108 | writel(0xd0000000, PCC5_LPDDR4_ADDR); |
| 109 | |
Ye Li | 8840830 | 2021-10-29 09:46:30 +0800 | [diff] [blame] | 110 | /* Wait until ddrclk reg lock bit is cleared, so that the div update is finished */ |
| 111 | cgc2_ddrclk_wait_unlock(); |
| 112 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 113 | /* for debug */ |
| 114 | /* setclkout_ddr(); */ |
| 115 | } |
| 116 | |
| 117 | int set_ddr_clk(u32 phy_freq_mhz) |
| 118 | { |
| 119 | debug("%s %u\n", __func__, phy_freq_mhz); |
| 120 | |
| 121 | if (phy_freq_mhz == 48) { |
| 122 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 123 | cgc2_ddrclk_config(2, 0); /* 24Mhz DDR clock */ |
| 124 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 125 | } else if (phy_freq_mhz == 384) { |
| 126 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 127 | cgc2_ddrclk_config(0, 0); /* 192Mhz DDR clock */ |
| 128 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 129 | } else if (phy_freq_mhz == 528) { |
| 130 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 131 | cgc2_ddrclk_config(4, 1); /* 264Mhz DDR clock */ |
| 132 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 133 | } else if (phy_freq_mhz == 264) { |
| 134 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 135 | cgc2_ddrclk_config(4, 3); /* 132Mhz DDR clock */ |
| 136 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 137 | } else if (phy_freq_mhz == 192) { |
| 138 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 139 | cgc2_ddrclk_config(0, 1); /* 96Mhz DDR clock */ |
| 140 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 141 | } else if (phy_freq_mhz == 96) { |
| 142 | writel(0x90000000, PCC5_LPDDR4_ADDR); /* disable ddr pcc */ |
| 143 | cgc2_ddrclk_config(0, 3); /* 48Mhz DDR clock */ |
| 144 | writel(0xd0000000, PCC5_LPDDR4_ADDR); /* enable ddr pcc */ |
| 145 | } else { |
| 146 | printf("ddr phy clk %uMhz is not supported\n", phy_freq_mhz); |
| 147 | return -EINVAL; |
| 148 | } |
| 149 | |
Ye Li | 8840830 | 2021-10-29 09:46:30 +0800 | [diff] [blame] | 150 | /* Wait until ddrclk reg lock bit is cleared, so that the div update is finished */ |
| 151 | cgc2_ddrclk_wait_unlock(); |
| 152 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 153 | return 0; |
| 154 | } |
| 155 | |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 156 | void clock_init_early(void) |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 157 | { |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 158 | cgc1_soscdiv_init(); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 159 | |
| 160 | init_clk_lpuart(); |
| 161 | |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 162 | /* Enable upower mu1 clk */ |
| 163 | pcc_clock_enable(3, UPOWER_PCC3_SLOT, true); |
| 164 | } |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 165 | |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 166 | /* This will be invoked after pmic voltage setting */ |
| 167 | void clock_init_late(void) |
| 168 | { |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 169 | |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 170 | if (IS_ENABLED(CONFIG_IMX8ULP_LD_MODE)) |
| 171 | cgc1_init_core_clk(MHZ(500)); |
| 172 | else if (IS_ENABLED(CONFIG_IMX8ULP_ND_MODE)) |
| 173 | cgc1_init_core_clk(MHZ(750)); |
| 174 | else |
| 175 | cgc1_init_core_clk(MHZ(960)); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 176 | |
Peng Fan | 4cdb3a3 | 2022-04-06 14:30:12 +0800 | [diff] [blame] | 177 | /* |
| 178 | * Audio use this frequency in kernel dts, |
| 179 | * however nic use pll3 pfd0, we have to |
| 180 | * make the freqency same as kernel to make nic |
| 181 | * not being disabled |
| 182 | */ |
| 183 | cgc1_pll3_init(540672000); |
| 184 | |
| 185 | if (IS_ENABLED(CONFIG_IMX8ULP_LD_MODE) || IS_ENABLED(CONFIG_IMX8ULP_ND_MODE)) { |
| 186 | pcc_clock_enable(4, SDHC0_PCC4_SLOT, false); |
| 187 | pcc_clock_sel(4, SDHC0_PCC4_SLOT, PLL3_PFD2_DIV2); |
| 188 | pcc_clock_enable(4, SDHC0_PCC4_SLOT, true); |
| 189 | pcc_reset_peripheral(4, SDHC0_PCC4_SLOT, false); |
| 190 | |
| 191 | pcc_clock_enable(4, SDHC1_PCC4_SLOT, false); |
| 192 | pcc_clock_sel(4, SDHC1_PCC4_SLOT, PLL3_PFD2_DIV2); |
| 193 | pcc_clock_enable(4, SDHC1_PCC4_SLOT, true); |
| 194 | pcc_reset_peripheral(4, SDHC1_PCC4_SLOT, false); |
| 195 | |
| 196 | pcc_clock_enable(4, SDHC2_PCC4_SLOT, false); |
| 197 | pcc_clock_sel(4, SDHC2_PCC4_SLOT, PLL3_PFD2_DIV2); |
| 198 | pcc_clock_enable(4, SDHC2_PCC4_SLOT, true); |
| 199 | pcc_reset_peripheral(4, SDHC2_PCC4_SLOT, false); |
| 200 | } else { |
| 201 | pcc_clock_enable(4, SDHC0_PCC4_SLOT, false); |
| 202 | pcc_clock_sel(4, SDHC0_PCC4_SLOT, PLL3_PFD1_DIV2); |
| 203 | pcc_clock_enable(4, SDHC0_PCC4_SLOT, true); |
| 204 | pcc_reset_peripheral(4, SDHC0_PCC4_SLOT, false); |
| 205 | |
| 206 | pcc_clock_enable(4, SDHC1_PCC4_SLOT, false); |
| 207 | pcc_clock_sel(4, SDHC1_PCC4_SLOT, PLL3_PFD2_DIV1); |
| 208 | pcc_clock_enable(4, SDHC1_PCC4_SLOT, true); |
| 209 | pcc_reset_peripheral(4, SDHC1_PCC4_SLOT, false); |
| 210 | |
| 211 | pcc_clock_enable(4, SDHC2_PCC4_SLOT, false); |
| 212 | pcc_clock_sel(4, SDHC2_PCC4_SLOT, PLL3_PFD2_DIV1); |
| 213 | pcc_clock_enable(4, SDHC2_PCC4_SLOT, true); |
| 214 | pcc_reset_peripheral(4, SDHC2_PCC4_SLOT, false); |
| 215 | } |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 216 | |
| 217 | /* |
| 218 | * Enable clock division |
| 219 | * TODO: may not needed after ROM ready. |
| 220 | */ |
| 221 | } |
| 222 | |
| 223 | #if IS_ENABLED(CONFIG_SYS_I2C_IMX_LPI2C) |
| 224 | int enable_i2c_clk(unsigned char enable, u32 i2c_num) |
| 225 | { |
| 226 | /* Set parent to FIRC DIV2 clock */ |
| 227 | const u32 lpi2c_pcc_clks[] = { |
| 228 | LPI2C4_PCC3_SLOT << 8 | 3, |
| 229 | LPI2C5_PCC3_SLOT << 8 | 3, |
| 230 | LPI2C6_PCC4_SLOT << 8 | 4, |
| 231 | LPI2C7_PCC4_SLOT << 8 | 4, |
| 232 | }; |
| 233 | |
Ye Li | 27666ca | 2021-10-29 09:46:21 +0800 | [diff] [blame] | 234 | if (i2c_num == 0) |
| 235 | return 0; |
| 236 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 237 | if (i2c_num < 4 || i2c_num > 7) |
| 238 | return -EINVAL; |
| 239 | |
| 240 | if (enable) { |
| 241 | pcc_clock_enable(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 242 | lpi2c_pcc_clks[i2c_num - 4] >> 8, false); |
| 243 | pcc_clock_sel(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 244 | lpi2c_pcc_clks[i2c_num - 4] >> 8, SOSC_DIV2); |
| 245 | pcc_clock_enable(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 246 | lpi2c_pcc_clks[i2c_num - 4] >> 8, true); |
| 247 | pcc_reset_peripheral(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 248 | lpi2c_pcc_clks[i2c_num - 4] >> 8, false); |
| 249 | } else { |
| 250 | pcc_clock_enable(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 251 | lpi2c_pcc_clks[i2c_num - 4] >> 8, false); |
| 252 | } |
| 253 | return 0; |
| 254 | } |
| 255 | |
| 256 | u32 imx_get_i2cclk(u32 i2c_num) |
| 257 | { |
| 258 | const u32 lpi2c_pcc_clks[] = { |
| 259 | LPI2C4_PCC3_SLOT << 8 | 3, |
| 260 | LPI2C5_PCC3_SLOT << 8 | 3, |
| 261 | LPI2C6_PCC4_SLOT << 8 | 4, |
| 262 | LPI2C7_PCC4_SLOT << 8 | 4, |
| 263 | }; |
| 264 | |
Ye Li | 27666ca | 2021-10-29 09:46:21 +0800 | [diff] [blame] | 265 | if (i2c_num == 0) |
| 266 | return 24000000; |
| 267 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 268 | if (i2c_num < 4 || i2c_num > 7) |
| 269 | return 0; |
| 270 | |
| 271 | return pcc_clock_get_rate(lpi2c_pcc_clks[i2c_num - 4] & 0xff, |
| 272 | lpi2c_pcc_clks[i2c_num - 4] >> 8); |
| 273 | } |
| 274 | #endif |
| 275 | |
Clark Wang | 276dfd5 | 2022-04-06 14:30:09 +0800 | [diff] [blame] | 276 | #if IS_ENABLED(CONFIG_SYS_I2C_IMX_I3C) |
| 277 | int enable_i3c_clk(unsigned char enable, u32 i3c_num) |
| 278 | { |
| 279 | if (enable) { |
| 280 | pcc_clock_enable(3, I3C2_PCC3_SLOT, false); |
| 281 | pcc_clock_sel(3, I3C2_PCC3_SLOT, SOSC_DIV2); |
| 282 | pcc_clock_enable(3, I3C2_PCC3_SLOT, true); |
| 283 | pcc_reset_peripheral(3, I3C2_PCC3_SLOT, false); |
| 284 | } else { |
| 285 | pcc_clock_enable(3, I3C2_PCC3_SLOT, false); |
| 286 | } |
| 287 | return 0; |
| 288 | } |
| 289 | |
| 290 | u32 imx_get_i3cclk(u32 i3c_num) |
| 291 | { |
| 292 | return pcc_clock_get_rate(3, I3C2_PCC3_SLOT); |
| 293 | } |
| 294 | #endif |
| 295 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 296 | void enable_usboh3_clk(unsigned char enable) |
| 297 | { |
| 298 | if (enable) { |
| 299 | pcc_clock_enable(4, USB0_PCC4_SLOT, true); |
| 300 | pcc_clock_enable(4, USBPHY_PCC4_SLOT, true); |
| 301 | pcc_reset_peripheral(4, USB0_PCC4_SLOT, false); |
| 302 | pcc_reset_peripheral(4, USBPHY_PCC4_SLOT, false); |
| 303 | |
| 304 | #ifdef CONFIG_USB_MAX_CONTROLLER_COUNT |
| 305 | if (CONFIG_USB_MAX_CONTROLLER_COUNT > 1) { |
| 306 | pcc_clock_enable(4, USB1_PCC4_SLOT, true); |
| 307 | pcc_clock_enable(4, USB1PHY_PCC4_SLOT, true); |
| 308 | pcc_reset_peripheral(4, USB1_PCC4_SLOT, false); |
| 309 | pcc_reset_peripheral(4, USB1PHY_PCC4_SLOT, false); |
| 310 | } |
| 311 | #endif |
| 312 | |
| 313 | pcc_clock_enable(4, USB_XBAR_PCC4_SLOT, true); |
| 314 | } else { |
| 315 | pcc_clock_enable(4, USB0_PCC4_SLOT, false); |
| 316 | pcc_clock_enable(4, USB1_PCC4_SLOT, false); |
| 317 | pcc_clock_enable(4, USBPHY_PCC4_SLOT, false); |
| 318 | pcc_clock_enable(4, USB1PHY_PCC4_SLOT, false); |
| 319 | pcc_clock_enable(4, USB_XBAR_PCC4_SLOT, false); |
| 320 | } |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 321 | } |
| 322 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 323 | int enable_usb_pll(ulong usb_phy_base) |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 324 | { |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 325 | u32 sosc_rate; |
| 326 | s32 timeout = 1000000; |
| 327 | |
| 328 | struct usbphy_regs *usbphy = |
| 329 | (struct usbphy_regs *)usb_phy_base; |
| 330 | |
| 331 | sosc_rate = cgc1_sosc_div(SOSC); |
| 332 | if (!sosc_rate) |
| 333 | return -EPERM; |
| 334 | |
| 335 | if (!(readl(&usbphy->usb1_pll_480_ctrl) & PLL_USB_LOCK_MASK)) { |
| 336 | writel(0x1c00000, &usbphy->usb1_pll_480_ctrl_clr); |
| 337 | |
| 338 | switch (sosc_rate) { |
| 339 | case 24000000: |
| 340 | writel(0xc00000, &usbphy->usb1_pll_480_ctrl_set); |
| 341 | break; |
| 342 | |
| 343 | case 30000000: |
| 344 | writel(0x800000, &usbphy->usb1_pll_480_ctrl_set); |
| 345 | break; |
| 346 | |
| 347 | case 19200000: |
| 348 | writel(0x1400000, &usbphy->usb1_pll_480_ctrl_set); |
| 349 | break; |
| 350 | |
| 351 | default: |
| 352 | writel(0xc00000, &usbphy->usb1_pll_480_ctrl_set); |
| 353 | break; |
| 354 | } |
| 355 | |
| 356 | /* Enable the regulator first */ |
| 357 | writel(PLL_USB_REG_ENABLE_MASK, |
| 358 | &usbphy->usb1_pll_480_ctrl_set); |
| 359 | |
| 360 | /* Wait at least 15us */ |
| 361 | udelay(15); |
| 362 | |
| 363 | /* Enable the power */ |
| 364 | writel(PLL_USB_PWR_MASK, &usbphy->usb1_pll_480_ctrl_set); |
| 365 | |
| 366 | /* Wait lock */ |
| 367 | while (timeout--) { |
| 368 | if (readl(&usbphy->usb1_pll_480_ctrl) & |
| 369 | PLL_USB_LOCK_MASK) |
| 370 | break; |
| 371 | } |
| 372 | |
| 373 | if (timeout <= 0) { |
| 374 | /* If timeout, we power down the pll */ |
| 375 | writel(PLL_USB_PWR_MASK, |
| 376 | &usbphy->usb1_pll_480_ctrl_clr); |
| 377 | return -ETIME; |
| 378 | } |
| 379 | } |
| 380 | |
| 381 | /* Clear the bypass */ |
| 382 | writel(PLL_USB_BYPASS_MASK, &usbphy->usb1_pll_480_ctrl_clr); |
| 383 | |
| 384 | /* Enable the PLL clock out to USB */ |
| 385 | writel((PLL_USB_EN_USB_CLKS_MASK | PLL_USB_ENABLE_MASK), |
| 386 | &usbphy->usb1_pll_480_ctrl_set); |
| 387 | |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 388 | return 0; |
| 389 | } |
| 390 | |
Ye Li | 3d3dfb0 | 2021-10-29 09:46:19 +0800 | [diff] [blame] | 391 | void enable_mipi_dsi_clk(unsigned char enable) |
| 392 | { |
| 393 | if (enable) { |
| 394 | pcc_clock_enable(5, DSI_PCC5_SLOT, false); |
Ye Li | cb7e375 | 2021-10-29 09:46:27 +0800 | [diff] [blame] | 395 | pcc_reset_peripheral(5, DSI_PCC5_SLOT, true); |
Ye Li | 3d3dfb0 | 2021-10-29 09:46:19 +0800 | [diff] [blame] | 396 | pcc_clock_sel(5, DSI_PCC5_SLOT, PLL4_PFD3_DIV2); |
| 397 | pcc_clock_div_config(5, DSI_PCC5_SLOT, 0, 6); |
| 398 | pcc_clock_enable(5, DSI_PCC5_SLOT, true); |
| 399 | pcc_reset_peripheral(5, DSI_PCC5_SLOT, false); |
| 400 | } else { |
| 401 | pcc_clock_enable(5, DSI_PCC5_SLOT, false); |
| 402 | pcc_reset_peripheral(5, DSI_PCC5_SLOT, true); |
| 403 | } |
| 404 | } |
| 405 | |
Alice Guo | 23ee0e1 | 2021-10-29 09:46:29 +0800 | [diff] [blame] | 406 | void enable_adc1_clk(bool enable) |
| 407 | { |
| 408 | if (enable) { |
| 409 | pcc_clock_enable(1, ADC1_PCC1_SLOT, false); |
| 410 | pcc_clock_sel(1, ADC1_PCC1_SLOT, CM33_BUSCLK); |
| 411 | pcc_clock_enable(1, ADC1_PCC1_SLOT, true); |
| 412 | pcc_reset_peripheral(1, ADC1_PCC1_SLOT, false); |
| 413 | } else { |
| 414 | pcc_clock_enable(1, ADC1_PCC1_SLOT, false); |
| 415 | } |
| 416 | } |
| 417 | |
Ye Li | cb7e375 | 2021-10-29 09:46:27 +0800 | [diff] [blame] | 418 | void reset_lcdclk(void) |
| 419 | { |
| 420 | /* Disable clock and reset dcnano*/ |
| 421 | pcc_clock_enable(5, DCNANO_PCC5_SLOT, false); |
| 422 | pcc_reset_peripheral(5, DCNANO_PCC5_SLOT, true); |
| 423 | } |
| 424 | |
Ye Li | 3d3dfb0 | 2021-10-29 09:46:19 +0800 | [diff] [blame] | 425 | void mxs_set_lcdclk(u32 base_addr, u32 freq_in_khz) |
| 426 | { |
| 427 | u8 pcd, best_pcd = 0; |
| 428 | u32 frac, rate, parent_rate, pfd, div; |
| 429 | u32 best_pfd = 0, best_frac = 0, best = 0, best_div = 0; |
| 430 | u32 pll4_rate; |
| 431 | |
| 432 | pcc_clock_enable(5, DCNANO_PCC5_SLOT, false); |
| 433 | |
| 434 | pll4_rate = cgc_clk_get_rate(PLL4); |
| 435 | pll4_rate = pll4_rate / 1000; /* Change to khz*/ |
| 436 | |
| 437 | debug("PLL4 rate %ukhz\n", pll4_rate); |
| 438 | |
| 439 | for (pfd = 12; pfd <= 35; pfd++) { |
| 440 | parent_rate = pll4_rate; |
| 441 | parent_rate = parent_rate * 18 / pfd; |
| 442 | |
| 443 | for (div = 1; div <= 64; div++) { |
| 444 | parent_rate = parent_rate / div; |
| 445 | |
| 446 | for (pcd = 0; pcd < 8; pcd++) { |
| 447 | for (frac = 0; frac < 2; frac++) { |
| 448 | if (pcd == 0 && frac == 1) |
| 449 | continue; |
| 450 | |
| 451 | rate = parent_rate * (frac + 1) / (pcd + 1); |
| 452 | if (rate > freq_in_khz) |
| 453 | continue; |
| 454 | |
| 455 | if (best == 0 || rate > best) { |
| 456 | best = rate; |
| 457 | best_pfd = pfd; |
| 458 | best_frac = frac; |
| 459 | best_pcd = pcd; |
| 460 | best_div = div; |
| 461 | } |
| 462 | } |
| 463 | } |
| 464 | } |
| 465 | } |
| 466 | |
| 467 | if (best == 0) { |
| 468 | printf("Can't find parent clock for LCDIF, target freq: %u\n", freq_in_khz); |
| 469 | return; |
| 470 | } |
| 471 | |
| 472 | debug("LCD target rate %ukhz, best rate %ukhz, frac %u, pcd %u, best_pfd %u, best_div %u\n", |
| 473 | freq_in_khz, best, best_frac, best_pcd, best_pfd, best_div); |
| 474 | |
| 475 | cgc2_pll4_pfd_config(PLL4_PFD0, best_pfd); |
| 476 | cgc2_pll4_pfddiv_config(PLL4_PFD0_DIV1, best_div - 1); |
| 477 | |
| 478 | pcc_clock_sel(5, DCNANO_PCC5_SLOT, PLL4_PFD0_DIV1); |
| 479 | pcc_clock_div_config(5, DCNANO_PCC5_SLOT, best_frac, best_pcd + 1); |
| 480 | pcc_clock_enable(5, DCNANO_PCC5_SLOT, true); |
| 481 | pcc_reset_peripheral(5, DCNANO_PCC5_SLOT, false); |
| 482 | } |
| 483 | |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 484 | u32 mxc_get_clock(enum mxc_clock clk) |
| 485 | { |
| 486 | switch (clk) { |
| 487 | case MXC_ESDHC_CLK: |
| 488 | return pcc_clock_get_rate(4, SDHC0_PCC4_SLOT); |
| 489 | case MXC_ESDHC2_CLK: |
| 490 | return pcc_clock_get_rate(4, SDHC1_PCC4_SLOT); |
| 491 | case MXC_ESDHC3_CLK: |
| 492 | return pcc_clock_get_rate(4, SDHC2_PCC4_SLOT); |
| 493 | case MXC_ARM_CLK: |
Ye Li | da0469d | 2021-10-29 09:46:18 +0800 | [diff] [blame] | 494 | return cgc_clk_get_rate(PLL2); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 495 | default: |
| 496 | return 0; |
| 497 | } |
| 498 | } |
| 499 | |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 500 | u32 get_lpuart_clk(void) |
| 501 | { |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 502 | int index = 0; |
| 503 | |
| 504 | const u32 lpuart_array[] = { |
| 505 | LPUART4_RBASE, |
| 506 | LPUART5_RBASE, |
| 507 | LPUART6_RBASE, |
| 508 | LPUART7_RBASE, |
| 509 | }; |
| 510 | |
| 511 | const u32 lpuart_pcc_slots[] = { |
| 512 | LPUART4_PCC3_SLOT, |
| 513 | LPUART5_PCC3_SLOT, |
| 514 | LPUART6_PCC4_SLOT, |
| 515 | LPUART7_PCC4_SLOT, |
| 516 | }; |
| 517 | |
| 518 | const u32 lpuart_pcc[] = { |
| 519 | 3, 3, 4, 4, |
| 520 | }; |
| 521 | |
| 522 | for (index = 0; index < 4; index++) { |
| 523 | if (lpuart_array[index] == LPUART_BASE) |
| 524 | break; |
| 525 | } |
| 526 | |
| 527 | if (index > 3) |
| 528 | return 0; |
| 529 | |
| 530 | return pcc_clock_get_rate(lpuart_pcc[index], lpuart_pcc_slots[index]); |
| 531 | } |
| 532 | |
| 533 | #ifndef CONFIG_SPL_BUILD |
| 534 | /* |
| 535 | * Dump some core clockes. |
| 536 | */ |
| 537 | int do_mx8ulp_showclocks(struct cmd_tbl *cmdtp, int flag, int argc, char * const argv[]) |
| 538 | { |
| 539 | printf("SDHC0 %8d MHz\n", pcc_clock_get_rate(4, SDHC0_PCC4_SLOT) / 1000000); |
| 540 | printf("SDHC1 %8d MHz\n", pcc_clock_get_rate(4, SDHC1_PCC4_SLOT) / 1000000); |
| 541 | printf("SDHC2 %8d MHz\n", pcc_clock_get_rate(4, SDHC2_PCC4_SLOT) / 1000000); |
| 542 | |
Ye Li | da0469d | 2021-10-29 09:46:18 +0800 | [diff] [blame] | 543 | printf("SOSC %8d MHz\n", cgc_clk_get_rate(SOSC) / 1000000); |
| 544 | printf("FRO %8d MHz\n", cgc_clk_get_rate(FRO) / 1000000); |
| 545 | printf("PLL2 %8d MHz\n", cgc_clk_get_rate(PLL2) / 1000000); |
| 546 | printf("PLL3 %8d MHz\n", cgc_clk_get_rate(PLL3) / 1000000); |
| 547 | printf("PLL3_VCODIV %8d MHz\n", cgc_clk_get_rate(PLL3_VCODIV) / 1000000); |
| 548 | printf("PLL3_PFD0 %8d MHz\n", cgc_clk_get_rate(PLL3_PFD0) / 1000000); |
| 549 | printf("PLL3_PFD1 %8d MHz\n", cgc_clk_get_rate(PLL3_PFD1) / 1000000); |
| 550 | printf("PLL3_PFD2 %8d MHz\n", cgc_clk_get_rate(PLL3_PFD2) / 1000000); |
| 551 | printf("PLL3_PFD3 %8d MHz\n", cgc_clk_get_rate(PLL3_PFD3) / 1000000); |
| 552 | |
| 553 | printf("PLL4_PFD0 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD0) / 1000000); |
| 554 | printf("PLL4_PFD1 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD1) / 1000000); |
| 555 | printf("PLL4_PFD2 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD2) / 1000000); |
| 556 | printf("PLL4_PFD3 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD3) / 1000000); |
| 557 | |
| 558 | printf("PLL4_PFD0_DIV1 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD0_DIV1) / 1000000); |
| 559 | printf("PLL4_PFD0_DIV2 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD0_DIV2) / 1000000); |
| 560 | printf("PLL4_PFD1_DIV1 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD1_DIV1) / 1000000); |
| 561 | printf("PLL4_PFD1_DIV2 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD1_DIV2) / 1000000); |
| 562 | |
| 563 | printf("PLL4_PFD2_DIV1 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD2_DIV1) / 1000000); |
| 564 | printf("PLL4_PFD2_DIV2 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD2_DIV2) / 1000000); |
| 565 | printf("PLL4_PFD3_DIV1 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD3_DIV1) / 1000000); |
| 566 | printf("PLL4_PFD3_DIV2 %8d MHz\n", cgc_clk_get_rate(PLL4_PFD3_DIV2) / 1000000); |
| 567 | |
| 568 | printf("LPAV_AXICLK %8d MHz\n", cgc_clk_get_rate(LPAV_AXICLK) / 1000000); |
| 569 | printf("LPAV_AHBCLK %8d MHz\n", cgc_clk_get_rate(LPAV_AHBCLK) / 1000000); |
| 570 | printf("LPAV_BUSCLK %8d MHz\n", cgc_clk_get_rate(LPAV_BUSCLK) / 1000000); |
| 571 | printf("NIC_APCLK %8d MHz\n", cgc_clk_get_rate(NIC_APCLK) / 1000000); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 572 | |
Ye Li | da0469d | 2021-10-29 09:46:18 +0800 | [diff] [blame] | 573 | printf("NIC_PERCLK %8d MHz\n", cgc_clk_get_rate(NIC_PERCLK) / 1000000); |
| 574 | printf("XBAR_APCLK %8d MHz\n", cgc_clk_get_rate(XBAR_APCLK) / 1000000); |
| 575 | printf("XBAR_BUSCLK %8d MHz\n", cgc_clk_get_rate(XBAR_BUSCLK) / 1000000); |
| 576 | printf("AD_SLOWCLK %8d MHz\n", cgc_clk_get_rate(AD_SLOWCLK) / 1000000); |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 577 | return 0; |
Peng Fan | b15705a | 2021-08-07 16:00:35 +0800 | [diff] [blame] | 578 | } |
Peng Fan | 690eea1 | 2021-08-07 16:00:45 +0800 | [diff] [blame] | 579 | |
| 580 | U_BOOT_CMD( |
| 581 | clocks, CONFIG_SYS_MAXARGS, 1, do_mx8ulp_showclocks, |
| 582 | "display clocks", |
| 583 | "" |
| 584 | ); |
| 585 | #endif |