clk: at91: replace prog clk round_rate with determine_rate

Implement the determine_rate callback to choose the best parent clk that
fulfills the requested rate.

Signed-off-by: Boris BREZILLON <b.brezillon@overkiz.com>
Signed-off-by: Mike Turquette <mturquette@linaro.org>
This commit is contained in:
Boris BREZILLON 2014-03-11 10:00:32 +01:00 committed by Mike Turquette
parent 843bad8361
commit 419f612932

View File

@ -102,40 +102,40 @@ static unsigned long clk_programmable_recalc_rate(struct clk_hw *hw,
return parent_rate >> prog->pres; return parent_rate >> prog->pres;
} }
static long clk_programmable_round_rate(struct clk_hw *hw, unsigned long rate, static long clk_programmable_determine_rate(struct clk_hw *hw,
unsigned long *parent_rate) unsigned long rate,
unsigned long *best_parent_rate,
struct clk **best_parent_clk)
{ {
unsigned long best_rate = *parent_rate; struct clk *parent = NULL;
unsigned long best_diff; long best_rate = -EINVAL;
unsigned long new_diff; unsigned long parent_rate;
unsigned long cur_rate; unsigned long tmp_rate;
int shift = shift; int shift;
int i;
if (rate > *parent_rate) for (i = 0; i < __clk_get_num_parents(hw->clk); i++) {
return *parent_rate; parent = clk_get_parent_by_index(hw->clk, i);
else if (!parent)
best_diff = *parent_rate - rate; continue;
if (!best_diff) parent_rate = __clk_get_rate(parent);
return best_rate; for (shift = 0; shift < PROG_PRES_MASK; shift++) {
tmp_rate = parent_rate >> shift;
for (shift = 1; shift < PROG_PRES_MASK; shift++) { if (tmp_rate <= rate)
cur_rate = *parent_rate >> shift; break;
if (cur_rate > rate)
new_diff = cur_rate - rate;
else
new_diff = rate - cur_rate;
if (!new_diff)
return cur_rate;
if (new_diff < best_diff) {
best_diff = new_diff;
best_rate = cur_rate;
} }
if (rate > cur_rate) if (tmp_rate > rate)
continue;
if (best_rate < 0 || (rate - tmp_rate) < (rate - best_rate)) {
best_rate = tmp_rate;
*best_parent_rate = parent_rate;
*best_parent_clk = parent;
}
if (!best_rate)
break; break;
} }
@ -228,7 +228,7 @@ static const struct clk_ops programmable_ops = {
.prepare = clk_programmable_prepare, .prepare = clk_programmable_prepare,
.is_prepared = clk_programmable_is_ready, .is_prepared = clk_programmable_is_ready,
.recalc_rate = clk_programmable_recalc_rate, .recalc_rate = clk_programmable_recalc_rate,
.round_rate = clk_programmable_round_rate, .determine_rate = clk_programmable_determine_rate,
.get_parent = clk_programmable_get_parent, .get_parent = clk_programmable_get_parent,
.set_parent = clk_programmable_set_parent, .set_parent = clk_programmable_set_parent,
.set_rate = clk_programmable_set_rate, .set_rate = clk_programmable_set_rate,