clk: microchip: mpfs: convert cfg_clk to clk_divider
The cfg_clk struct is now just a redefinition of the clk_divider struct with custom implentations of the ops, that implement an extra level of redirection. Remove the custom struct and replace it with clk_divider. Reviewed-by: Daire McNamara <daire.mcnamara@microchip.com> Signed-off-by: Conor Dooley <conor.dooley@microchip.com> Reviewed-by: Claudiu Beznea <claudiu.beznea@microchip.com> Signed-off-by: Claudiu Beznea <claudiu.beznea@microchip.com> Link: https://lore.kernel.org/r/20220909123123.2699583-13-conor.dooley@microchip.compull/520/merge
parent
e7df7ba08c
commit
4da2404bb0
|
|
@ -49,24 +49,13 @@ struct mpfs_msspll_hw_clock {
|
||||||
|
|
||||||
#define to_mpfs_msspll_clk(_hw) container_of(_hw, struct mpfs_msspll_hw_clock, hw)
|
#define to_mpfs_msspll_clk(_hw) container_of(_hw, struct mpfs_msspll_hw_clock, hw)
|
||||||
|
|
||||||
struct mpfs_cfg_clock {
|
|
||||||
void __iomem *reg;
|
|
||||||
const struct clk_div_table *table;
|
|
||||||
u8 shift;
|
|
||||||
u8 width;
|
|
||||||
u8 flags;
|
|
||||||
};
|
|
||||||
|
|
||||||
struct mpfs_cfg_hw_clock {
|
struct mpfs_cfg_hw_clock {
|
||||||
struct mpfs_cfg_clock cfg;
|
struct clk_divider cfg;
|
||||||
struct clk_hw hw;
|
|
||||||
struct clk_init_data init;
|
struct clk_init_data init;
|
||||||
unsigned int id;
|
unsigned int id;
|
||||||
u32 reg_offset;
|
u32 reg_offset;
|
||||||
};
|
};
|
||||||
|
|
||||||
#define to_mpfs_cfg_clk(_hw) container_of(_hw, struct mpfs_cfg_hw_clock, hw)
|
|
||||||
|
|
||||||
struct mpfs_periph_clock {
|
struct mpfs_periph_clock {
|
||||||
void __iomem *reg;
|
void __iomem *reg;
|
||||||
u8 shift;
|
u8 shift;
|
||||||
|
|
@ -226,56 +215,6 @@ static int mpfs_clk_register_mssplls(struct device *dev, struct mpfs_msspll_hw_c
|
||||||
* "CFG" clocks
|
* "CFG" clocks
|
||||||
*/
|
*/
|
||||||
|
|
||||||
static unsigned long mpfs_cfg_clk_recalc_rate(struct clk_hw *hw, unsigned long prate)
|
|
||||||
{
|
|
||||||
struct mpfs_cfg_hw_clock *cfg_hw = to_mpfs_cfg_clk(hw);
|
|
||||||
struct mpfs_cfg_clock *cfg = &cfg_hw->cfg;
|
|
||||||
u32 val;
|
|
||||||
|
|
||||||
val = readl_relaxed(cfg->reg) >> cfg->shift;
|
|
||||||
val &= clk_div_mask(cfg->width);
|
|
||||||
|
|
||||||
return divider_recalc_rate(hw, prate, val, cfg->table, cfg->flags, cfg->width);
|
|
||||||
}
|
|
||||||
|
|
||||||
static long mpfs_cfg_clk_round_rate(struct clk_hw *hw, unsigned long rate, unsigned long *prate)
|
|
||||||
{
|
|
||||||
struct mpfs_cfg_hw_clock *cfg_hw = to_mpfs_cfg_clk(hw);
|
|
||||||
struct mpfs_cfg_clock *cfg = &cfg_hw->cfg;
|
|
||||||
|
|
||||||
return divider_round_rate(hw, rate, prate, cfg->table, cfg->width, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int mpfs_cfg_clk_set_rate(struct clk_hw *hw, unsigned long rate, unsigned long prate)
|
|
||||||
{
|
|
||||||
struct mpfs_cfg_hw_clock *cfg_hw = to_mpfs_cfg_clk(hw);
|
|
||||||
struct mpfs_cfg_clock *cfg = &cfg_hw->cfg;
|
|
||||||
unsigned long flags;
|
|
||||||
u32 val;
|
|
||||||
int divider_setting;
|
|
||||||
|
|
||||||
divider_setting = divider_get_val(rate, prate, cfg->table, cfg->width, 0);
|
|
||||||
|
|
||||||
if (divider_setting < 0)
|
|
||||||
return divider_setting;
|
|
||||||
|
|
||||||
spin_lock_irqsave(&mpfs_clk_lock, flags);
|
|
||||||
val = readl_relaxed(cfg->reg);
|
|
||||||
val &= ~(clk_div_mask(cfg->width) << cfg_hw->cfg.shift);
|
|
||||||
val |= divider_setting << cfg->shift;
|
|
||||||
writel_relaxed(val, cfg->reg);
|
|
||||||
|
|
||||||
spin_unlock_irqrestore(&mpfs_clk_lock, flags);
|
|
||||||
|
|
||||||
return 0;
|
|
||||||
}
|
|
||||||
|
|
||||||
static const struct clk_ops mpfs_clk_cfg_ops = {
|
|
||||||
.recalc_rate = mpfs_cfg_clk_recalc_rate,
|
|
||||||
.round_rate = mpfs_cfg_clk_round_rate,
|
|
||||||
.set_rate = mpfs_cfg_clk_set_rate,
|
|
||||||
};
|
|
||||||
|
|
||||||
#define CLK_CFG(_id, _name, _parent, _shift, _width, _table, _flags, _offset) { \
|
#define CLK_CFG(_id, _name, _parent, _shift, _width, _table, _flags, _offset) { \
|
||||||
.id = _id, \
|
.id = _id, \
|
||||||
.cfg.shift = _shift, \
|
.cfg.shift = _shift, \
|
||||||
|
|
@ -283,7 +222,8 @@ static const struct clk_ops mpfs_clk_cfg_ops = {
|
||||||
.cfg.table = _table, \
|
.cfg.table = _table, \
|
||||||
.reg_offset = _offset, \
|
.reg_offset = _offset, \
|
||||||
.cfg.flags = _flags, \
|
.cfg.flags = _flags, \
|
||||||
.hw.init = CLK_HW_INIT(_name, _parent, &mpfs_clk_cfg_ops, 0), \
|
.cfg.hw.init = CLK_HW_INIT(_name, _parent, &clk_divider_ops, 0), \
|
||||||
|
.cfg.lock = &mpfs_clk_lock, \
|
||||||
}
|
}
|
||||||
|
|
||||||
#define CLK_CPU_OFFSET 0u
|
#define CLK_CPU_OFFSET 0u
|
||||||
|
|
@ -305,8 +245,8 @@ static struct mpfs_cfg_hw_clock mpfs_cfg_clks[] = {
|
||||||
.cfg.table = mpfs_div_rtcref_table,
|
.cfg.table = mpfs_div_rtcref_table,
|
||||||
.reg_offset = REG_RTC_CLOCK_CR,
|
.reg_offset = REG_RTC_CLOCK_CR,
|
||||||
.cfg.flags = CLK_DIVIDER_ONE_BASED,
|
.cfg.flags = CLK_DIVIDER_ONE_BASED,
|
||||||
.hw.init =
|
.cfg.hw.init =
|
||||||
CLK_HW_INIT_PARENTS_DATA("clk_rtcref", mpfs_ext_ref, &mpfs_clk_cfg_ops, 0),
|
CLK_HW_INIT_PARENTS_DATA("clk_rtcref", mpfs_ext_ref, &clk_divider_ops, 0),
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
|
@ -320,13 +260,13 @@ static int mpfs_clk_register_cfgs(struct device *dev, struct mpfs_cfg_hw_clock *
|
||||||
struct mpfs_cfg_hw_clock *cfg_hw = &cfg_hws[i];
|
struct mpfs_cfg_hw_clock *cfg_hw = &cfg_hws[i];
|
||||||
|
|
||||||
cfg_hw->cfg.reg = data->base + cfg_hw->reg_offset;
|
cfg_hw->cfg.reg = data->base + cfg_hw->reg_offset;
|
||||||
ret = devm_clk_hw_register(dev, &cfg_hw->hw);
|
ret = devm_clk_hw_register(dev, &cfg_hw->cfg.hw);
|
||||||
if (ret)
|
if (ret)
|
||||||
return dev_err_probe(dev, ret, "failed to register clock id: %d\n",
|
return dev_err_probe(dev, ret, "failed to register clock id: %d\n",
|
||||||
cfg_hw->id);
|
cfg_hw->id);
|
||||||
|
|
||||||
id = cfg_hw->id;
|
id = cfg_hw->id;
|
||||||
data->hw_data.hws[id] = &cfg_hw->hw;
|
data->hw_data.hws[id] = &cfg_hw->cfg.hw;
|
||||||
}
|
}
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
@ -396,7 +336,7 @@ static const struct clk_ops mpfs_periph_clk_ops = {
|
||||||
_flags), \
|
_flags), \
|
||||||
}
|
}
|
||||||
|
|
||||||
#define PARENT_CLK(PARENT) (&mpfs_cfg_clks[CLK_##PARENT##_OFFSET].hw)
|
#define PARENT_CLK(PARENT) (&mpfs_cfg_clks[CLK_##PARENT##_OFFSET].cfg.hw)
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Critical clocks:
|
* Critical clocks:
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue