1 /* 2 * [origin: Linux kernel linux/arch/arm/mach-at91/clock.c] 3 * 4 * Copyright (C) 2005 David Brownell 5 * Copyright (C) 2005 Ivan Kokshaysky 6 * Copyright (C) 2009 Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com> 7 * Copyright (C) 2013 Bo Shen <voice.shen@atmel.com> 8 * Copyright (C) 2015 Wenyou Yang <wenyou.yang@atmel.com> 9 * 10 * SPDX-License-Identifier: GPL-2.0+ 11 */ 12 13 #include <common.h> 14 #include <asm/errno.h> 15 #include <asm/io.h> 16 #include <asm/arch/hardware.h> 17 #include <asm/arch/at91_pmc.h> 18 #include <asm/arch/clk.h> 19 20 #if !defined(CONFIG_AT91FAMILY) 21 # error You need to define CONFIG_AT91FAMILY in your board config! 22 #endif 23 24 DECLARE_GLOBAL_DATA_PTR; 25 26 static unsigned long at91_css_to_rate(unsigned long css) 27 { 28 switch (css) { 29 case AT91_PMC_MCKR_CSS_SLOW: 30 return CONFIG_SYS_AT91_SLOW_CLOCK; 31 case AT91_PMC_MCKR_CSS_MAIN: 32 return gd->arch.main_clk_rate_hz; 33 case AT91_PMC_MCKR_CSS_PLLA: 34 return gd->arch.plla_rate_hz; 35 } 36 37 return 0; 38 } 39 40 static u32 at91_pll_rate(u32 freq, u32 reg) 41 { 42 unsigned mul, div; 43 44 div = reg & 0xff; 45 mul = (reg >> 18) & 0x7f; 46 if (div && mul) { 47 freq /= div; 48 freq *= mul + 1; 49 } else { 50 freq = 0; 51 } 52 53 return freq; 54 } 55 56 int at91_clock_init(unsigned long main_clock) 57 { 58 unsigned freq, mckr; 59 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 60 #ifndef CONFIG_SYS_AT91_MAIN_CLOCK 61 unsigned tmp; 62 /* 63 * When the bootloader initialized the main oscillator correctly, 64 * there's no problem using the cycle counter. But if it didn't, 65 * or when using oscillator bypass mode, we must be told the speed 66 * of the main clock. 67 */ 68 if (!main_clock) { 69 do { 70 tmp = readl(&pmc->mcfr); 71 } while (!(tmp & AT91_PMC_MCFR_MAINRDY)); 72 tmp &= AT91_PMC_MCFR_MAINF_MASK; 73 main_clock = tmp * (CONFIG_SYS_AT91_SLOW_CLOCK / 16); 74 } 75 #endif 76 gd->arch.main_clk_rate_hz = main_clock; 77 78 /* report if PLLA is more than mildly overclocked */ 79 gd->arch.plla_rate_hz = at91_pll_rate(main_clock, readl(&pmc->pllar)); 80 81 /* 82 * MCK and CPU derive from one of those primary clocks. 83 * For now, assume this parentage won't change. 84 */ 85 mckr = readl(&pmc->mckr); 86 87 /* plla divisor by 2 */ 88 if (mckr & (1 << 12)) 89 gd->arch.plla_rate_hz >>= 1; 90 91 gd->arch.mck_rate_hz = at91_css_to_rate(mckr & AT91_PMC_MCKR_CSS_MASK); 92 freq = gd->arch.mck_rate_hz; 93 94 /* prescale */ 95 freq >>= mckr & AT91_PMC_MCKR_PRES_MASK; 96 97 switch (mckr & AT91_PMC_MCKR_MDIV_MASK) { 98 case AT91_PMC_MCKR_MDIV_2: 99 gd->arch.mck_rate_hz = freq / 2; 100 break; 101 case AT91_PMC_MCKR_MDIV_3: 102 gd->arch.mck_rate_hz = freq / 3; 103 break; 104 case AT91_PMC_MCKR_MDIV_4: 105 gd->arch.mck_rate_hz = freq / 4; 106 break; 107 default: 108 break; 109 } 110 111 gd->arch.cpu_clk_rate_hz = freq; 112 113 return 0; 114 } 115 116 void at91_plla_init(u32 pllar) 117 { 118 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 119 120 writel(pllar, &pmc->pllar); 121 while (!(readl(&pmc->sr) & (AT91_PMC_LOCKA | AT91_PMC_MCKRDY))) 122 ; 123 } 124 125 void at91_mck_init(u32 mckr) 126 { 127 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 128 u32 tmp; 129 130 tmp = readl(&pmc->mckr); 131 tmp &= ~(AT91_PMC_MCKR_CSS_MASK | 132 AT91_PMC_MCKR_PRES_MASK | 133 AT91_PMC_MCKR_MDIV_MASK | 134 AT91_PMC_MCKR_PLLADIV_2); 135 #ifdef CPU_HAS_H32MXDIV 136 tmp &= ~AT91_PMC_MCKR_H32MXDIV; 137 #endif 138 139 tmp |= mckr & (AT91_PMC_MCKR_CSS_MASK | 140 AT91_PMC_MCKR_PRES_MASK | 141 AT91_PMC_MCKR_MDIV_MASK | 142 AT91_PMC_MCKR_PLLADIV_2); 143 #ifdef CPU_HAS_H32MXDIV 144 tmp |= mckr & AT91_PMC_MCKR_H32MXDIV; 145 #endif 146 147 writel(tmp, &pmc->mckr); 148 149 while (!(readl(&pmc->sr) & AT91_PMC_MCKRDY)) 150 ; 151 } 152 153 void at91_periph_clk_enable(int id) 154 { 155 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 156 u32 regval; 157 158 if (id > AT91_PMC_PCR_PID_MASK) 159 return; 160 161 regval = AT91_PMC_PCR_EN | AT91_PMC_PCR_CMD_WRITE | id; 162 163 writel(regval, &pmc->pcr); 164 } 165 166 void at91_periph_clk_disable(int id) 167 { 168 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 169 u32 regval; 170 171 if (id > AT91_PMC_PCR_PID_MASK) 172 return; 173 174 regval = AT91_PMC_PCR_CMD_WRITE | id; 175 176 writel(regval, &pmc->pcr); 177 } 178 179 int at91_enable_periph_generated_clk(u32 id, u32 clk_source, u32 div) 180 { 181 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 182 u32 regval, status; 183 u32 timeout = 1000; 184 185 if (id > AT91_PMC_PCR_PID_MASK) 186 return -EINVAL; 187 188 if (div > 0xff) 189 return -EINVAL; 190 191 writel(id, &pmc->pcr); 192 regval = readl(&pmc->pcr); 193 regval &= ~AT91_PMC_PCR_GCKCSS; 194 regval &= ~AT91_PMC_PCR_GCKDIV; 195 196 switch (clk_source) { 197 case GCK_CSS_SLOW_CLK: 198 regval |= AT91_PMC_PCR_GCKCSS_SLOW_CLK; 199 break; 200 case GCK_CSS_MAIN_CLK: 201 regval |= AT91_PMC_PCR_GCKCSS_MAIN_CLK; 202 break; 203 case GCK_CSS_PLLA_CLK: 204 regval |= AT91_PMC_PCR_GCKCSS_PLLA_CLK; 205 break; 206 case GCK_CSS_UPLL_CLK: 207 regval |= AT91_PMC_PCR_GCKCSS_UPLL_CLK; 208 break; 209 case GCK_CSS_MCK_CLK: 210 regval |= AT91_PMC_PCR_GCKCSS_MCK_CLK; 211 break; 212 case GCK_CSS_AUDIO_CLK: 213 regval |= AT91_PMC_PCR_GCKCSS_AUDIO_CLK; 214 break; 215 default: 216 printf("Error GCK clock source selection!\n"); 217 return -EINVAL; 218 } 219 220 regval |= AT91_PMC_PCR_CMD_WRITE | 221 AT91_PMC_PCR_GCKDIV_(div) | 222 AT91_PMC_PCR_GCKEN; 223 224 writel(regval, &pmc->pcr); 225 226 do { 227 udelay(1); 228 status = readl(&pmc->sr); 229 } while ((!!(--timeout)) && (!(status & AT91_PMC_GCKRDY))); 230 231 if (!timeout) 232 printf("Timeout waiting for GCK ready!\n"); 233 234 return 0; 235 } 236 237 u32 at91_get_periph_generated_clk(u32 id) 238 { 239 struct at91_pmc *pmc = (struct at91_pmc *)ATMEL_BASE_PMC; 240 u32 regval, clk_source, div; 241 u32 freq; 242 243 if (id > AT91_PMC_PCR_PID_MASK) 244 return 0; 245 246 writel(id, &pmc->pcr); 247 regval = readl(&pmc->pcr); 248 249 clk_source = regval & AT91_PMC_PCR_GCKCSS; 250 switch (clk_source) { 251 case AT91_PMC_PCR_GCKCSS_SLOW_CLK: 252 freq = CONFIG_SYS_AT91_SLOW_CLOCK; 253 break; 254 case AT91_PMC_PCR_GCKCSS_MAIN_CLK: 255 freq = gd->arch.main_clk_rate_hz; 256 break; 257 case AT91_PMC_PCR_GCKCSS_PLLA_CLK: 258 freq = gd->arch.plla_rate_hz; 259 break; 260 default: 261 printf("Improper GCK clock source selection!\n"); 262 freq = 0; 263 break; 264 } 265 266 div = ((regval & AT91_PMC_PCR_GCKDIV) >> AT91_PMC_PCR_GCKDIV_OFFSET); 267 div += 1; 268 269 return freq / div; 270 } 271