| Hao Zhang | 4dca7f0 | 2014-07-16 00:59:23 +0300 | [diff] [blame] | 1 | /* |
| 2 | * Keystone2: get clk rate for K2E |
| 3 | * |
| 4 | * (C) Copyright 2012-2014 |
| 5 | * Texas Instruments Incorporated, <www.ti.com> |
| 6 | * |
| 7 | * SPDX-License-Identifier: GPL-2.0+ |
| 8 | */ |
| 9 | |
| 10 | #include <common.h> |
| 11 | #include <asm/arch/clock.h> |
| 12 | #include <asm/arch/clock_defs.h> |
| 13 | |
| Hao Zhang | 4dca7f0 | 2014-07-16 00:59:23 +0300 | [diff] [blame] | 14 | /** |
| 15 | * pll_freq_get - get pll frequency |
| 16 | * Fout = Fref * NF(mult) / NR(prediv) / OD |
| 17 | * @pll: pll identifier |
| 18 | */ |
| 19 | static unsigned long pll_freq_get(int pll) |
| 20 | { |
| 21 | unsigned long mult = 1, prediv = 1, output_div = 2; |
| 22 | unsigned long ret; |
| 23 | u32 tmp, reg; |
| 24 | |
| 25 | if (pll == CORE_PLL) { |
| 26 | ret = external_clk[sys_clk]; |
| 27 | if (pllctl_reg_read(pll, ctl) & PLLCTL_PLLEN) { |
| 28 | /* PLL mode */ |
| 29 | tmp = __raw_readl(KS2_MAINPLLCTL0); |
| 30 | prediv = (tmp & PLL_DIV_MASK) + 1; |
| 31 | mult = (((tmp & PLLM_MULT_HI_SMASK) >> 6) | |
| 32 | (pllctl_reg_read(pll, mult) & |
| 33 | PLLM_MULT_LO_MASK)) + 1; |
| 34 | output_div = ((pllctl_reg_read(pll, secctl) >> |
| 35 | PLL_CLKOD_SHIFT) & PLL_CLKOD_MASK) + 1; |
| 36 | |
| 37 | ret = ret / prediv / output_div * mult; |
| 38 | } |
| 39 | } else { |
| 40 | switch (pll) { |
| 41 | case PASS_PLL: |
| 42 | ret = external_clk[pa_clk]; |
| 43 | reg = KS2_PASSPLLCTL0; |
| 44 | break; |
| 45 | case DDR3_PLL: |
| 46 | ret = external_clk[ddr3_clk]; |
| 47 | reg = KS2_DDR3APLLCTL0; |
| 48 | break; |
| 49 | default: |
| 50 | return 0; |
| 51 | } |
| 52 | |
| 53 | tmp = __raw_readl(reg); |
| 54 | |
| 55 | if (!(tmp & PLLCTL_BYPASS)) { |
| 56 | /* Bypass disabled */ |
| 57 | prediv = (tmp & PLL_DIV_MASK) + 1; |
| 58 | mult = ((tmp >> PLL_MULT_SHIFT) & PLL_MULT_MASK) + 1; |
| 59 | output_div = ((tmp >> PLL_CLKOD_SHIFT) & |
| 60 | PLL_CLKOD_MASK) + 1; |
| 61 | ret = ((ret / prediv) * mult) / output_div; |
| 62 | } |
| 63 | } |
| 64 | |
| 65 | return ret; |
| 66 | } |
| 67 | |
| 68 | unsigned long clk_get_rate(unsigned int clk) |
| 69 | { |
| 70 | switch (clk) { |
| 71 | case core_pll_clk: return pll_freq_get(CORE_PLL); |
| 72 | case pass_pll_clk: return pll_freq_get(PASS_PLL); |
| 73 | case ddr3_pll_clk: return pll_freq_get(DDR3_PLL); |
| 74 | case sys_clk0_1_clk: |
| 75 | case sys_clk0_clk: return pll_freq_get(CORE_PLL) / pll0div_read(1); |
| 76 | case sys_clk1_clk: return pll_freq_get(CORE_PLL) / pll0div_read(2); |
| 77 | case sys_clk2_clk: return pll_freq_get(CORE_PLL) / pll0div_read(3); |
| 78 | case sys_clk3_clk: return pll_freq_get(CORE_PLL) / pll0div_read(4); |
| 79 | case sys_clk0_2_clk: return clk_get_rate(sys_clk0_clk) / 2; |
| 80 | case sys_clk0_3_clk: return clk_get_rate(sys_clk0_clk) / 3; |
| 81 | case sys_clk0_4_clk: return clk_get_rate(sys_clk0_clk) / 4; |
| 82 | case sys_clk0_6_clk: return clk_get_rate(sys_clk0_clk) / 6; |
| 83 | case sys_clk0_8_clk: return clk_get_rate(sys_clk0_clk) / 8; |
| 84 | case sys_clk0_12_clk: return clk_get_rate(sys_clk0_clk) / 12; |
| 85 | case sys_clk0_24_clk: return clk_get_rate(sys_clk0_clk) / 24; |
| 86 | case sys_clk1_3_clk: return clk_get_rate(sys_clk1_clk) / 3; |
| 87 | case sys_clk1_4_clk: return clk_get_rate(sys_clk1_clk) / 4; |
| 88 | case sys_clk1_6_clk: return clk_get_rate(sys_clk1_clk) / 6; |
| 89 | case sys_clk1_12_clk: return clk_get_rate(sys_clk1_clk) / 12; |
| 90 | default: |
| 91 | break; |
| 92 | } |
| 93 | |
| 94 | return 0; |
| 95 | } |