Commit 87ba9e59 authored by Maxime Ripard's avatar Maxime Ripard

clk: sunxi-ng: div: Allow to set a maximum

Some dividers might have a maximum value that is lower than the width of
the register.

Add a field to _ccu_div to handle those case properly. If the field is set
to 0, the code will assume that the maximum value is the maximum one that
can be used with the field register width.

Otherwise, we'll use whatever value has been set.
Signed-off-by: default avatarMaxime Ripard <maxime.ripard@free-electrons.com>
Acked-by: default avatarChen-Yu Tsai <wens@csie.org>
parent e9c959a6
...@@ -23,6 +23,9 @@ ...@@ -23,6 +23,9 @@
* struct _ccu_div - Internal divider description * struct _ccu_div - Internal divider description
* @shift: Bit offset of the divider in its register * @shift: Bit offset of the divider in its register
* @width: Width of the divider field in its register * @width: Width of the divider field in its register
* @max: Maximum value allowed for that divider. This is the
* arithmetic value, not the maximum value to be set in the
* register.
* @flags: clk_divider flags to apply on this divider * @flags: clk_divider flags to apply on this divider
* @table: Divider table pointer (if applicable) * @table: Divider table pointer (if applicable)
* *
...@@ -37,6 +40,8 @@ struct _ccu_div { ...@@ -37,6 +40,8 @@ struct _ccu_div {
u8 shift; u8 shift;
u8 width; u8 width;
u32 max;
u32 flags; u32 flags;
struct clk_div_table *table; struct clk_div_table *table;
...@@ -50,14 +55,25 @@ struct _ccu_div { ...@@ -50,14 +55,25 @@ struct _ccu_div {
.table = _table, \ .table = _table, \
} }
#define _SUNXI_CCU_DIV_FLAGS(_shift, _width, _flags) \
_SUNXI_CCU_DIV_TABLE_FLAGS(_shift, _width, NULL, _flags)
#define _SUNXI_CCU_DIV_TABLE(_shift, _width, _table) \ #define _SUNXI_CCU_DIV_TABLE(_shift, _width, _table) \
_SUNXI_CCU_DIV_TABLE_FLAGS(_shift, _width, _table, 0) _SUNXI_CCU_DIV_TABLE_FLAGS(_shift, _width, _table, 0)
#define _SUNXI_CCU_DIV_MAX_FLAGS(_shift, _width, _max, _flags) \
{ \
.shift = _shift, \
.width = _width, \
.flags = _flags, \
.max = _max, \
}
#define _SUNXI_CCU_DIV_FLAGS(_shift, _width, _flags) \
_SUNXI_CCU_DIV_MAX_FLAGS(_shift, _width, 0, _flags)
#define _SUNXI_CCU_DIV_MAX(_shift, _width, _max) \
_SUNXI_CCU_DIV_MAX_FLAGS(_shift, _width, _max, 0)
#define _SUNXI_CCU_DIV(_shift, _width) \ #define _SUNXI_CCU_DIV(_shift, _width) \
_SUNXI_CCU_DIV_TABLE_FLAGS(_shift, _width, NULL, 0) _SUNXI_CCU_DIV_FLAGS(_shift, _width, 0)
struct ccu_div { struct ccu_div {
u32 enable; u32 enable;
......
...@@ -21,9 +21,9 @@ static void ccu_mp_find_best(unsigned long parent, unsigned long rate, ...@@ -21,9 +21,9 @@ static void ccu_mp_find_best(unsigned long parent, unsigned long rate,
unsigned int best_m = 0, best_p = 0; unsigned int best_m = 0, best_p = 0;
unsigned int _m, _p; unsigned int _m, _p;
for (_p = 0; _p <= max_p; _p++) { for (_p = 1; _p <= max_p; _p <<= 1) {
for (_m = 1; _m <= max_m; _m++) { for (_m = 1; _m <= max_m; _m++) {
unsigned long tmp_rate = (parent >> _p) / _m; unsigned long tmp_rate = parent / _p / _m;
if (tmp_rate > rate) if (tmp_rate > rate)
continue; continue;
...@@ -46,13 +46,15 @@ static unsigned long ccu_mp_round_rate(struct ccu_mux_internal *mux, ...@@ -46,13 +46,15 @@ static unsigned long ccu_mp_round_rate(struct ccu_mux_internal *mux,
void *data) void *data)
{ {
struct ccu_mp *cmp = data; struct ccu_mp *cmp = data;
unsigned int max_m, max_p;
unsigned int m, p; unsigned int m, p;
ccu_mp_find_best(parent_rate, rate, max_m = cmp->m.max ?: 1 << cmp->m.width;
1 << cmp->m.width, (1 << cmp->p.width) - 1, max_p = cmp->p.max ?: 1 << ((1 << cmp->p.width) - 1);
&m, &p);
return (parent_rate >> p) / m; ccu_mp_find_best(parent_rate, rate, max_m, max_p, &m, &p);
return parent_rate / p / m;
} }
static void ccu_mp_disable(struct clk_hw *hw) static void ccu_mp_disable(struct clk_hw *hw)
...@@ -108,13 +110,14 @@ static int ccu_mp_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -108,13 +110,14 @@ static int ccu_mp_set_rate(struct clk_hw *hw, unsigned long rate,
{ {
struct ccu_mp *cmp = hw_to_ccu_mp(hw); struct ccu_mp *cmp = hw_to_ccu_mp(hw);
unsigned long flags; unsigned long flags;
unsigned int max_m, max_p;
unsigned int m, p; unsigned int m, p;
u32 reg; u32 reg;
ccu_mp_find_best(parent_rate, rate, max_m = cmp->m.max ?: 1 << cmp->m.width;
1 << cmp->m.width, (1 << cmp->p.width) - 1, max_p = cmp->p.max ?: 1 << ((1 << cmp->p.width) - 1);
&m, &p);
ccu_mp_find_best(parent_rate, rate, max_m, max_p, &m, &p);
spin_lock_irqsave(cmp->common.lock, flags); spin_lock_irqsave(cmp->common.lock, flags);
...@@ -122,7 +125,7 @@ static int ccu_mp_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -122,7 +125,7 @@ static int ccu_mp_set_rate(struct clk_hw *hw, unsigned long rate,
reg &= ~GENMASK(cmp->m.width + cmp->m.shift - 1, cmp->m.shift); reg &= ~GENMASK(cmp->m.width + cmp->m.shift - 1, cmp->m.shift);
reg &= ~GENMASK(cmp->p.width + cmp->p.shift - 1, cmp->p.shift); reg &= ~GENMASK(cmp->p.width + cmp->p.shift - 1, cmp->p.shift);
writel(reg | (p << cmp->p.shift) | ((m - 1) << cmp->m.shift), writel(reg | (ilog2(p) << cmp->p.shift) | ((m - 1) << cmp->m.shift),
cmp->common.base + cmp->common.reg); cmp->common.base + cmp->common.reg);
spin_unlock_irqrestore(cmp->common.lock, flags); spin_unlock_irqrestore(cmp->common.lock, flags);
......
...@@ -103,7 +103,7 @@ static unsigned long ccu_nkm_round_rate(struct ccu_mux_internal *mux, ...@@ -103,7 +103,7 @@ static unsigned long ccu_nkm_round_rate(struct ccu_mux_internal *mux,
_nkm.max_n = 1 << nkm->n.width; _nkm.max_n = 1 << nkm->n.width;
_nkm.max_k = 1 << nkm->k.width; _nkm.max_k = 1 << nkm->k.width;
_nkm.max_m = 1 << nkm->m.width; _nkm.max_m = nkm->m.max ?: 1 << nkm->m.width;
ccu_nkm_find_best(parent_rate, rate, &_nkm); ccu_nkm_find_best(parent_rate, rate, &_nkm);
...@@ -129,7 +129,7 @@ static int ccu_nkm_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -129,7 +129,7 @@ static int ccu_nkm_set_rate(struct clk_hw *hw, unsigned long rate,
_nkm.max_n = 1 << nkm->n.width; _nkm.max_n = 1 << nkm->n.width;
_nkm.max_k = 1 << nkm->k.width; _nkm.max_k = 1 << nkm->k.width;
_nkm.max_m = 1 << nkm->m.width; _nkm.max_m = nkm->m.max ?: 1 << nkm->m.width;
ccu_nkm_find_best(parent_rate, rate, &_nkm); ccu_nkm_find_best(parent_rate, rate, &_nkm);
......
...@@ -29,14 +29,14 @@ static void ccu_nkmp_find_best(unsigned long parent, unsigned long rate, ...@@ -29,14 +29,14 @@ static void ccu_nkmp_find_best(unsigned long parent, unsigned long rate,
unsigned long _n, _k, _m, _p; unsigned long _n, _k, _m, _p;
for (_k = 1; _k <= nkmp->max_k; _k++) { for (_k = 1; _k <= nkmp->max_k; _k++) {
for (_p = 0; _p <= nkmp->max_p; _p++) { for (_p = 1; _p <= nkmp->max_p; _p <<= 1) {
unsigned long tmp_rate; unsigned long tmp_rate;
rational_best_approximation(rate / _k, parent >> _p, rational_best_approximation(rate / _k, parent / _p,
nkmp->max_n, nkmp->max_m, nkmp->max_n, nkmp->max_m,
&_n, &_m); &_n, &_m);
tmp_rate = (parent * _n * _k >> _p) / _m; tmp_rate = parent * _n * _k / (_m * _p);
if (tmp_rate > rate) if (tmp_rate > rate)
continue; continue;
...@@ -110,13 +110,12 @@ static long ccu_nkmp_round_rate(struct clk_hw *hw, unsigned long rate, ...@@ -110,13 +110,12 @@ static long ccu_nkmp_round_rate(struct clk_hw *hw, unsigned long rate,
_nkmp.max_n = 1 << nkmp->n.width; _nkmp.max_n = 1 << nkmp->n.width;
_nkmp.max_k = 1 << nkmp->k.width; _nkmp.max_k = 1 << nkmp->k.width;
_nkmp.max_m = 1 << nkmp->m.width; _nkmp.max_m = nkmp->m.max ?: 1 << nkmp->m.width;
_nkmp.max_p = (1 << nkmp->p.width) - 1; _nkmp.max_p = nkmp->p.max ?: 1 << ((1 << nkmp->p.width) - 1);
ccu_nkmp_find_best(*parent_rate, rate, ccu_nkmp_find_best(*parent_rate, rate, &_nkmp);
&_nkmp);
return (*parent_rate * _nkmp.n * _nkmp.k >> _nkmp.p) / _nkmp.m; return *parent_rate * _nkmp.n * _nkmp.k / (_nkmp.m * _nkmp.p);
} }
static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate, static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate,
...@@ -129,8 +128,8 @@ static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -129,8 +128,8 @@ static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate,
_nkmp.max_n = 1 << nkmp->n.width; _nkmp.max_n = 1 << nkmp->n.width;
_nkmp.max_k = 1 << nkmp->k.width; _nkmp.max_k = 1 << nkmp->k.width;
_nkmp.max_m = 1 << nkmp->m.width; _nkmp.max_m = nkmp->m.max ?: 1 << nkmp->m.width;
_nkmp.max_p = (1 << nkmp->p.width) - 1; _nkmp.max_p = nkmp->p.max ?: 1 << ((1 << nkmp->p.width) - 1);
ccu_nkmp_find_best(parent_rate, rate, &_nkmp); ccu_nkmp_find_best(parent_rate, rate, &_nkmp);
...@@ -145,7 +144,7 @@ static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -145,7 +144,7 @@ static int ccu_nkmp_set_rate(struct clk_hw *hw, unsigned long rate,
reg |= (_nkmp.n - 1) << nkmp->n.shift; reg |= (_nkmp.n - 1) << nkmp->n.shift;
reg |= (_nkmp.k - 1) << nkmp->k.shift; reg |= (_nkmp.k - 1) << nkmp->k.shift;
reg |= (_nkmp.m - 1) << nkmp->m.shift; reg |= (_nkmp.m - 1) << nkmp->m.shift;
reg |= _nkmp.p << nkmp->p.shift; reg |= ilog2(_nkmp.p) << nkmp->p.shift;
writel(reg, nkmp->common.base + nkmp->common.reg); writel(reg, nkmp->common.base + nkmp->common.reg);
......
...@@ -61,11 +61,13 @@ static long ccu_nm_round_rate(struct clk_hw *hw, unsigned long rate, ...@@ -61,11 +61,13 @@ static long ccu_nm_round_rate(struct clk_hw *hw, unsigned long rate,
unsigned long *parent_rate) unsigned long *parent_rate)
{ {
struct ccu_nm *nm = hw_to_ccu_nm(hw); struct ccu_nm *nm = hw_to_ccu_nm(hw);
unsigned long max_n, max_m;
unsigned long n, m; unsigned long n, m;
rational_best_approximation(rate, *parent_rate, max_n = 1 << nm->n.width;
1 << nm->n.width, 1 << nm->m.width, max_m = nm->m.max ?: 1 << nm->m.width;
&n, &m);
rational_best_approximation(rate, *parent_rate, max_n, max_m, &n, &m);
return *parent_rate * n / m; return *parent_rate * n / m;
} }
...@@ -75,6 +77,7 @@ static int ccu_nm_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -75,6 +77,7 @@ static int ccu_nm_set_rate(struct clk_hw *hw, unsigned long rate,
{ {
struct ccu_nm *nm = hw_to_ccu_nm(hw); struct ccu_nm *nm = hw_to_ccu_nm(hw);
unsigned long flags; unsigned long flags;
unsigned long max_n, max_m;
unsigned long n, m; unsigned long n, m;
u32 reg; u32 reg;
...@@ -83,9 +86,10 @@ static int ccu_nm_set_rate(struct clk_hw *hw, unsigned long rate, ...@@ -83,9 +86,10 @@ static int ccu_nm_set_rate(struct clk_hw *hw, unsigned long rate,
else else
ccu_frac_helper_disable(&nm->common, &nm->frac); ccu_frac_helper_disable(&nm->common, &nm->frac);
rational_best_approximation(rate, parent_rate, max_n = 1 << nm->n.width;
1 << nm->n.width, 1 << nm->m.width, max_m = nm->m.max ?: 1 << nm->m.width;
&n, &m);
rational_best_approximation(rate, parent_rate, max_n, max_m, &n, &m);
spin_lock_irqsave(nm->common.lock, flags); spin_lock_irqsave(nm->common.lock, flags);
......
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