1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Copyright (c) 2014, The Linux Foundation. All rights reserved.
4 */
5
6#include <linux/kernel.h>
7#include <linux/bitops.h>
8#include <linux/regmap.h>
9#include <linux/export.h>
10
11#include "clk-regmap-divider.h"
12
13static inline struct clk_regmap_div *to_clk_regmap_div(struct clk_hw *hw)
14{
15 return container_of(to_clk_regmap(hw), struct clk_regmap_div, clkr);
16}
17
18static long div_round_ro_rate(struct clk_hw *hw, unsigned long rate,
19 unsigned long *prate)
20{
21 struct clk_regmap_div *divider = to_clk_regmap_div(hw);
22 struct clk_regmap *clkr = &divider->clkr;
23 u32 val;
24
25 regmap_read(map: clkr->regmap, reg: divider->reg, val: &val);
26 val >>= divider->shift;
27 val &= BIT(divider->width) - 1;
28
29 return divider_ro_round_rate(hw, rate, prate, NULL, width: divider->width,
30 CLK_DIVIDER_ROUND_CLOSEST, val);
31}
32
33static long div_round_rate(struct clk_hw *hw, unsigned long rate,
34 unsigned long *prate)
35{
36 struct clk_regmap_div *divider = to_clk_regmap_div(hw);
37
38 return divider_round_rate(hw, rate, prate, NULL, width: divider->width,
39 CLK_DIVIDER_ROUND_CLOSEST);
40}
41
42static int div_set_rate(struct clk_hw *hw, unsigned long rate,
43 unsigned long parent_rate)
44{
45 struct clk_regmap_div *divider = to_clk_regmap_div(hw);
46 struct clk_regmap *clkr = &divider->clkr;
47 u32 div;
48
49 div = divider_get_val(rate, parent_rate, NULL, width: divider->width,
50 CLK_DIVIDER_ROUND_CLOSEST);
51
52 return regmap_update_bits(map: clkr->regmap, reg: divider->reg,
53 mask: (BIT(divider->width) - 1) << divider->shift,
54 val: div << divider->shift);
55}
56
57static unsigned long div_recalc_rate(struct clk_hw *hw,
58 unsigned long parent_rate)
59{
60 struct clk_regmap_div *divider = to_clk_regmap_div(hw);
61 struct clk_regmap *clkr = &divider->clkr;
62 u32 div;
63
64 regmap_read(map: clkr->regmap, reg: divider->reg, val: &div);
65 div >>= divider->shift;
66 div &= BIT(divider->width) - 1;
67
68 return divider_recalc_rate(hw, parent_rate, val: div, NULL,
69 CLK_DIVIDER_ROUND_CLOSEST, width: divider->width);
70}
71
72const struct clk_ops clk_regmap_div_ops = {
73 .round_rate = div_round_rate,
74 .set_rate = div_set_rate,
75 .recalc_rate = div_recalc_rate,
76};
77EXPORT_SYMBOL_GPL(clk_regmap_div_ops);
78
79const struct clk_ops clk_regmap_div_ro_ops = {
80 .round_rate = div_round_ro_rate,
81 .recalc_rate = div_recalc_rate,
82};
83EXPORT_SYMBOL_GPL(clk_regmap_div_ro_ops);
84

source code of linux/drivers/clk/qcom/clk-regmap-divider.c