1 /* 2 * Copyright (C) 2012 ST Microelectronics 3 * Viresh Kumar <viresh.linux@gmail.com> 4 * 5 * This file is licensed under the terms of the GNU General Public 6 * License version 2. This program is licensed "as is" without any 7 * warranty of any kind, whether express or implied. 8 * 9 * VCO-PLL clock implementation 10 */ 11 12 #define pr_fmt(fmt) "clk-vco-pll: " fmt 13 14 #include <linux/clk-provider.h> 15 #include <linux/slab.h> 16 #include <linux/io.h> 17 #include <linux/err.h> 18 #include "clk.h" 19 20 /* 21 * DOC: VCO-PLL clock 22 * 23 * VCO and PLL rate are derived from following equations: 24 * 25 * In normal mode 26 * vco = (2 * M[15:8] * Fin)/N 27 * 28 * In Dithered mode 29 * vco = (2 * M[15:0] * Fin)/(256 * N) 30 * 31 * pll_rate = pll/2^p 32 * 33 * vco and pll are very closely bound to each other, "vco needs to program: 34 * mode, m & n" and "pll needs to program p", both share common enable/disable 35 * logic. 36 * 37 * clk_register_vco_pll() registers instances of both vco & pll. 38 * CLK_SET_RATE_PARENT flag is forced for pll, as it will always pass its 39 * set_rate to vco. A single rate table exists for both the clocks, which 40 * configures m, n and p. 41 */ 42 43 /* PLL_CTR register masks */ 44 #define PLL_MODE_NORMAL 0 45 #define PLL_MODE_FRACTION 1 46 #define PLL_MODE_DITH_DSM 2 47 #define PLL_MODE_DITH_SSM 3 48 #define PLL_MODE_MASK 3 49 #define PLL_MODE_SHIFT 3 50 #define PLL_ENABLE 2 51 52 #define PLL_LOCK_SHIFT 0 53 #define PLL_LOCK_MASK 1 54 55 /* PLL FRQ register masks */ 56 #define PLL_NORM_FDBK_M_MASK 0xFF 57 #define PLL_NORM_FDBK_M_SHIFT 24 58 #define PLL_DITH_FDBK_M_MASK 0xFFFF 59 #define PLL_DITH_FDBK_M_SHIFT 16 60 #define PLL_DIV_P_MASK 0x7 61 #define PLL_DIV_P_SHIFT 8 62 #define PLL_DIV_N_MASK 0xFF 63 #define PLL_DIV_N_SHIFT 0 64 65 #define to_clk_vco(_hw) container_of(_hw, struct clk_vco, hw) 66 #define to_clk_pll(_hw) container_of(_hw, struct clk_pll, hw) 67 68 /* Calculates pll clk rate for specific value of mode, m, n and p */ 69 static unsigned long pll_calc_rate(struct pll_rate_tbl *rtbl, 70 unsigned long prate, int index, unsigned long *pll_rate) 71 { 72 unsigned long rate = prate; 73 unsigned int mode; 74 75 mode = rtbl[index].mode ? 256 : 1; 76 rate = (((2 * rate / 10000) * rtbl[index].m) / (mode * rtbl[index].n)); 77 78 if (pll_rate) 79 *pll_rate = (rate / (1 << rtbl[index].p)) * 10000; 80 81 return rate * 10000; 82 } 83 84 static long clk_pll_round_rate_index(struct clk_hw *hw, unsigned long drate, 85 unsigned long *prate, int *index) 86 { 87 struct clk_pll *pll = to_clk_pll(hw); 88 unsigned long prev_rate, vco_prev_rate, rate = 0; 89 unsigned long vco_parent_rate = 90 __clk_get_rate(__clk_get_parent(__clk_get_parent(hw->clk))); 91 92 if (!prate) { 93 pr_err("%s: prate is must for pll clk\n", __func__); 94 return -EINVAL; 95 } 96 97 for (*index = 0; *index < pll->vco->rtbl_cnt; (*index)++) { 98 prev_rate = rate; 99 vco_prev_rate = *prate; 100 *prate = pll_calc_rate(pll->vco->rtbl, vco_parent_rate, *index, 101 &rate); 102 if (drate < rate) { 103 /* previous clock was best */ 104 if (*index) { 105 rate = prev_rate; 106 *prate = vco_prev_rate; 107 (*index)--; 108 } 109 break; 110 } 111 } 112 113 return rate; 114 } 115 116 static long clk_pll_round_rate(struct clk_hw *hw, unsigned long drate, 117 unsigned long *prate) 118 { 119 int unused; 120 121 return clk_pll_round_rate_index(hw, drate, prate, &unused); 122 } 123 124 static unsigned long clk_pll_recalc_rate(struct clk_hw *hw, unsigned long 125 parent_rate) 126 { 127 struct clk_pll *pll = to_clk_pll(hw); 128 unsigned long flags = 0; 129 unsigned int p; 130 131 if (pll->vco->lock) 132 spin_lock_irqsave(pll->vco->lock, flags); 133 134 p = readl_relaxed(pll->vco->cfg_reg); 135 136 if (pll->vco->lock) 137 spin_unlock_irqrestore(pll->vco->lock, flags); 138 139 p = (p >> PLL_DIV_P_SHIFT) & PLL_DIV_P_MASK; 140 141 return parent_rate / (1 << p); 142 } 143 144 static int clk_pll_set_rate(struct clk_hw *hw, unsigned long drate, 145 unsigned long prate) 146 { 147 struct clk_pll *pll = to_clk_pll(hw); 148 struct pll_rate_tbl *rtbl = pll->vco->rtbl; 149 unsigned long flags = 0, val; 150 int uninitialized_var(i); 151 152 clk_pll_round_rate_index(hw, drate, NULL, &i); 153 154 if (pll->vco->lock) 155 spin_lock_irqsave(pll->vco->lock, flags); 156 157 val = readl_relaxed(pll->vco->cfg_reg); 158 val &= ~(PLL_DIV_P_MASK << PLL_DIV_P_SHIFT); 159 val |= (rtbl[i].p & PLL_DIV_P_MASK) << PLL_DIV_P_SHIFT; 160 writel_relaxed(val, pll->vco->cfg_reg); 161 162 if (pll->vco->lock) 163 spin_unlock_irqrestore(pll->vco->lock, flags); 164 165 return 0; 166 } 167 168 static struct clk_ops clk_pll_ops = { 169 .recalc_rate = clk_pll_recalc_rate, 170 .round_rate = clk_pll_round_rate, 171 .set_rate = clk_pll_set_rate, 172 }; 173 174 static inline unsigned long vco_calc_rate(struct clk_hw *hw, 175 unsigned long prate, int index) 176 { 177 struct clk_vco *vco = to_clk_vco(hw); 178 179 return pll_calc_rate(vco->rtbl, prate, index, NULL); 180 } 181 182 static long clk_vco_round_rate(struct clk_hw *hw, unsigned long drate, 183 unsigned long *prate) 184 { 185 struct clk_vco *vco = to_clk_vco(hw); 186 int unused; 187 188 return clk_round_rate_index(hw, drate, *prate, vco_calc_rate, 189 vco->rtbl_cnt, &unused); 190 } 191 192 static unsigned long clk_vco_recalc_rate(struct clk_hw *hw, 193 unsigned long parent_rate) 194 { 195 struct clk_vco *vco = to_clk_vco(hw); 196 unsigned long flags = 0; 197 unsigned int num = 2, den = 0, val, mode = 0; 198 199 if (vco->lock) 200 spin_lock_irqsave(vco->lock, flags); 201 202 mode = (readl_relaxed(vco->mode_reg) >> PLL_MODE_SHIFT) & PLL_MODE_MASK; 203 204 val = readl_relaxed(vco->cfg_reg); 205 206 if (vco->lock) 207 spin_unlock_irqrestore(vco->lock, flags); 208 209 den = (val >> PLL_DIV_N_SHIFT) & PLL_DIV_N_MASK; 210 211 /* calculate numerator & denominator */ 212 if (!mode) { 213 /* Normal mode */ 214 num *= (val >> PLL_NORM_FDBK_M_SHIFT) & PLL_NORM_FDBK_M_MASK; 215 } else { 216 /* Dithered mode */ 217 num *= (val >> PLL_DITH_FDBK_M_SHIFT) & PLL_DITH_FDBK_M_MASK; 218 den *= 256; 219 } 220 221 if (!den) { 222 WARN(1, "%s: denominator can't be zero\n", __func__); 223 return 0; 224 } 225 226 return (((parent_rate / 10000) * num) / den) * 10000; 227 } 228 229 /* Configures new clock rate of vco */ 230 static int clk_vco_set_rate(struct clk_hw *hw, unsigned long drate, 231 unsigned long prate) 232 { 233 struct clk_vco *vco = to_clk_vco(hw); 234 struct pll_rate_tbl *rtbl = vco->rtbl; 235 unsigned long flags = 0, val; 236 int i; 237 238 clk_round_rate_index(hw, drate, prate, vco_calc_rate, vco->rtbl_cnt, 239 &i); 240 241 if (vco->lock) 242 spin_lock_irqsave(vco->lock, flags); 243 244 val = readl_relaxed(vco->mode_reg); 245 val &= ~(PLL_MODE_MASK << PLL_MODE_SHIFT); 246 val |= (rtbl[i].mode & PLL_MODE_MASK) << PLL_MODE_SHIFT; 247 writel_relaxed(val, vco->mode_reg); 248 249 val = readl_relaxed(vco->cfg_reg); 250 val &= ~(PLL_DIV_N_MASK << PLL_DIV_N_SHIFT); 251 val |= (rtbl[i].n & PLL_DIV_N_MASK) << PLL_DIV_N_SHIFT; 252 253 val &= ~(PLL_DITH_FDBK_M_MASK << PLL_DITH_FDBK_M_SHIFT); 254 if (rtbl[i].mode) 255 val |= (rtbl[i].m & PLL_DITH_FDBK_M_MASK) << 256 PLL_DITH_FDBK_M_SHIFT; 257 else 258 val |= (rtbl[i].m & PLL_NORM_FDBK_M_MASK) << 259 PLL_NORM_FDBK_M_SHIFT; 260 261 writel_relaxed(val, vco->cfg_reg); 262 263 if (vco->lock) 264 spin_unlock_irqrestore(vco->lock, flags); 265 266 return 0; 267 } 268 269 static struct clk_ops clk_vco_ops = { 270 .recalc_rate = clk_vco_recalc_rate, 271 .round_rate = clk_vco_round_rate, 272 .set_rate = clk_vco_set_rate, 273 }; 274 275 struct clk *clk_register_vco_pll(const char *vco_name, const char *pll_name, 276 const char *vco_gate_name, const char *parent_name, 277 unsigned long flags, void __iomem *mode_reg, void __iomem 278 *cfg_reg, struct pll_rate_tbl *rtbl, u8 rtbl_cnt, 279 spinlock_t *lock, struct clk **pll_clk, 280 struct clk **vco_gate_clk) 281 { 282 struct clk_vco *vco; 283 struct clk_pll *pll; 284 struct clk *vco_clk, *tpll_clk, *tvco_gate_clk; 285 struct clk_init_data vco_init, pll_init; 286 const char **vco_parent_name; 287 288 if (!vco_name || !pll_name || !parent_name || !mode_reg || !cfg_reg || 289 !rtbl || !rtbl_cnt) { 290 pr_err("Invalid arguments passed"); 291 return ERR_PTR(-EINVAL); 292 } 293 294 vco = kzalloc(sizeof(*vco), GFP_KERNEL); 295 if (!vco) { 296 pr_err("could not allocate vco clk\n"); 297 return ERR_PTR(-ENOMEM); 298 } 299 300 pll = kzalloc(sizeof(*pll), GFP_KERNEL); 301 if (!pll) { 302 pr_err("could not allocate pll clk\n"); 303 goto free_vco; 304 } 305 306 /* struct clk_vco assignments */ 307 vco->mode_reg = mode_reg; 308 vco->cfg_reg = cfg_reg; 309 vco->rtbl = rtbl; 310 vco->rtbl_cnt = rtbl_cnt; 311 vco->lock = lock; 312 vco->hw.init = &vco_init; 313 314 pll->vco = vco; 315 pll->hw.init = &pll_init; 316 317 if (vco_gate_name) { 318 tvco_gate_clk = clk_register_gate(NULL, vco_gate_name, 319 parent_name, 0, mode_reg, PLL_ENABLE, 0, lock); 320 if (IS_ERR_OR_NULL(tvco_gate_clk)) 321 goto free_pll; 322 323 if (vco_gate_clk) 324 *vco_gate_clk = tvco_gate_clk; 325 vco_parent_name = &vco_gate_name; 326 } else { 327 vco_parent_name = &parent_name; 328 } 329 330 vco_init.name = vco_name; 331 vco_init.ops = &clk_vco_ops; 332 vco_init.flags = flags; 333 vco_init.parent_names = vco_parent_name; 334 vco_init.num_parents = 1; 335 336 pll_init.name = pll_name; 337 pll_init.ops = &clk_pll_ops; 338 pll_init.flags = CLK_SET_RATE_PARENT; 339 pll_init.parent_names = &vco_name; 340 pll_init.num_parents = 1; 341 342 vco_clk = clk_register(NULL, &vco->hw); 343 if (IS_ERR_OR_NULL(vco_clk)) 344 goto free_pll; 345 346 tpll_clk = clk_register(NULL, &pll->hw); 347 if (IS_ERR_OR_NULL(tpll_clk)) 348 goto free_pll; 349 350 if (pll_clk) 351 *pll_clk = tpll_clk; 352 353 return vco_clk; 354 355 free_pll: 356 kfree(pll); 357 free_vco: 358 kfree(vco); 359 360 pr_err("Failed to register vco pll clock\n"); 361 362 return ERR_PTR(-ENOMEM); 363 } 364