|
@@ -23,6 +23,29 @@ static inline struct clk_regmap_div *to_clk_regmap_div(struct clk_hw *hw)
|
|
|
return container_of(to_clk_regmap(hw), struct clk_regmap_div, clkr);
|
|
|
}
|
|
|
|
|
|
+static long div_round_ro_rate(struct clk_hw *hw, unsigned long rate,
|
|
|
+ unsigned long *prate)
|
|
|
+{
|
|
|
+ struct clk_regmap_div *divider = to_clk_regmap_div(hw);
|
|
|
+ struct clk_regmap *clkr = ÷r->clkr;
|
|
|
+ u32 div;
|
|
|
+ struct clk_hw *hw_parent = clk_hw_get_parent(hw);
|
|
|
+
|
|
|
+ regmap_read(clkr->regmap, divider->reg, &div);
|
|
|
+ div >>= divider->shift;
|
|
|
+ div &= BIT(divider->width) - 1;
|
|
|
+ div += 1;
|
|
|
+
|
|
|
+ if (clk_hw_get_flags(hw) & CLK_SET_RATE_PARENT) {
|
|
|
+ if (!hw_parent)
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ *prate = clk_hw_round_rate(hw_parent, rate * div);
|
|
|
+ }
|
|
|
+
|
|
|
+ return DIV_ROUND_UP_ULL((u64)*prate, div);
|
|
|
+}
|
|
|
+
|
|
|
static long div_round_rate(struct clk_hw *hw, unsigned long rate,
|
|
|
unsigned long *prate)
|
|
|
{
|
|
@@ -68,3 +91,9 @@ const struct clk_ops clk_regmap_div_ops = {
|
|
|
.recalc_rate = div_recalc_rate,
|
|
|
};
|
|
|
EXPORT_SYMBOL_GPL(clk_regmap_div_ops);
|
|
|
+
|
|
|
+const struct clk_ops clk_regmap_div_ro_ops = {
|
|
|
+ .round_rate = div_round_ro_rate,
|
|
|
+ .recalc_rate = div_recalc_rate,
|
|
|
+};
|
|
|
+EXPORT_SYMBOL_GPL(clk_regmap_div_ro_ops);
|