Commit 9d9cc58a authored by 周琰杰 (Zhou Yanjie)'s avatar 周琰杰 (Zhou Yanjie) Committed by Stephen Boyd

clk: Ingenic: Adjust cgu code to make it compatible with X1830.

The PLL of X1830 Soc from Ingenic has been greatly changed,
the bypass control is placed in another register, so now two
registers may needed to control the PLL. To this end, a new
"bypass_reg" was introduced. In addition, when calculating
rate, the PLL of X1830 introduced an extra 2x multiplier,
so a new "rate_multiplier" was introduced. And adjust the
code in jz47xx-cgu.c and x1000-cgu.c, make it to be
compatible with the new cgu code.
Signed-off-by: default avatar周琰杰 (Zhou Yanjie) <zhouyanjie@wanyeetech.com>
Reviewed-by: default avatarPaul Cercueil <paul@crapouillou.net>
Link: https://lkml.kernel.org/r/20200528031549.13846-3-zhouyanjie@wanyeetech.comSigned-off-by: default avatarStephen Boyd <sboyd@kernel.org>
parent 15e3ae36
...@@ -90,6 +90,9 @@ ingenic_pll_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) ...@@ -90,6 +90,9 @@ ingenic_pll_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
n += pll_info->n_offset; n += pll_info->n_offset;
od_enc = ctl >> pll_info->od_shift; od_enc = ctl >> pll_info->od_shift;
od_enc &= GENMASK(pll_info->od_bits - 1, 0); od_enc &= GENMASK(pll_info->od_bits - 1, 0);
ctl = readl(cgu->base + pll_info->bypass_reg);
bypass = !pll_info->no_bypass_bit && bypass = !pll_info->no_bypass_bit &&
!!(ctl & BIT(pll_info->bypass_bit)); !!(ctl & BIT(pll_info->bypass_bit));
...@@ -103,7 +106,8 @@ ingenic_pll_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) ...@@ -103,7 +106,8 @@ ingenic_pll_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
BUG_ON(od == pll_info->od_max); BUG_ON(od == pll_info->od_max);
od++; od++;
return div_u64((u64)parent_rate * m, n * od); return div_u64((u64)parent_rate * m * pll_info->rate_multiplier,
n * od);
} }
static unsigned long static unsigned long
...@@ -136,7 +140,8 @@ ingenic_pll_calc(const struct ingenic_cgu_clk_info *clk_info, ...@@ -136,7 +140,8 @@ ingenic_pll_calc(const struct ingenic_cgu_clk_info *clk_info,
if (pod) if (pod)
*pod = od; *pod = od;
return div_u64((u64)parent_rate * m, n * od); return div_u64((u64)parent_rate * m * pll_info->rate_multiplier,
n * od);
} }
static inline const struct ingenic_cgu_clk_info *to_clk_info( static inline const struct ingenic_cgu_clk_info *to_clk_info(
...@@ -209,9 +214,14 @@ static int ingenic_pll_enable(struct clk_hw *hw) ...@@ -209,9 +214,14 @@ static int ingenic_pll_enable(struct clk_hw *hw)
u32 ctl; u32 ctl;
spin_lock_irqsave(&cgu->lock, flags); spin_lock_irqsave(&cgu->lock, flags);
ctl = readl(cgu->base + pll_info->reg); ctl = readl(cgu->base + pll_info->bypass_reg);
ctl &= ~BIT(pll_info->bypass_bit); ctl &= ~BIT(pll_info->bypass_bit);
writel(ctl, cgu->base + pll_info->bypass_reg);
ctl = readl(cgu->base + pll_info->reg);
ctl |= BIT(pll_info->enable_bit); ctl |= BIT(pll_info->enable_bit);
writel(ctl, cgu->base + pll_info->reg); writel(ctl, cgu->base + pll_info->reg);
......
...@@ -17,6 +17,7 @@ ...@@ -17,6 +17,7 @@
/** /**
* struct ingenic_cgu_pll_info - information about a PLL * struct ingenic_cgu_pll_info - information about a PLL
* @reg: the offset of the PLL's control register within the CGU * @reg: the offset of the PLL's control register within the CGU
* @rate_multiplier: the multiplier needed by pll rate calculation
* @m_shift: the number of bits to shift the multiplier value by (ie. the * @m_shift: the number of bits to shift the multiplier value by (ie. the
* index of the lowest bit of the multiplier value in the PLL's * index of the lowest bit of the multiplier value in the PLL's
* control register) * control register)
...@@ -37,6 +38,7 @@ ...@@ -37,6 +38,7 @@
* @od_encoding: a pointer to an array mapping post-VCO divider values to * @od_encoding: a pointer to an array mapping post-VCO divider values to
* their encoded values in the PLL control register, or -1 for * their encoded values in the PLL control register, or -1 for
* unsupported values * unsupported values
* @bypass_reg: the offset of the bypass control register within the CGU
* @bypass_bit: the index of the bypass bit in the PLL control register * @bypass_bit: the index of the bypass bit in the PLL control register
* @enable_bit: the index of the enable bit in the PLL control register * @enable_bit: the index of the enable bit in the PLL control register
* @stable_bit: the index of the stable bit in the PLL control register * @stable_bit: the index of the stable bit in the PLL control register
...@@ -44,10 +46,12 @@ ...@@ -44,10 +46,12 @@
*/ */
struct ingenic_cgu_pll_info { struct ingenic_cgu_pll_info {
unsigned reg; unsigned reg;
unsigned rate_multiplier;
const s8 *od_encoding; const s8 *od_encoding;
u8 m_shift, m_bits, m_offset; u8 m_shift, m_bits, m_offset;
u8 n_shift, n_bits, n_offset; u8 n_shift, n_bits, n_offset;
u8 od_shift, od_bits, od_max; u8 od_shift, od_bits, od_max;
unsigned bypass_reg;
u8 bypass_bit; u8 bypass_bit;
u8 enable_bit; u8 enable_bit;
u8 stable_bit; u8 stable_bit;
......
...@@ -9,7 +9,9 @@ ...@@ -9,7 +9,9 @@
#include <linux/clk-provider.h> #include <linux/clk-provider.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/of.h> #include <linux/of.h>
#include <dt-bindings/clock/jz4725b-cgu.h> #include <dt-bindings/clock/jz4725b-cgu.h>
#include "cgu.h" #include "cgu.h"
#include "pm.h" #include "pm.h"
...@@ -54,6 +56,7 @@ static const struct ingenic_cgu_clk_info jz4725b_cgu_clocks[] = { ...@@ -54,6 +56,7 @@ static const struct ingenic_cgu_clk_info jz4725b_cgu_clocks[] = {
.parents = { JZ4725B_CLK_EXT, -1, -1, -1 }, .parents = { JZ4725B_CLK_EXT, -1, -1, -1 },
.pll = { .pll = {
.reg = CGU_REG_CPPCR, .reg = CGU_REG_CPPCR,
.rate_multiplier = 1,
.m_shift = 23, .m_shift = 23,
.m_bits = 9, .m_bits = 9,
.m_offset = 2, .m_offset = 2,
...@@ -65,6 +68,7 @@ static const struct ingenic_cgu_clk_info jz4725b_cgu_clocks[] = { ...@@ -65,6 +68,7 @@ static const struct ingenic_cgu_clk_info jz4725b_cgu_clocks[] = {
.od_max = 4, .od_max = 4,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.stable_bit = 10, .stable_bit = 10,
.bypass_reg = CGU_REG_CPPCR,
.bypass_bit = 9, .bypass_bit = 9,
.enable_bit = 8, .enable_bit = 8,
}, },
......
...@@ -10,7 +10,9 @@ ...@@ -10,7 +10,9 @@
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/of.h> #include <linux/of.h>
#include <dt-bindings/clock/jz4740-cgu.h> #include <dt-bindings/clock/jz4740-cgu.h>
#include "cgu.h" #include "cgu.h"
#include "pm.h" #include "pm.h"
...@@ -69,6 +71,7 @@ static const struct ingenic_cgu_clk_info jz4740_cgu_clocks[] = { ...@@ -69,6 +71,7 @@ static const struct ingenic_cgu_clk_info jz4740_cgu_clocks[] = {
.parents = { JZ4740_CLK_EXT, -1, -1, -1 }, .parents = { JZ4740_CLK_EXT, -1, -1, -1 },
.pll = { .pll = {
.reg = CGU_REG_CPPCR, .reg = CGU_REG_CPPCR,
.rate_multiplier = 1,
.m_shift = 23, .m_shift = 23,
.m_bits = 9, .m_bits = 9,
.m_offset = 2, .m_offset = 2,
...@@ -80,6 +83,7 @@ static const struct ingenic_cgu_clk_info jz4740_cgu_clocks[] = { ...@@ -80,6 +83,7 @@ static const struct ingenic_cgu_clk_info jz4740_cgu_clocks[] = {
.od_max = 4, .od_max = 4,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.stable_bit = 10, .stable_bit = 10,
.bypass_reg = CGU_REG_CPPCR,
.bypass_bit = 9, .bypass_bit = 9,
.enable_bit = 8, .enable_bit = 8,
}, },
......
...@@ -9,7 +9,9 @@ ...@@ -9,7 +9,9 @@
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/io.h> #include <linux/io.h>
#include <linux/of.h> #include <linux/of.h>
#include <dt-bindings/clock/jz4770-cgu.h> #include <dt-bindings/clock/jz4770-cgu.h>
#include "cgu.h" #include "cgu.h"
#include "pm.h" #include "pm.h"
...@@ -102,6 +104,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = { ...@@ -102,6 +104,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = {
.parents = { JZ4770_CLK_EXT }, .parents = { JZ4770_CLK_EXT },
.pll = { .pll = {
.reg = CGU_REG_CPPCR0, .reg = CGU_REG_CPPCR0,
.rate_multiplier = 1,
.m_shift = 24, .m_shift = 24,
.m_bits = 7, .m_bits = 7,
.m_offset = 1, .m_offset = 1,
...@@ -112,6 +115,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = { ...@@ -112,6 +115,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = {
.od_bits = 2, .od_bits = 2,
.od_max = 8, .od_max = 8,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.bypass_reg = CGU_REG_CPPCR0,
.bypass_bit = 9, .bypass_bit = 9,
.enable_bit = 8, .enable_bit = 8,
.stable_bit = 10, .stable_bit = 10,
...@@ -124,6 +128,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = { ...@@ -124,6 +128,7 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = {
.parents = { JZ4770_CLK_EXT }, .parents = { JZ4770_CLK_EXT },
.pll = { .pll = {
.reg = CGU_REG_CPPCR1, .reg = CGU_REG_CPPCR1,
.rate_multiplier = 1,
.m_shift = 24, .m_shift = 24,
.m_bits = 7, .m_bits = 7,
.m_offset = 1, .m_offset = 1,
...@@ -134,9 +139,10 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = { ...@@ -134,9 +139,10 @@ static const struct ingenic_cgu_clk_info jz4770_cgu_clocks[] = {
.od_bits = 2, .od_bits = 2,
.od_max = 8, .od_max = 8,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.bypass_reg = CGU_REG_CPPCR1,
.no_bypass_bit = true,
.enable_bit = 7, .enable_bit = 7,
.stable_bit = 6, .stable_bit = 6,
.no_bypass_bit = true,
}, },
}, },
......
...@@ -13,6 +13,7 @@ ...@@ -13,6 +13,7 @@
#include <linux/of.h> #include <linux/of.h>
#include <dt-bindings/clock/jz4780-cgu.h> #include <dt-bindings/clock/jz4780-cgu.h>
#include "cgu.h" #include "cgu.h"
#include "pm.h" #include "pm.h"
...@@ -266,6 +267,7 @@ static const struct ingenic_cgu_clk_info jz4780_cgu_clocks[] = { ...@@ -266,6 +267,7 @@ static const struct ingenic_cgu_clk_info jz4780_cgu_clocks[] = {
#define DEF_PLL(name) { \ #define DEF_PLL(name) { \
.reg = CGU_REG_ ## name, \ .reg = CGU_REG_ ## name, \
.rate_multiplier = 1, \
.m_shift = 19, \ .m_shift = 19, \
.m_bits = 13, \ .m_bits = 13, \
.m_offset = 1, \ .m_offset = 1, \
...@@ -277,6 +279,7 @@ static const struct ingenic_cgu_clk_info jz4780_cgu_clocks[] = { ...@@ -277,6 +279,7 @@ static const struct ingenic_cgu_clk_info jz4780_cgu_clocks[] = {
.od_max = 16, \ .od_max = 16, \
.od_encoding = pll_od_encoding, \ .od_encoding = pll_od_encoding, \
.stable_bit = 6, \ .stable_bit = 6, \
.bypass_reg = CGU_REG_ ## name, \
.bypass_bit = 1, \ .bypass_bit = 1, \
.enable_bit = 0, \ .enable_bit = 0, \
} }
......
...@@ -7,7 +7,9 @@ ...@@ -7,7 +7,9 @@
#include <linux/clk-provider.h> #include <linux/clk-provider.h>
#include <linux/delay.h> #include <linux/delay.h>
#include <linux/of.h> #include <linux/of.h>
#include <dt-bindings/clock/x1000-cgu.h> #include <dt-bindings/clock/x1000-cgu.h>
#include "cgu.h" #include "cgu.h"
#include "pm.h" #include "pm.h"
...@@ -58,6 +60,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = { ...@@ -58,6 +60,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = {
.parents = { X1000_CLK_EXCLK, -1, -1, -1 }, .parents = { X1000_CLK_EXCLK, -1, -1, -1 },
.pll = { .pll = {
.reg = CGU_REG_APLL, .reg = CGU_REG_APLL,
.rate_multiplier = 1,
.m_shift = 24, .m_shift = 24,
.m_bits = 7, .m_bits = 7,
.m_offset = 1, .m_offset = 1,
...@@ -68,6 +71,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = { ...@@ -68,6 +71,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = {
.od_bits = 2, .od_bits = 2,
.od_max = 8, .od_max = 8,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.bypass_reg = CGU_REG_APLL,
.bypass_bit = 9, .bypass_bit = 9,
.enable_bit = 8, .enable_bit = 8,
.stable_bit = 10, .stable_bit = 10,
...@@ -79,6 +83,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = { ...@@ -79,6 +83,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = {
.parents = { X1000_CLK_EXCLK, -1, -1, -1 }, .parents = { X1000_CLK_EXCLK, -1, -1, -1 },
.pll = { .pll = {
.reg = CGU_REG_MPLL, .reg = CGU_REG_MPLL,
.rate_multiplier = 1,
.m_shift = 24, .m_shift = 24,
.m_bits = 7, .m_bits = 7,
.m_offset = 1, .m_offset = 1,
...@@ -89,6 +94,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = { ...@@ -89,6 +94,7 @@ static const struct ingenic_cgu_clk_info x1000_cgu_clocks[] = {
.od_bits = 2, .od_bits = 2,
.od_max = 8, .od_max = 8,
.od_encoding = pll_od_encoding, .od_encoding = pll_od_encoding,
.bypass_reg = CGU_REG_MPLL,
.bypass_bit = 6, .bypass_bit = 6,
.enable_bit = 7, .enable_bit = 7,
.stable_bit = 0, .stable_bit = 0,
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment