Merge git://git.kernel.org/pub/scm/linux/kernel/git/davem/net
[deliverable/linux.git] / arch / arm / mach-imx / clk-pllv3.c
CommitLineData
a3f6b9db
SG
1/*
2 * Copyright 2012 Freescale Semiconductor, Inc.
3 * Copyright 2012 Linaro Ltd.
4 *
5 * The code contained herein is licensed under the GNU General Public
6 * License. You may obtain a copy of the GNU General Public License
7 * Version 2 or later at the following locations:
8 *
9 * http://www.opensource.org/licenses/gpl-license.html
10 * http://www.gnu.org/copyleft/gpl.html
11 */
12
13#include <linux/clk.h>
14#include <linux/clk-provider.h>
322503a1 15#include <linux/delay.h>
a3f6b9db
SG
16#include <linux/io.h>
17#include <linux/slab.h>
18#include <linux/jiffies.h>
19#include <linux/err.h>
20#include "clk.h"
21
22#define PLL_NUM_OFFSET 0x10
23#define PLL_DENOM_OFFSET 0x20
24
25#define BM_PLL_POWER (0x1 << 12)
26#define BM_PLL_ENABLE (0x1 << 13)
27#define BM_PLL_BYPASS (0x1 << 16)
28#define BM_PLL_LOCK (0x1 << 31)
29
30/**
31 * struct clk_pllv3 - IMX PLL clock version 3
32 * @clk_hw: clock source
33 * @base: base address of PLL registers
34 * @powerup_set: set POWER bit to power up the PLL
a3f6b9db
SG
35 * @div_mask: mask of divider bits
36 *
37 * IMX PLL clock version 3, found on i.MX6 series. Divider for pllv3
38 * is actually a multiplier, and always sits at bit 0.
39 */
40struct clk_pllv3 {
41 struct clk_hw hw;
42 void __iomem *base;
43 bool powerup_set;
a3f6b9db
SG
44 u32 div_mask;
45};
46
47#define to_clk_pllv3(_hw) container_of(_hw, struct clk_pllv3, hw)
48
bc3b84da 49static int clk_pllv3_wait_lock(struct clk_pllv3 *pll)
a3f6b9db 50{
bc3b84da
SG
51 unsigned long timeout = jiffies + msecs_to_jiffies(10);
52 u32 val = readl_relaxed(pll->base) & BM_PLL_POWER;
a3f6b9db 53
bc3b84da
SG
54 /* No need to wait for lock when pll is not powered up */
55 if ((pll->powerup_set && !val) || (!pll->powerup_set && val))
56 return 0;
a3f6b9db
SG
57
58 /* Wait for PLL to lock */
0a036388
PC
59 do {
60 if (readl_relaxed(pll->base) & BM_PLL_LOCK)
61 break;
a3f6b9db 62 if (time_after(jiffies, timeout))
0a036388 63 break;
322503a1 64 usleep_range(50, 500);
0a036388 65 } while (1);
a3f6b9db 66
bc3b84da
SG
67 return readl_relaxed(pll->base) & BM_PLL_LOCK ? 0 : -ETIMEDOUT;
68}
69
70static int clk_pllv3_prepare(struct clk_hw *hw)
71{
72 struct clk_pllv3 *pll = to_clk_pllv3(hw);
73 u32 val;
43c9b9e8 74 int ret;
bc3b84da
SG
75
76 val = readl_relaxed(pll->base);
bc3b84da
SG
77 if (pll->powerup_set)
78 val |= BM_PLL_POWER;
0a036388 79 else
bc3b84da
SG
80 val &= ~BM_PLL_POWER;
81 writel_relaxed(val, pll->base);
82
43c9b9e8
SG
83 ret = clk_pllv3_wait_lock(pll);
84 if (ret)
85 return ret;
86
87 val = readl_relaxed(pll->base);
88 val &= ~BM_PLL_BYPASS;
89 writel_relaxed(val, pll->base);
90
91 return 0;
a3f6b9db
SG
92}
93
94static void clk_pllv3_unprepare(struct clk_hw *hw)
95{
96 struct clk_pllv3 *pll = to_clk_pllv3(hw);
97 u32 val;
98
99 val = readl_relaxed(pll->base);
100 val |= BM_PLL_BYPASS;
101 if (pll->powerup_set)
102 val &= ~BM_PLL_POWER;
103 else
104 val |= BM_PLL_POWER;
105 writel_relaxed(val, pll->base);
106}
107
108static int clk_pllv3_enable(struct clk_hw *hw)
109{
110 struct clk_pllv3 *pll = to_clk_pllv3(hw);
111 u32 val;
112
113 val = readl_relaxed(pll->base);
2b254693 114 val |= BM_PLL_ENABLE;
a3f6b9db
SG
115 writel_relaxed(val, pll->base);
116
117 return 0;
118}
119
120static void clk_pllv3_disable(struct clk_hw *hw)
121{
122 struct clk_pllv3 *pll = to_clk_pllv3(hw);
123 u32 val;
124
125 val = readl_relaxed(pll->base);
2b254693 126 val &= ~BM_PLL_ENABLE;
a3f6b9db
SG
127 writel_relaxed(val, pll->base);
128}
129
130static unsigned long clk_pllv3_recalc_rate(struct clk_hw *hw,
131 unsigned long parent_rate)
132{
133 struct clk_pllv3 *pll = to_clk_pllv3(hw);
134 u32 div = readl_relaxed(pll->base) & pll->div_mask;
135
136 return (div == 1) ? parent_rate * 22 : parent_rate * 20;
137}
138
139static long clk_pllv3_round_rate(struct clk_hw *hw, unsigned long rate,
140 unsigned long *prate)
141{
142 unsigned long parent_rate = *prate;
143
144 return (rate >= parent_rate * 22) ? parent_rate * 22 :
145 parent_rate * 20;
146}
147
148static int clk_pllv3_set_rate(struct clk_hw *hw, unsigned long rate,
149 unsigned long parent_rate)
150{
151 struct clk_pllv3 *pll = to_clk_pllv3(hw);
152 u32 val, div;
153
154 if (rate == parent_rate * 22)
155 div = 1;
156 else if (rate == parent_rate * 20)
157 div = 0;
158 else
159 return -EINVAL;
160
161 val = readl_relaxed(pll->base);
162 val &= ~pll->div_mask;
163 val |= div;
164 writel_relaxed(val, pll->base);
165
bc3b84da 166 return clk_pllv3_wait_lock(pll);
a3f6b9db
SG
167}
168
169static const struct clk_ops clk_pllv3_ops = {
170 .prepare = clk_pllv3_prepare,
171 .unprepare = clk_pllv3_unprepare,
172 .enable = clk_pllv3_enable,
173 .disable = clk_pllv3_disable,
174 .recalc_rate = clk_pllv3_recalc_rate,
175 .round_rate = clk_pllv3_round_rate,
176 .set_rate = clk_pllv3_set_rate,
177};
178
179static unsigned long clk_pllv3_sys_recalc_rate(struct clk_hw *hw,
180 unsigned long parent_rate)
181{
182 struct clk_pllv3 *pll = to_clk_pllv3(hw);
183 u32 div = readl_relaxed(pll->base) & pll->div_mask;
184
185 return parent_rate * div / 2;
186}
187
188static long clk_pllv3_sys_round_rate(struct clk_hw *hw, unsigned long rate,
189 unsigned long *prate)
190{
191 unsigned long parent_rate = *prate;
192 unsigned long min_rate = parent_rate * 54 / 2;
193 unsigned long max_rate = parent_rate * 108 / 2;
194 u32 div;
195
196 if (rate > max_rate)
197 rate = max_rate;
198 else if (rate < min_rate)
199 rate = min_rate;
200 div = rate * 2 / parent_rate;
201
202 return parent_rate * div / 2;
203}
204
205static int clk_pllv3_sys_set_rate(struct clk_hw *hw, unsigned long rate,
206 unsigned long parent_rate)
207{
208 struct clk_pllv3 *pll = to_clk_pllv3(hw);
209 unsigned long min_rate = parent_rate * 54 / 2;
210 unsigned long max_rate = parent_rate * 108 / 2;
211 u32 val, div;
212
213 if (rate < min_rate || rate > max_rate)
214 return -EINVAL;
215
216 div = rate * 2 / parent_rate;
217 val = readl_relaxed(pll->base);
218 val &= ~pll->div_mask;
219 val |= div;
220 writel_relaxed(val, pll->base);
221
bc3b84da 222 return clk_pllv3_wait_lock(pll);
a3f6b9db
SG
223}
224
225static const struct clk_ops clk_pllv3_sys_ops = {
226 .prepare = clk_pllv3_prepare,
227 .unprepare = clk_pllv3_unprepare,
228 .enable = clk_pllv3_enable,
229 .disable = clk_pllv3_disable,
230 .recalc_rate = clk_pllv3_sys_recalc_rate,
231 .round_rate = clk_pllv3_sys_round_rate,
232 .set_rate = clk_pllv3_sys_set_rate,
233};
234
235static unsigned long clk_pllv3_av_recalc_rate(struct clk_hw *hw,
236 unsigned long parent_rate)
237{
238 struct clk_pllv3 *pll = to_clk_pllv3(hw);
239 u32 mfn = readl_relaxed(pll->base + PLL_NUM_OFFSET);
240 u32 mfd = readl_relaxed(pll->base + PLL_DENOM_OFFSET);
241 u32 div = readl_relaxed(pll->base) & pll->div_mask;
242
243 return (parent_rate * div) + ((parent_rate / mfd) * mfn);
244}
245
246static long clk_pllv3_av_round_rate(struct clk_hw *hw, unsigned long rate,
247 unsigned long *prate)
248{
249 unsigned long parent_rate = *prate;
250 unsigned long min_rate = parent_rate * 27;
251 unsigned long max_rate = parent_rate * 54;
252 u32 div;
253 u32 mfn, mfd = 1000000;
254 s64 temp64;
255
256 if (rate > max_rate)
257 rate = max_rate;
258 else if (rate < min_rate)
259 rate = min_rate;
260
261 div = rate / parent_rate;
262 temp64 = (u64) (rate - div * parent_rate);
263 temp64 *= mfd;
264 do_div(temp64, parent_rate);
265 mfn = temp64;
266
267 return parent_rate * div + parent_rate / mfd * mfn;
268}
269
270static int clk_pllv3_av_set_rate(struct clk_hw *hw, unsigned long rate,
271 unsigned long parent_rate)
272{
273 struct clk_pllv3 *pll = to_clk_pllv3(hw);
274 unsigned long min_rate = parent_rate * 27;
275 unsigned long max_rate = parent_rate * 54;
276 u32 val, div;
277 u32 mfn, mfd = 1000000;
278 s64 temp64;
279
280 if (rate < min_rate || rate > max_rate)
281 return -EINVAL;
282
283 div = rate / parent_rate;
284 temp64 = (u64) (rate - div * parent_rate);
285 temp64 *= mfd;
286 do_div(temp64, parent_rate);
287 mfn = temp64;
288
289 val = readl_relaxed(pll->base);
290 val &= ~pll->div_mask;
291 val |= div;
292 writel_relaxed(val, pll->base);
293 writel_relaxed(mfn, pll->base + PLL_NUM_OFFSET);
294 writel_relaxed(mfd, pll->base + PLL_DENOM_OFFSET);
295
bc3b84da 296 return clk_pllv3_wait_lock(pll);
a3f6b9db
SG
297}
298
299static const struct clk_ops clk_pllv3_av_ops = {
300 .prepare = clk_pllv3_prepare,
301 .unprepare = clk_pllv3_unprepare,
302 .enable = clk_pllv3_enable,
303 .disable = clk_pllv3_disable,
304 .recalc_rate = clk_pllv3_av_recalc_rate,
305 .round_rate = clk_pllv3_av_round_rate,
306 .set_rate = clk_pllv3_av_set_rate,
307};
308
309static unsigned long clk_pllv3_enet_recalc_rate(struct clk_hw *hw,
310 unsigned long parent_rate)
311{
7a04092c 312 return 500000000;
a3f6b9db
SG
313}
314
315static const struct clk_ops clk_pllv3_enet_ops = {
316 .prepare = clk_pllv3_prepare,
317 .unprepare = clk_pllv3_unprepare,
318 .enable = clk_pllv3_enable,
319 .disable = clk_pllv3_disable,
320 .recalc_rate = clk_pllv3_enet_recalc_rate,
a3f6b9db
SG
321};
322
a3f6b9db
SG
323struct clk *imx_clk_pllv3(enum imx_pllv3_type type, const char *name,
324 const char *parent_name, void __iomem *base,
2b254693 325 u32 div_mask)
a3f6b9db
SG
326{
327 struct clk_pllv3 *pll;
328 const struct clk_ops *ops;
329 struct clk *clk;
330 struct clk_init_data init;
331
332 pll = kzalloc(sizeof(*pll), GFP_KERNEL);
333 if (!pll)
334 return ERR_PTR(-ENOMEM);
335
336 switch (type) {
337 case IMX_PLLV3_SYS:
338 ops = &clk_pllv3_sys_ops;
339 break;
340 case IMX_PLLV3_USB:
341 ops = &clk_pllv3_ops;
342 pll->powerup_set = true;
343 break;
344 case IMX_PLLV3_AV:
345 ops = &clk_pllv3_av_ops;
346 break;
347 case IMX_PLLV3_ENET:
348 ops = &clk_pllv3_enet_ops;
349 break;
a3f6b9db
SG
350 default:
351 ops = &clk_pllv3_ops;
352 }
353 pll->base = base;
a3f6b9db
SG
354 pll->div_mask = div_mask;
355
356 init.name = name;
357 init.ops = ops;
358 init.flags = 0;
359 init.parent_names = &parent_name;
360 init.num_parents = 1;
361
362 pll->hw.init = &init;
363
364 clk = clk_register(NULL, &pll->hw);
365 if (IS_ERR(clk))
366 kfree(pll);
367
368 return clk;
369}
This page took 0.141955 seconds and 5 git commands to generate.