Commit 6435c499 authored by Stephen Boyd's avatar Stephen Boyd

Merge tag 'renesas-clk-for-v5.14-tag1' of...

Merge tag 'renesas-clk-for-v5.14-tag1' of git://git.kernel.org/pub/scm/linux/kernel/git/geert/renesas-drivers into clk-renesas

Pull Renesas clk driver updates from Geert Uytterhoeven:

 - Add support for CPU core clock boost modes on R-Car Gen3
 - Add ISPCS (Image Signal Processor) clocks on R-Car V3U
 - Switch SH/R-Mobile and R-Car "DIV6" clocks to .determine_rate()
   and improve support for multiple parents
 - Switch RZ/N1 divider clocks to .determine_rate()
 - Add ZA2 (Audio Clock Generator) clock on R-Car D3
 - Minor fixes and improvements

* tag 'renesas-clk-for-v5.14-tag1' of git://git.kernel.org/pub/scm/linux/kernel/git/geert/renesas-drivers:
  clk: renesas: r8a77995: Add ZA2 clock
  clk: renesas: cpg-mssr: Make srstclr[] comment block consistent
  clk: renesas: cpg-mssr: Remove unused [RM]MSTPCR() definitions
  clk: renesas: r9a06g032: Switch to .determine_rate()
  clk: renesas: div6: Implement range checking
  clk: renesas: div6: Consider all parents for requested rate
  clk: renesas: div6: Switch to .determine_rate()
  clk: renesas: div6: Simplify src mask handling
  clk: renesas: div6: Use clamp() instead of clamp_t()
  clk: renesas: rcar-usb2-clock-sel: Fix error handling in .probe()
  clk: renesas: r8a779a0: Add ISPCS clocks
  clk: renesas: rcar-gen3: Add boost support to Z clocks
  clk: renesas: rcar-gen3: Add custom clock for PLLs
  clk: renesas: rcar-gen3: Increase Z clock accuracy
  clk: renesas: rcar-gen3: Grammar s/dependent of/dependent on/
  clk: renesas: rcar-gen3: Remove superfluous masking in cpg_z_clk_set_rate()
  clk: renesas: rcar-gen3: Make cpg_z_clk.mask u32
  clk: renesas: rcar-gen3: Update Z clock rate formula in comments
parents 6efb943b 790c06cc
...@@ -28,8 +28,7 @@ ...@@ -28,8 +28,7 @@
* @hw: handle between common and hardware-specific interfaces * @hw: handle between common and hardware-specific interfaces
* @reg: IO-remapped register * @reg: IO-remapped register
* @div: divisor value (1-64) * @div: divisor value (1-64)
* @src_shift: Shift to access the register bits to select the parent clock * @src_mask: Bitmask covering the register bits to select the parent clock
* @src_width: Number of register bits to select the parent clock (may be 0)
* @nb: Notifier block to save/restore clock state for system resume * @nb: Notifier block to save/restore clock state for system resume
* @parents: Array to map from valid parent clocks indices to hardware indices * @parents: Array to map from valid parent clocks indices to hardware indices
*/ */
...@@ -37,8 +36,7 @@ struct div6_clock { ...@@ -37,8 +36,7 @@ struct div6_clock {
struct clk_hw hw; struct clk_hw hw;
void __iomem *reg; void __iomem *reg;
unsigned int div; unsigned int div;
u32 src_shift; u32 src_mask;
u32 src_width;
struct notifier_block nb; struct notifier_block nb;
u8 parents[]; u8 parents[];
}; };
...@@ -99,15 +97,52 @@ static unsigned int cpg_div6_clock_calc_div(unsigned long rate, ...@@ -99,15 +97,52 @@ static unsigned int cpg_div6_clock_calc_div(unsigned long rate,
rate = 1; rate = 1;
div = DIV_ROUND_CLOSEST(parent_rate, rate); div = DIV_ROUND_CLOSEST(parent_rate, rate);
return clamp_t(unsigned int, div, 1, 64); return clamp(div, 1U, 64U);
} }
static long cpg_div6_clock_round_rate(struct clk_hw *hw, unsigned long rate, static int cpg_div6_clock_determine_rate(struct clk_hw *hw,
unsigned long *parent_rate) struct clk_rate_request *req)
{ {
unsigned int div = cpg_div6_clock_calc_div(rate, *parent_rate); unsigned long prate, calc_rate, diff, best_rate, best_prate;
unsigned int num_parents = clk_hw_get_num_parents(hw);
struct clk_hw *parent, *best_parent = NULL;
unsigned int i, min_div, max_div, div;
unsigned long min_diff = ULONG_MAX;
for (i = 0; i < num_parents; i++) {
parent = clk_hw_get_parent_by_index(hw, i);
if (!parent)
continue;
prate = clk_hw_get_rate(parent);
if (!prate)
continue;
min_div = max(DIV_ROUND_UP(prate, req->max_rate), 1UL);
max_div = req->min_rate ? min(prate / req->min_rate, 64UL) : 64;
if (max_div < min_div)
continue;
div = cpg_div6_clock_calc_div(req->rate, prate);
div = clamp(div, min_div, max_div);
calc_rate = prate / div;
diff = calc_rate > req->rate ? calc_rate - req->rate
: req->rate - calc_rate;
if (diff < min_diff) {
best_rate = calc_rate;
best_parent = parent;
best_prate = prate;
min_diff = diff;
}
}
if (!best_parent)
return -EINVAL;
return *parent_rate / div; req->best_parent_rate = best_prate;
req->best_parent_hw = best_parent;
req->rate = best_rate;
return 0;
} }
static int cpg_div6_clock_set_rate(struct clk_hw *hw, unsigned long rate, static int cpg_div6_clock_set_rate(struct clk_hw *hw, unsigned long rate,
...@@ -133,11 +168,11 @@ static u8 cpg_div6_clock_get_parent(struct clk_hw *hw) ...@@ -133,11 +168,11 @@ static u8 cpg_div6_clock_get_parent(struct clk_hw *hw)
unsigned int i; unsigned int i;
u8 hw_index; u8 hw_index;
if (clock->src_width == 0) if (clock->src_mask == 0)
return 0; return 0;
hw_index = (readl(clock->reg) >> clock->src_shift) & hw_index = (readl(clock->reg) & clock->src_mask) >>
(BIT(clock->src_width) - 1); __ffs(clock->src_mask);
for (i = 0; i < clk_hw_get_num_parents(hw); i++) { for (i = 0; i < clk_hw_get_num_parents(hw); i++) {
if (clock->parents[i] == hw_index) if (clock->parents[i] == hw_index)
return i; return i;
...@@ -151,18 +186,13 @@ static u8 cpg_div6_clock_get_parent(struct clk_hw *hw) ...@@ -151,18 +186,13 @@ static u8 cpg_div6_clock_get_parent(struct clk_hw *hw)
static int cpg_div6_clock_set_parent(struct clk_hw *hw, u8 index) static int cpg_div6_clock_set_parent(struct clk_hw *hw, u8 index)
{ {
struct div6_clock *clock = to_div6_clock(hw); struct div6_clock *clock = to_div6_clock(hw);
u8 hw_index; u32 src;
u32 mask;
if (index >= clk_hw_get_num_parents(hw)) if (index >= clk_hw_get_num_parents(hw))
return -EINVAL; return -EINVAL;
mask = ~((BIT(clock->src_width) - 1) << clock->src_shift); src = clock->parents[index] << __ffs(clock->src_mask);
hw_index = clock->parents[index]; writel((readl(clock->reg) & ~clock->src_mask) | src, clock->reg);
writel((readl(clock->reg) & mask) | (hw_index << clock->src_shift),
clock->reg);
return 0; return 0;
} }
...@@ -173,7 +203,7 @@ static const struct clk_ops cpg_div6_clock_ops = { ...@@ -173,7 +203,7 @@ static const struct clk_ops cpg_div6_clock_ops = {
.get_parent = cpg_div6_clock_get_parent, .get_parent = cpg_div6_clock_get_parent,
.set_parent = cpg_div6_clock_set_parent, .set_parent = cpg_div6_clock_set_parent,
.recalc_rate = cpg_div6_clock_recalc_rate, .recalc_rate = cpg_div6_clock_recalc_rate,
.round_rate = cpg_div6_clock_round_rate, .determine_rate = cpg_div6_clock_determine_rate,
.set_rate = cpg_div6_clock_set_rate, .set_rate = cpg_div6_clock_set_rate,
}; };
...@@ -236,17 +266,15 @@ struct clk * __init cpg_div6_register(const char *name, ...@@ -236,17 +266,15 @@ struct clk * __init cpg_div6_register(const char *name,
switch (num_parents) { switch (num_parents) {
case 1: case 1:
/* fixed parent clock */ /* fixed parent clock */
clock->src_shift = clock->src_width = 0; clock->src_mask = 0;
break; break;
case 4: case 4:
/* clock with EXSRC bits 6-7 */ /* clock with EXSRC bits 6-7 */
clock->src_shift = 6; clock->src_mask = GENMASK(7, 6);
clock->src_width = 2;
break; break;
case 8: case 8:
/* VCLK with EXSRC bits 12-14 */ /* VCLK with EXSRC bits 12-14 */
clock->src_shift = 12; clock->src_mask = GENMASK(14, 12);
clock->src_width = 3;
break; break;
default: default:
pr_err("%s: invalid number of parents for DIV6 clock %s\n", pr_err("%s: invalid number of parents for DIV6 clock %s\n",
......
...@@ -75,6 +75,7 @@ static const struct cpg_core_clk r8a77995_core_clks[] __initconst = { ...@@ -75,6 +75,7 @@ static const struct cpg_core_clk r8a77995_core_clks[] __initconst = {
DEF_RATE(".oco", CLK_OCO, 8 * 1000 * 1000), DEF_RATE(".oco", CLK_OCO, 8 * 1000 * 1000),
/* Core Clock Outputs */ /* Core Clock Outputs */
DEF_FIXED("za2", R8A77995_CLK_ZA2, CLK_PLL0D3, 2, 1),
DEF_FIXED("z2", R8A77995_CLK_Z2, CLK_PLL0D3, 1, 1), DEF_FIXED("z2", R8A77995_CLK_Z2, CLK_PLL0D3, 1, 1),
DEF_FIXED("ztr", R8A77995_CLK_ZTR, CLK_PLL1, 6, 1), DEF_FIXED("ztr", R8A77995_CLK_ZTR, CLK_PLL1, 6, 1),
DEF_FIXED("zt", R8A77995_CLK_ZT, CLK_PLL1, 4, 1), DEF_FIXED("zt", R8A77995_CLK_ZT, CLK_PLL1, 4, 1),
......
...@@ -180,6 +180,10 @@ static const struct mssr_mod_clk r8a779a0_mod_clks[] __initconst = { ...@@ -180,6 +180,10 @@ static const struct mssr_mod_clk r8a779a0_mod_clks[] __initconst = {
DEF_MOD("i2c4", 522, R8A779A0_CLK_S1D4), DEF_MOD("i2c4", 522, R8A779A0_CLK_S1D4),
DEF_MOD("i2c5", 523, R8A779A0_CLK_S1D4), DEF_MOD("i2c5", 523, R8A779A0_CLK_S1D4),
DEF_MOD("i2c6", 524, R8A779A0_CLK_S1D4), DEF_MOD("i2c6", 524, R8A779A0_CLK_S1D4),
DEF_MOD("ispcs0", 612, R8A779A0_CLK_S1D1),
DEF_MOD("ispcs1", 613, R8A779A0_CLK_S1D1),
DEF_MOD("ispcs2", 614, R8A779A0_CLK_S1D1),
DEF_MOD("ispcs3", 615, R8A779A0_CLK_S1D1),
DEF_MOD("msi0", 618, R8A779A0_CLK_MSO), DEF_MOD("msi0", 618, R8A779A0_CLK_MSO),
DEF_MOD("msi1", 619, R8A779A0_CLK_MSO), DEF_MOD("msi1", 619, R8A779A0_CLK_MSO),
DEF_MOD("msi2", 620, R8A779A0_CLK_MSO), DEF_MOD("msi2", 620, R8A779A0_CLK_MSO),
......
...@@ -604,20 +604,19 @@ r9a06g032_div_clamp_div(struct r9a06g032_clk_div *clk, ...@@ -604,20 +604,19 @@ r9a06g032_div_clamp_div(struct r9a06g032_clk_div *clk,
return div; return div;
} }
static long static int
r9a06g032_div_round_rate(struct clk_hw *hw, r9a06g032_div_determine_rate(struct clk_hw *hw, struct clk_rate_request *req)
unsigned long rate, unsigned long *prate)
{ {
struct r9a06g032_clk_div *clk = to_r9a06g032_div(hw); struct r9a06g032_clk_div *clk = to_r9a06g032_div(hw);
u32 div = DIV_ROUND_UP(*prate, rate); u32 div = DIV_ROUND_UP(req->best_parent_rate, req->rate);
pr_devel("%s %pC %ld (prate %ld) (wanted div %u)\n", __func__, pr_devel("%s %pC %ld (prate %ld) (wanted div %u)\n", __func__,
hw->clk, rate, *prate, div); hw->clk, req->rate, req->best_parent_rate, div);
pr_devel(" min %d (%ld) max %d (%ld)\n", pr_devel(" min %d (%ld) max %d (%ld)\n",
clk->min, DIV_ROUND_UP(*prate, clk->min), clk->min, DIV_ROUND_UP(req->best_parent_rate, clk->min),
clk->max, DIV_ROUND_UP(*prate, clk->max)); clk->max, DIV_ROUND_UP(req->best_parent_rate, clk->max));
div = r9a06g032_div_clamp_div(clk, rate, *prate); div = r9a06g032_div_clamp_div(clk, req->rate, req->best_parent_rate);
/* /*
* this is a hack. Currently the serial driver asks for a clock rate * this is a hack. Currently the serial driver asks for a clock rate
* that is 16 times the baud rate -- and that is wildly outside the * that is 16 times the baud rate -- and that is wildly outside the
...@@ -630,11 +629,13 @@ r9a06g032_div_round_rate(struct clk_hw *hw, ...@@ -630,11 +629,13 @@ r9a06g032_div_round_rate(struct clk_hw *hw,
if (clk->index == R9A06G032_DIV_UART || if (clk->index == R9A06G032_DIV_UART ||
clk->index == R9A06G032_DIV_P2_PG) { clk->index == R9A06G032_DIV_P2_PG) {
pr_devel("%s div uart hack!\n", __func__); pr_devel("%s div uart hack!\n", __func__);
return clk_get_rate(hw->clk); req->rate = clk_get_rate(hw->clk);
return 0;
} }
req->rate = DIV_ROUND_UP(req->best_parent_rate, div);
pr_devel("%s %pC %ld / %u = %ld\n", __func__, hw->clk, pr_devel("%s %pC %ld / %u = %ld\n", __func__, hw->clk,
*prate, div, DIV_ROUND_UP(*prate, div)); req->best_parent_rate, div, req->rate);
return DIV_ROUND_UP(*prate, div); return 0;
} }
static int static int
...@@ -663,7 +664,7 @@ r9a06g032_div_set_rate(struct clk_hw *hw, ...@@ -663,7 +664,7 @@ r9a06g032_div_set_rate(struct clk_hw *hw,
static const struct clk_ops r9a06g032_clk_div_ops = { static const struct clk_ops r9a06g032_clk_div_ops = {
.recalc_rate = r9a06g032_div_recalc_rate, .recalc_rate = r9a06g032_div_recalc_rate,
.round_rate = r9a06g032_div_round_rate, .determine_rate = r9a06g032_div_determine_rate,
.set_rate = r9a06g032_div_set_rate, .set_rate = r9a06g032_div_set_rate,
}; };
......
...@@ -26,19 +26,135 @@ ...@@ -26,19 +26,135 @@
#include "rcar-cpg-lib.h" #include "rcar-cpg-lib.h"
#include "rcar-gen3-cpg.h" #include "rcar-gen3-cpg.h"
#define CPG_PLL0CR 0x00d8 #define CPG_PLLECR 0x00d0 /* PLL Enable Control Register */
#define CPG_PLLECR_PLLST(n) BIT(8 + (n)) /* PLLn Circuit Status */
#define CPG_PLL0CR 0x00d8 /* PLLn Control Registers */
#define CPG_PLL2CR 0x002c #define CPG_PLL2CR 0x002c
#define CPG_PLL4CR 0x01f4 #define CPG_PLL4CR 0x01f4
#define CPG_PLLnCR_STC_MASK GENMASK(30, 24) /* PLL Circuit Mult. Ratio */
#define CPG_RCKCR_CKSEL BIT(15) /* RCLK Clock Source Select */ #define CPG_RCKCR_CKSEL BIT(15) /* RCLK Clock Source Select */
/* PLL Clocks */
struct cpg_pll_clk {
struct clk_hw hw;
void __iomem *pllcr_reg;
void __iomem *pllecr_reg;
unsigned int fixed_mult;
u32 pllecr_pllst_mask;
};
#define to_pll_clk(_hw) container_of(_hw, struct cpg_pll_clk, hw)
static unsigned long cpg_pll_clk_recalc_rate(struct clk_hw *hw,
unsigned long parent_rate)
{
struct cpg_pll_clk *pll_clk = to_pll_clk(hw);
unsigned int mult;
u32 val;
val = readl(pll_clk->pllcr_reg) & CPG_PLLnCR_STC_MASK;
mult = (val >> __ffs(CPG_PLLnCR_STC_MASK)) + 1;
return parent_rate * mult * pll_clk->fixed_mult;
}
static int cpg_pll_clk_determine_rate(struct clk_hw *hw,
struct clk_rate_request *req)
{
struct cpg_pll_clk *pll_clk = to_pll_clk(hw);
unsigned int min_mult, max_mult, mult;
unsigned long prate;
prate = req->best_parent_rate * pll_clk->fixed_mult;
min_mult = max(div64_ul(req->min_rate, prate), 1ULL);
max_mult = min(div64_ul(req->max_rate, prate), 128ULL);
if (max_mult < min_mult)
return -EINVAL;
mult = DIV_ROUND_CLOSEST_ULL(req->rate, prate);
mult = clamp(mult, min_mult, max_mult);
req->rate = prate * mult;
return 0;
}
static int cpg_pll_clk_set_rate(struct clk_hw *hw, unsigned long rate,
unsigned long parent_rate)
{
struct cpg_pll_clk *pll_clk = to_pll_clk(hw);
unsigned int mult, i;
u32 val;
mult = DIV_ROUND_CLOSEST_ULL(rate, parent_rate * pll_clk->fixed_mult);
mult = clamp(mult, 1U, 128U);
val = readl(pll_clk->pllcr_reg);
val &= ~CPG_PLLnCR_STC_MASK;
val |= (mult - 1) << __ffs(CPG_PLLnCR_STC_MASK);
writel(val, pll_clk->pllcr_reg);
for (i = 1000; i; i--) {
if (readl(pll_clk->pllecr_reg) & pll_clk->pllecr_pllst_mask)
return 0;
cpu_relax();
}
return -ETIMEDOUT;
}
static const struct clk_ops cpg_pll_clk_ops = {
.recalc_rate = cpg_pll_clk_recalc_rate,
.determine_rate = cpg_pll_clk_determine_rate,
.set_rate = cpg_pll_clk_set_rate,
};
static struct clk * __init cpg_pll_clk_register(const char *name,
const char *parent_name,
void __iomem *base,
unsigned int mult,
unsigned int offset,
unsigned int index)
{
struct cpg_pll_clk *pll_clk;
struct clk_init_data init = {};
struct clk *clk;
pll_clk = kzalloc(sizeof(*pll_clk), GFP_KERNEL);
if (!pll_clk)
return ERR_PTR(-ENOMEM);
init.name = name;
init.ops = &cpg_pll_clk_ops;
init.parent_names = &parent_name;
init.num_parents = 1;
pll_clk->hw.init = &init;
pll_clk->pllcr_reg = base + offset;
pll_clk->pllecr_reg = base + CPG_PLLECR;
pll_clk->fixed_mult = mult; /* PLL refclk x (setting + 1) x mult */
pll_clk->pllecr_pllst_mask = CPG_PLLECR_PLLST(index);
clk = clk_register(NULL, &pll_clk->hw);
if (IS_ERR(clk))
kfree(pll_clk);
return clk;
}
/* /*
* Z Clock & Z2 Clock * Z Clock & Z2 Clock
* *
* Traits of this clock: * Traits of this clock:
* prepare - clk_prepare only ensures that parents are prepared * prepare - clk_prepare only ensures that parents are prepared
* enable - clk_enable only ensures that parents are enabled * enable - clk_enable only ensures that parents are enabled
* rate - rate is adjustable. clk->rate = (parent->rate * mult / 32 ) / 2 * rate - rate is adjustable.
* clk->rate = (parent->rate * mult / 32 ) / fixed_div
* parent - fixed parent. No clk_set_parent support * parent - fixed parent. No clk_set_parent support
*/ */
#define CPG_FRQCRB 0x00000004 #define CPG_FRQCRB 0x00000004
...@@ -49,8 +165,9 @@ struct cpg_z_clk { ...@@ -49,8 +165,9 @@ struct cpg_z_clk {
struct clk_hw hw; struct clk_hw hw;
void __iomem *reg; void __iomem *reg;
void __iomem *kick_reg; void __iomem *kick_reg;
unsigned long mask; unsigned long max_rate; /* Maximum rate for normal mode */
unsigned int fixed_div; unsigned int fixed_div;
u32 mask;
}; };
#define to_z_clk(_hw) container_of(_hw, struct cpg_z_clk, hw) #define to_z_clk(_hw) container_of(_hw, struct cpg_z_clk, hw)
...@@ -74,7 +191,18 @@ static int cpg_z_clk_determine_rate(struct clk_hw *hw, ...@@ -74,7 +191,18 @@ static int cpg_z_clk_determine_rate(struct clk_hw *hw,
{ {
struct cpg_z_clk *zclk = to_z_clk(hw); struct cpg_z_clk *zclk = to_z_clk(hw);
unsigned int min_mult, max_mult, mult; unsigned int min_mult, max_mult, mult;
unsigned long prate; unsigned long rate, prate;
rate = min(req->rate, req->max_rate);
if (rate <= zclk->max_rate) {
/* Set parent rate to initial value for normal modes */
prate = zclk->max_rate;
} else {
/* Set increased parent rate for boost modes */
prate = rate;
}
req->best_parent_rate = clk_hw_round_rate(clk_hw_get_parent(hw),
prate * zclk->fixed_div);
prate = req->best_parent_rate / zclk->fixed_div; prate = req->best_parent_rate / zclk->fixed_div;
min_mult = max(div64_ul(req->min_rate * 32ULL, prate), 1ULL); min_mult = max(div64_ul(req->min_rate * 32ULL, prate), 1ULL);
...@@ -82,10 +210,10 @@ static int cpg_z_clk_determine_rate(struct clk_hw *hw, ...@@ -82,10 +210,10 @@ static int cpg_z_clk_determine_rate(struct clk_hw *hw,
if (max_mult < min_mult) if (max_mult < min_mult)
return -EINVAL; return -EINVAL;
mult = div64_ul(req->rate * 32ULL, prate); mult = DIV_ROUND_CLOSEST_ULL(rate * 32ULL, prate);
mult = clamp(mult, min_mult, max_mult); mult = clamp(mult, min_mult, max_mult);
req->rate = div_u64((u64)prate * mult, 32); req->rate = DIV_ROUND_CLOSEST_ULL((u64)prate * mult, 32);
return 0; return 0;
} }
...@@ -103,8 +231,7 @@ static int cpg_z_clk_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -103,8 +231,7 @@ static int cpg_z_clk_set_rate(struct clk_hw *hw, unsigned long rate,
if (readl(zclk->kick_reg) & CPG_FRQCRB_KICK) if (readl(zclk->kick_reg) & CPG_FRQCRB_KICK)
return -EBUSY; return -EBUSY;
cpg_reg_modify(zclk->reg, zclk->mask, cpg_reg_modify(zclk->reg, zclk->mask, (32 - mult) << __ffs(zclk->mask));
((32 - mult) << __ffs(zclk->mask)) & zclk->mask);
/* /*
* Set KICK bit in FRQCRB to update hardware setting and wait for * Set KICK bit in FRQCRB to update hardware setting and wait for
...@@ -117,7 +244,7 @@ static int cpg_z_clk_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -117,7 +244,7 @@ static int cpg_z_clk_set_rate(struct clk_hw *hw, unsigned long rate,
* *
* Using experimental measurements, it seems that no more than * Using experimental measurements, it seems that no more than
* ~10 iterations are needed, independently of the CPU rate. * ~10 iterations are needed, independently of the CPU rate.
* Since this value might be dependent of external xtal rate, pll1 * Since this value might be dependent on external xtal rate, pll1
* rate or even the other emulation clocks rate, use 1000 as a * rate or even the other emulation clocks rate, use 1000 as a
* "super" safe value. * "super" safe value.
*/ */
...@@ -153,7 +280,7 @@ static struct clk * __init cpg_z_clk_register(const char *name, ...@@ -153,7 +280,7 @@ static struct clk * __init cpg_z_clk_register(const char *name,
init.name = name; init.name = name;
init.ops = &cpg_z_clk_ops; init.ops = &cpg_z_clk_ops;
init.flags = 0; init.flags = CLK_SET_RATE_PARENT;
init.parent_names = &parent_name; init.parent_names = &parent_name;
init.num_parents = 1; init.num_parents = 1;
...@@ -164,9 +291,13 @@ static struct clk * __init cpg_z_clk_register(const char *name, ...@@ -164,9 +291,13 @@ static struct clk * __init cpg_z_clk_register(const char *name,
zclk->fixed_div = div; /* PLLVCO x 1/div x SYS-CPU divider */ zclk->fixed_div = div; /* PLLVCO x 1/div x SYS-CPU divider */
clk = clk_register(NULL, &zclk->hw); clk = clk_register(NULL, &zclk->hw);
if (IS_ERR(clk)) if (IS_ERR(clk)) {
kfree(zclk); kfree(zclk);
return clk;
}
zclk->max_rate = clk_hw_get_rate(clk_hw_get_parent(&zclk->hw)) /
zclk->fixed_div;
return clk; return clk;
} }
...@@ -314,16 +445,13 @@ struct clk * __init rcar_gen3_cpg_clk_register(struct device *dev, ...@@ -314,16 +445,13 @@ struct clk * __init rcar_gen3_cpg_clk_register(struct device *dev,
case CLK_TYPE_GEN3_PLL0: case CLK_TYPE_GEN3_PLL0:
/* /*
* PLL0 is a configurable multiplier clock. Register it as a * PLL0 is implemented as a custom clock, to change the
* fixed factor clock for now as there's no generic multiplier * multiplier when cpufreq changes between normal and boost
* clock implementation and we currently have no need to change * modes.
* the multiplier value.
*/ */
value = readl(base + CPG_PLL0CR); mult = (cpg_quirks & PLL_ERRATA) ? 4 : 2;
mult = (((value >> 24) & 0x7f) + 1) * 2; return cpg_pll_clk_register(core->name, __clk_get_name(parent),
if (cpg_quirks & PLL_ERRATA) base, mult, CPG_PLL0CR, 0);
mult *= 2;
break;
case CLK_TYPE_GEN3_PLL1: case CLK_TYPE_GEN3_PLL1:
mult = cpg_pll_config->pll1_mult; mult = cpg_pll_config->pll1_mult;
...@@ -332,16 +460,13 @@ struct clk * __init rcar_gen3_cpg_clk_register(struct device *dev, ...@@ -332,16 +460,13 @@ struct clk * __init rcar_gen3_cpg_clk_register(struct device *dev,
case CLK_TYPE_GEN3_PLL2: case CLK_TYPE_GEN3_PLL2:
/* /*
* PLL2 is a configurable multiplier clock. Register it as a * PLL2 is implemented as a custom clock, to change the
* fixed factor clock for now as there's no generic multiplier * multiplier when cpufreq changes between normal and boost
* clock implementation and we currently have no need to change * modes.
* the multiplier value.
*/ */
value = readl(base + CPG_PLL2CR); mult = (cpg_quirks & PLL_ERRATA) ? 4 : 2;
mult = (((value >> 24) & 0x7f) + 1) * 2; return cpg_pll_clk_register(core->name, __clk_get_name(parent),
if (cpg_quirks & PLL_ERRATA) base, mult, CPG_PLL2CR, 2);
mult *= 2;
break;
case CLK_TYPE_GEN3_PLL3: case CLK_TYPE_GEN3_PLL3:
mult = cpg_pll_config->pll3_mult; mult = cpg_pll_config->pll3_mult;
......
...@@ -128,10 +128,8 @@ static int rcar_usb2_clock_sel_resume(struct device *dev) ...@@ -128,10 +128,8 @@ static int rcar_usb2_clock_sel_resume(struct device *dev)
static int rcar_usb2_clock_sel_remove(struct platform_device *pdev) static int rcar_usb2_clock_sel_remove(struct platform_device *pdev)
{ {
struct device *dev = &pdev->dev; struct device *dev = &pdev->dev;
struct usb2_clock_sel_priv *priv = platform_get_drvdata(pdev);
of_clk_del_provider(dev->of_node); of_clk_del_provider(dev->of_node);
clk_hw_unregister(&priv->hw);
pm_runtime_put(dev); pm_runtime_put(dev);
pm_runtime_disable(dev); pm_runtime_disable(dev);
...@@ -164,9 +162,6 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev) ...@@ -164,9 +162,6 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev)
if (IS_ERR(priv->rsts)) if (IS_ERR(priv->rsts))
return PTR_ERR(priv->rsts); return PTR_ERR(priv->rsts);
pm_runtime_enable(dev);
pm_runtime_get_sync(dev);
clk = devm_clk_get(dev, "usb_extal"); clk = devm_clk_get(dev, "usb_extal");
if (!IS_ERR(clk) && !clk_prepare_enable(clk)) { if (!IS_ERR(clk) && !clk_prepare_enable(clk)) {
priv->extal = !!clk_get_rate(clk); priv->extal = !!clk_get_rate(clk);
...@@ -183,6 +178,8 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev) ...@@ -183,6 +178,8 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev)
return -ENOENT; return -ENOENT;
} }
pm_runtime_enable(dev);
pm_runtime_get_sync(dev);
platform_set_drvdata(pdev, priv); platform_set_drvdata(pdev, priv);
dev_set_drvdata(dev, priv); dev_set_drvdata(dev, priv);
...@@ -190,11 +187,20 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev) ...@@ -190,11 +187,20 @@ static int rcar_usb2_clock_sel_probe(struct platform_device *pdev)
init.ops = &usb2_clock_sel_clock_ops; init.ops = &usb2_clock_sel_clock_ops;
priv->hw.init = &init; priv->hw.init = &init;
clk = clk_register(NULL, &priv->hw); ret = devm_clk_hw_register(NULL, &priv->hw);
if (IS_ERR(clk)) if (ret)
return PTR_ERR(clk); goto pm_put;
ret = of_clk_add_hw_provider(np, of_clk_hw_simple_get, &priv->hw);
if (ret)
goto pm_put;
return 0;
return of_clk_add_hw_provider(np, of_clk_hw_simple_get, &priv->hw); pm_put:
pm_runtime_put(dev);
pm_runtime_disable(dev);
return ret;
} }
static const struct dev_pm_ops rcar_usb2_clock_sel_pm_ops = { static const struct dev_pm_ops rcar_usb2_clock_sel_pm_ops = {
......
...@@ -100,13 +100,9 @@ static const u16 srcr_for_v3u[] = { ...@@ -100,13 +100,9 @@ static const u16 srcr_for_v3u[] = {
0x2C20, 0x2C24, 0x2C28, 0x2C2C, 0x2C30, 0x2C34, 0x2C38, 0x2C20, 0x2C24, 0x2C28, 0x2C2C, 0x2C30, 0x2C34, 0x2C38,
}; };
/* Realtime Module Stop Control Register offsets */ /*
#define RMSTPCR(i) (smstpcr[i] - 0x20) * Software Reset Clearing Register offsets
*/
/* Modem Module Stop Control Register offsets (r8a73a4) */
#define MMSTPCR(i) (smstpcr[i] + 0x20)
/* Software Reset Clearing Register offsets */
static const u16 srstclr[] = { static const u16 srstclr[] = {
0x940, 0x944, 0x948, 0x94C, 0x950, 0x954, 0x958, 0x95C, 0x940, 0x944, 0x948, 0x94C, 0x950, 0x954, 0x958, 0x95C,
......
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