2 * Copyright (c) 2014, The Linux Foundation. All rights reserved.
4 * This software is licensed under the terms of the GNU General Public
5 * License version 2, as published by the Free Software Foundation, and
6 * may be copied, distributed, and modified under those terms.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
14 #include <linux/kernel.h>
15 #include <linux/bitops.h>
16 #include <linux/regmap.h>
17 #include <linux/export.h>
19 #include "clk-regmap-divider.h"
21 static inline struct clk_regmap_div
*to_clk_regmap_div(struct clk_hw
*hw
)
23 return container_of(to_clk_regmap(hw
), struct clk_regmap_div
, clkr
);
26 static long div_round_ro_rate(struct clk_hw
*hw
, unsigned long rate
,
29 struct clk_regmap_div
*divider
= to_clk_regmap_div(hw
);
30 struct clk_regmap
*clkr
= ÷r
->clkr
;
33 regmap_read(clkr
->regmap
, divider
->reg
, &val
);
34 val
>>= divider
->shift
;
35 val
&= BIT(divider
->width
) - 1;
37 return divider_ro_round_rate(hw
, rate
, prate
, NULL
, divider
->width
,
38 CLK_DIVIDER_ROUND_CLOSEST
, val
);
41 static long div_round_rate(struct clk_hw
*hw
, unsigned long rate
,
44 struct clk_regmap_div
*divider
= to_clk_regmap_div(hw
);
46 return divider_round_rate(hw
, rate
, prate
, NULL
, divider
->width
,
47 CLK_DIVIDER_ROUND_CLOSEST
);
50 static int div_set_rate(struct clk_hw
*hw
, unsigned long rate
,
51 unsigned long parent_rate
)
53 struct clk_regmap_div
*divider
= to_clk_regmap_div(hw
);
54 struct clk_regmap
*clkr
= ÷r
->clkr
;
57 div
= divider_get_val(rate
, parent_rate
, NULL
, divider
->width
,
58 CLK_DIVIDER_ROUND_CLOSEST
);
60 return regmap_update_bits(clkr
->regmap
, divider
->reg
,
61 (BIT(divider
->width
) - 1) << divider
->shift
,
62 div
<< divider
->shift
);
65 static unsigned long div_recalc_rate(struct clk_hw
*hw
,
66 unsigned long parent_rate
)
68 struct clk_regmap_div
*divider
= to_clk_regmap_div(hw
);
69 struct clk_regmap
*clkr
= ÷r
->clkr
;
72 regmap_read(clkr
->regmap
, divider
->reg
, &div
);
73 div
>>= divider
->shift
;
74 div
&= BIT(divider
->width
) - 1;
76 return divider_recalc_rate(hw
, parent_rate
, div
, NULL
,
77 CLK_DIVIDER_ROUND_CLOSEST
, divider
->width
);
80 const struct clk_ops clk_regmap_div_ops
= {
81 .round_rate
= div_round_rate
,
82 .set_rate
= div_set_rate
,
83 .recalc_rate
= div_recalc_rate
,
85 EXPORT_SYMBOL_GPL(clk_regmap_div_ops
);
87 const struct clk_ops clk_regmap_div_ro_ops
= {
88 .round_rate
= div_round_ro_rate
,
89 .recalc_rate
= div_recalc_rate
,
91 EXPORT_SYMBOL_GPL(clk_regmap_div_ro_ops
);