Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 1 | /* |
| 2 | * |
| 3 | * Clock initialization for OMAP4 |
| 4 | * |
| 5 | * (C) Copyright 2010 |
| 6 | * Texas Instruments, <www.ti.com> |
| 7 | * |
| 8 | * Aneesh V <aneesh@ti.com> |
| 9 | * |
| 10 | * Based on previous work by: |
| 11 | * Santosh Shilimkar <santosh.shilimkar@ti.com> |
| 12 | * Rajendra Nayak <rnayak@ti.com> |
| 13 | * |
Wolfgang Denk | 1a45966 | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 14 | * SPDX-License-Identifier: GPL-2.0+ |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 15 | */ |
| 16 | #include <common.h> |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 17 | #include <i2c.h> |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 18 | #include <asm/omap_common.h> |
Sanjeev Premi | 3b690eb | 2011-09-08 10:48:39 -0400 | [diff] [blame] | 19 | #include <asm/gpio.h> |
Lokesh Vutla | af1d002 | 2013-05-30 02:54:32 +0000 | [diff] [blame] | 20 | #include <asm/arch/clock.h> |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 21 | #include <asm/arch/sys_proto.h> |
| 22 | #include <asm/utils.h> |
Aneesh V | d506719 | 2011-07-21 09:29:32 -0400 | [diff] [blame] | 23 | #include <asm/omap_gpio.h> |
Lokesh Vutla | 9ca8bfe | 2013-02-04 04:21:59 +0000 | [diff] [blame] | 24 | #include <asm/emif.h> |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 25 | |
| 26 | #ifndef CONFIG_SPL_BUILD |
| 27 | /* |
| 28 | * printing to console doesn't work unless |
| 29 | * this code is executed from SPL |
| 30 | */ |
| 31 | #define printf(fmt, args...) |
| 32 | #define puts(s) |
| 33 | #endif |
| 34 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 35 | const u32 sys_clk_array[8] = { |
| 36 | 12000000, /* 12 MHz */ |
Lokesh Vutla | 97405d8 | 2013-05-30 03:19:38 +0000 | [diff] [blame] | 37 | 20000000, /* 20 MHz */ |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 38 | 16800000, /* 16.8 MHz */ |
| 39 | 19200000, /* 19.2 MHz */ |
| 40 | 26000000, /* 26 MHz */ |
| 41 | 27000000, /* 27 MHz */ |
| 42 | 38400000, /* 38.4 MHz */ |
| 43 | }; |
| 44 | |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 45 | static inline u32 __get_sys_clk_index(void) |
| 46 | { |
Lokesh Vutla | ea8eff1 | 2013-02-12 21:29:05 +0000 | [diff] [blame] | 47 | s8 ind; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 48 | /* |
| 49 | * For ES1 the ROM code calibration of sys clock is not reliable |
| 50 | * due to hw issue. So, use hard-coded value. If this value is not |
| 51 | * correct for any board over-ride this function in board file |
| 52 | * From ES2.0 onwards you will get this information from |
| 53 | * CM_SYS_CLKSEL |
| 54 | */ |
| 55 | if (omap_revision() == OMAP4430_ES1_0) |
| 56 | ind = OMAP_SYS_CLK_IND_38_4_MHZ; |
| 57 | else { |
| 58 | /* SYS_CLKSEL - 1 to match the dpll param array indices */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 59 | ind = (readl((*prcm)->cm_sys_clksel) & |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 60 | CM_SYS_CLKSEL_SYS_CLKSEL_MASK) - 1; |
| 61 | } |
| 62 | return ind; |
| 63 | } |
| 64 | |
| 65 | u32 get_sys_clk_index(void) |
| 66 | __attribute__ ((weak, alias("__get_sys_clk_index"))); |
| 67 | |
| 68 | u32 get_sys_clk_freq(void) |
| 69 | { |
| 70 | u8 index = get_sys_clk_index(); |
| 71 | return sys_clk_array[index]; |
| 72 | } |
| 73 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 74 | void setup_post_dividers(u32 const base, const struct dpll_params *params) |
| 75 | { |
| 76 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
| 77 | |
| 78 | /* Setup post-dividers */ |
| 79 | if (params->m2 >= 0) |
| 80 | writel(params->m2, &dpll_regs->cm_div_m2_dpll); |
| 81 | if (params->m3 >= 0) |
| 82 | writel(params->m3, &dpll_regs->cm_div_m3_dpll); |
| 83 | if (params->m4_h11 >= 0) |
| 84 | writel(params->m4_h11, &dpll_regs->cm_div_m4_h11_dpll); |
| 85 | if (params->m5_h12 >= 0) |
| 86 | writel(params->m5_h12, &dpll_regs->cm_div_m5_h12_dpll); |
| 87 | if (params->m6_h13 >= 0) |
| 88 | writel(params->m6_h13, &dpll_regs->cm_div_m6_h13_dpll); |
| 89 | if (params->m7_h14 >= 0) |
| 90 | writel(params->m7_h14, &dpll_regs->cm_div_m7_h14_dpll); |
SRICHARAN R | 47abc3d | 2013-02-12 01:33:43 +0000 | [diff] [blame] | 91 | if (params->h21 >= 0) |
| 92 | writel(params->h21, &dpll_regs->cm_div_h21_dpll); |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 93 | if (params->h22 >= 0) |
| 94 | writel(params->h22, &dpll_regs->cm_div_h22_dpll); |
| 95 | if (params->h23 >= 0) |
| 96 | writel(params->h23, &dpll_regs->cm_div_h23_dpll); |
SRICHARAN R | 47abc3d | 2013-02-12 01:33:43 +0000 | [diff] [blame] | 97 | if (params->h24 >= 0) |
| 98 | writel(params->h24, &dpll_regs->cm_div_h24_dpll); |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 99 | } |
| 100 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 101 | static inline void do_bypass_dpll(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 102 | { |
| 103 | struct dpll_regs *dpll_regs = (struct dpll_regs *)base; |
| 104 | |
| 105 | clrsetbits_le32(&dpll_regs->cm_clkmode_dpll, |
| 106 | CM_CLKMODE_DPLL_DPLL_EN_MASK, |
| 107 | DPLL_EN_FAST_RELOCK_BYPASS << |
| 108 | CM_CLKMODE_DPLL_EN_SHIFT); |
| 109 | } |
| 110 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 111 | static inline void wait_for_bypass(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 112 | { |
| 113 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
| 114 | |
| 115 | if (!wait_on_value(ST_DPLL_CLK_MASK, 0, &dpll_regs->cm_idlest_dpll, |
| 116 | LDELAY)) { |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 117 | printf("Bypassing DPLL failed %x\n", base); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 118 | } |
| 119 | } |
| 120 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 121 | static inline void do_lock_dpll(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 122 | { |
| 123 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
| 124 | |
| 125 | clrsetbits_le32(&dpll_regs->cm_clkmode_dpll, |
| 126 | CM_CLKMODE_DPLL_DPLL_EN_MASK, |
| 127 | DPLL_EN_LOCK << CM_CLKMODE_DPLL_EN_SHIFT); |
| 128 | } |
| 129 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 130 | static inline void wait_for_lock(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 131 | { |
| 132 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
| 133 | |
| 134 | if (!wait_on_value(ST_DPLL_CLK_MASK, ST_DPLL_CLK_MASK, |
| 135 | &dpll_regs->cm_idlest_dpll, LDELAY)) { |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 136 | printf("DPLL locking failed for %x\n", base); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 137 | hang(); |
| 138 | } |
| 139 | } |
| 140 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 141 | inline u32 check_for_lock(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 142 | { |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 143 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 144 | u32 lock = readl(&dpll_regs->cm_idlest_dpll) & ST_DPLL_CLK_MASK; |
| 145 | |
| 146 | return lock; |
| 147 | } |
| 148 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 149 | const struct dpll_params *get_mpu_dpll_params(struct dplls const *dpll_data) |
| 150 | { |
| 151 | u32 sysclk_ind = get_sys_clk_index(); |
| 152 | return &dpll_data->mpu[sysclk_ind]; |
| 153 | } |
| 154 | |
| 155 | const struct dpll_params *get_core_dpll_params(struct dplls const *dpll_data) |
| 156 | { |
| 157 | u32 sysclk_ind = get_sys_clk_index(); |
| 158 | return &dpll_data->core[sysclk_ind]; |
| 159 | } |
| 160 | |
| 161 | const struct dpll_params *get_per_dpll_params(struct dplls const *dpll_data) |
| 162 | { |
| 163 | u32 sysclk_ind = get_sys_clk_index(); |
| 164 | return &dpll_data->per[sysclk_ind]; |
| 165 | } |
| 166 | |
| 167 | const struct dpll_params *get_iva_dpll_params(struct dplls const *dpll_data) |
| 168 | { |
| 169 | u32 sysclk_ind = get_sys_clk_index(); |
| 170 | return &dpll_data->iva[sysclk_ind]; |
| 171 | } |
| 172 | |
| 173 | const struct dpll_params *get_usb_dpll_params(struct dplls const *dpll_data) |
| 174 | { |
| 175 | u32 sysclk_ind = get_sys_clk_index(); |
| 176 | return &dpll_data->usb[sysclk_ind]; |
| 177 | } |
| 178 | |
| 179 | const struct dpll_params *get_abe_dpll_params(struct dplls const *dpll_data) |
| 180 | { |
| 181 | #ifdef CONFIG_SYS_OMAP_ABE_SYSCK |
| 182 | u32 sysclk_ind = get_sys_clk_index(); |
| 183 | return &dpll_data->abe[sysclk_ind]; |
| 184 | #else |
| 185 | return dpll_data->abe; |
| 186 | #endif |
| 187 | } |
| 188 | |
Lokesh Vutla | ea8eff1 | 2013-02-12 21:29:05 +0000 | [diff] [blame] | 189 | static const struct dpll_params *get_ddr_dpll_params |
| 190 | (struct dplls const *dpll_data) |
| 191 | { |
| 192 | u32 sysclk_ind = get_sys_clk_index(); |
| 193 | |
| 194 | if (!dpll_data->ddr) |
| 195 | return NULL; |
| 196 | return &dpll_data->ddr[sysclk_ind]; |
| 197 | } |
| 198 | |
Lokesh Vutla | 65e9d56 | 2013-07-08 16:04:39 +0530 | [diff] [blame] | 199 | #ifdef CONFIG_DRIVER_TI_CPSW |
| 200 | static const struct dpll_params *get_gmac_dpll_params |
| 201 | (struct dplls const *dpll_data) |
| 202 | { |
| 203 | u32 sysclk_ind = get_sys_clk_index(); |
| 204 | |
| 205 | if (!dpll_data->gmac) |
| 206 | return NULL; |
| 207 | return &dpll_data->gmac[sysclk_ind]; |
| 208 | } |
| 209 | #endif |
| 210 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 211 | static void do_setup_dpll(u32 const base, const struct dpll_params *params, |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 212 | u8 lock, char *dpll) |
| 213 | { |
| 214 | u32 temp, M, N; |
| 215 | struct dpll_regs *const dpll_regs = (struct dpll_regs *)base; |
| 216 | |
Lokesh Vutla | ea8eff1 | 2013-02-12 21:29:05 +0000 | [diff] [blame] | 217 | if (!params) |
| 218 | return; |
| 219 | |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 220 | temp = readl(&dpll_regs->cm_clksel_dpll); |
| 221 | |
| 222 | if (check_for_lock(base)) { |
| 223 | /* |
| 224 | * The Dpll has already been locked by rom code using CH. |
| 225 | * Check if M,N are matching with Ideal nominal opp values. |
| 226 | * If matches, skip the rest otherwise relock. |
| 227 | */ |
| 228 | M = (temp & CM_CLKSEL_DPLL_M_MASK) >> CM_CLKSEL_DPLL_M_SHIFT; |
| 229 | N = (temp & CM_CLKSEL_DPLL_N_MASK) >> CM_CLKSEL_DPLL_N_SHIFT; |
| 230 | if ((M != (params->m)) || (N != (params->n))) { |
| 231 | debug("\n %s Dpll locked, but not for ideal M = %d," |
| 232 | "N = %d values, current values are M = %d," |
| 233 | "N= %d" , dpll, params->m, params->n, |
| 234 | M, N); |
| 235 | } else { |
| 236 | /* Dpll locked with ideal values for nominal opps. */ |
| 237 | debug("\n %s Dpll already locked with ideal" |
| 238 | "nominal opp values", dpll); |
| 239 | goto setup_post_dividers; |
| 240 | } |
| 241 | } |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 242 | |
| 243 | bypass_dpll(base); |
| 244 | |
| 245 | /* Set M & N */ |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 246 | temp &= ~CM_CLKSEL_DPLL_M_MASK; |
| 247 | temp |= (params->m << CM_CLKSEL_DPLL_M_SHIFT) & CM_CLKSEL_DPLL_M_MASK; |
| 248 | |
| 249 | temp &= ~CM_CLKSEL_DPLL_N_MASK; |
| 250 | temp |= (params->n << CM_CLKSEL_DPLL_N_SHIFT) & CM_CLKSEL_DPLL_N_MASK; |
| 251 | |
| 252 | writel(temp, &dpll_regs->cm_clksel_dpll); |
| 253 | |
| 254 | /* Lock */ |
| 255 | if (lock) |
| 256 | do_lock_dpll(base); |
| 257 | |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 258 | setup_post_dividers: |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 259 | setup_post_dividers(base, params); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 260 | |
| 261 | /* Wait till the DPLL locks */ |
| 262 | if (lock) |
| 263 | wait_for_lock(base); |
| 264 | } |
| 265 | |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 266 | u32 omap_ddr_clk(void) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 267 | { |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 268 | u32 ddr_clk, sys_clk_khz, omap_rev, divider; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 269 | const struct dpll_params *core_dpll_params; |
| 270 | |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 271 | omap_rev = omap_revision(); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 272 | sys_clk_khz = get_sys_clk_freq() / 1000; |
| 273 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 274 | core_dpll_params = get_core_dpll_params(*dplls_data); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 275 | |
| 276 | debug("sys_clk %d\n ", sys_clk_khz * 1000); |
| 277 | |
| 278 | /* Find Core DPLL locked frequency first */ |
| 279 | ddr_clk = sys_clk_khz * 2 * core_dpll_params->m / |
| 280 | (core_dpll_params->n + 1); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 281 | |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 282 | if (omap_rev < OMAP5430_ES1_0) { |
| 283 | /* |
| 284 | * DDR frequency is PHY_ROOT_CLK/2 |
| 285 | * PHY_ROOT_CLK = Fdpll/2/M2 |
| 286 | */ |
| 287 | divider = 4; |
| 288 | } else { |
| 289 | /* |
| 290 | * DDR frequency is PHY_ROOT_CLK |
| 291 | * PHY_ROOT_CLK = Fdpll/2/M2 |
| 292 | */ |
| 293 | divider = 2; |
| 294 | } |
| 295 | |
| 296 | ddr_clk = ddr_clk / divider / core_dpll_params->m2; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 297 | ddr_clk *= 1000; /* convert to Hz */ |
| 298 | debug("ddr_clk %d\n ", ddr_clk); |
| 299 | |
| 300 | return ddr_clk; |
| 301 | } |
| 302 | |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 303 | /* |
| 304 | * Lock MPU dpll |
| 305 | * |
| 306 | * Resulting MPU frequencies: |
| 307 | * 4430 ES1.0 : 600 MHz |
| 308 | * 4430 ES2.x : 792 MHz (OPP Turbo) |
| 309 | * 4460 : 920 MHz (OPP Turbo) - DCC disabled |
| 310 | */ |
| 311 | void configure_mpu_dpll(void) |
| 312 | { |
| 313 | const struct dpll_params *params; |
| 314 | struct dpll_regs *mpu_dpll_regs; |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 315 | u32 omap_rev; |
| 316 | omap_rev = omap_revision(); |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 317 | |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 318 | /* |
| 319 | * DCC and clock divider settings for 4460. |
| 320 | * DCC is required, if more than a certain frequency is required. |
| 321 | * For, 4460 > 1GHZ. |
| 322 | * 5430 > 1.4GHZ. |
| 323 | */ |
| 324 | if ((omap_rev >= OMAP4460_ES1_0) && (omap_rev < OMAP5430_ES1_0)) { |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 325 | mpu_dpll_regs = |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 326 | (struct dpll_regs *)((*prcm)->cm_clkmode_dpll_mpu); |
| 327 | bypass_dpll((*prcm)->cm_clkmode_dpll_mpu); |
| 328 | clrbits_le32((*prcm)->cm_mpu_mpu_clkctrl, |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 329 | MPU_CLKCTRL_CLKSEL_EMIF_DIV_MODE_MASK); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 330 | setbits_le32((*prcm)->cm_mpu_mpu_clkctrl, |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 331 | MPU_CLKCTRL_CLKSEL_ABE_DIV_MODE_MASK); |
| 332 | clrbits_le32(&mpu_dpll_regs->cm_clksel_dpll, |
| 333 | CM_CLKSEL_DCC_EN_MASK); |
| 334 | } |
| 335 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 336 | params = get_mpu_dpll_params(*dplls_data); |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 337 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 338 | do_setup_dpll((*prcm)->cm_clkmode_dpll_mpu, params, DPLL_LOCK, "mpu"); |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 339 | debug("MPU DPLL locked\n"); |
| 340 | } |
| 341 | |
Dan Murphy | d861a33 | 2013-08-26 08:54:50 -0500 | [diff] [blame] | 342 | #if defined(CONFIG_USB_EHCI_OMAP) || defined(CONFIG_USB_XHCI_OMAP) |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 343 | static void setup_usb_dpll(void) |
| 344 | { |
| 345 | const struct dpll_params *params; |
| 346 | u32 sys_clk_khz, sd_div, num, den; |
| 347 | |
| 348 | sys_clk_khz = get_sys_clk_freq() / 1000; |
| 349 | /* |
| 350 | * USB: |
| 351 | * USB dpll is J-type. Need to set DPLL_SD_DIV for jitter correction |
| 352 | * DPLL_SD_DIV = CEILING ([DPLL_MULT/(DPLL_DIV+1)]* CLKINP / 250) |
| 353 | * - where CLKINP is sys_clk in MHz |
| 354 | * Use CLKINP in KHz and adjust the denominator accordingly so |
| 355 | * that we have enough accuracy and at the same time no overflow |
| 356 | */ |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 357 | params = get_usb_dpll_params(*dplls_data); |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 358 | num = params->m * sys_clk_khz; |
| 359 | den = (params->n + 1) * 250 * 1000; |
| 360 | num += den - 1; |
| 361 | sd_div = num / den; |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 362 | clrsetbits_le32((*prcm)->cm_clksel_dpll_usb, |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 363 | CM_CLKSEL_DPLL_DPLL_SD_DIV_MASK, |
| 364 | sd_div << CM_CLKSEL_DPLL_DPLL_SD_DIV_SHIFT); |
| 365 | |
| 366 | /* Now setup the dpll with the regular function */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 367 | do_setup_dpll((*prcm)->cm_clkmode_dpll_usb, params, DPLL_LOCK, "usb"); |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 368 | } |
| 369 | #endif |
| 370 | |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 371 | static void setup_dplls(void) |
| 372 | { |
Anatolij Gustschin | 164a750 | 2011-12-03 06:46:14 +0000 | [diff] [blame] | 373 | u32 temp; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 374 | const struct dpll_params *params; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 375 | |
Anatolij Gustschin | 164a750 | 2011-12-03 06:46:14 +0000 | [diff] [blame] | 376 | debug("setup_dplls\n"); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 377 | |
| 378 | /* CORE dpll */ |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 379 | params = get_core_dpll_params(*dplls_data); /* default - safest */ |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 380 | /* |
| 381 | * Do not lock the core DPLL now. Just set it up. |
| 382 | * Core DPLL will be locked after setting up EMIF |
| 383 | * using the FREQ_UPDATE method(freq_update_core()) |
| 384 | */ |
Lokesh Vutla | 9ca8bfe | 2013-02-04 04:21:59 +0000 | [diff] [blame] | 385 | if (emif_sdram_type() == EMIF_SDRAM_TYPE_LPDDR2) |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 386 | do_setup_dpll((*prcm)->cm_clkmode_dpll_core, params, |
Lokesh Vutla | 753bae8 | 2012-05-22 00:03:26 +0000 | [diff] [blame] | 387 | DPLL_NO_LOCK, "core"); |
| 388 | else |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 389 | do_setup_dpll((*prcm)->cm_clkmode_dpll_core, params, |
Lokesh Vutla | 753bae8 | 2012-05-22 00:03:26 +0000 | [diff] [blame] | 390 | DPLL_LOCK, "core"); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 391 | /* Set the ratios for CORE_CLK, L3_CLK, L4_CLK */ |
| 392 | temp = (CLKSEL_CORE_X2_DIV_1 << CLKSEL_CORE_SHIFT) | |
| 393 | (CLKSEL_L3_CORE_DIV_2 << CLKSEL_L3_SHIFT) | |
| 394 | (CLKSEL_L4_L3_DIV_2 << CLKSEL_L4_SHIFT); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 395 | writel(temp, (*prcm)->cm_clksel_core); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 396 | debug("Core DPLL configured\n"); |
| 397 | |
| 398 | /* lock PER dpll */ |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 399 | params = get_per_dpll_params(*dplls_data); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 400 | do_setup_dpll((*prcm)->cm_clkmode_dpll_per, |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 401 | params, DPLL_LOCK, "per"); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 402 | debug("PER DPLL locked\n"); |
| 403 | |
| 404 | /* MPU dpll */ |
Aneesh V | b4dc644 | 2011-07-21 09:29:36 -0400 | [diff] [blame] | 405 | configure_mpu_dpll(); |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 406 | |
Dan Murphy | d861a33 | 2013-08-26 08:54:50 -0500 | [diff] [blame] | 407 | #if defined(CONFIG_USB_EHCI_OMAP) || defined(CONFIG_USB_XHCI_OMAP) |
Govindraj.R | 860004c | 2012-02-06 03:55:36 +0000 | [diff] [blame] | 408 | setup_usb_dpll(); |
| 409 | #endif |
Lokesh Vutla | ea8eff1 | 2013-02-12 21:29:05 +0000 | [diff] [blame] | 410 | params = get_ddr_dpll_params(*dplls_data); |
| 411 | do_setup_dpll((*prcm)->cm_clkmode_dpll_ddrphy, |
| 412 | params, DPLL_LOCK, "ddr"); |
Lokesh Vutla | 65e9d56 | 2013-07-08 16:04:39 +0530 | [diff] [blame] | 413 | |
| 414 | #ifdef CONFIG_DRIVER_TI_CPSW |
| 415 | params = get_gmac_dpll_params(*dplls_data); |
| 416 | do_setup_dpll((*prcm)->cm_clkmode_dpll_gmac, params, |
| 417 | DPLL_LOCK, "gmac"); |
| 418 | #endif |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 419 | } |
| 420 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 421 | u32 get_offset_code(u32 volt_offset, struct pmic_data *pmic) |
Aneesh V | d506719 | 2011-07-21 09:29:32 -0400 | [diff] [blame] | 422 | { |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 423 | u32 offset_code; |
Nishanth Menon | 3acb553 | 2012-03-01 14:17:38 +0000 | [diff] [blame] | 424 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 425 | volt_offset -= pmic->base_offset; |
Nishanth Menon | 3acb553 | 2012-03-01 14:17:38 +0000 | [diff] [blame] | 426 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 427 | offset_code = (volt_offset + pmic->step - 1) / pmic->step; |
Aneesh V | d506719 | 2011-07-21 09:29:32 -0400 | [diff] [blame] | 428 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 429 | /* |
| 430 | * Offset codes 1-6 all give the base voltage in Palmas |
| 431 | * Offset code 0 switches OFF the SMPS |
| 432 | */ |
| 433 | return offset_code + pmic->start_code; |
Aneesh V | d506719 | 2011-07-21 09:29:32 -0400 | [diff] [blame] | 434 | } |
| 435 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 436 | void do_scale_vcore(u32 vcore_reg, u32 volt_mv, struct pmic_data *pmic) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 437 | { |
Nishanth Menon | a78274b | 2012-03-01 14:17:37 +0000 | [diff] [blame] | 438 | u32 offset_code; |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 439 | u32 offset = volt_mv; |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 440 | int ret = 0; |
| 441 | |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 442 | if (!volt_mv) |
| 443 | return; |
| 444 | |
Lokesh Vutla | 4ca94d8 | 2013-05-30 02:54:33 +0000 | [diff] [blame] | 445 | pmic->pmic_bus_init(); |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 446 | /* See if we can first get the GPIO if needed */ |
| 447 | if (pmic->gpio_en) |
| 448 | ret = gpio_request(pmic->gpio, "PMIC_GPIO"); |
| 449 | |
| 450 | if (ret < 0) { |
| 451 | printf("%s: gpio %d request failed %d\n", __func__, |
| 452 | pmic->gpio, ret); |
| 453 | return; |
| 454 | } |
| 455 | |
| 456 | /* Pull the GPIO low to select SET0 register, while we program SET1 */ |
| 457 | if (pmic->gpio_en) |
| 458 | gpio_direction_output(pmic->gpio, 0); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 459 | |
| 460 | /* convert to uV for better accuracy in the calculations */ |
| 461 | offset *= 1000; |
| 462 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 463 | offset_code = get_offset_code(offset, pmic); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 464 | |
| 465 | debug("do_scale_vcore: volt - %d offset_code - 0x%x\n", volt_mv, |
| 466 | offset_code); |
SRICHARAN R | 8de17f4 | 2012-03-12 02:25:38 +0000 | [diff] [blame] | 467 | |
Lokesh Vutla | 4ca94d8 | 2013-05-30 02:54:33 +0000 | [diff] [blame] | 468 | if (pmic->pmic_write(pmic->i2c_slave_addr, vcore_reg, offset_code)) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 469 | printf("Scaling voltage failed for 0x%x\n", vcore_reg); |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 470 | |
| 471 | if (pmic->gpio_en) |
| 472 | gpio_direction_output(pmic->gpio, 1); |
| 473 | } |
| 474 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 475 | static u32 optimize_vcore_voltage(struct volts const *v) |
| 476 | { |
| 477 | u32 val; |
| 478 | if (!v->value) |
| 479 | return 0; |
| 480 | if (!v->efuse.reg) |
| 481 | return v->value; |
| 482 | |
| 483 | switch (v->efuse.reg_bits) { |
| 484 | case 16: |
| 485 | val = readw(v->efuse.reg); |
| 486 | break; |
| 487 | case 32: |
| 488 | val = readl(v->efuse.reg); |
| 489 | break; |
| 490 | default: |
| 491 | printf("Error: efuse 0x%08x bits=%d unknown\n", |
| 492 | v->efuse.reg, v->efuse.reg_bits); |
| 493 | return v->value; |
| 494 | } |
| 495 | |
| 496 | if (!val) { |
| 497 | printf("Error: efuse 0x%08x bits=%d val=0, using %d\n", |
| 498 | v->efuse.reg, v->efuse.reg_bits, v->value); |
| 499 | return v->value; |
| 500 | } |
| 501 | |
| 502 | debug("%s:efuse 0x%08x bits=%d Vnom=%d, using efuse value %d\n", |
| 503 | __func__, v->efuse.reg, v->efuse.reg_bits, v->value, val); |
| 504 | return val; |
| 505 | } |
| 506 | |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 507 | /* |
| 508 | * Setup the voltages for vdd_mpu, vdd_core, and vdd_iva |
| 509 | * We set the maximum voltages allowed here because Smart-Reflex is not |
| 510 | * enabled in bootloader. Voltage initialization in the kernel will set |
| 511 | * these to the nominal values after enabling Smart-Reflex |
| 512 | */ |
| 513 | void scale_vcores(struct vcores_data const *vcores) |
| 514 | { |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 515 | u32 val; |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 516 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 517 | val = optimize_vcore_voltage(&vcores->core); |
| 518 | do_scale_vcore(vcores->core.addr, val, vcores->core.pmic); |
| 519 | |
| 520 | val = optimize_vcore_voltage(&vcores->mpu); |
| 521 | do_scale_vcore(vcores->mpu.addr, val, vcores->mpu.pmic); |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 522 | |
Andrii Tseglytskyi | e69c585 | 2013-05-20 22:42:09 +0000 | [diff] [blame] | 523 | /* Configure MPU ABB LDO after scale */ |
| 524 | abb_setup((*ctrl)->control_std_fuse_opp_vdd_mpu_2, |
| 525 | (*ctrl)->control_wkup_ldovbb_mpu_voltage_ctrl, |
| 526 | (*prcm)->prm_abbldo_mpu_setup, |
| 527 | (*prcm)->prm_abbldo_mpu_ctrl, |
| 528 | (*prcm)->prm_irqstatus_mpu_2, |
| 529 | OMAP_ABB_MPU_TXDONE_MASK, |
| 530 | OMAP_ABB_FAST_OPP); |
| 531 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 532 | val = optimize_vcore_voltage(&vcores->mm); |
| 533 | do_scale_vcore(vcores->mm.addr, val, vcores->mm.pmic); |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 534 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 535 | val = optimize_vcore_voltage(&vcores->gpu); |
| 536 | do_scale_vcore(vcores->gpu.addr, val, vcores->gpu.pmic); |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 537 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 538 | val = optimize_vcore_voltage(&vcores->eve); |
| 539 | do_scale_vcore(vcores->eve.addr, val, vcores->eve.pmic); |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 540 | |
Nishanth Menon | 18c9d55 | 2013-05-30 03:19:31 +0000 | [diff] [blame] | 541 | val = optimize_vcore_voltage(&vcores->iva); |
| 542 | do_scale_vcore(vcores->iva.addr, val, vcores->iva.pmic); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 543 | } |
| 544 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 545 | static inline void enable_clock_domain(u32 const clkctrl_reg, u32 enable_mode) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 546 | { |
| 547 | clrsetbits_le32(clkctrl_reg, CD_CLKCTRL_CLKTRCTRL_MASK, |
| 548 | enable_mode << CD_CLKCTRL_CLKTRCTRL_SHIFT); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 549 | debug("Enable clock domain - %x\n", clkctrl_reg); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 550 | } |
| 551 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 552 | static inline void wait_for_clk_enable(u32 clkctrl_addr) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 553 | { |
| 554 | u32 clkctrl, idlest = MODULE_CLKCTRL_IDLEST_DISABLED; |
| 555 | u32 bound = LDELAY; |
| 556 | |
| 557 | while ((idlest == MODULE_CLKCTRL_IDLEST_DISABLED) || |
| 558 | (idlest == MODULE_CLKCTRL_IDLEST_TRANSITIONING)) { |
| 559 | |
| 560 | clkctrl = readl(clkctrl_addr); |
| 561 | idlest = (clkctrl & MODULE_CLKCTRL_IDLEST_MASK) >> |
| 562 | MODULE_CLKCTRL_IDLEST_SHIFT; |
| 563 | if (--bound == 0) { |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 564 | printf("Clock enable failed for 0x%x idlest 0x%x\n", |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 565 | clkctrl_addr, clkctrl); |
| 566 | return; |
| 567 | } |
| 568 | } |
| 569 | } |
| 570 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 571 | static inline void enable_clock_module(u32 const clkctrl_addr, u32 enable_mode, |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 572 | u32 wait_for_enable) |
| 573 | { |
| 574 | clrsetbits_le32(clkctrl_addr, MODULE_CLKCTRL_MODULEMODE_MASK, |
| 575 | enable_mode << MODULE_CLKCTRL_MODULEMODE_SHIFT); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 576 | debug("Enable clock module - %x\n", clkctrl_addr); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 577 | if (wait_for_enable) |
| 578 | wait_for_clk_enable(clkctrl_addr); |
| 579 | } |
| 580 | |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 581 | void freq_update_core(void) |
| 582 | { |
| 583 | u32 freq_config1 = 0; |
| 584 | const struct dpll_params *core_dpll_params; |
SRICHARAN R | f401073 | 2012-03-12 02:25:37 +0000 | [diff] [blame] | 585 | u32 omap_rev = omap_revision(); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 586 | |
SRICHARAN R | ee9447b | 2013-02-04 04:22:01 +0000 | [diff] [blame] | 587 | core_dpll_params = get_core_dpll_params(*dplls_data); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 588 | /* Put EMIF clock domain in sw wakeup mode */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 589 | enable_clock_domain((*prcm)->cm_memif_clkstctrl, |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 590 | CD_CLKCTRL_CLKTRCTRL_SW_WKUP); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 591 | wait_for_clk_enable((*prcm)->cm_memif_emif_1_clkctrl); |
| 592 | wait_for_clk_enable((*prcm)->cm_memif_emif_2_clkctrl); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 593 | |
| 594 | freq_config1 = SHADOW_FREQ_CONFIG1_FREQ_UPDATE_MASK | |
| 595 | SHADOW_FREQ_CONFIG1_DLL_RESET_MASK; |
| 596 | |
| 597 | freq_config1 |= (DPLL_EN_LOCK << SHADOW_FREQ_CONFIG1_DPLL_EN_SHIFT) & |
| 598 | SHADOW_FREQ_CONFIG1_DPLL_EN_MASK; |
| 599 | |
| 600 | freq_config1 |= (core_dpll_params->m2 << |
| 601 | SHADOW_FREQ_CONFIG1_M2_DIV_SHIFT) & |
| 602 | SHADOW_FREQ_CONFIG1_M2_DIV_MASK; |
| 603 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 604 | writel(freq_config1, (*prcm)->cm_shadow_freq_config1); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 605 | if (!wait_on_value(SHADOW_FREQ_CONFIG1_FREQ_UPDATE_MASK, 0, |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 606 | (u32 *) (*prcm)->cm_shadow_freq_config1, LDELAY)) { |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 607 | puts("FREQ UPDATE procedure failed!!"); |
| 608 | hang(); |
| 609 | } |
| 610 | |
SRICHARAN R | f401073 | 2012-03-12 02:25:37 +0000 | [diff] [blame] | 611 | /* |
| 612 | * Putting EMIF in HW_AUTO is seen to be causing issues with |
Lubomir Popov | a8f408a | 2013-04-04 05:51:45 +0000 | [diff] [blame] | 613 | * EMIF clocks and the master DLL. Keep EMIF in SW_WKUP |
SRICHARAN R | f401073 | 2012-03-12 02:25:37 +0000 | [diff] [blame] | 614 | * in OMAP5430 ES1.0 silicon |
| 615 | */ |
| 616 | if (omap_rev != OMAP5430_ES1_0) { |
| 617 | /* Put EMIF clock domain back in hw auto mode */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 618 | enable_clock_domain((*prcm)->cm_memif_clkstctrl, |
SRICHARAN R | f401073 | 2012-03-12 02:25:37 +0000 | [diff] [blame] | 619 | CD_CLKCTRL_CLKTRCTRL_HW_AUTO); |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 620 | wait_for_clk_enable((*prcm)->cm_memif_emif_1_clkctrl); |
| 621 | wait_for_clk_enable((*prcm)->cm_memif_emif_2_clkctrl); |
SRICHARAN R | f401073 | 2012-03-12 02:25:37 +0000 | [diff] [blame] | 622 | } |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 623 | } |
| 624 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 625 | void bypass_dpll(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 626 | { |
| 627 | do_bypass_dpll(base); |
| 628 | wait_for_bypass(base); |
| 629 | } |
| 630 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 631 | void lock_dpll(u32 const base) |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 632 | { |
| 633 | do_lock_dpll(base); |
| 634 | wait_for_lock(base); |
| 635 | } |
| 636 | |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 637 | void setup_clocks_for_console(void) |
| 638 | { |
| 639 | /* Do not add any spl_debug prints in this function */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 640 | clrsetbits_le32((*prcm)->cm_l4per_clkstctrl, CD_CLKCTRL_CLKTRCTRL_MASK, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 641 | CD_CLKCTRL_CLKTRCTRL_SW_WKUP << |
| 642 | CD_CLKCTRL_CLKTRCTRL_SHIFT); |
| 643 | |
| 644 | /* Enable all UARTs - console will be on one of them */ |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 645 | clrsetbits_le32((*prcm)->cm_l4per_uart1_clkctrl, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 646 | MODULE_CLKCTRL_MODULEMODE_MASK, |
| 647 | MODULE_CLKCTRL_MODULEMODE_SW_EXPLICIT_EN << |
| 648 | MODULE_CLKCTRL_MODULEMODE_SHIFT); |
| 649 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 650 | clrsetbits_le32((*prcm)->cm_l4per_uart2_clkctrl, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 651 | MODULE_CLKCTRL_MODULEMODE_MASK, |
| 652 | MODULE_CLKCTRL_MODULEMODE_SW_EXPLICIT_EN << |
| 653 | MODULE_CLKCTRL_MODULEMODE_SHIFT); |
| 654 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 655 | clrsetbits_le32((*prcm)->cm_l4per_uart3_clkctrl, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 656 | MODULE_CLKCTRL_MODULEMODE_MASK, |
| 657 | MODULE_CLKCTRL_MODULEMODE_SW_EXPLICIT_EN << |
| 658 | MODULE_CLKCTRL_MODULEMODE_SHIFT); |
| 659 | |
Lubomir Popov | a8f408a | 2013-04-04 05:51:45 +0000 | [diff] [blame] | 660 | clrsetbits_le32((*prcm)->cm_l4per_uart4_clkctrl, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 661 | MODULE_CLKCTRL_MODULEMODE_MASK, |
| 662 | MODULE_CLKCTRL_MODULEMODE_SW_EXPLICIT_EN << |
| 663 | MODULE_CLKCTRL_MODULEMODE_SHIFT); |
| 664 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 665 | clrsetbits_le32((*prcm)->cm_l4per_clkstctrl, CD_CLKCTRL_CLKTRCTRL_MASK, |
Aneesh V | bcae721 | 2011-07-21 09:10:21 -0400 | [diff] [blame] | 666 | CD_CLKCTRL_CLKTRCTRL_HW_AUTO << |
| 667 | CD_CLKCTRL_CLKTRCTRL_SHIFT); |
| 668 | } |
| 669 | |
SRICHARAN R | 01b753f | 2013-02-04 04:22:00 +0000 | [diff] [blame] | 670 | void do_enable_clocks(u32 const *clk_domains, |
| 671 | u32 const *clk_modules_hw_auto, |
| 672 | u32 const *clk_modules_explicit_en, |
Sricharan | 2e5ba48 | 2011-11-15 09:49:58 -0500 | [diff] [blame] | 673 | u8 wait_for_enable) |
| 674 | { |
| 675 | u32 i, max = 100; |
| 676 | |
| 677 | /* Put the clock domains in SW_WKUP mode */ |
| 678 | for (i = 0; (i < max) && clk_domains[i]; i++) { |
| 679 | enable_clock_domain(clk_domains[i], |
| 680 | CD_CLKCTRL_CLKTRCTRL_SW_WKUP); |
| 681 | } |
| 682 | |
| 683 | /* Clock modules that need to be put in HW_AUTO */ |
| 684 | for (i = 0; (i < max) && clk_modules_hw_auto[i]; i++) { |
| 685 | enable_clock_module(clk_modules_hw_auto[i], |
| 686 | MODULE_CLKCTRL_MODULEMODE_HW_AUTO, |
| 687 | wait_for_enable); |
| 688 | }; |
| 689 | |
| 690 | /* Clock modules that need to be put in SW_EXPLICIT_EN mode */ |
| 691 | for (i = 0; (i < max) && clk_modules_explicit_en[i]; i++) { |
| 692 | enable_clock_module(clk_modules_explicit_en[i], |
| 693 | MODULE_CLKCTRL_MODULEMODE_SW_EXPLICIT_EN, |
| 694 | wait_for_enable); |
| 695 | }; |
| 696 | |
| 697 | /* Put the clock domains in HW_AUTO mode now */ |
| 698 | for (i = 0; (i < max) && clk_domains[i]; i++) { |
| 699 | enable_clock_domain(clk_domains[i], |
| 700 | CD_CLKCTRL_CLKTRCTRL_HW_AUTO); |
| 701 | } |
| 702 | } |
| 703 | |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 704 | void prcm_init(void) |
| 705 | { |
Sricharan | 508a58f | 2011-11-15 09:49:55 -0500 | [diff] [blame] | 706 | switch (omap_hw_init_context()) { |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 707 | case OMAP_INIT_CONTEXT_SPL: |
| 708 | case OMAP_INIT_CONTEXT_UBOOT_FROM_NOR: |
| 709 | case OMAP_INIT_CONTEXT_UBOOT_AFTER_CH: |
Aneesh V | 25223a6 | 2011-07-21 09:29:29 -0400 | [diff] [blame] | 710 | enable_basic_clocks(); |
Lokesh Vutla | 3332b24 | 2013-05-30 03:19:30 +0000 | [diff] [blame] | 711 | timer_init(); |
SRICHARAN R | 3fcdd4a | 2013-02-04 04:22:02 +0000 | [diff] [blame] | 712 | scale_vcores(*omap_vcores); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 713 | setup_dplls(); |
Lokesh Vutla | 0b1b60c | 2013-04-17 20:49:40 +0000 | [diff] [blame] | 714 | setup_warmreset_time(); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 715 | break; |
| 716 | default: |
| 717 | break; |
| 718 | } |
Sricharan | 78f455c | 2011-11-15 09:50:03 -0500 | [diff] [blame] | 719 | |
| 720 | if (OMAP_INIT_CONTEXT_SPL != omap_hw_init_context()) |
| 721 | enable_basic_uboot_clocks(); |
Aneesh V | 3776801 | 2011-07-21 09:10:07 -0400 | [diff] [blame] | 722 | } |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 723 | |
| 724 | void gpi2c_init(void) |
| 725 | { |
| 726 | static int gpi2c = 1; |
| 727 | |
| 728 | if (gpi2c) { |
Heiko Schocher | 6789e84 | 2013-10-22 11:03:18 +0200 | [diff] [blame] | 729 | i2c_init(CONFIG_SYS_OMAP24_I2C_SPEED, |
| 730 | CONFIG_SYS_OMAP24_I2C_SLAVE); |
Lokesh Vutla | 63fc0c7 | 2013-05-30 03:19:29 +0000 | [diff] [blame] | 731 | gpi2c = 0; |
| 732 | } |
| 733 | } |