1
2
3
4
5
6
7
8
9
10#include <linux/clk-provider.h>
11#include <linux/mfd/abx500/ab8500-sysctrl.h>
12#include <linux/device.h>
13#include <linux/slab.h>
14#include <linux/delay.h>
15#include <linux/io.h>
16#include <linux/err.h>
17#include "clk.h"
18
19#define SYSCTRL_MAX_NUM_PARENTS 4
20
21#define to_clk_sysctrl(_hw) container_of(_hw, struct clk_sysctrl, hw)
22
23struct clk_sysctrl {
24 struct clk_hw hw;
25 struct device *dev;
26 u8 parent_index;
27 u16 reg_sel[SYSCTRL_MAX_NUM_PARENTS];
28 u8 reg_mask[SYSCTRL_MAX_NUM_PARENTS];
29 u8 reg_bits[SYSCTRL_MAX_NUM_PARENTS];
30 unsigned long rate;
31 unsigned long enable_delay_us;
32};
33
34
35
36static int clk_sysctrl_prepare(struct clk_hw *hw)
37{
38 int ret;
39 struct clk_sysctrl *clk = to_clk_sysctrl(hw);
40
41 ret = ab8500_sysctrl_write(clk->reg_sel[0], clk->reg_mask[0],
42 clk->reg_bits[0]);
43
44 if (!ret && clk->enable_delay_us)
45 usleep_range(clk->enable_delay_us, clk->enable_delay_us);
46
47 return ret;
48}
49
50static void clk_sysctrl_unprepare(struct clk_hw *hw)
51{
52 struct clk_sysctrl *clk = to_clk_sysctrl(hw);
53 if (ab8500_sysctrl_clear(clk->reg_sel[0], clk->reg_mask[0]))
54 dev_err(clk->dev, "clk_sysctrl: %s fail to clear %s.\n",
55 __func__, clk_hw_get_name(hw));
56}
57
58static unsigned long clk_sysctrl_recalc_rate(struct clk_hw *hw,
59 unsigned long parent_rate)
60{
61 struct clk_sysctrl *clk = to_clk_sysctrl(hw);
62 return clk->rate;
63}
64
65static int clk_sysctrl_set_parent(struct clk_hw *hw, u8 index)
66{
67 struct clk_sysctrl *clk = to_clk_sysctrl(hw);
68 u8 old_index = clk->parent_index;
69 int ret = 0;
70
71 if (clk->reg_sel[old_index]) {
72 ret = ab8500_sysctrl_clear(clk->reg_sel[old_index],
73 clk->reg_mask[old_index]);
74 if (ret)
75 return ret;
76 }
77
78 if (clk->reg_sel[index]) {
79 ret = ab8500_sysctrl_write(clk->reg_sel[index],
80 clk->reg_mask[index],
81 clk->reg_bits[index]);
82 if (ret) {
83 if (clk->reg_sel[old_index])
84 ab8500_sysctrl_write(clk->reg_sel[old_index],
85 clk->reg_mask[old_index],
86 clk->reg_bits[old_index]);
87 return ret;
88 }
89 }
90 clk->parent_index = index;
91
92 return ret;
93}
94
95static u8 clk_sysctrl_get_parent(struct clk_hw *hw)
96{
97 struct clk_sysctrl *clk = to_clk_sysctrl(hw);
98 return clk->parent_index;
99}
100
101static const struct clk_ops clk_sysctrl_gate_ops = {
102 .prepare = clk_sysctrl_prepare,
103 .unprepare = clk_sysctrl_unprepare,
104};
105
106static const struct clk_ops clk_sysctrl_gate_fixed_rate_ops = {
107 .prepare = clk_sysctrl_prepare,
108 .unprepare = clk_sysctrl_unprepare,
109 .recalc_rate = clk_sysctrl_recalc_rate,
110};
111
112static const struct clk_ops clk_sysctrl_set_parent_ops = {
113 .set_parent = clk_sysctrl_set_parent,
114 .get_parent = clk_sysctrl_get_parent,
115};
116
117static struct clk *clk_reg_sysctrl(struct device *dev,
118 const char *name,
119 const char **parent_names,
120 u8 num_parents,
121 u16 *reg_sel,
122 u8 *reg_mask,
123 u8 *reg_bits,
124 unsigned long rate,
125 unsigned long enable_delay_us,
126 unsigned long flags,
127 const struct clk_ops *clk_sysctrl_ops)
128{
129 struct clk_sysctrl *clk;
130 struct clk_init_data clk_sysctrl_init;
131 struct clk *clk_reg;
132 int i;
133
134 if (!dev)
135 return ERR_PTR(-EINVAL);
136
137 if (!name || (num_parents > SYSCTRL_MAX_NUM_PARENTS)) {
138 dev_err(dev, "clk_sysctrl: invalid arguments passed\n");
139 return ERR_PTR(-EINVAL);
140 }
141
142 clk = devm_kzalloc(dev, sizeof(*clk), GFP_KERNEL);
143 if (!clk)
144 return ERR_PTR(-ENOMEM);
145
146
147 clk->reg_sel[0] = reg_sel[0];
148 clk->reg_bits[0] = reg_bits[0];
149 clk->reg_mask[0] = reg_mask[0];
150
151
152 for (i = 1; i < num_parents; i++) {
153 clk->reg_sel[i] = reg_sel[i];
154 clk->reg_bits[i] = reg_bits[i];
155 clk->reg_mask[i] = reg_mask[i];
156 }
157
158 clk->parent_index = 0;
159 clk->rate = rate;
160 clk->enable_delay_us = enable_delay_us;
161 clk->dev = dev;
162
163 clk_sysctrl_init.name = name;
164 clk_sysctrl_init.ops = clk_sysctrl_ops;
165 clk_sysctrl_init.flags = flags;
166 clk_sysctrl_init.parent_names = parent_names;
167 clk_sysctrl_init.num_parents = num_parents;
168 clk->hw.init = &clk_sysctrl_init;
169
170 clk_reg = devm_clk_register(clk->dev, &clk->hw);
171 if (IS_ERR(clk_reg))
172 dev_err(dev, "clk_sysctrl: clk_register failed\n");
173
174 return clk_reg;
175}
176
177struct clk *clk_reg_sysctrl_gate(struct device *dev,
178 const char *name,
179 const char *parent_name,
180 u16 reg_sel,
181 u8 reg_mask,
182 u8 reg_bits,
183 unsigned long enable_delay_us,
184 unsigned long flags)
185{
186 const char **parent_names = (parent_name ? &parent_name : NULL);
187 u8 num_parents = (parent_name ? 1 : 0);
188
189 return clk_reg_sysctrl(dev, name, parent_names, num_parents,
190 ®_sel, ®_mask, ®_bits, 0, enable_delay_us,
191 flags, &clk_sysctrl_gate_ops);
192}
193
194struct clk *clk_reg_sysctrl_gate_fixed_rate(struct device *dev,
195 const char *name,
196 const char *parent_name,
197 u16 reg_sel,
198 u8 reg_mask,
199 u8 reg_bits,
200 unsigned long rate,
201 unsigned long enable_delay_us,
202 unsigned long flags)
203{
204 const char **parent_names = (parent_name ? &parent_name : NULL);
205 u8 num_parents = (parent_name ? 1 : 0);
206
207 return clk_reg_sysctrl(dev, name, parent_names, num_parents,
208 ®_sel, ®_mask, ®_bits,
209 rate, enable_delay_us, flags,
210 &clk_sysctrl_gate_fixed_rate_ops);
211}
212
213struct clk *clk_reg_sysctrl_set_parent(struct device *dev,
214 const char *name,
215 const char **parent_names,
216 u8 num_parents,
217 u16 *reg_sel,
218 u8 *reg_mask,
219 u8 *reg_bits,
220 unsigned long flags)
221{
222 return clk_reg_sysctrl(dev, name, parent_names, num_parents,
223 reg_sel, reg_mask, reg_bits, 0, 0, flags,
224 &clk_sysctrl_set_parent_ops);
225}
226
