1 // SPDX-License-Identifier: GPL-2.0+
2 //
3 // OWL composite clock driver
4 //
5 // Copyright (c) 2014 Actions Semi Inc.
6 // Author: David Liu <liuwei@actions-semi.com>
7 //
8 // Copyright (c) 2018 Linaro Ltd.
9 // Author: Manivannan Sadhasivam <manivannan.sadhasivam@linaro.org>
10
11 #include <linux/clk-provider.h>
12 #include <linux/regmap.h>
13
14 #include "owl-composite.h"
15
owl_comp_get_parent(struct clk_hw * hw)16 static u8 owl_comp_get_parent(struct clk_hw *hw)
17 {
18 struct owl_composite *comp = hw_to_owl_comp(hw);
19
20 return owl_mux_helper_get_parent(&comp->common, &comp->mux_hw);
21 }
22
owl_comp_set_parent(struct clk_hw * hw,u8 index)23 static int owl_comp_set_parent(struct clk_hw *hw, u8 index)
24 {
25 struct owl_composite *comp = hw_to_owl_comp(hw);
26
27 return owl_mux_helper_set_parent(&comp->common, &comp->mux_hw, index);
28 }
29
owl_comp_disable(struct clk_hw * hw)30 static void owl_comp_disable(struct clk_hw *hw)
31 {
32 struct owl_composite *comp = hw_to_owl_comp(hw);
33 struct owl_clk_common *common = &comp->common;
34
35 owl_gate_set(common, &comp->gate_hw, false);
36 }
37
owl_comp_enable(struct clk_hw * hw)38 static int owl_comp_enable(struct clk_hw *hw)
39 {
40 struct owl_composite *comp = hw_to_owl_comp(hw);
41 struct owl_clk_common *common = &comp->common;
42
43 owl_gate_set(common, &comp->gate_hw, true);
44
45 return 0;
46 }
47
owl_comp_is_enabled(struct clk_hw * hw)48 static int owl_comp_is_enabled(struct clk_hw *hw)
49 {
50 struct owl_composite *comp = hw_to_owl_comp(hw);
51 struct owl_clk_common *common = &comp->common;
52
53 return owl_gate_clk_is_enabled(common, &comp->gate_hw);
54 }
55
owl_comp_div_determine_rate(struct clk_hw * hw,struct clk_rate_request * req)56 static int owl_comp_div_determine_rate(struct clk_hw *hw,
57 struct clk_rate_request *req)
58 {
59 struct owl_composite *comp = hw_to_owl_comp(hw);
60 long rate;
61
62 rate = owl_divider_helper_round_rate(&comp->common, &comp->rate.div_hw,
63 req->rate, &req->best_parent_rate);
64 if (rate < 0)
65 return rate;
66
67 req->rate = rate;
68 return 0;
69 }
70
owl_comp_div_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)71 static unsigned long owl_comp_div_recalc_rate(struct clk_hw *hw,
72 unsigned long parent_rate)
73 {
74 struct owl_composite *comp = hw_to_owl_comp(hw);
75
76 return owl_divider_helper_recalc_rate(&comp->common, &comp->rate.div_hw,
77 parent_rate);
78 }
79
owl_comp_div_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)80 static int owl_comp_div_set_rate(struct clk_hw *hw, unsigned long rate,
81 unsigned long parent_rate)
82 {
83 struct owl_composite *comp = hw_to_owl_comp(hw);
84
85 return owl_divider_helper_set_rate(&comp->common, &comp->rate.div_hw,
86 rate, parent_rate);
87 }
88
owl_comp_fact_determine_rate(struct clk_hw * hw,struct clk_rate_request * req)89 static int owl_comp_fact_determine_rate(struct clk_hw *hw,
90 struct clk_rate_request *req)
91 {
92 struct owl_composite *comp = hw_to_owl_comp(hw);
93 long rate;
94
95 rate = owl_factor_helper_round_rate(&comp->common,
96 &comp->rate.factor_hw,
97 req->rate, &req->best_parent_rate);
98 if (rate < 0)
99 return rate;
100
101 req->rate = rate;
102 return 0;
103 }
104
owl_comp_fact_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)105 static unsigned long owl_comp_fact_recalc_rate(struct clk_hw *hw,
106 unsigned long parent_rate)
107 {
108 struct owl_composite *comp = hw_to_owl_comp(hw);
109
110 return owl_factor_helper_recalc_rate(&comp->common,
111 &comp->rate.factor_hw,
112 parent_rate);
113 }
114
owl_comp_fact_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)115 static int owl_comp_fact_set_rate(struct clk_hw *hw, unsigned long rate,
116 unsigned long parent_rate)
117 {
118 struct owl_composite *comp = hw_to_owl_comp(hw);
119
120 return owl_factor_helper_set_rate(&comp->common,
121 &comp->rate.factor_hw,
122 rate, parent_rate);
123 }
124
owl_comp_fix_fact_round_rate(struct clk_hw * hw,unsigned long rate,unsigned long * parent_rate)125 static long owl_comp_fix_fact_round_rate(struct clk_hw *hw, unsigned long rate,
126 unsigned long *parent_rate)
127 {
128 struct owl_composite *comp = hw_to_owl_comp(hw);
129 struct clk_fixed_factor *fix_fact_hw = &comp->rate.fix_fact_hw;
130
131 return comp->fix_fact_ops->round_rate(&fix_fact_hw->hw, rate, parent_rate);
132 }
133
owl_comp_fix_fact_recalc_rate(struct clk_hw * hw,unsigned long parent_rate)134 static unsigned long owl_comp_fix_fact_recalc_rate(struct clk_hw *hw,
135 unsigned long parent_rate)
136 {
137 struct owl_composite *comp = hw_to_owl_comp(hw);
138 struct clk_fixed_factor *fix_fact_hw = &comp->rate.fix_fact_hw;
139
140 return comp->fix_fact_ops->recalc_rate(&fix_fact_hw->hw, parent_rate);
141
142 }
143
owl_comp_fix_fact_set_rate(struct clk_hw * hw,unsigned long rate,unsigned long parent_rate)144 static int owl_comp_fix_fact_set_rate(struct clk_hw *hw, unsigned long rate,
145 unsigned long parent_rate)
146 {
147 /*
148 * We must report success but we can do so unconditionally because
149 * owl_comp_fix_fact_round_rate returns values that ensure this call is
150 * a nop.
151 */
152
153 return 0;
154 }
155
156 const struct clk_ops owl_comp_div_ops = {
157 /* mux_ops */
158 .get_parent = owl_comp_get_parent,
159 .set_parent = owl_comp_set_parent,
160
161 /* gate_ops */
162 .disable = owl_comp_disable,
163 .enable = owl_comp_enable,
164 .is_enabled = owl_comp_is_enabled,
165
166 /* div_ops */
167 .determine_rate = owl_comp_div_determine_rate,
168 .recalc_rate = owl_comp_div_recalc_rate,
169 .set_rate = owl_comp_div_set_rate,
170 };
171
172
173 const struct clk_ops owl_comp_fact_ops = {
174 /* mux_ops */
175 .get_parent = owl_comp_get_parent,
176 .set_parent = owl_comp_set_parent,
177
178 /* gate_ops */
179 .disable = owl_comp_disable,
180 .enable = owl_comp_enable,
181 .is_enabled = owl_comp_is_enabled,
182
183 /* fact_ops */
184 .determine_rate = owl_comp_fact_determine_rate,
185 .recalc_rate = owl_comp_fact_recalc_rate,
186 .set_rate = owl_comp_fact_set_rate,
187 };
188
189 const struct clk_ops owl_comp_fix_fact_ops = {
190 /* gate_ops */
191 .disable = owl_comp_disable,
192 .enable = owl_comp_enable,
193 .is_enabled = owl_comp_is_enabled,
194
195 /* fix_fact_ops */
196 .round_rate = owl_comp_fix_fact_round_rate,
197 .recalc_rate = owl_comp_fix_fact_recalc_rate,
198 .set_rate = owl_comp_fix_fact_set_rate,
199 };
200
201
202 const struct clk_ops owl_comp_pass_ops = {
203 /* mux_ops */
204 .determine_rate = clk_hw_determine_rate_no_reparent,
205 .get_parent = owl_comp_get_parent,
206 .set_parent = owl_comp_set_parent,
207
208 /* gate_ops */
209 .disable = owl_comp_disable,
210 .enable = owl_comp_enable,
211 .is_enabled = owl_comp_is_enabled,
212 };
213