diff options
Diffstat (limited to 'firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c')
-rw-r--r-- | firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c | 40 |
1 files changed, 40 insertions, 0 deletions
diff --git a/firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c b/firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c index a01fab07d0..2dc6e817de 100644 --- a/firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c +++ b/firmware/target/arm/imx31/gigabeat-s/clkctl-imx31.c | |||
@@ -43,3 +43,43 @@ void imx31_clkctl_module_clock_gating(enum IMX31_CG_LIST cg, | |||
43 | 43 | ||
44 | restore_interrupt(oldlevel); | 44 | restore_interrupt(oldlevel); |
45 | } | 45 | } |
46 | |||
47 | /* Get the PLL reference clock frequency in HZ */ | ||
48 | unsigned int imx31_clkctl_get_pll_ref_clk(void) | ||
49 | { | ||
50 | if ((CLKCTL_CCMR & (3 << 1)) == (1 << 1)) | ||
51 | return CONFIG_CLK32_FREQ * 1024; | ||
52 | else | ||
53 | return CONFIG_HCLK_FREQ; | ||
54 | } | ||
55 | |||
56 | /* Return PLL frequency in HZ */ | ||
57 | unsigned int imx31_clkctl_get_pll(enum IMX31_PLLS pll) | ||
58 | { | ||
59 | uint32_t infreq = imx31_clkctl_get_pll_ref_clk(); | ||
60 | uint32_t reg = (&CLKCTL_MPCTL)[pll]; | ||
61 | uint32_t mfn = reg & 0x3ff; | ||
62 | uint32_t pd = ((reg >> 26) & 0xf) + 1; | ||
63 | uint64_t mfd = ((reg >> 16) & 0x3ff) + 1; | ||
64 | uint32_t mfi = (reg >> 10) & 0xf; | ||
65 | |||
66 | mfi = mfi <= 5 ? 5 : mfi; | ||
67 | |||
68 | return 2*infreq*(mfi * mfd + mfn) / (mfd * pd); | ||
69 | } | ||
70 | |||
71 | unsigned int imx31_clkctl_get_ipg_clk(void) | ||
72 | { | ||
73 | unsigned int pll = imx31_clkctl_get_pll((CLKCTL_PMCR0 & 0xC0000000) == 0 ? | ||
74 | PLL_SERIAL : PLL_MCU); | ||
75 | uint32_t reg = CLKCTL_PDR0; | ||
76 | unsigned int max_pdf = ((reg >> 3) & 0x7) + 1; | ||
77 | unsigned int ipg_pdf = ((reg >> 6) & 0x3) + 1; | ||
78 | |||
79 | return pll / (max_pdf * ipg_pdf); | ||
80 | } | ||
81 | |||
82 | unsigned int imx31_clkctl_get_ata_clk(void) | ||
83 | { | ||
84 | return imx31_clkctl_get_ipg_clk(); | ||
85 | } | ||