clk: samsung: Add clock PLL support for ARTPEC-9 SoC

Add below clock PLL support for Axis ARTPEC-9 SoC platform:
- pll_a9fracm: Integer PLL with mid frequency FVCO (800 to 6400 MHz)
             This is used in ARTPEC-9 SoC for shared PLL

- pll_a9fraco: Integer/Fractional PLL with mid frequency FVCO
             (600 to 2400 MHz)
             This is used in ARTPEC-9 SoC for Audio PLL

FOUT calculation for pll_a9fracm and pll_a9fraco:
FOUT = (MDIV x FIN)/(PDIV x (SDIV + 1)) for integer PLL
FOUT = (((MDIV + (KDIV/2^24)) x FIN)/(PDIV x (SDIV + 1)) for fractional PLL

Signed-off-by: GyoungBo Min <mingyoungbo@coasia.com>
Reviewed-by: Kyunghwan Kim <kenkim@coasia.com>
Signed-off-by: Ravi Patel <ravi.patel@samsung.com>
Link: https://patch.msgid.link/20251029130731.51305-3-ravi.patel@samsung.com
Signed-off-by: Krzysztof Kozlowski <krzk@kernel.org>
This commit is contained in:
GyoungBo Min 2025-10-29 18:37:29 +05:30 committed by Krzysztof Kozlowski
parent 6974ae5aa2
commit f051dc5bc8
2 changed files with 194 additions and 8 deletions

View File

@ -201,6 +201,9 @@ static const struct clk_ops samsung_pll3000_clk_ops = {
#define PLL35XX_LOCK_STAT_SHIFT (29)
#define PLL35XX_ENABLE_SHIFT (31)
/* A9FRACM is similar to PLL35xx, except that MDIV is bit different */
#define PLLA9FRACM_MDIV_SHIFT (14)
static unsigned long samsung_pll35xx_recalc_rate(struct clk_hw *hw,
unsigned long parent_rate)
{
@ -209,7 +212,12 @@ static unsigned long samsung_pll35xx_recalc_rate(struct clk_hw *hw,
u64 fvco = parent_rate;
pll_con = readl_relaxed(pll->con_reg);
mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
if (pll->type == pll_a9fracm)
mdiv = (pll_con >> PLLA9FRACM_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
else
mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
pdiv = (pll_con >> PLL35XX_PDIV_SHIFT) & PLL35XX_PDIV_MASK;
sdiv = (pll_con >> PLL35XX_SDIV_SHIFT) & PLL35XX_SDIV_MASK;
@ -219,12 +227,15 @@ static unsigned long samsung_pll35xx_recalc_rate(struct clk_hw *hw,
return (unsigned long)fvco;
}
static inline bool samsung_pll35xx_mp_change(
const struct samsung_pll_rate_table *rate, u32 pll_con)
static inline bool samsung_pll35xx_mp_change(u32 pll_type,
const struct samsung_pll_rate_table *rate, u32 pll_con)
{
u32 old_mdiv, old_pdiv;
old_mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
if (pll_type == pll_a9fracm)
old_mdiv = (pll_con >> PLLA9FRACM_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
else
old_mdiv = (pll_con >> PLL35XX_MDIV_SHIFT) & PLL35XX_MDIV_MASK;
old_pdiv = (pll_con >> PLL35XX_PDIV_SHIFT) & PLL35XX_PDIV_MASK;
return (rate->mdiv != old_mdiv || rate->pdiv != old_pdiv);
@ -236,6 +247,12 @@ static int samsung_pll35xx_set_rate(struct clk_hw *hw, unsigned long drate,
struct samsung_clk_pll *pll = to_clk_pll(hw);
const struct samsung_pll_rate_table *rate;
u32 tmp;
u32 mdiv_shift;
if (pll->type == pll_a9fracm)
mdiv_shift = PLLA9FRACM_MDIV_SHIFT;
else
mdiv_shift = PLL35XX_MDIV_SHIFT;
/* Get required rate settings from table */
rate = samsung_get_pll_settings(pll, drate);
@ -247,7 +264,7 @@ static int samsung_pll35xx_set_rate(struct clk_hw *hw, unsigned long drate,
tmp = readl_relaxed(pll->con_reg);
if (!(samsung_pll35xx_mp_change(rate, tmp))) {
if (!(samsung_pll35xx_mp_change(pll->type, rate, tmp))) {
/* If only s change, change just s value only*/
tmp &= ~(PLL35XX_SDIV_MASK << PLL35XX_SDIV_SHIFT);
tmp |= rate->sdiv << PLL35XX_SDIV_SHIFT;
@ -257,7 +274,7 @@ static int samsung_pll35xx_set_rate(struct clk_hw *hw, unsigned long drate,
}
/* Set PLL lock time. */
if (pll->type == pll_142xx || pll->type == pll_1017x)
if (pll->type == pll_142xx || pll->type == pll_1017x || pll->type == pll_a9fracm)
writel_relaxed(rate->pdiv * PLL142XX_LOCK_FACTOR,
pll->lock_reg);
else
@ -265,10 +282,10 @@ static int samsung_pll35xx_set_rate(struct clk_hw *hw, unsigned long drate,
pll->lock_reg);
/* Change PLL PMS values */
tmp &= ~((PLL35XX_MDIV_MASK << PLL35XX_MDIV_SHIFT) |
tmp &= ~((PLL35XX_MDIV_MASK << mdiv_shift) |
(PLL35XX_PDIV_MASK << PLL35XX_PDIV_SHIFT) |
(PLL35XX_SDIV_MASK << PLL35XX_SDIV_SHIFT));
tmp |= (rate->mdiv << PLL35XX_MDIV_SHIFT) |
tmp |= (rate->mdiv << mdiv_shift) |
(rate->pdiv << PLL35XX_PDIV_SHIFT) |
(rate->sdiv << PLL35XX_SDIV_SHIFT);
writel_relaxed(tmp, pll->con_reg);
@ -1428,6 +1445,149 @@ static const struct clk_ops samsung_pll1031x_clk_min_ops = {
.recalc_rate = samsung_pll1031x_recalc_rate,
};
/*
* PLLA9FRACO Clock Type
*/
#define PLLA9FRACO_LOCK_FACTOR (500)
#define PLLA9FRACO_MDIV_MASK (0x3ff)
#define PLLA9FRACO_PDIV_MASK (0x3f)
#define PLLA9FRACO_SDIV_MASK (0x7)
#define PLLA9FRACO_MDIV_SHIFT (14)
#define PLLA9FRACO_PDIV_SHIFT (8)
#define PLLA9FRACO_SDIV_SHIFT (0)
#define PLLA9FRACO_PLL_CON5_DIV_FRAC (0x14)
#define PLLA9FRACO_KDIV_MASK (0xffffff)
#define PLLA9FRACO_KDIV_SHIFT (0)
#define PLLA9FRACO_DAC_MODE BIT(30)
#define PLLA9FRACO_DSM_EN BIT(31)
#define PLLA9FRACO_FOUTPOSTDIVEN BIT(3)
#define PLLA9FRACO_MUX_SEL BIT(4)
#define PLLA9FRACO_ENABLE_SHIFT (31)
#define PLLA9FRACO_LOCK_STAT_SHIFT (29)
static unsigned long samsung_a9fraco_recalc_rate(struct clk_hw *hw,
unsigned long parent_rate)
{
struct samsung_clk_pll *pll = to_clk_pll(hw);
u32 pll_con0, pll_con5;
u64 mdiv, pdiv, sdiv, kdiv;
u64 fvco = parent_rate;
pll_con0 = readl_relaxed(pll->con_reg);
pll_con5 = readl_relaxed(pll->con_reg + PLLA9FRACO_PLL_CON5_DIV_FRAC);
mdiv = (pll_con0 >> PLLA9FRACO_MDIV_SHIFT) & PLLA9FRACO_MDIV_MASK;
pdiv = (pll_con0 >> PLLA9FRACO_PDIV_SHIFT) & PLLA9FRACO_PDIV_MASK;
sdiv = (pll_con0 >> PLLA9FRACO_SDIV_SHIFT) & PLLA9FRACO_SDIV_MASK;
kdiv = (pll_con5 & PLLA9FRACO_KDIV_MASK);
/* fvco = fref * (M + K/2^24) / p * (S+1) */
fvco *= mdiv;
fvco = (fvco << 24) + kdiv;
do_div(fvco, ((pdiv * (sdiv + 1)) << 24));
return (unsigned long)fvco;
}
static bool samsung_a9fraco_mpk_change(u32 pll_con0, u32 pll_con5,
const struct samsung_pll_rate_table *rate)
{
u32 old_mdiv, old_pdiv, old_kdiv;
old_mdiv = (pll_con0 >> PLLA9FRACO_MDIV_SHIFT) & PLLA9FRACO_MDIV_MASK;
old_pdiv = (pll_con0 >> PLLA9FRACO_PDIV_SHIFT) & PLLA9FRACO_PDIV_MASK;
old_kdiv = (pll_con5 >> PLLA9FRACO_KDIV_SHIFT) & PLLA9FRACO_KDIV_MASK;
return (old_mdiv != rate->mdiv || old_pdiv != rate->pdiv || old_kdiv != rate->kdiv);
}
static int samsung_a9fraco_set_rate(struct clk_hw *hw, unsigned long drate, unsigned long prate)
{
struct samsung_clk_pll *pll = to_clk_pll(hw);
const struct samsung_pll_rate_table *rate;
u32 con0, con5;
int ret;
/* Get required rate settings from table */
rate = samsung_get_pll_settings(pll, drate);
if (!rate) {
pr_err("%s: Invalid rate : %lu for pll clk %s\n", __func__,
drate, clk_hw_get_name(hw));
return -EINVAL;
}
con0 = readl_relaxed(pll->con_reg);
con5 = readl_relaxed(pll->con_reg + PLLA9FRACO_PLL_CON5_DIV_FRAC);
if (!(samsung_a9fraco_mpk_change(con0, con5, rate))) {
/* If only s change, change just s value only */
con0 &= ~(PLLA9FRACO_SDIV_MASK << PLLA9FRACO_SDIV_SHIFT);
con0 |= rate->sdiv << PLLA9FRACO_SDIV_SHIFT;
writel_relaxed(con0, pll->con_reg);
return 0;
}
/* Select OSCCLK (0) */
con0 = readl_relaxed(pll->con_reg);
con0 &= ~(PLLA9FRACO_MUX_SEL);
writel_relaxed(con0, pll->con_reg);
/* Disable PLL */
con0 &= ~BIT(PLLA9FRACO_ENABLE_SHIFT);
writel_relaxed(con0, pll->con_reg);
/* Set PLL lock time. */
writel_relaxed(rate->pdiv * PLLA9FRACO_LOCK_FACTOR, pll->lock_reg);
/* Set PLL M, P, and S values. */
con0 &= ~((PLLA9FRACO_MDIV_MASK << PLLA9FRACO_MDIV_SHIFT) |
(PLLA9FRACO_PDIV_MASK << PLLA9FRACO_PDIV_SHIFT) |
(PLLA9FRACO_SDIV_MASK << PLLA9FRACO_SDIV_SHIFT));
/* The field FOUTPOSTDIVEN should always be 1, else FOUT might be 0 Hz. */
con0 |= (rate->mdiv << PLLA9FRACO_MDIV_SHIFT) |
(rate->pdiv << PLLA9FRACO_PDIV_SHIFT) |
(rate->sdiv << PLLA9FRACO_SDIV_SHIFT) | (PLLA9FRACO_FOUTPOSTDIVEN);
/* Set PLL K, DSM_EN and DAC_MODE values. */
con5 = readl_relaxed(pll->con_reg + PLLA9FRACO_PLL_CON5_DIV_FRAC);
con5 &= ~((PLLA9FRACO_KDIV_MASK << PLLA9FRACO_KDIV_SHIFT) |
PLLA9FRACO_DSM_EN | PLLA9FRACO_DAC_MODE);
con5 |= (rate->kdiv << PLLA9FRACO_KDIV_SHIFT) | PLLA9FRACO_DSM_EN | PLLA9FRACO_DAC_MODE;
/* Write configuration to PLL */
writel_relaxed(con0, pll->con_reg);
writel_relaxed(con5, pll->con_reg + PLLA9FRACO_PLL_CON5_DIV_FRAC);
/* Enable PLL */
con0 = readl_relaxed(pll->con_reg);
con0 |= BIT(PLLA9FRACO_ENABLE_SHIFT);
writel_relaxed(con0, pll->con_reg);
/* Wait for PLL lock if the PLL is enabled */
ret = samsung_pll_lock_wait(pll, BIT(pll->lock_offs));
if (ret < 0)
return ret;
/* Select FOUT (1) */
con0 |= (PLLA9FRACO_MUX_SEL);
writel_relaxed(con0, pll->con_reg);
return 0;
}
static const struct clk_ops samsung_a9fraco_clk_ops = {
.recalc_rate = samsung_a9fraco_recalc_rate,
.determine_rate = samsung_pll_determine_rate,
.set_rate = samsung_a9fraco_set_rate,
};
static const struct clk_ops samsung_a9fraco_clk_min_ops = {
.recalc_rate = samsung_a9fraco_recalc_rate,
};
static void __init _samsung_clk_register_pll(struct samsung_clk_provider *ctx,
const struct samsung_pll_clock *pll_clk)
{
@ -1477,6 +1637,7 @@ static void __init _samsung_clk_register_pll(struct samsung_clk_provider *ctx,
case pll_1452x:
case pll_142xx:
case pll_1017x:
case pll_a9fracm:
pll->enable_offs = PLL35XX_ENABLE_SHIFT;
pll->lock_offs = PLL35XX_LOCK_STAT_SHIFT;
if (!pll->rate_table)
@ -1578,6 +1739,14 @@ static void __init _samsung_clk_register_pll(struct samsung_clk_provider *ctx,
else
init.ops = &samsung_pll1031x_clk_ops;
break;
case pll_a9fraco:
pll->enable_offs = PLLA9FRACO_ENABLE_SHIFT;
pll->lock_offs = PLLA9FRACO_LOCK_STAT_SHIFT;
if (!pll->rate_table)
init.ops = &samsung_a9fraco_clk_min_ops;
else
init.ops = &samsung_a9fraco_clk_ops;
break;
default:
pr_warn("%s: Unknown pll type for pll clk %s\n",
__func__, pll_clk->name);

View File

@ -51,6 +51,8 @@ enum samsung_pll_type {
pll_4311,
pll_1017x,
pll_1031x,
pll_a9fracm,
pll_a9fraco,
};
#define PLL_RATE(_fin, _m, _p, _s, _k, _ks) \
@ -58,6 +60,11 @@ enum samsung_pll_type {
#define PLL_VALID_RATE(_fin, _fout, _m, _p, _s, _k, _ks) ((_fout) + \
BUILD_BUG_ON_ZERO(PLL_RATE(_fin, _m, _p, _s, _k, _ks) != (_fout)))
#define PLL_FRACO_RATE(_fin, _m, _p, _s, _k, _ks) \
((u64)(_fin) * (BIT(_ks) * (_m) + (_k)) / BIT(_ks) / ((_p) * ((_s) + 1)))
#define PLL_FRACO_VALID_RATE(_fin, _fout, _m, _p, _s, _k, _ks) ((_fout) + \
BUILD_BUG_ON_ZERO(PLL_FRACO_RATE(_fin, _m, _p, _s, _k, _ks) != (_fout)))
#define PLL_35XX_RATE(_fin, _rate, _m, _p, _s) \
{ \
.rate = PLL_VALID_RATE(_fin, _rate, \
@ -111,6 +118,16 @@ enum samsung_pll_type {
.vsel = (_vsel), \
}
#define PLL_A9FRACO_RATE(_fin, _rate, _m, _p, _s, _k) \
{ \
.rate = PLL_FRACO_VALID_RATE(_fin, _rate, \
_m, _p, _s, _k, 24), \
.mdiv = (_m), \
.pdiv = (_p), \
.sdiv = (_s), \
.kdiv = (_k), \
}
/* NOTE: Rate table should be kept sorted in descending order. */
struct samsung_pll_rate_table {