diff options
author | Mark Salter <msalter@redhat.com> | 2011-10-04 11:10:50 -0400 |
---|---|---|
committer | Mark Salter <msalter@redhat.com> | 2011-10-06 19:48:07 -0400 |
commit | 81ec98898188639ac53413605681b3e3bb0a2ff1 (patch) | |
tree | ba8a4c16120f0e9c2fd2fe5c9e5f7acc0a56e652 /arch/c6x/platforms | |
parent | e94e668251ab31b17ef6dcd16ba7fe05ffc1917a (diff) |
C6X: clocks
The C6X SoCs contain several PLL controllers each with up to 16 clock outputs
feeding into the cores or peripheral clock domains. The hardware is very similar
to arm/mach-davinci clocks. This is still a work in progress which needs to be
updated once device tree clock binding changes shake out.
Signed-off-by: Mark Salter <msalter@redhat.com>
Signed-off-by: Aurelien Jacquiot <a-jacquiot@ti.com>
Acked-by: Arnd Bergmann <arnd@arndb.de>
Diffstat (limited to 'arch/c6x/platforms')
-rw-r--r-- | arch/c6x/platforms/pll.c | 444 | ||||
-rw-r--r-- | arch/c6x/platforms/plldata.c | 404 |
2 files changed, 848 insertions, 0 deletions
diff --git a/arch/c6x/platforms/pll.c b/arch/c6x/platforms/pll.c new file mode 100644 index 000000000000..3aa898f7ce4d --- /dev/null +++ b/arch/c6x/platforms/pll.c | |||
@@ -0,0 +1,444 @@ | |||
1 | /* | ||
2 | * Clock and PLL control for C64x+ devices | ||
3 | * | ||
4 | * Copyright (C) 2010, 2011 Texas Instruments. | ||
5 | * Contributed by: Mark Salter <msalter@redhat.com> | ||
6 | * | ||
7 | * Copied heavily from arm/mach-davinci/clock.c, so: | ||
8 | * | ||
9 | * Copyright (C) 2006-2007 Texas Instruments. | ||
10 | * Copyright (C) 2008-2009 Deep Root Systems, LLC | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or modify | ||
13 | * it under the terms of the GNU General Public License as published by | ||
14 | * the Free Software Foundation; either version 2 of the License, or | ||
15 | * (at your option) any later version. | ||
16 | */ | ||
17 | |||
18 | #include <linux/module.h> | ||
19 | #include <linux/clkdev.h> | ||
20 | #include <linux/clk.h> | ||
21 | #include <linux/io.h> | ||
22 | #include <linux/err.h> | ||
23 | |||
24 | #include <asm/clock.h> | ||
25 | #include <asm/soc.h> | ||
26 | |||
27 | static LIST_HEAD(clocks); | ||
28 | static DEFINE_MUTEX(clocks_mutex); | ||
29 | static DEFINE_SPINLOCK(clockfw_lock); | ||
30 | |||
31 | static void __clk_enable(struct clk *clk) | ||
32 | { | ||
33 | if (clk->parent) | ||
34 | __clk_enable(clk->parent); | ||
35 | clk->usecount++; | ||
36 | } | ||
37 | |||
38 | static void __clk_disable(struct clk *clk) | ||
39 | { | ||
40 | if (WARN_ON(clk->usecount == 0)) | ||
41 | return; | ||
42 | --clk->usecount; | ||
43 | |||
44 | if (clk->parent) | ||
45 | __clk_disable(clk->parent); | ||
46 | } | ||
47 | |||
48 | int clk_enable(struct clk *clk) | ||
49 | { | ||
50 | unsigned long flags; | ||
51 | |||
52 | if (clk == NULL || IS_ERR(clk)) | ||
53 | return -EINVAL; | ||
54 | |||
55 | spin_lock_irqsave(&clockfw_lock, flags); | ||
56 | __clk_enable(clk); | ||
57 | spin_unlock_irqrestore(&clockfw_lock, flags); | ||
58 | |||
59 | return 0; | ||
60 | } | ||
61 | EXPORT_SYMBOL(clk_enable); | ||
62 | |||
63 | void clk_disable(struct clk *clk) | ||
64 | { | ||
65 | unsigned long flags; | ||
66 | |||
67 | if (clk == NULL || IS_ERR(clk)) | ||
68 | return; | ||
69 | |||
70 | spin_lock_irqsave(&clockfw_lock, flags); | ||
71 | __clk_disable(clk); | ||
72 | spin_unlock_irqrestore(&clockfw_lock, flags); | ||
73 | } | ||
74 | EXPORT_SYMBOL(clk_disable); | ||
75 | |||
76 | unsigned long clk_get_rate(struct clk *clk) | ||
77 | { | ||
78 | if (clk == NULL || IS_ERR(clk)) | ||
79 | return -EINVAL; | ||
80 | |||
81 | return clk->rate; | ||
82 | } | ||
83 | EXPORT_SYMBOL(clk_get_rate); | ||
84 | |||
85 | long clk_round_rate(struct clk *clk, unsigned long rate) | ||
86 | { | ||
87 | if (clk == NULL || IS_ERR(clk)) | ||
88 | return -EINVAL; | ||
89 | |||
90 | if (clk->round_rate) | ||
91 | return clk->round_rate(clk, rate); | ||
92 | |||
93 | return clk->rate; | ||
94 | } | ||
95 | EXPORT_SYMBOL(clk_round_rate); | ||
96 | |||
97 | /* Propagate rate to children */ | ||
98 | static void propagate_rate(struct clk *root) | ||
99 | { | ||
100 | struct clk *clk; | ||
101 | |||
102 | list_for_each_entry(clk, &root->children, childnode) { | ||
103 | if (clk->recalc) | ||
104 | clk->rate = clk->recalc(clk); | ||
105 | propagate_rate(clk); | ||
106 | } | ||
107 | } | ||
108 | |||
109 | int clk_set_rate(struct clk *clk, unsigned long rate) | ||
110 | { | ||
111 | unsigned long flags; | ||
112 | int ret = -EINVAL; | ||
113 | |||
114 | if (clk == NULL || IS_ERR(clk)) | ||
115 | return ret; | ||
116 | |||
117 | if (clk->set_rate) | ||
118 | ret = clk->set_rate(clk, rate); | ||
119 | |||
120 | spin_lock_irqsave(&clockfw_lock, flags); | ||
121 | if (ret == 0) { | ||
122 | if (clk->recalc) | ||
123 | clk->rate = clk->recalc(clk); | ||
124 | propagate_rate(clk); | ||
125 | } | ||
126 | spin_unlock_irqrestore(&clockfw_lock, flags); | ||
127 | |||
128 | return ret; | ||
129 | } | ||
130 | EXPORT_SYMBOL(clk_set_rate); | ||
131 | |||
132 | int clk_set_parent(struct clk *clk, struct clk *parent) | ||
133 | { | ||
134 | unsigned long flags; | ||
135 | |||
136 | if (clk == NULL || IS_ERR(clk)) | ||
137 | return -EINVAL; | ||
138 | |||
139 | /* Cannot change parent on enabled clock */ | ||
140 | if (WARN_ON(clk->usecount)) | ||
141 | return -EINVAL; | ||
142 | |||
143 | mutex_lock(&clocks_mutex); | ||
144 | clk->parent = parent; | ||
145 | list_del_init(&clk->childnode); | ||
146 | list_add(&clk->childnode, &clk->parent->children); | ||
147 | mutex_unlock(&clocks_mutex); | ||
148 | |||
149 | spin_lock_irqsave(&clockfw_lock, flags); | ||
150 | if (clk->recalc) | ||
151 | clk->rate = clk->recalc(clk); | ||
152 | propagate_rate(clk); | ||
153 | spin_unlock_irqrestore(&clockfw_lock, flags); | ||
154 | |||
155 | return 0; | ||
156 | } | ||
157 | EXPORT_SYMBOL(clk_set_parent); | ||
158 | |||
159 | int clk_register(struct clk *clk) | ||
160 | { | ||
161 | if (clk == NULL || IS_ERR(clk)) | ||
162 | return -EINVAL; | ||
163 | |||
164 | if (WARN(clk->parent && !clk->parent->rate, | ||
165 | "CLK: %s parent %s has no rate!\n", | ||
166 | clk->name, clk->parent->name)) | ||
167 | return -EINVAL; | ||
168 | |||
169 | mutex_lock(&clocks_mutex); | ||
170 | list_add_tail(&clk->node, &clocks); | ||
171 | if (clk->parent) | ||
172 | list_add_tail(&clk->childnode, &clk->parent->children); | ||
173 | mutex_unlock(&clocks_mutex); | ||
174 | |||
175 | /* If rate is already set, use it */ | ||
176 | if (clk->rate) | ||
177 | return 0; | ||
178 | |||
179 | /* Else, see if there is a way to calculate it */ | ||
180 | if (clk->recalc) | ||
181 | clk->rate = clk->recalc(clk); | ||
182 | |||
183 | /* Otherwise, default to parent rate */ | ||
184 | else if (clk->parent) | ||
185 | clk->rate = clk->parent->rate; | ||
186 | |||
187 | return 0; | ||
188 | } | ||
189 | EXPORT_SYMBOL(clk_register); | ||
190 | |||
191 | void clk_unregister(struct clk *clk) | ||
192 | { | ||
193 | if (clk == NULL || IS_ERR(clk)) | ||
194 | return; | ||
195 | |||
196 | mutex_lock(&clocks_mutex); | ||
197 | list_del(&clk->node); | ||
198 | list_del(&clk->childnode); | ||
199 | mutex_unlock(&clocks_mutex); | ||
200 | } | ||
201 | EXPORT_SYMBOL(clk_unregister); | ||
202 | |||
203 | |||
204 | static u32 pll_read(struct pll_data *pll, int reg) | ||
205 | { | ||
206 | return soc_readl(pll->base + reg); | ||
207 | } | ||
208 | |||
209 | static unsigned long clk_sysclk_recalc(struct clk *clk) | ||
210 | { | ||
211 | u32 v, plldiv = 0; | ||
212 | struct pll_data *pll; | ||
213 | unsigned long rate = clk->rate; | ||
214 | |||
215 | if (WARN_ON(!clk->parent)) | ||
216 | return rate; | ||
217 | |||
218 | rate = clk->parent->rate; | ||
219 | |||
220 | /* the parent must be a PLL */ | ||
221 | if (WARN_ON(!clk->parent->pll_data)) | ||
222 | return rate; | ||
223 | |||
224 | pll = clk->parent->pll_data; | ||
225 | |||
226 | /* If pre-PLL, source clock is before the multiplier and divider(s) */ | ||
227 | if (clk->flags & PRE_PLL) | ||
228 | rate = pll->input_rate; | ||
229 | |||
230 | if (!clk->div) { | ||
231 | pr_debug("%s: (no divider) rate = %lu KHz\n", | ||
232 | clk->name, rate / 1000); | ||
233 | return rate; | ||
234 | } | ||
235 | |||
236 | if (clk->flags & FIXED_DIV_PLL) { | ||
237 | rate /= clk->div; | ||
238 | pr_debug("%s: (fixed divide by %d) rate = %lu KHz\n", | ||
239 | clk->name, clk->div, rate / 1000); | ||
240 | return rate; | ||
241 | } | ||
242 | |||
243 | v = pll_read(pll, clk->div); | ||
244 | if (v & PLLDIV_EN) | ||
245 | plldiv = (v & PLLDIV_RATIO_MASK) + 1; | ||
246 | |||
247 | if (plldiv == 0) | ||
248 | plldiv = 1; | ||
249 | |||
250 | rate /= plldiv; | ||
251 | |||
252 | pr_debug("%s: (divide by %d) rate = %lu KHz\n", | ||
253 | clk->name, plldiv, rate / 1000); | ||
254 | |||
255 | return rate; | ||
256 | } | ||
257 | |||
258 | static unsigned long clk_leafclk_recalc(struct clk *clk) | ||
259 | { | ||
260 | if (WARN_ON(!clk->parent)) | ||
261 | return clk->rate; | ||
262 | |||
263 | pr_debug("%s: (parent %s) rate = %lu KHz\n", | ||
264 | clk->name, clk->parent->name, clk->parent->rate / 1000); | ||
265 | |||
266 | return clk->parent->rate; | ||
267 | } | ||
268 | |||
269 | static unsigned long clk_pllclk_recalc(struct clk *clk) | ||
270 | { | ||
271 | u32 ctrl, mult = 0, prediv = 0, postdiv = 0; | ||
272 | u8 bypass; | ||
273 | struct pll_data *pll = clk->pll_data; | ||
274 | unsigned long rate = clk->rate; | ||
275 | |||
276 | if (clk->flags & FIXED_RATE_PLL) | ||
277 | return rate; | ||
278 | |||
279 | ctrl = pll_read(pll, PLLCTL); | ||
280 | rate = pll->input_rate = clk->parent->rate; | ||
281 | |||
282 | if (ctrl & PLLCTL_PLLEN) | ||
283 | bypass = 0; | ||
284 | else | ||
285 | bypass = 1; | ||
286 | |||
287 | if (pll->flags & PLL_HAS_MUL) { | ||
288 | mult = pll_read(pll, PLLM); | ||
289 | mult = (mult & PLLM_PLLM_MASK) + 1; | ||
290 | } | ||
291 | if (pll->flags & PLL_HAS_PRE) { | ||
292 | prediv = pll_read(pll, PLLPRE); | ||
293 | if (prediv & PLLDIV_EN) | ||
294 | prediv = (prediv & PLLDIV_RATIO_MASK) + 1; | ||
295 | else | ||
296 | prediv = 0; | ||
297 | } | ||
298 | if (pll->flags & PLL_HAS_POST) { | ||
299 | postdiv = pll_read(pll, PLLPOST); | ||
300 | if (postdiv & PLLDIV_EN) | ||
301 | postdiv = (postdiv & PLLDIV_RATIO_MASK) + 1; | ||
302 | else | ||
303 | postdiv = 1; | ||
304 | } | ||
305 | |||
306 | if (!bypass) { | ||
307 | if (prediv) | ||
308 | rate /= prediv; | ||
309 | if (mult) | ||
310 | rate *= mult; | ||
311 | if (postdiv) | ||
312 | rate /= postdiv; | ||
313 | |||
314 | pr_debug("PLL%d: input = %luMHz, pre[%d] mul[%d] post[%d] " | ||
315 | "--> %luMHz output.\n", | ||
316 | pll->num, clk->parent->rate / 1000000, | ||
317 | prediv, mult, postdiv, rate / 1000000); | ||
318 | } else | ||
319 | pr_debug("PLL%d: input = %luMHz, bypass mode.\n", | ||
320 | pll->num, clk->parent->rate / 1000000); | ||
321 | |||
322 | return rate; | ||
323 | } | ||
324 | |||
325 | |||
326 | static void __init __init_clk(struct clk *clk) | ||
327 | { | ||
328 | INIT_LIST_HEAD(&clk->node); | ||
329 | INIT_LIST_HEAD(&clk->children); | ||
330 | INIT_LIST_HEAD(&clk->childnode); | ||
331 | |||
332 | if (!clk->recalc) { | ||
333 | |||
334 | /* Check if clock is a PLL */ | ||
335 | if (clk->pll_data) | ||
336 | clk->recalc = clk_pllclk_recalc; | ||
337 | |||
338 | /* Else, if it is a PLL-derived clock */ | ||
339 | else if (clk->flags & CLK_PLL) | ||
340 | clk->recalc = clk_sysclk_recalc; | ||
341 | |||
342 | /* Otherwise, it is a leaf clock (PSC clock) */ | ||
343 | else if (clk->parent) | ||
344 | clk->recalc = clk_leafclk_recalc; | ||
345 | } | ||
346 | } | ||
347 | |||
348 | void __init c6x_clks_init(struct clk_lookup *clocks) | ||
349 | { | ||
350 | struct clk_lookup *c; | ||
351 | struct clk *clk; | ||
352 | size_t num_clocks = 0; | ||
353 | |||
354 | for (c = clocks; c->clk; c++) { | ||
355 | clk = c->clk; | ||
356 | |||
357 | __init_clk(clk); | ||
358 | clk_register(clk); | ||
359 | num_clocks++; | ||
360 | |||
361 | /* Turn on clocks that Linux doesn't otherwise manage */ | ||
362 | if (clk->flags & ALWAYS_ENABLED) | ||
363 | clk_enable(clk); | ||
364 | } | ||
365 | |||
366 | clkdev_add_table(clocks, num_clocks); | ||
367 | } | ||
368 | |||
369 | #ifdef CONFIG_DEBUG_FS | ||
370 | |||
371 | #include <linux/debugfs.h> | ||
372 | #include <linux/seq_file.h> | ||
373 | |||
374 | #define CLKNAME_MAX 10 /* longest clock name */ | ||
375 | #define NEST_DELTA 2 | ||
376 | #define NEST_MAX 4 | ||
377 | |||
378 | static void | ||
379 | dump_clock(struct seq_file *s, unsigned nest, struct clk *parent) | ||
380 | { | ||
381 | char *state; | ||
382 | char buf[CLKNAME_MAX + NEST_DELTA * NEST_MAX]; | ||
383 | struct clk *clk; | ||
384 | unsigned i; | ||
385 | |||
386 | if (parent->flags & CLK_PLL) | ||
387 | state = "pll"; | ||
388 | else | ||
389 | state = ""; | ||
390 | |||
391 | /* <nest spaces> name <pad to end> */ | ||
392 | memset(buf, ' ', sizeof(buf) - 1); | ||
393 | buf[sizeof(buf) - 1] = 0; | ||
394 | i = strlen(parent->name); | ||
395 | memcpy(buf + nest, parent->name, | ||
396 | min(i, (unsigned)(sizeof(buf) - 1 - nest))); | ||
397 | |||
398 | seq_printf(s, "%s users=%2d %-3s %9ld Hz\n", | ||
399 | buf, parent->usecount, state, clk_get_rate(parent)); | ||
400 | /* REVISIT show device associations too */ | ||
401 | |||
402 | /* cost is now small, but not linear... */ | ||
403 | list_for_each_entry(clk, &parent->children, childnode) { | ||
404 | dump_clock(s, nest + NEST_DELTA, clk); | ||
405 | } | ||
406 | } | ||
407 | |||
408 | static int c6x_ck_show(struct seq_file *m, void *v) | ||
409 | { | ||
410 | struct clk *clk; | ||
411 | |||
412 | /* | ||
413 | * Show clock tree; We trust nonzero usecounts equate to PSC enables... | ||
414 | */ | ||
415 | mutex_lock(&clocks_mutex); | ||
416 | list_for_each_entry(clk, &clocks, node) | ||
417 | if (!clk->parent) | ||
418 | dump_clock(m, 0, clk); | ||
419 | mutex_unlock(&clocks_mutex); | ||
420 | |||
421 | return 0; | ||
422 | } | ||
423 | |||
424 | static int c6x_ck_open(struct inode *inode, struct file *file) | ||
425 | { | ||
426 | return single_open(file, c6x_ck_show, NULL); | ||
427 | } | ||
428 | |||
429 | static const struct file_operations c6x_ck_operations = { | ||
430 | .open = c6x_ck_open, | ||
431 | .read = seq_read, | ||
432 | .llseek = seq_lseek, | ||
433 | .release = single_release, | ||
434 | }; | ||
435 | |||
436 | static int __init c6x_clk_debugfs_init(void) | ||
437 | { | ||
438 | debugfs_create_file("c6x_clocks", S_IFREG | S_IRUGO, NULL, NULL, | ||
439 | &c6x_ck_operations); | ||
440 | |||
441 | return 0; | ||
442 | } | ||
443 | device_initcall(c6x_clk_debugfs_init); | ||
444 | #endif /* CONFIG_DEBUG_FS */ | ||
diff --git a/arch/c6x/platforms/plldata.c b/arch/c6x/platforms/plldata.c new file mode 100644 index 000000000000..2cfd6f42968f --- /dev/null +++ b/arch/c6x/platforms/plldata.c | |||
@@ -0,0 +1,404 @@ | |||
1 | /* | ||
2 | * Port on Texas Instruments TMS320C6x architecture | ||
3 | * | ||
4 | * Copyright (C) 2011 Texas Instruments Incorporated | ||
5 | * Author: Mark Salter <msalter@redhat.com> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify | ||
8 | * it under the terms of the GNU General Public License version 2 as | ||
9 | * published by the Free Software Foundation. | ||
10 | */ | ||
11 | #include <linux/kernel.h> | ||
12 | #include <linux/delay.h> | ||
13 | #include <linux/errno.h> | ||
14 | #include <linux/string.h> | ||
15 | #include <linux/ioport.h> | ||
16 | #include <linux/clkdev.h> | ||
17 | #include <linux/of.h> | ||
18 | #include <linux/of_address.h> | ||
19 | |||
20 | #include <asm/clock.h> | ||
21 | #include <asm/setup.h> | ||
22 | #include <asm/irq.h> | ||
23 | |||
24 | /* | ||
25 | * Common SoC clock support. | ||
26 | */ | ||
27 | |||
28 | /* Default input for PLL1 */ | ||
29 | struct clk clkin1 = { | ||
30 | .name = "clkin1", | ||
31 | .node = LIST_HEAD_INIT(clkin1.node), | ||
32 | .children = LIST_HEAD_INIT(clkin1.children), | ||
33 | .childnode = LIST_HEAD_INIT(clkin1.childnode), | ||
34 | }; | ||
35 | |||
36 | struct pll_data c6x_soc_pll1 = { | ||
37 | .num = 1, | ||
38 | .sysclks = { | ||
39 | { | ||
40 | .name = "pll1", | ||
41 | .parent = &clkin1, | ||
42 | .pll_data = &c6x_soc_pll1, | ||
43 | .flags = CLK_PLL, | ||
44 | }, | ||
45 | { | ||
46 | .name = "pll1_sysclk1", | ||
47 | .parent = &c6x_soc_pll1.sysclks[0], | ||
48 | .flags = CLK_PLL, | ||
49 | }, | ||
50 | { | ||
51 | .name = "pll1_sysclk2", | ||
52 | .parent = &c6x_soc_pll1.sysclks[0], | ||
53 | .flags = CLK_PLL, | ||
54 | }, | ||
55 | { | ||
56 | .name = "pll1_sysclk3", | ||
57 | .parent = &c6x_soc_pll1.sysclks[0], | ||
58 | .flags = CLK_PLL, | ||
59 | }, | ||
60 | { | ||
61 | .name = "pll1_sysclk4", | ||
62 | .parent = &c6x_soc_pll1.sysclks[0], | ||
63 | .flags = CLK_PLL, | ||
64 | }, | ||
65 | { | ||
66 | .name = "pll1_sysclk5", | ||
67 | .parent = &c6x_soc_pll1.sysclks[0], | ||
68 | .flags = CLK_PLL, | ||
69 | }, | ||
70 | { | ||
71 | .name = "pll1_sysclk6", | ||
72 | .parent = &c6x_soc_pll1.sysclks[0], | ||
73 | .flags = CLK_PLL, | ||
74 | }, | ||
75 | { | ||
76 | .name = "pll1_sysclk7", | ||
77 | .parent = &c6x_soc_pll1.sysclks[0], | ||
78 | .flags = CLK_PLL, | ||
79 | }, | ||
80 | { | ||
81 | .name = "pll1_sysclk8", | ||
82 | .parent = &c6x_soc_pll1.sysclks[0], | ||
83 | .flags = CLK_PLL, | ||
84 | }, | ||
85 | { | ||
86 | .name = "pll1_sysclk9", | ||
87 | .parent = &c6x_soc_pll1.sysclks[0], | ||
88 | .flags = CLK_PLL, | ||
89 | }, | ||
90 | { | ||
91 | .name = "pll1_sysclk10", | ||
92 | .parent = &c6x_soc_pll1.sysclks[0], | ||
93 | .flags = CLK_PLL, | ||
94 | }, | ||
95 | { | ||
96 | .name = "pll1_sysclk11", | ||
97 | .parent = &c6x_soc_pll1.sysclks[0], | ||
98 | .flags = CLK_PLL, | ||
99 | }, | ||
100 | { | ||
101 | .name = "pll1_sysclk12", | ||
102 | .parent = &c6x_soc_pll1.sysclks[0], | ||
103 | .flags = CLK_PLL, | ||
104 | }, | ||
105 | { | ||
106 | .name = "pll1_sysclk13", | ||
107 | .parent = &c6x_soc_pll1.sysclks[0], | ||
108 | .flags = CLK_PLL, | ||
109 | }, | ||
110 | { | ||
111 | .name = "pll1_sysclk14", | ||
112 | .parent = &c6x_soc_pll1.sysclks[0], | ||
113 | .flags = CLK_PLL, | ||
114 | }, | ||
115 | { | ||
116 | .name = "pll1_sysclk15", | ||
117 | .parent = &c6x_soc_pll1.sysclks[0], | ||
118 | .flags = CLK_PLL, | ||
119 | }, | ||
120 | { | ||
121 | .name = "pll1_sysclk16", | ||
122 | .parent = &c6x_soc_pll1.sysclks[0], | ||
123 | .flags = CLK_PLL, | ||
124 | }, | ||
125 | }, | ||
126 | }; | ||
127 | |||
128 | /* CPU core clock */ | ||
129 | struct clk c6x_core_clk = { | ||
130 | .name = "core", | ||
131 | }; | ||
132 | |||
133 | /* miscellaneous IO clocks */ | ||
134 | struct clk c6x_i2c_clk = { | ||
135 | .name = "i2c", | ||
136 | }; | ||
137 | |||
138 | struct clk c6x_watchdog_clk = { | ||
139 | .name = "watchdog", | ||
140 | }; | ||
141 | |||
142 | struct clk c6x_mcbsp1_clk = { | ||
143 | .name = "mcbsp1", | ||
144 | }; | ||
145 | |||
146 | struct clk c6x_mcbsp2_clk = { | ||
147 | .name = "mcbsp2", | ||
148 | }; | ||
149 | |||
150 | struct clk c6x_mdio_clk = { | ||
151 | .name = "mdio", | ||
152 | }; | ||
153 | |||
154 | |||
155 | #ifdef CONFIG_SOC_TMS320C6455 | ||
156 | static struct clk_lookup c6455_clks[] = { | ||
157 | CLK(NULL, "pll1", &c6x_soc_pll1.sysclks[0]), | ||
158 | CLK(NULL, "pll1_sysclk2", &c6x_soc_pll1.sysclks[2]), | ||
159 | CLK(NULL, "pll1_sysclk3", &c6x_soc_pll1.sysclks[3]), | ||
160 | CLK(NULL, "pll1_sysclk4", &c6x_soc_pll1.sysclks[4]), | ||
161 | CLK(NULL, "pll1_sysclk5", &c6x_soc_pll1.sysclks[5]), | ||
162 | CLK(NULL, "core", &c6x_core_clk), | ||
163 | CLK("i2c_davinci.1", NULL, &c6x_i2c_clk), | ||
164 | CLK("watchdog", NULL, &c6x_watchdog_clk), | ||
165 | CLK("2c81800.mdio", NULL, &c6x_mdio_clk), | ||
166 | CLK("", NULL, NULL) | ||
167 | }; | ||
168 | |||
169 | |||
170 | static void __init c6455_setup_clocks(struct device_node *node) | ||
171 | { | ||
172 | struct pll_data *pll = &c6x_soc_pll1; | ||
173 | struct clk *sysclks = pll->sysclks; | ||
174 | |||
175 | pll->flags = PLL_HAS_PRE | PLL_HAS_MUL; | ||
176 | |||
177 | sysclks[2].flags |= FIXED_DIV_PLL; | ||
178 | sysclks[2].div = 3; | ||
179 | sysclks[3].flags |= FIXED_DIV_PLL; | ||
180 | sysclks[3].div = 6; | ||
181 | sysclks[4].div = PLLDIV4; | ||
182 | sysclks[5].div = PLLDIV5; | ||
183 | |||
184 | c6x_core_clk.parent = &sysclks[0]; | ||
185 | c6x_i2c_clk.parent = &sysclks[3]; | ||
186 | c6x_watchdog_clk.parent = &sysclks[3]; | ||
187 | c6x_mdio_clk.parent = &sysclks[3]; | ||
188 | |||
189 | c6x_clks_init(c6455_clks); | ||
190 | } | ||
191 | #endif /* CONFIG_SOC_TMS320C6455 */ | ||
192 | |||
193 | #ifdef CONFIG_SOC_TMS320C6457 | ||
194 | static struct clk_lookup c6457_clks[] = { | ||
195 | CLK(NULL, "pll1", &c6x_soc_pll1.sysclks[0]), | ||
196 | CLK(NULL, "pll1_sysclk1", &c6x_soc_pll1.sysclks[1]), | ||
197 | CLK(NULL, "pll1_sysclk2", &c6x_soc_pll1.sysclks[2]), | ||
198 | CLK(NULL, "pll1_sysclk3", &c6x_soc_pll1.sysclks[3]), | ||
199 | CLK(NULL, "pll1_sysclk4", &c6x_soc_pll1.sysclks[4]), | ||
200 | CLK(NULL, "pll1_sysclk5", &c6x_soc_pll1.sysclks[5]), | ||
201 | CLK(NULL, "core", &c6x_core_clk), | ||
202 | CLK("i2c_davinci.1", NULL, &c6x_i2c_clk), | ||
203 | CLK("watchdog", NULL, &c6x_watchdog_clk), | ||
204 | CLK("2c81800.mdio", NULL, &c6x_mdio_clk), | ||
205 | CLK("", NULL, NULL) | ||
206 | }; | ||
207 | |||
208 | static void __init c6457_setup_clocks(struct device_node *node) | ||
209 | { | ||
210 | struct pll_data *pll = &c6x_soc_pll1; | ||
211 | struct clk *sysclks = pll->sysclks; | ||
212 | |||
213 | pll->flags = PLL_HAS_MUL | PLL_HAS_POST; | ||
214 | |||
215 | sysclks[1].flags |= FIXED_DIV_PLL; | ||
216 | sysclks[1].div = 1; | ||
217 | sysclks[2].flags |= FIXED_DIV_PLL; | ||
218 | sysclks[2].div = 3; | ||
219 | sysclks[3].flags |= FIXED_DIV_PLL; | ||
220 | sysclks[3].div = 6; | ||
221 | sysclks[4].div = PLLDIV4; | ||
222 | sysclks[5].div = PLLDIV5; | ||
223 | |||
224 | c6x_core_clk.parent = &sysclks[1]; | ||
225 | c6x_i2c_clk.parent = &sysclks[3]; | ||
226 | c6x_watchdog_clk.parent = &sysclks[5]; | ||
227 | c6x_mdio_clk.parent = &sysclks[5]; | ||
228 | |||
229 | c6x_clks_init(c6457_clks); | ||
230 | } | ||
231 | #endif /* CONFIG_SOC_TMS320C6455 */ | ||
232 | |||
233 | #ifdef CONFIG_SOC_TMS320C6472 | ||
234 | static struct clk_lookup c6472_clks[] = { | ||
235 | CLK(NULL, "pll1", &c6x_soc_pll1.sysclks[0]), | ||
236 | CLK(NULL, "pll1_sysclk1", &c6x_soc_pll1.sysclks[1]), | ||
237 | CLK(NULL, "pll1_sysclk2", &c6x_soc_pll1.sysclks[2]), | ||
238 | CLK(NULL, "pll1_sysclk3", &c6x_soc_pll1.sysclks[3]), | ||
239 | CLK(NULL, "pll1_sysclk4", &c6x_soc_pll1.sysclks[4]), | ||
240 | CLK(NULL, "pll1_sysclk5", &c6x_soc_pll1.sysclks[5]), | ||
241 | CLK(NULL, "pll1_sysclk6", &c6x_soc_pll1.sysclks[6]), | ||
242 | CLK(NULL, "pll1_sysclk7", &c6x_soc_pll1.sysclks[7]), | ||
243 | CLK(NULL, "pll1_sysclk8", &c6x_soc_pll1.sysclks[8]), | ||
244 | CLK(NULL, "pll1_sysclk9", &c6x_soc_pll1.sysclks[9]), | ||
245 | CLK(NULL, "pll1_sysclk10", &c6x_soc_pll1.sysclks[10]), | ||
246 | CLK(NULL, "core", &c6x_core_clk), | ||
247 | CLK("i2c_davinci.1", NULL, &c6x_i2c_clk), | ||
248 | CLK("watchdog", NULL, &c6x_watchdog_clk), | ||
249 | CLK("2c81800.mdio", NULL, &c6x_mdio_clk), | ||
250 | CLK("", NULL, NULL) | ||
251 | }; | ||
252 | |||
253 | /* assumptions used for delay loop calculations */ | ||
254 | #define MIN_CLKIN1_KHz 15625 | ||
255 | #define MAX_CORE_KHz 700000 | ||
256 | #define MIN_PLLOUT_KHz MIN_CLKIN1_KHz | ||
257 | |||
258 | static void __init c6472_setup_clocks(struct device_node *node) | ||
259 | { | ||
260 | struct pll_data *pll = &c6x_soc_pll1; | ||
261 | struct clk *sysclks = pll->sysclks; | ||
262 | int i; | ||
263 | |||
264 | pll->flags = PLL_HAS_MUL; | ||
265 | |||
266 | for (i = 1; i <= 6; i++) { | ||
267 | sysclks[i].flags |= FIXED_DIV_PLL; | ||
268 | sysclks[i].div = 1; | ||
269 | } | ||
270 | |||
271 | sysclks[7].flags |= FIXED_DIV_PLL; | ||
272 | sysclks[7].div = 3; | ||
273 | sysclks[8].flags |= FIXED_DIV_PLL; | ||
274 | sysclks[8].div = 6; | ||
275 | sysclks[9].flags |= FIXED_DIV_PLL; | ||
276 | sysclks[9].div = 2; | ||
277 | sysclks[10].div = PLLDIV10; | ||
278 | |||
279 | c6x_core_clk.parent = &sysclks[get_coreid() + 1]; | ||
280 | c6x_i2c_clk.parent = &sysclks[8]; | ||
281 | c6x_watchdog_clk.parent = &sysclks[8]; | ||
282 | c6x_mdio_clk.parent = &sysclks[5]; | ||
283 | |||
284 | c6x_clks_init(c6472_clks); | ||
285 | } | ||
286 | #endif /* CONFIG_SOC_TMS320C6472 */ | ||
287 | |||
288 | |||
289 | #ifdef CONFIG_SOC_TMS320C6474 | ||
290 | static struct clk_lookup c6474_clks[] = { | ||
291 | CLK(NULL, "pll1", &c6x_soc_pll1.sysclks[0]), | ||
292 | CLK(NULL, "pll1_sysclk7", &c6x_soc_pll1.sysclks[7]), | ||
293 | CLK(NULL, "pll1_sysclk9", &c6x_soc_pll1.sysclks[9]), | ||
294 | CLK(NULL, "pll1_sysclk10", &c6x_soc_pll1.sysclks[10]), | ||
295 | CLK(NULL, "pll1_sysclk11", &c6x_soc_pll1.sysclks[11]), | ||
296 | CLK(NULL, "pll1_sysclk12", &c6x_soc_pll1.sysclks[12]), | ||
297 | CLK(NULL, "pll1_sysclk13", &c6x_soc_pll1.sysclks[13]), | ||
298 | CLK(NULL, "core", &c6x_core_clk), | ||
299 | CLK("i2c_davinci.1", NULL, &c6x_i2c_clk), | ||
300 | CLK("mcbsp.1", NULL, &c6x_mcbsp1_clk), | ||
301 | CLK("mcbsp.2", NULL, &c6x_mcbsp2_clk), | ||
302 | CLK("watchdog", NULL, &c6x_watchdog_clk), | ||
303 | CLK("2c81800.mdio", NULL, &c6x_mdio_clk), | ||
304 | CLK("", NULL, NULL) | ||
305 | }; | ||
306 | |||
307 | static void __init c6474_setup_clocks(struct device_node *node) | ||
308 | { | ||
309 | struct pll_data *pll = &c6x_soc_pll1; | ||
310 | struct clk *sysclks = pll->sysclks; | ||
311 | |||
312 | pll->flags = PLL_HAS_MUL; | ||
313 | |||
314 | sysclks[7].flags |= FIXED_DIV_PLL; | ||
315 | sysclks[7].div = 1; | ||
316 | sysclks[9].flags |= FIXED_DIV_PLL; | ||
317 | sysclks[9].div = 3; | ||
318 | sysclks[10].flags |= FIXED_DIV_PLL; | ||
319 | sysclks[10].div = 6; | ||
320 | |||
321 | sysclks[11].div = PLLDIV11; | ||
322 | |||
323 | sysclks[12].flags |= FIXED_DIV_PLL; | ||
324 | sysclks[12].div = 2; | ||
325 | |||
326 | sysclks[13].div = PLLDIV13; | ||
327 | |||
328 | c6x_core_clk.parent = &sysclks[7]; | ||
329 | c6x_i2c_clk.parent = &sysclks[10]; | ||
330 | c6x_watchdog_clk.parent = &sysclks[10]; | ||
331 | c6x_mcbsp1_clk.parent = &sysclks[10]; | ||
332 | c6x_mcbsp2_clk.parent = &sysclks[10]; | ||
333 | |||
334 | c6x_clks_init(c6474_clks); | ||
335 | } | ||
336 | #endif /* CONFIG_SOC_TMS320C6474 */ | ||
337 | |||
338 | static struct of_device_id c6x_clkc_match[] __initdata = { | ||
339 | #ifdef CONFIG_SOC_TMS320C6455 | ||
340 | { .compatible = "ti,c6455-pll", .data = c6455_setup_clocks }, | ||
341 | #endif | ||
342 | #ifdef CONFIG_SOC_TMS320C6457 | ||
343 | { .compatible = "ti,c6457-pll", .data = c6457_setup_clocks }, | ||
344 | #endif | ||
345 | #ifdef CONFIG_SOC_TMS320C6472 | ||
346 | { .compatible = "ti,c6472-pll", .data = c6472_setup_clocks }, | ||
347 | #endif | ||
348 | #ifdef CONFIG_SOC_TMS320C6474 | ||
349 | { .compatible = "ti,c6474-pll", .data = c6474_setup_clocks }, | ||
350 | #endif | ||
351 | { .compatible = "ti,c64x+pll" }, | ||
352 | {} | ||
353 | }; | ||
354 | |||
355 | void __init c64x_setup_clocks(void) | ||
356 | { | ||
357 | void (*__setup_clocks)(struct device_node *np); | ||
358 | struct pll_data *pll = &c6x_soc_pll1; | ||
359 | struct device_node *node; | ||
360 | const struct of_device_id *id; | ||
361 | int err; | ||
362 | u32 val; | ||
363 | |||
364 | node = of_find_matching_node(NULL, c6x_clkc_match); | ||
365 | if (!node) | ||
366 | return; | ||
367 | |||
368 | pll->base = of_iomap(node, 0); | ||
369 | if (!pll->base) | ||
370 | goto out; | ||
371 | |||
372 | err = of_property_read_u32(node, "clock-frequency", &val); | ||
373 | if (err || val == 0) { | ||
374 | pr_err("%s: no clock-frequency found! Using %dMHz\n", | ||
375 | node->full_name, (int)val / 1000000); | ||
376 | val = 25000000; | ||
377 | } | ||
378 | clkin1.rate = val; | ||
379 | |||
380 | err = of_property_read_u32(node, "ti,c64x+pll-bypass-delay", &val); | ||
381 | if (err) | ||
382 | val = 5000; | ||
383 | pll->bypass_delay = val; | ||
384 | |||
385 | err = of_property_read_u32(node, "ti,c64x+pll-reset-delay", &val); | ||
386 | if (err) | ||
387 | val = 30000; | ||
388 | pll->reset_delay = val; | ||
389 | |||
390 | err = of_property_read_u32(node, "ti,c64x+pll-lock-delay", &val); | ||
391 | if (err) | ||
392 | val = 30000; | ||
393 | pll->lock_delay = val; | ||
394 | |||
395 | /* id->data is a pointer to SoC-specific setup */ | ||
396 | id = of_match_node(c6x_clkc_match, node); | ||
397 | if (id && id->data) { | ||
398 | __setup_clocks = id->data; | ||
399 | __setup_clocks(node); | ||
400 | } | ||
401 | |||
402 | out: | ||
403 | of_node_put(node); | ||
404 | } | ||