Commit 88a4e128 authored by Jerome Brunet's avatar Jerome Brunet Committed by Neil Armstrong

clk: meson: migrate the audio divider clock to clk_regmap

Rework meson audio divider driver to use clk_regmap and move gxbb
clock using meson_clk_audio_divider to clk_regmap.
Signed-off-by: default avatarJerome Brunet <jbrunet@baylibre.com>
Signed-off-by: default avatarNeil Armstrong <narmstrong@baylibre.com>
parent c763e61a
...@@ -28,8 +28,11 @@ ...@@ -28,8 +28,11 @@
#include <linux/clk-provider.h> #include <linux/clk-provider.h>
#include "clkc.h" #include "clkc.h"
#define to_meson_clk_audio_divider(_hw) container_of(_hw, \ static inline struct meson_clk_audio_div_data *
struct meson_clk_audio_divider, hw) meson_clk_audio_div_data(struct clk_regmap *clk)
{
return (struct meson_clk_audio_div_data *)clk->data;
}
static int _div_round(unsigned long parent_rate, unsigned long rate, static int _div_round(unsigned long parent_rate, unsigned long rate,
unsigned long flags) unsigned long flags)
...@@ -45,15 +48,9 @@ static int _get_val(unsigned long parent_rate, unsigned long rate) ...@@ -45,15 +48,9 @@ static int _get_val(unsigned long parent_rate, unsigned long rate)
return DIV_ROUND_UP_ULL((u64)parent_rate, rate) - 1; return DIV_ROUND_UP_ULL((u64)parent_rate, rate) - 1;
} }
static int _valid_divider(struct clk_hw *hw, int divider) static int _valid_divider(unsigned int width, int divider)
{ {
struct meson_clk_audio_divider *adiv = int max_divider = 1 << width;
to_meson_clk_audio_divider(hw);
int max_divider;
u8 width;
width = adiv->div.width;
max_divider = 1 << width;
return clamp(divider, 1, max_divider); return clamp(divider, 1, max_divider);
} }
...@@ -61,14 +58,11 @@ static int _valid_divider(struct clk_hw *hw, int divider) ...@@ -61,14 +58,11 @@ static int _valid_divider(struct clk_hw *hw, int divider)
static unsigned long audio_divider_recalc_rate(struct clk_hw *hw, static unsigned long audio_divider_recalc_rate(struct clk_hw *hw,
unsigned long parent_rate) unsigned long parent_rate)
{ {
struct meson_clk_audio_divider *adiv = struct clk_regmap *clk = to_clk_regmap(hw);
to_meson_clk_audio_divider(hw); struct meson_clk_audio_div_data *adiv = meson_clk_audio_div_data(clk);
struct parm *p; unsigned long divider;
unsigned long reg, divider;
p = &adiv->div; divider = meson_parm_read(clk->map, &adiv->div);
reg = readl(adiv->base + p->reg_off);
divider = PARM_GET(p->width, p->shift, reg) + 1;
return DIV_ROUND_UP_ULL((u64)parent_rate, divider); return DIV_ROUND_UP_ULL((u64)parent_rate, divider);
} }
...@@ -77,14 +71,14 @@ static long audio_divider_round_rate(struct clk_hw *hw, ...@@ -77,14 +71,14 @@ static long audio_divider_round_rate(struct clk_hw *hw,
unsigned long rate, unsigned long rate,
unsigned long *parent_rate) unsigned long *parent_rate)
{ {
struct meson_clk_audio_divider *adiv = struct clk_regmap *clk = to_clk_regmap(hw);
to_meson_clk_audio_divider(hw); struct meson_clk_audio_div_data *adiv = meson_clk_audio_div_data(clk);
unsigned long max_prate; unsigned long max_prate;
int divider; int divider;
if (!(clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT)) { if (!(clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT)) {
divider = _div_round(*parent_rate, rate, adiv->flags); divider = _div_round(*parent_rate, rate, adiv->flags);
divider = _valid_divider(hw, divider); divider = _valid_divider(adiv->div.width, divider);
return DIV_ROUND_UP_ULL((u64)*parent_rate, divider); return DIV_ROUND_UP_ULL((u64)*parent_rate, divider);
} }
...@@ -93,7 +87,7 @@ static long audio_divider_round_rate(struct clk_hw *hw, ...@@ -93,7 +87,7 @@ static long audio_divider_round_rate(struct clk_hw *hw,
/* Get the corresponding rounded down divider */ /* Get the corresponding rounded down divider */
divider = max_prate / rate; divider = max_prate / rate;
divider = _valid_divider(hw, divider); divider = _valid_divider(adiv->div.width, divider);
/* Get actual rate of the parent */ /* Get actual rate of the parent */
*parent_rate = clk_hw_round_rate(clk_hw_get_parent(hw), *parent_rate = clk_hw_round_rate(clk_hw_get_parent(hw),
...@@ -106,28 +100,11 @@ static int audio_divider_set_rate(struct clk_hw *hw, ...@@ -106,28 +100,11 @@ static int audio_divider_set_rate(struct clk_hw *hw,
unsigned long rate, unsigned long rate,
unsigned long parent_rate) unsigned long parent_rate)
{ {
struct meson_clk_audio_divider *adiv = struct clk_regmap *clk = to_clk_regmap(hw);
to_meson_clk_audio_divider(hw); struct meson_clk_audio_div_data *adiv = meson_clk_audio_div_data(clk);
struct parm *p; int val = _get_val(parent_rate, rate);
unsigned long reg, flags = 0;
int val; meson_parm_write(clk->map, &adiv->div, val);
val = _get_val(parent_rate, rate);
if (adiv->lock)
spin_lock_irqsave(adiv->lock, flags);
else
__acquire(adiv->lock);
p = &adiv->div;
reg = readl(adiv->base + p->reg_off);
reg = PARM_SET(p->width, p->shift, reg, val);
writel(reg, adiv->base + p->reg_off);
if (adiv->lock)
spin_unlock_irqrestore(adiv->lock, flags);
else
__release(adiv->lock);
return 0; return 0;
} }
......
...@@ -142,12 +142,9 @@ struct meson_clk_mpll_data { ...@@ -142,12 +142,9 @@ struct meson_clk_mpll_data {
spinlock_t *lock; spinlock_t *lock;
}; };
struct meson_clk_audio_divider { struct meson_clk_audio_div_data {
struct clk_hw hw;
void __iomem *base;
struct parm div; struct parm div;
u8 flags; u8 flags;
spinlock_t *lock;
}; };
#define MESON_GATE(_name, _reg, _bit) \ #define MESON_GATE(_name, _reg, _bit) \
......
...@@ -826,14 +826,15 @@ static struct clk_regmap gxbb_cts_amclk_sel = { ...@@ -826,14 +826,15 @@ static struct clk_regmap gxbb_cts_amclk_sel = {
}, },
}; };
static struct meson_clk_audio_divider gxbb_cts_amclk_div = { static struct clk_regmap gxbb_cts_amclk_div = {
.div = { .data = &(struct meson_clk_audio_div_data){
.reg_off = HHI_AUD_CLK_CNTL, .div = {
.shift = 0, .reg_off = HHI_AUD_CLK_CNTL,
.width = 8, .shift = 0,
.width = 8,
},
.flags = CLK_DIVIDER_ROUND_CLOSEST,
}, },
.flags = CLK_DIVIDER_ROUND_CLOSEST,
.lock = &meson_clk_lock,
.hw.init = &(struct clk_init_data){ .hw.init = &(struct clk_init_data){
.name = "cts_amclk_div", .name = "cts_amclk_div",
.ops = &meson_clk_audio_divider_ops, .ops = &meson_clk_audio_divider_ops,
...@@ -1777,10 +1778,6 @@ static struct meson_clk_pll *const gxl_clk_plls[] = { ...@@ -1777,10 +1778,6 @@ static struct meson_clk_pll *const gxl_clk_plls[] = {
&gxl_gp0_pll, &gxl_gp0_pll,
}; };
static struct meson_clk_audio_divider *const gxbb_audio_dividers[] = {
&gxbb_cts_amclk_div,
};
static struct clk_regmap *const gx_clk_regmaps[] = { static struct clk_regmap *const gx_clk_regmaps[] = {
&gxbb_clk81, &gxbb_clk81,
&gxbb_ddr, &gxbb_ddr,
...@@ -1912,29 +1909,24 @@ static struct clk_regmap *const gx_clk_regmaps[] = { ...@@ -1912,29 +1909,24 @@ static struct clk_regmap *const gx_clk_regmaps[] = {
&gxbb_mpll0, &gxbb_mpll0,
&gxbb_mpll1, &gxbb_mpll1,
&gxbb_mpll2, &gxbb_mpll2,
&gxbb_cts_amclk_div,
}; };
struct clkc_data { struct clkc_data {
struct meson_clk_pll *const *clk_plls; struct meson_clk_pll *const *clk_plls;
unsigned int clk_plls_count; unsigned int clk_plls_count;
struct meson_clk_audio_divider *const *clk_audio_dividers;
unsigned int clk_audio_dividers_count;
struct clk_hw_onecell_data *hw_onecell_data; struct clk_hw_onecell_data *hw_onecell_data;
}; };
static const struct clkc_data gxbb_clkc_data = { static const struct clkc_data gxbb_clkc_data = {
.clk_plls = gxbb_clk_plls, .clk_plls = gxbb_clk_plls,
.clk_plls_count = ARRAY_SIZE(gxbb_clk_plls), .clk_plls_count = ARRAY_SIZE(gxbb_clk_plls),
.clk_audio_dividers = gxbb_audio_dividers,
.clk_audio_dividers_count = ARRAY_SIZE(gxbb_audio_dividers),
.hw_onecell_data = &gxbb_hw_onecell_data, .hw_onecell_data = &gxbb_hw_onecell_data,
}; };
static const struct clkc_data gxl_clkc_data = { static const struct clkc_data gxl_clkc_data = {
.clk_plls = gxl_clk_plls, .clk_plls = gxl_clk_plls,
.clk_plls_count = ARRAY_SIZE(gxl_clk_plls), .clk_plls_count = ARRAY_SIZE(gxl_clk_plls),
.clk_audio_dividers = gxbb_audio_dividers,
.clk_audio_dividers_count = ARRAY_SIZE(gxbb_audio_dividers),
.hw_onecell_data = &gxl_hw_onecell_data, .hw_onecell_data = &gxl_hw_onecell_data,
}; };
...@@ -1981,10 +1973,6 @@ static int gxbb_clkc_probe(struct platform_device *pdev) ...@@ -1981,10 +1973,6 @@ static int gxbb_clkc_probe(struct platform_device *pdev)
for (i = 0; i < clkc_data->clk_plls_count; i++) for (i = 0; i < clkc_data->clk_plls_count; i++)
clkc_data->clk_plls[i]->base = clk_base; clkc_data->clk_plls[i]->base = clk_base;
/* Populate base address for the audio dividers */
for (i = 0; i < clkc_data->clk_audio_dividers_count; i++)
clkc_data->clk_audio_dividers[i]->base = clk_base;
/* Populate regmap for the common regmap backed clocks */ /* Populate regmap for the common regmap backed clocks */
for (i = 0; i < ARRAY_SIZE(gx_clk_regmaps); i++) for (i = 0; i < ARRAY_SIZE(gx_clk_regmaps); i++)
gx_clk_regmaps[i]->map = map; gx_clk_regmaps[i]->map = map;
......
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