On 25-01-21, 11:18, Bjorn Andersson wrote:
> On Sun 17 Jan 22:43 CST 2021, Vinod Koul wrote:
> 
> > From: Vivek Aknurwar <viv...@codeaurora.org>
> > 
> > Lucid 5LPE is a slightly different Lucid PLL with different offsets and
> > porgramming sequence so add support for these
> > 
> > Signed-off-by: Vivek Aknurwar <viv...@codeaurora.org>
> > Signed-off-by: Jeevan Shriram <jshri...@codeaurora.org>
> > [vkoul: rebase and tidy up for upstream]
> > Signed-off-by: Vinod Koul <vk...@kernel.org>
> > ---
> >  drivers/clk/qcom/clk-alpha-pll.c | 173 +++++++++++++++++++++++++++++++
> >  drivers/clk/qcom/clk-alpha-pll.h |   4 +
> >  2 files changed, 177 insertions(+)
> > 
> > diff --git a/drivers/clk/qcom/clk-alpha-pll.c 
> > b/drivers/clk/qcom/clk-alpha-pll.c
> > index a30ea7b09224..f9c48da21bd1 100644
> > --- a/drivers/clk/qcom/clk-alpha-pll.c
> > +++ b/drivers/clk/qcom/clk-alpha-pll.c
> > @@ -156,6 +156,12 @@ EXPORT_SYMBOL_GPL(clk_alpha_pll_regs);
> >  /* LUCID PLL specific settings and offsets */
> >  #define LUCID_PCAL_DONE            BIT(27)
> >  
> > +/* LUCID 5LPE PLL specific settings and offsets */
> > +#define LUCID_5LPE_PCAL_DONE               BIT(11)
> > +#define LUCID_5LPE_ALPHA_PLL_ACK_LATCH     BIT(13)
> > +#define LUCID_5LPE_PLL_LATCH_INPUT BIT(14)
> > +#define LUCID_5LPE_ENABLE_VOTE_RUN BIT(21)
> > +
> >  #define pll_alpha_width(p)                                 \
> >             ((PLL_ALPHA_VAL_U(p) - PLL_ALPHA_VAL(p) == 4) ? \
> >                              ALPHA_REG_BITWIDTH : ALPHA_REG_16BIT_WIDTH)
> > @@ -1604,3 +1610,170 @@ const struct clk_ops clk_alpha_pll_agera_ops = {
> >     .set_rate = clk_alpha_pll_agera_set_rate,
> >  };
> >  EXPORT_SYMBOL_GPL(clk_alpha_pll_agera_ops);
> > +
> > +static int alpha_pll_lucid_5lpe_enable(struct clk_hw *hw)
> > +{
> > +   struct clk_alpha_pll *pll = to_clk_alpha_pll(hw);
> > +   u32 val;
> > +   int ret;
> > +
> > +   ret = regmap_read(pll->clkr.regmap, PLL_USER_CTL(pll), &val);
> > +   if (ret)
> > +           return ret;
> > +
> > +   /* If in FSM mode, just vote for it */
> > +   if (val & LUCID_5LPE_ENABLE_VOTE_RUN) {
> > +           ret = clk_enable_regmap(hw);
> > +           if (ret)
> > +                   return ret;
> > +           return wait_for_pll_enable_lock(pll);
> > +   }
> > +
> > +   /* Check if PLL is already enabled, return if enabled */
> > +   ret = trion_pll_is_enabled(pll, pll->clkr.regmap);
> > +   if (ret < 0)
> > +           return ret;
> > +
> > +   ret = regmap_update_bits(pll->clkr.regmap, PLL_MODE(pll), PLL_RESET_N, 
> > PLL_RESET_N);
> > +   if (ret)
> > +           return ret;
> > +
> > +   regmap_write(pll->clkr.regmap, PLL_OPMODE(pll), PLL_RUN);
> > +
> > +   ret = wait_for_pll_enable_lock(pll);
> > +   if (ret)
> > +           return ret;
> > +
> > +   /* Enable the PLL outputs */
> > +   ret = regmap_update_bits(pll->clkr.regmap, PLL_USER_CTL(pll), 
> > PLL_OUT_MASK, PLL_OUT_MASK);
> > +   if (ret)
> > +           return ret;
> > +
> > +   /* Enable the global PLL outputs */
> > +   return regmap_update_bits(pll->clkr.regmap, PLL_MODE(pll), PLL_OUTCTRL, 
> > PLL_OUTCTRL);
> > +}
> > +
> > +static void alpha_pll_lucid_5lpe_disable(struct clk_hw *hw)
> > +{
> > +   struct clk_alpha_pll *pll = to_clk_alpha_pll(hw);
> > +   u32 val;
> > +   int ret;
> > +
> > +   ret = regmap_read(pll->clkr.regmap, PLL_USER_CTL(pll), &val);
> > +   if (ret)
> > +           return;
> > +
> > +   /* If in FSM mode, just unvote it */
> > +   if (val & LUCID_5LPE_ENABLE_VOTE_RUN) {
> > +           clk_disable_regmap(hw);
> > +           return;
> > +   }
> > +
> > +   /* Disable the global PLL output */
> > +   ret = regmap_update_bits(pll->clkr.regmap, PLL_MODE(pll), PLL_OUTCTRL, 
> > 0);
> > +   if (ret)
> > +           return;
> > +
> > +   /* Disable the PLL outputs */
> > +   ret = regmap_update_bits(pll->clkr.regmap, PLL_USER_CTL(pll), 
> > PLL_OUT_MASK, 0);
> > +   if (ret)
> > +           return;
> > +
> > +   /* Place the PLL mode in STANDBY */
> > +   regmap_write(pll->clkr.regmap, PLL_OPMODE(pll), PLL_STANDBY);
> > +}
> > +
> > +/*
> > + * The Lucid 5LPE PLL requires a power-on self-calibration which happens
> > + * when the PLL comes out of reset. Calibrate in case it is not completed.
> > + */
> > +static int alpha_pll_lucid_5lpe_prepare(struct clk_hw *hw)
> > +{
> > +   struct clk_alpha_pll *pll = to_clk_alpha_pll(hw);
> > +   struct clk_hw *p;
> > +   u32 val;
> > +   int ret;
> > +
> > +   /* Return early if calibration is not needed. */
> > +   regmap_read(pll->clkr.regmap, PLL_MODE(pll), &val);
> 
> I doubt this will ever fail, but static analysis tools would complain
> about val possibly being uninitialized after this.
> 
> And the return value is checked in the other functions.

Yes agreed, will update this. Somehow I dont this my checked W=1
complained about this, maybe some others would..

-- 
~Vinod

Reply via email to