1 // SPDX-License-Identifier: GPL-2.0-only
3 * Copyright (c) 2016, The Linux Foundation. All rights reserved.
7 #include <linux/clk-provider.h>
8 #include <linux/delay.h>
12 #include "dsi_phy_14nm.xml.h"
14 #define PHY_14NM_CKLN_IDX 4
17 * DSI PLL 14nm - clock diagram (eg: DSI0):
23 * dsi0vco_clk ---| n1 |--o--| /8 |-- dsi0pllbyte
25 * | dsi0n1_postdivby2_clk
29 * | | |--| n2 |-- dsi0pll
30 * o--------------| / +----+
34 #define POLL_MAX_READS 15
35 #define POLL_TIMEOUT_US 1000
37 #define VCO_REF_CLK_RATE 19200000
38 #define VCO_MIN_RATE 1300000000UL
39 #define VCO_MAX_RATE 2600000000UL
41 struct dsi_pll_config {
44 u32 ssc_en; /* SSC enable/disable */
65 struct pll_14nm_cached_state {
66 unsigned long vco_rate;
74 struct msm_dsi_phy *phy;
76 /* protects REG_DSI_14nm_PHY_CMN_CLK_CFG0 register */
77 spinlock_t postdiv_lock;
79 struct pll_14nm_cached_state cached_state;
81 struct dsi_pll_14nm *slave;
84 #define to_pll_14nm(x) container_of(x, struct dsi_pll_14nm, clk_hw)
87 * Private struct for N1/N2 post-divider clocks. These clocks are similar to
88 * the generic clk_divider class of clocks. The only difference is that it
89 * also sets the slave DSI PLL's post-dividers if in bonded DSI mode
91 struct dsi_pll_14nm_postdiv {
97 u8 flags; /* same flags as used by clk_divider struct */
99 struct dsi_pll_14nm *pll;
102 #define to_pll_14nm_postdiv(_hw) container_of(_hw, struct dsi_pll_14nm_postdiv, hw)
105 * Global list of private DSI PLL struct pointers. We need this for bonded DSI
106 * mode, where the master PLL's clk_ops needs access the slave's private data
108 static struct dsi_pll_14nm *pll_14nm_list[DSI_MAX];
110 static bool pll_14nm_poll_for_ready(struct dsi_pll_14nm *pll_14nm,
111 u32 nb_tries, u32 timeout_us)
113 bool pll_locked = false;
114 void __iomem *base = pll_14nm->phy->pll_base;
119 val = dsi_phy_read(base +
120 REG_DSI_14nm_PHY_PLL_RESET_SM_READY_STATUS);
121 pll_locked = !!(val & BIT(5));
132 val = dsi_phy_read(base +
133 REG_DSI_14nm_PHY_PLL_RESET_SM_READY_STATUS);
134 pll_locked = !!(val & BIT(0));
143 DBG("DSI PLL is %slocked", pll_locked ? "" : "*not* ");
148 static void dsi_pll_14nm_config_init(struct dsi_pll_config *pconf)
151 pconf->plllock_cnt = 1;
154 * SSC is enabled by default. We might need DT props for configuring
155 * some SSC params like PPM and center/down spread etc.
158 pconf->ssc_center = 0; /* down spread by default */
159 pconf->ssc_spread = 5; /* PPM / 1000 */
160 pconf->ssc_freq = 31500; /* default recommended */
161 pconf->ssc_adj_period = 37;
164 #define CEIL(x, y) (((x) + ((y) - 1)) / (y))
166 static void pll_14nm_ssc_calc(struct dsi_pll_14nm *pll, struct dsi_pll_config *pconf)
168 u32 period, ssc_period;
172 DBG("vco=%lld ref=%d", pconf->vco_current_rate, VCO_REF_CLK_RATE);
174 ssc_period = pconf->ssc_freq / 500;
175 period = (u32)VCO_REF_CLK_RATE / 1000;
176 ssc_period = CEIL(period, ssc_period);
178 pconf->ssc_period = ssc_period;
180 DBG("ssc freq=%d spread=%d period=%d", pconf->ssc_freq,
181 pconf->ssc_spread, pconf->ssc_period);
183 step_size = (u32)pconf->vco_current_rate;
184 ref = VCO_REF_CLK_RATE;
186 step_size = div_u64(step_size, ref);
188 step_size = div_u64(step_size, 1000);
189 step_size *= pconf->ssc_spread;
190 step_size = div_u64(step_size, 1000);
191 step_size *= (pconf->ssc_adj_period + 1);
194 step_size = div_u64_rem(step_size, ssc_period + 1, &rem);
198 DBG("step_size=%lld", step_size);
200 step_size &= 0x0ffff; /* take lower 16 bits */
202 pconf->ssc_step_size = step_size;
205 static void pll_14nm_dec_frac_calc(struct dsi_pll_14nm *pll, struct dsi_pll_config *pconf)
207 u64 multiplier = BIT(20);
208 u64 dec_start_multiple, dec_start, pll_comp_val;
209 u32 duration, div_frac_start;
210 u64 vco_clk_rate = pconf->vco_current_rate;
211 u64 fref = VCO_REF_CLK_RATE;
213 DBG("vco_clk_rate=%lld ref_clk_rate=%lld", vco_clk_rate, fref);
215 dec_start_multiple = div_u64(vco_clk_rate * multiplier, fref);
216 div_u64_rem(dec_start_multiple, multiplier, &div_frac_start);
218 dec_start = div_u64(dec_start_multiple, multiplier);
220 pconf->dec_start = (u32)dec_start;
221 pconf->div_frac_start = div_frac_start;
223 if (pconf->plllock_cnt == 0)
225 else if (pconf->plllock_cnt == 1)
227 else if (pconf->plllock_cnt == 2)
232 pll_comp_val = duration * dec_start_multiple;
233 pll_comp_val = div_u64(pll_comp_val, multiplier);
234 do_div(pll_comp_val, 10);
236 pconf->plllock_cmp = (u32)pll_comp_val;
239 static u32 pll_14nm_kvco_slop(u32 vrate)
243 if (vrate > VCO_MIN_RATE && vrate <= 1800000000UL)
245 else if (vrate > 1800000000UL && vrate < 2300000000UL)
247 else if (vrate > 2300000000UL && vrate < VCO_MAX_RATE)
253 static void pll_14nm_calc_vco_count(struct dsi_pll_14nm *pll, struct dsi_pll_config *pconf)
255 u64 vco_clk_rate = pconf->vco_current_rate;
256 u64 fref = VCO_REF_CLK_RATE;
257 u32 vco_measure_time = 5;
258 u32 kvco_measure_time = 5;
262 data = fref * vco_measure_time;
263 do_div(data, 1000000);
264 data &= 0x03ff; /* 10 bits */
266 pconf->pll_vco_div_ref = data;
268 data = div_u64(vco_clk_rate, 1000000); /* unit is Mhz */
269 data *= vco_measure_time;
271 pconf->pll_vco_count = data;
273 data = fref * kvco_measure_time;
274 do_div(data, 1000000);
275 data &= 0x03ff; /* 10 bits */
277 pconf->pll_kvco_div_ref = data;
279 cnt = pll_14nm_kvco_slop(vco_clk_rate);
282 cnt *= kvco_measure_time;
283 pconf->pll_kvco_count = cnt;
286 static void pll_db_commit_ssc(struct dsi_pll_14nm *pll, struct dsi_pll_config *pconf)
288 void __iomem *base = pll->phy->pll_base;
291 data = pconf->ssc_adj_period;
293 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_ADJ_PER1, data);
294 data = (pconf->ssc_adj_period >> 8);
296 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_ADJ_PER2, data);
298 data = pconf->ssc_period;
300 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_PER1, data);
301 data = (pconf->ssc_period >> 8);
303 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_PER2, data);
305 data = pconf->ssc_step_size;
307 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_STEP_SIZE1, data);
308 data = (pconf->ssc_step_size >> 8);
310 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_STEP_SIZE2, data);
312 data = (pconf->ssc_center & 0x01);
314 data |= 0x01; /* enable */
315 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SSC_EN_CENTER, data);
317 wmb(); /* make sure register committed */
320 static void pll_db_commit_common(struct dsi_pll_14nm *pll,
321 struct dsi_pll_config *pconf)
323 void __iomem *base = pll->phy->pll_base;
326 /* confgiure the non frequency dependent pll registers */
328 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_SYSCLK_EN_RESET, data);
330 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_TXCLK_EN, 1);
332 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_RESETSM_CNTRL, 48);
333 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_RESETSM_CNTRL2, 4 << 3); /* bandgap_timer */
334 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_RESETSM_CNTRL5, 5); /* pll_wakeup_timer */
336 data = pconf->pll_vco_div_ref & 0xff;
337 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_VCO_DIV_REF1, data);
338 data = (pconf->pll_vco_div_ref >> 8) & 0x3;
339 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_VCO_DIV_REF2, data);
341 data = pconf->pll_kvco_div_ref & 0xff;
342 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_KVCO_DIV_REF1, data);
343 data = (pconf->pll_kvco_div_ref >> 8) & 0x3;
344 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_KVCO_DIV_REF2, data);
346 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_MISC1, 16);
348 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_IE_TRIM, 4);
350 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_IP_TRIM, 4);
352 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_CP_SET_CUR, 1 << 3 | 1);
354 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_ICPCSET, 0 << 3 | 0);
356 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_ICPMSET, 0 << 3 | 0);
358 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_ICP_SET, 4 << 3 | 4);
360 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_LPF1, 1 << 4 | 11);
362 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_IPTAT_TRIM, 7);
364 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_CRCTRL, 1 << 4 | 2);
367 static void pll_14nm_software_reset(struct dsi_pll_14nm *pll_14nm)
369 void __iomem *cmn_base = pll_14nm->phy->base;
371 /* de assert pll start and apply pll sw reset */
374 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_PLL_CNTRL, 0);
377 dsi_phy_write_udelay(cmn_base + REG_DSI_14nm_PHY_CMN_CTRL_1, 0x20, 10);
378 wmb(); /* make sure register committed */
380 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_CTRL_1, 0);
381 wmb(); /* make sure register committed */
384 static void pll_db_commit_14nm(struct dsi_pll_14nm *pll,
385 struct dsi_pll_config *pconf)
387 void __iomem *base = pll->phy->pll_base;
388 void __iomem *cmn_base = pll->phy->base;
391 DBG("DSI%d PLL", pll->phy->id);
393 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_LDO_CNTRL, 0x3c);
395 pll_db_commit_common(pll, pconf);
397 pll_14nm_software_reset(pll);
399 /* Use the /2 path in Mux */
400 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_CLK_CFG1, 1);
402 data = 0xff; /* data, clk, pll normal operation */
403 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_CTRL_0, data);
405 /* configure the frequency dependent pll registers */
406 data = pconf->dec_start;
407 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_DEC_START, data);
409 data = pconf->div_frac_start & 0xff;
410 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START1, data);
411 data = (pconf->div_frac_start >> 8) & 0xff;
412 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START2, data);
413 data = (pconf->div_frac_start >> 16) & 0xf;
414 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START3, data);
416 data = pconf->plllock_cmp & 0xff;
417 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLLLOCK_CMP1, data);
419 data = (pconf->plllock_cmp >> 8) & 0xff;
420 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLLLOCK_CMP2, data);
422 data = (pconf->plllock_cmp >> 16) & 0x3;
423 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLLLOCK_CMP3, data);
425 data = pconf->plllock_cnt << 1 | 0 << 3; /* plllock_rng */
426 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLLLOCK_CMP_EN, data);
428 data = pconf->pll_vco_count & 0xff;
429 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_VCO_COUNT1, data);
430 data = (pconf->pll_vco_count >> 8) & 0xff;
431 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_VCO_COUNT2, data);
433 data = pconf->pll_kvco_count & 0xff;
434 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_KVCO_COUNT1, data);
435 data = (pconf->pll_kvco_count >> 8) & 0x3;
436 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_KVCO_COUNT2, data);
439 * High nibble configures the post divider internal to the VCO. It's
440 * fixed to divide by 1 for now.
447 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_LPF2_POSTDIV, 0 << 4 | 3);
450 pll_db_commit_ssc(pll, pconf);
452 wmb(); /* make sure register committed */
456 * VCO clock Callbacks
458 static int dsi_pll_14nm_vco_set_rate(struct clk_hw *hw, unsigned long rate,
459 unsigned long parent_rate)
461 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(hw);
462 struct dsi_pll_config conf;
464 DBG("DSI PLL%d rate=%lu, parent's=%lu", pll_14nm->phy->id, rate,
467 dsi_pll_14nm_config_init(&conf);
468 conf.vco_current_rate = rate;
470 pll_14nm_dec_frac_calc(pll_14nm, &conf);
473 pll_14nm_ssc_calc(pll_14nm, &conf);
475 pll_14nm_calc_vco_count(pll_14nm, &conf);
477 /* commit the slave DSI PLL registers if we're master. Note that we
478 * don't lock the slave PLL. We just ensure that the PLL/PHY registers
479 * of the master and slave are identical
481 if (pll_14nm->phy->usecase == MSM_DSI_PHY_MASTER) {
482 struct dsi_pll_14nm *pll_14nm_slave = pll_14nm->slave;
484 pll_db_commit_14nm(pll_14nm_slave, &conf);
487 pll_db_commit_14nm(pll_14nm, &conf);
492 static unsigned long dsi_pll_14nm_vco_recalc_rate(struct clk_hw *hw,
493 unsigned long parent_rate)
495 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(hw);
496 void __iomem *base = pll_14nm->phy->pll_base;
497 u64 vco_rate, multiplier = BIT(20);
500 u64 ref_clk = parent_rate;
502 dec_start = dsi_phy_read(base + REG_DSI_14nm_PHY_PLL_DEC_START);
505 DBG("dec_start = %x", dec_start);
507 div_frac_start = (dsi_phy_read(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START3)
509 div_frac_start |= (dsi_phy_read(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START2)
511 div_frac_start |= dsi_phy_read(base + REG_DSI_14nm_PHY_PLL_DIV_FRAC_START1)
514 DBG("div_frac_start = %x", div_frac_start);
516 vco_rate = ref_clk * dec_start;
518 vco_rate += ((ref_clk * div_frac_start) / multiplier);
521 * Recalculating the rate from dec_start and frac_start doesn't end up
522 * the rate we originally set. Convert the freq to KHz, round it up and
523 * convert it back to MHz.
525 vco_rate = DIV_ROUND_UP_ULL(vco_rate, 1000) * 1000;
527 DBG("returning vco rate = %lu", (unsigned long)vco_rate);
529 return (unsigned long)vco_rate;
532 static int dsi_pll_14nm_vco_prepare(struct clk_hw *hw)
534 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(hw);
535 void __iomem *base = pll_14nm->phy->pll_base;
536 void __iomem *cmn_base = pll_14nm->phy->base;
541 if (unlikely(pll_14nm->phy->pll_on))
544 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_VREF_CFG1, 0x10);
545 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_PLL_CNTRL, 1);
547 locked = pll_14nm_poll_for_ready(pll_14nm, POLL_MAX_READS,
550 if (unlikely(!locked)) {
551 DRM_DEV_ERROR(&pll_14nm->phy->pdev->dev, "DSI PLL lock failed\n");
555 DBG("DSI PLL lock success");
556 pll_14nm->phy->pll_on = true;
561 static void dsi_pll_14nm_vco_unprepare(struct clk_hw *hw)
563 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(hw);
564 void __iomem *cmn_base = pll_14nm->phy->base;
568 if (unlikely(!pll_14nm->phy->pll_on))
571 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_PLL_CNTRL, 0);
573 pll_14nm->phy->pll_on = false;
576 static long dsi_pll_14nm_clk_round_rate(struct clk_hw *hw,
577 unsigned long rate, unsigned long *parent_rate)
579 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(hw);
581 if (rate < pll_14nm->phy->cfg->min_pll_rate)
582 return pll_14nm->phy->cfg->min_pll_rate;
583 else if (rate > pll_14nm->phy->cfg->max_pll_rate)
584 return pll_14nm->phy->cfg->max_pll_rate;
589 static const struct clk_ops clk_ops_dsi_pll_14nm_vco = {
590 .round_rate = dsi_pll_14nm_clk_round_rate,
591 .set_rate = dsi_pll_14nm_vco_set_rate,
592 .recalc_rate = dsi_pll_14nm_vco_recalc_rate,
593 .prepare = dsi_pll_14nm_vco_prepare,
594 .unprepare = dsi_pll_14nm_vco_unprepare,
598 * N1 and N2 post-divider clock callbacks
600 #define div_mask(width) ((1 << (width)) - 1)
601 static unsigned long dsi_pll_14nm_postdiv_recalc_rate(struct clk_hw *hw,
602 unsigned long parent_rate)
604 struct dsi_pll_14nm_postdiv *postdiv = to_pll_14nm_postdiv(hw);
605 struct dsi_pll_14nm *pll_14nm = postdiv->pll;
606 void __iomem *base = pll_14nm->phy->base;
607 u8 shift = postdiv->shift;
608 u8 width = postdiv->width;
611 DBG("DSI%d PLL parent rate=%lu", pll_14nm->phy->id, parent_rate);
613 val = dsi_phy_read(base + REG_DSI_14nm_PHY_CMN_CLK_CFG0) >> shift;
614 val &= div_mask(width);
616 return divider_recalc_rate(hw, parent_rate, val, NULL,
617 postdiv->flags, width);
620 static long dsi_pll_14nm_postdiv_round_rate(struct clk_hw *hw,
622 unsigned long *prate)
624 struct dsi_pll_14nm_postdiv *postdiv = to_pll_14nm_postdiv(hw);
625 struct dsi_pll_14nm *pll_14nm = postdiv->pll;
627 DBG("DSI%d PLL parent rate=%lu", pll_14nm->phy->id, rate);
629 return divider_round_rate(hw, rate, prate, NULL,
634 static int dsi_pll_14nm_postdiv_set_rate(struct clk_hw *hw, unsigned long rate,
635 unsigned long parent_rate)
637 struct dsi_pll_14nm_postdiv *postdiv = to_pll_14nm_postdiv(hw);
638 struct dsi_pll_14nm *pll_14nm = postdiv->pll;
639 void __iomem *base = pll_14nm->phy->base;
640 spinlock_t *lock = &pll_14nm->postdiv_lock;
641 u8 shift = postdiv->shift;
642 u8 width = postdiv->width;
644 unsigned long flags = 0;
647 DBG("DSI%d PLL parent rate=%lu parent rate %lu", pll_14nm->phy->id, rate,
650 value = divider_get_val(rate, parent_rate, NULL, postdiv->width,
653 spin_lock_irqsave(lock, flags);
655 val = dsi_phy_read(base + REG_DSI_14nm_PHY_CMN_CLK_CFG0);
656 val &= ~(div_mask(width) << shift);
658 val |= value << shift;
659 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_CLK_CFG0, val);
661 /* If we're master in bonded DSI mode, then the slave PLL's post-dividers
662 * follow the master's post dividers
664 if (pll_14nm->phy->usecase == MSM_DSI_PHY_MASTER) {
665 struct dsi_pll_14nm *pll_14nm_slave = pll_14nm->slave;
666 void __iomem *slave_base = pll_14nm_slave->phy->base;
668 dsi_phy_write(slave_base + REG_DSI_14nm_PHY_CMN_CLK_CFG0, val);
671 spin_unlock_irqrestore(lock, flags);
676 static const struct clk_ops clk_ops_dsi_pll_14nm_postdiv = {
677 .recalc_rate = dsi_pll_14nm_postdiv_recalc_rate,
678 .round_rate = dsi_pll_14nm_postdiv_round_rate,
679 .set_rate = dsi_pll_14nm_postdiv_set_rate,
686 static void dsi_14nm_pll_save_state(struct msm_dsi_phy *phy)
688 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(phy->vco_hw);
689 struct pll_14nm_cached_state *cached_state = &pll_14nm->cached_state;
690 void __iomem *cmn_base = pll_14nm->phy->base;
693 data = dsi_phy_read(cmn_base + REG_DSI_14nm_PHY_CMN_CLK_CFG0);
695 cached_state->n1postdiv = data & 0xf;
696 cached_state->n2postdiv = (data >> 4) & 0xf;
698 DBG("DSI%d PLL save state %x %x", pll_14nm->phy->id,
699 cached_state->n1postdiv, cached_state->n2postdiv);
701 cached_state->vco_rate = clk_hw_get_rate(phy->vco_hw);
704 static int dsi_14nm_pll_restore_state(struct msm_dsi_phy *phy)
706 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(phy->vco_hw);
707 struct pll_14nm_cached_state *cached_state = &pll_14nm->cached_state;
708 void __iomem *cmn_base = pll_14nm->phy->base;
712 ret = dsi_pll_14nm_vco_set_rate(phy->vco_hw,
713 cached_state->vco_rate, 0);
715 DRM_DEV_ERROR(&pll_14nm->phy->pdev->dev,
716 "restore vco rate failed. ret=%d\n", ret);
720 data = cached_state->n1postdiv | (cached_state->n2postdiv << 4);
722 DBG("DSI%d PLL restore state %x %x", pll_14nm->phy->id,
723 cached_state->n1postdiv, cached_state->n2postdiv);
725 dsi_phy_write(cmn_base + REG_DSI_14nm_PHY_CMN_CLK_CFG0, data);
727 /* also restore post-dividers for slave DSI PLL */
728 if (phy->usecase == MSM_DSI_PHY_MASTER) {
729 struct dsi_pll_14nm *pll_14nm_slave = pll_14nm->slave;
730 void __iomem *slave_base = pll_14nm_slave->phy->base;
732 dsi_phy_write(slave_base + REG_DSI_14nm_PHY_CMN_CLK_CFG0, data);
738 static int dsi_14nm_set_usecase(struct msm_dsi_phy *phy)
740 struct dsi_pll_14nm *pll_14nm = to_pll_14nm(phy->vco_hw);
741 void __iomem *base = phy->pll_base;
742 u32 clkbuflr_en, bandgap = 0;
744 switch (phy->usecase) {
745 case MSM_DSI_PHY_STANDALONE:
748 case MSM_DSI_PHY_MASTER:
750 pll_14nm->slave = pll_14nm_list[(pll_14nm->phy->id + 1) % DSI_MAX];
752 case MSM_DSI_PHY_SLAVE:
760 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_CLKBUFLR_EN, clkbuflr_en);
762 dsi_phy_write(base + REG_DSI_14nm_PHY_PLL_PLL_BANDGAP, bandgap);
767 static struct clk_hw *pll_14nm_postdiv_register(struct dsi_pll_14nm *pll_14nm,
769 const char *parent_name,
773 struct dsi_pll_14nm_postdiv *pll_postdiv;
774 struct device *dev = &pll_14nm->phy->pdev->dev;
775 struct clk_init_data postdiv_init = {
776 .parent_names = (const char *[]) { parent_name },
780 .ops = &clk_ops_dsi_pll_14nm_postdiv,
784 pll_postdiv = devm_kzalloc(dev, sizeof(*pll_postdiv), GFP_KERNEL);
786 return ERR_PTR(-ENOMEM);
788 pll_postdiv->pll = pll_14nm;
789 pll_postdiv->shift = shift;
790 /* both N1 and N2 postdividers are 4 bits wide */
791 pll_postdiv->width = 4;
792 /* range of each divider is from 1 to 15 */
793 pll_postdiv->flags = CLK_DIVIDER_ONE_BASED;
794 pll_postdiv->hw.init = &postdiv_init;
796 ret = devm_clk_hw_register(dev, &pll_postdiv->hw);
800 return &pll_postdiv->hw;
803 static int pll_14nm_register(struct dsi_pll_14nm *pll_14nm, struct clk_hw **provided_clocks)
805 char clk_name[32], parent[32], vco_name[32];
806 struct clk_init_data vco_init = {
807 .parent_names = (const char *[]){ "xo" },
810 .flags = CLK_IGNORE_UNUSED,
811 .ops = &clk_ops_dsi_pll_14nm_vco,
813 struct device *dev = &pll_14nm->phy->pdev->dev;
817 DBG("DSI%d", pll_14nm->phy->id);
819 snprintf(vco_name, 32, "dsi%dvco_clk", pll_14nm->phy->id);
820 pll_14nm->clk_hw.init = &vco_init;
822 ret = devm_clk_hw_register(dev, &pll_14nm->clk_hw);
826 snprintf(clk_name, 32, "dsi%dn1_postdiv_clk", pll_14nm->phy->id);
827 snprintf(parent, 32, "dsi%dvco_clk", pll_14nm->phy->id);
829 /* N1 postdiv, bits 0-3 in REG_DSI_14nm_PHY_CMN_CLK_CFG0 */
830 hw = pll_14nm_postdiv_register(pll_14nm, clk_name, parent,
831 CLK_SET_RATE_PARENT, 0);
835 snprintf(clk_name, 32, "dsi%dpllbyte", pll_14nm->phy->id);
836 snprintf(parent, 32, "dsi%dn1_postdiv_clk", pll_14nm->phy->id);
838 /* DSI Byte clock = VCO_CLK / N1 / 8 */
839 hw = devm_clk_hw_register_fixed_factor(dev, clk_name, parent,
840 CLK_SET_RATE_PARENT, 1, 8);
844 provided_clocks[DSI_BYTE_PLL_CLK] = hw;
846 snprintf(clk_name, 32, "dsi%dn1_postdivby2_clk", pll_14nm->phy->id);
847 snprintf(parent, 32, "dsi%dn1_postdiv_clk", pll_14nm->phy->id);
850 * Skip the mux for now, force DSICLK_SEL to 1, Add a /2 divider
851 * on the way. Don't let it set parent.
853 hw = devm_clk_hw_register_fixed_factor(dev, clk_name, parent, 0, 1, 2);
857 snprintf(clk_name, 32, "dsi%dpll", pll_14nm->phy->id);
858 snprintf(parent, 32, "dsi%dn1_postdivby2_clk", pll_14nm->phy->id);
860 /* DSI pixel clock = VCO_CLK / N1 / 2 / N2
861 * This is the output of N2 post-divider, bits 4-7 in
862 * REG_DSI_14nm_PHY_CMN_CLK_CFG0. Don't let it set parent.
864 hw = pll_14nm_postdiv_register(pll_14nm, clk_name, parent, 0, 4);
868 provided_clocks[DSI_PIXEL_PLL_CLK] = hw;
873 static int dsi_pll_14nm_init(struct msm_dsi_phy *phy)
875 struct platform_device *pdev = phy->pdev;
876 struct dsi_pll_14nm *pll_14nm;
882 pll_14nm = devm_kzalloc(&pdev->dev, sizeof(*pll_14nm), GFP_KERNEL);
886 DBG("PLL%d", phy->id);
888 pll_14nm_list[phy->id] = pll_14nm;
890 spin_lock_init(&pll_14nm->postdiv_lock);
894 ret = pll_14nm_register(pll_14nm, phy->provided_clocks->hws);
896 DRM_DEV_ERROR(&pdev->dev, "failed to register PLL: %d\n", ret);
900 phy->vco_hw = &pll_14nm->clk_hw;
905 static void dsi_14nm_dphy_set_timing(struct msm_dsi_phy *phy,
906 struct msm_dsi_dphy_timing *timing,
909 void __iomem *base = phy->lane_base;
910 bool clk_ln = (lane_idx == PHY_14NM_CKLN_IDX);
911 u32 zero = clk_ln ? timing->clk_zero : timing->hs_zero;
912 u32 prepare = clk_ln ? timing->clk_prepare : timing->hs_prepare;
913 u32 trail = clk_ln ? timing->clk_trail : timing->hs_trail;
914 u32 rqst = clk_ln ? timing->hs_rqst_ckln : timing->hs_rqst;
915 u32 prep_dly = clk_ln ? timing->hs_prep_dly_ckln : timing->hs_prep_dly;
916 u32 halfbyte_en = clk_ln ? timing->hs_halfbyte_en_ckln :
917 timing->hs_halfbyte_en;
919 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_4(lane_idx),
920 DSI_14nm_PHY_LN_TIMING_CTRL_4_HS_EXIT(timing->hs_exit));
921 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_5(lane_idx),
922 DSI_14nm_PHY_LN_TIMING_CTRL_5_HS_ZERO(zero));
923 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_6(lane_idx),
924 DSI_14nm_PHY_LN_TIMING_CTRL_6_HS_PREPARE(prepare));
925 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_7(lane_idx),
926 DSI_14nm_PHY_LN_TIMING_CTRL_7_HS_TRAIL(trail));
927 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_8(lane_idx),
928 DSI_14nm_PHY_LN_TIMING_CTRL_8_HS_RQST(rqst));
929 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_CFG0(lane_idx),
930 DSI_14nm_PHY_LN_CFG0_PREPARE_DLY(prep_dly));
931 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_CFG1(lane_idx),
932 halfbyte_en ? DSI_14nm_PHY_LN_CFG1_HALFBYTECLK_EN : 0);
933 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_9(lane_idx),
934 DSI_14nm_PHY_LN_TIMING_CTRL_9_TA_GO(timing->ta_go) |
935 DSI_14nm_PHY_LN_TIMING_CTRL_9_TA_SURE(timing->ta_sure));
936 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_10(lane_idx),
937 DSI_14nm_PHY_LN_TIMING_CTRL_10_TA_GET(timing->ta_get));
938 dsi_phy_write(base + REG_DSI_14nm_PHY_LN_TIMING_CTRL_11(lane_idx),
939 DSI_14nm_PHY_LN_TIMING_CTRL_11_TRIG3_CMD(0xa0));
942 static int dsi_14nm_phy_enable(struct msm_dsi_phy *phy,
943 struct msm_dsi_phy_clk_request *clk_req)
945 struct msm_dsi_dphy_timing *timing = &phy->timing;
949 void __iomem *base = phy->base;
950 void __iomem *lane_base = phy->lane_base;
953 if (msm_dsi_dphy_timing_calc_v2(timing, clk_req)) {
954 DRM_DEV_ERROR(&phy->pdev->dev,
955 "%s: D-PHY timing calculation failed\n", __func__);
960 if (phy->usecase != MSM_DSI_PHY_STANDALONE)
961 data |= DSI_14nm_PHY_CMN_LDO_CNTRL_VREG_CTRL(32);
962 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_LDO_CNTRL, data);
964 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_GLBL_TEST_CTRL, 0x1);
966 /* 4 data lanes + 1 clk lane configuration */
967 for (i = 0; i < 5; i++) {
968 dsi_phy_write(lane_base + REG_DSI_14nm_PHY_LN_VREG_CNTRL(i),
971 dsi_phy_write(lane_base +
972 REG_DSI_14nm_PHY_LN_STRENGTH_CTRL_0(i), 0xff);
973 dsi_phy_write(lane_base +
974 REG_DSI_14nm_PHY_LN_STRENGTH_CTRL_1(i),
975 (i == PHY_14NM_CKLN_IDX) ? 0x00 : 0x06);
977 dsi_phy_write(lane_base + REG_DSI_14nm_PHY_LN_CFG3(i),
978 (i == PHY_14NM_CKLN_IDX) ? 0x8f : 0x0f);
979 dsi_phy_write(lane_base + REG_DSI_14nm_PHY_LN_CFG2(i), 0x10);
980 dsi_phy_write(lane_base + REG_DSI_14nm_PHY_LN_TEST_DATAPATH(i),
982 dsi_phy_write(lane_base + REG_DSI_14nm_PHY_LN_TEST_STR(i),
985 dsi_14nm_dphy_set_timing(phy, timing, i);
988 /* Make sure PLL is not start */
989 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_PLL_CNTRL, 0x00);
991 wmb(); /* make sure everything is written before reset and enable */
993 /* reset digital block */
994 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_CTRL_1, 0x80);
995 wmb(); /* ensure reset is asserted */
997 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_CTRL_1, 0x00);
999 glbl_test_ctrl = dsi_phy_read(base + REG_DSI_14nm_PHY_CMN_GLBL_TEST_CTRL);
1000 if (phy->id == DSI_1 && phy->usecase == MSM_DSI_PHY_SLAVE)
1001 glbl_test_ctrl |= DSI_14nm_PHY_CMN_GLBL_TEST_CTRL_BITCLK_HS_SEL;
1003 glbl_test_ctrl &= ~DSI_14nm_PHY_CMN_GLBL_TEST_CTRL_BITCLK_HS_SEL;
1004 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_GLBL_TEST_CTRL, glbl_test_ctrl);
1005 ret = dsi_14nm_set_usecase(phy);
1007 DRM_DEV_ERROR(&phy->pdev->dev, "%s: set pll usecase failed, %d\n",
1012 /* Remove power down from PLL and all lanes */
1013 dsi_phy_write(base + REG_DSI_14nm_PHY_CMN_CTRL_0, 0xff);
1018 static void dsi_14nm_phy_disable(struct msm_dsi_phy *phy)
1020 dsi_phy_write(phy->base + REG_DSI_14nm_PHY_CMN_GLBL_TEST_CTRL, 0);
1021 dsi_phy_write(phy->base + REG_DSI_14nm_PHY_CMN_CTRL_0, 0);
1023 /* ensure that the phy is completely disabled */
1027 const struct msm_dsi_phy_cfg dsi_phy_14nm_cfgs = {
1028 .has_phy_lane = true,
1032 {"vcca", 17000, 32},
1036 .enable = dsi_14nm_phy_enable,
1037 .disable = dsi_14nm_phy_disable,
1038 .pll_init = dsi_pll_14nm_init,
1039 .save_pll_state = dsi_14nm_pll_save_state,
1040 .restore_pll_state = dsi_14nm_pll_restore_state,
1042 .min_pll_rate = VCO_MIN_RATE,
1043 .max_pll_rate = VCO_MAX_RATE,
1044 .io_start = { 0x994400, 0x996400 },
1048 const struct msm_dsi_phy_cfg dsi_phy_14nm_660_cfgs = {
1049 .has_phy_lane = true,
1053 {"vcca", 73400, 32},
1057 .enable = dsi_14nm_phy_enable,
1058 .disable = dsi_14nm_phy_disable,
1059 .pll_init = dsi_pll_14nm_init,
1060 .save_pll_state = dsi_14nm_pll_save_state,
1061 .restore_pll_state = dsi_14nm_pll_restore_state,
1063 .min_pll_rate = VCO_MIN_RATE,
1064 .max_pll_rate = VCO_MAX_RATE,
1065 .io_start = { 0xc994400, 0xc996000 },