diff options
Diffstat (limited to 'drivers/clk/clk-divider.c')
-rw-r--r-- | drivers/clk/clk-divider.c | 36 |
1 files changed, 30 insertions, 6 deletions
diff --git a/drivers/clk/clk-divider.c b/drivers/clk/clk-divider.c index 3c98d2650fa3..b6234a5da12d 100644 --- a/drivers/clk/clk-divider.c +++ b/drivers/clk/clk-divider.c | |||
@@ -342,19 +342,43 @@ long divider_round_rate_parent(struct clk_hw *hw, struct clk_hw *parent, | |||
342 | } | 342 | } |
343 | EXPORT_SYMBOL_GPL(divider_round_rate_parent); | 343 | EXPORT_SYMBOL_GPL(divider_round_rate_parent); |
344 | 344 | ||
345 | long divider_ro_round_rate_parent(struct clk_hw *hw, struct clk_hw *parent, | ||
346 | unsigned long rate, unsigned long *prate, | ||
347 | const struct clk_div_table *table, u8 width, | ||
348 | unsigned long flags, unsigned int val) | ||
349 | { | ||
350 | int div; | ||
351 | |||
352 | div = _get_div(table, val, flags, width); | ||
353 | |||
354 | /* Even a read-only clock can propagate a rate change */ | ||
355 | if (clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT) { | ||
356 | if (!parent) | ||
357 | return -EINVAL; | ||
358 | |||
359 | *prate = clk_hw_round_rate(parent, rate * div); | ||
360 | } | ||
361 | |||
362 | return DIV_ROUND_UP_ULL((u64)*prate, div); | ||
363 | } | ||
364 | EXPORT_SYMBOL_GPL(divider_ro_round_rate_parent); | ||
365 | |||
366 | |||
345 | static long clk_divider_round_rate(struct clk_hw *hw, unsigned long rate, | 367 | static long clk_divider_round_rate(struct clk_hw *hw, unsigned long rate, |
346 | unsigned long *prate) | 368 | unsigned long *prate) |
347 | { | 369 | { |
348 | struct clk_divider *divider = to_clk_divider(hw); | 370 | struct clk_divider *divider = to_clk_divider(hw); |
349 | int bestdiv; | ||
350 | 371 | ||
351 | /* if read only, just return current value */ | 372 | /* if read only, just return current value */ |
352 | if (divider->flags & CLK_DIVIDER_READ_ONLY) { | 373 | if (divider->flags & CLK_DIVIDER_READ_ONLY) { |
353 | bestdiv = clk_readl(divider->reg) >> divider->shift; | 374 | u32 val; |
354 | bestdiv &= clk_div_mask(divider->width); | 375 | |
355 | bestdiv = _get_div(divider->table, bestdiv, divider->flags, | 376 | val = clk_readl(divider->reg) >> divider->shift; |
356 | divider->width); | 377 | val &= clk_div_mask(divider->width); |
357 | return DIV_ROUND_UP_ULL((u64)*prate, bestdiv); | 378 | |
379 | return divider_ro_round_rate(hw, rate, prate, divider->table, | ||
380 | divider->width, divider->flags, | ||
381 | val); | ||
358 | } | 382 | } |
359 | 383 | ||
360 | return divider_round_rate(hw, rate, prate, divider->table, | 384 | return divider_round_rate(hw, rate, prate, divider->table, |