Linux 2.6.31.6
[linux/fpc-iii.git] / arch / arm / mach-s3c2443 / clock.c
blob2785d69c95b0dabc972004115efe66b73b6e8df1
1 /* linux/arch/arm/mach-s3c2443/clock.c
3 * Copyright (c) 2007 Simtec Electronics
4 * Ben Dooks <ben@simtec.co.uk>
6 * S3C2443 Clock control support
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
23 #include <linux/init.h>
24 #include <linux/module.h>
25 #include <linux/kernel.h>
26 #include <linux/list.h>
27 #include <linux/errno.h>
28 #include <linux/err.h>
29 #include <linux/sysdev.h>
30 #include <linux/clk.h>
31 #include <linux/mutex.h>
32 #include <linux/serial_core.h>
33 #include <linux/io.h>
35 #include <asm/mach/map.h>
37 #include <mach/hardware.h>
39 #include <mach/regs-s3c2443-clock.h>
41 #include <plat/cpu-freq.h>
43 #include <plat/s3c2443.h>
44 #include <plat/clock.h>
45 #include <plat/cpu.h>
47 /* We currently have to assume that the system is running
48 * from the XTPll input, and that all ***REFCLKs are being
49 * fed from it, as we cannot read the state of OM[4] from
50 * software.
52 * It would be possible for each board initialisation to
53 * set the correct muxing at initialisation
56 static int s3c2443_clkcon_enable_h(struct clk *clk, int enable)
58 unsigned int clocks = clk->ctrlbit;
59 unsigned long clkcon;
61 clkcon = __raw_readl(S3C2443_HCLKCON);
63 if (enable)
64 clkcon |= clocks;
65 else
66 clkcon &= ~clocks;
68 __raw_writel(clkcon, S3C2443_HCLKCON);
70 return 0;
73 static int s3c2443_clkcon_enable_p(struct clk *clk, int enable)
75 unsigned int clocks = clk->ctrlbit;
76 unsigned long clkcon;
78 clkcon = __raw_readl(S3C2443_PCLKCON);
80 if (enable)
81 clkcon |= clocks;
82 else
83 clkcon &= ~clocks;
85 __raw_writel(clkcon, S3C2443_PCLKCON);
87 return 0;
90 static int s3c2443_clkcon_enable_s(struct clk *clk, int enable)
92 unsigned int clocks = clk->ctrlbit;
93 unsigned long clkcon;
95 clkcon = __raw_readl(S3C2443_SCLKCON);
97 if (enable)
98 clkcon |= clocks;
99 else
100 clkcon &= ~clocks;
102 __raw_writel(clkcon, S3C2443_SCLKCON);
104 return 0;
107 static unsigned long s3c2443_roundrate_clksrc(struct clk *clk,
108 unsigned long rate,
109 unsigned int max)
111 unsigned long parent_rate = clk_get_rate(clk->parent);
112 int div;
114 if (rate > parent_rate)
115 return parent_rate;
117 /* note, we remove the +/- 1 calculations as they cancel out */
119 div = (rate / parent_rate);
121 if (div < 1)
122 div = 1;
123 else if (div > max)
124 div = max;
126 return parent_rate / div;
129 static unsigned long s3c2443_roundrate_clksrc4(struct clk *clk,
130 unsigned long rate)
132 return s3c2443_roundrate_clksrc(clk, rate, 4);
135 static unsigned long s3c2443_roundrate_clksrc16(struct clk *clk,
136 unsigned long rate)
138 return s3c2443_roundrate_clksrc(clk, rate, 16);
141 static unsigned long s3c2443_roundrate_clksrc256(struct clk *clk,
142 unsigned long rate)
144 return s3c2443_roundrate_clksrc(clk, rate, 256);
147 /* clock selections */
149 static struct clk clk_mpllref = {
150 .name = "mpllref",
151 .parent = &clk_xtal,
152 .id = -1,
155 #if 0
156 static struct clk clk_mpll = {
157 .name = "mpll",
158 .parent = &clk_mpllref,
159 .id = -1,
161 #endif
163 static struct clk clk_i2s_ext = {
164 .name = "i2s-ext",
165 .id = -1,
168 static int s3c2443_setparent_epllref(struct clk *clk, struct clk *parent)
170 unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
172 clksrc &= ~S3C2443_CLKSRC_EPLLREF_MASK;
174 if (parent == &clk_xtal)
175 clksrc |= S3C2443_CLKSRC_EPLLREF_XTAL;
176 else if (parent == &clk_ext)
177 clksrc |= S3C2443_CLKSRC_EPLLREF_EXTCLK;
178 else if (parent != &clk_mpllref)
179 return -EINVAL;
181 __raw_writel(clksrc, S3C2443_CLKSRC);
182 clk->parent = parent;
184 return 0;
187 static struct clk clk_epllref = {
188 .name = "epllref",
189 .id = -1,
190 .set_parent = s3c2443_setparent_epllref,
193 static unsigned long s3c2443_getrate_mdivclk(struct clk *clk)
195 unsigned long parent_rate = clk_get_rate(clk->parent);
196 unsigned long div = __raw_readl(S3C2443_CLKDIV0);
198 div &= S3C2443_CLKDIV0_EXTDIV_MASK;
199 div >>= (S3C2443_CLKDIV0_EXTDIV_SHIFT-1); /* x2 */
201 return parent_rate / (div + 1);
204 static struct clk clk_mdivclk = {
205 .name = "mdivclk",
206 .parent = &clk_mpllref,
207 .id = -1,
208 .get_rate = s3c2443_getrate_mdivclk,
211 static int s3c2443_setparent_msysclk(struct clk *clk, struct clk *parent)
213 unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
215 clksrc &= ~(S3C2443_CLKSRC_MSYSCLK_MPLL |
216 S3C2443_CLKSRC_EXTCLK_DIV);
218 if (parent == &clk_mpll)
219 clksrc |= S3C2443_CLKSRC_MSYSCLK_MPLL;
220 else if (parent == &clk_mdivclk)
221 clksrc |= S3C2443_CLKSRC_EXTCLK_DIV;
222 else if (parent != &clk_mpllref)
223 return -EINVAL;
225 __raw_writel(clksrc, S3C2443_CLKSRC);
226 clk->parent = parent;
228 return 0;
231 static struct clk clk_msysclk = {
232 .name = "msysclk",
233 .parent = &clk_xtal,
234 .id = -1,
235 .set_parent = s3c2443_setparent_msysclk,
238 /* armdiv
240 * this clock is sourced from msysclk and can have a number of
241 * divider values applied to it to then be fed into armclk.
244 static struct clk clk_armdiv = {
245 .name = "armdiv",
246 .id = -1,
247 .parent = &clk_msysclk,
250 /* armclk
252 * this is the clock fed into the ARM core itself, either from
253 * armdiv or from hclk.
256 static int s3c2443_setparent_armclk(struct clk *clk, struct clk *parent)
258 unsigned long clkdiv0;
260 clkdiv0 = __raw_readl(S3C2443_CLKDIV0);
262 if (parent == &clk_armdiv)
263 clkdiv0 &= ~S3C2443_CLKDIV0_DVS;
264 else if (parent == &clk_h)
265 clkdiv0 |= S3C2443_CLKDIV0_DVS;
266 else
267 return -EINVAL;
269 __raw_writel(clkdiv0, S3C2443_CLKDIV0);
270 return 0;
273 static struct clk clk_arm = {
274 .name = "armclk",
275 .id = -1,
276 .set_parent = s3c2443_setparent_armclk,
279 /* esysclk
281 * this is sourced from either the EPLL or the EPLLref clock
284 static int s3c2443_setparent_esysclk(struct clk *clk, struct clk *parent)
286 unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
288 if (parent == &clk_epll)
289 clksrc |= S3C2443_CLKSRC_ESYSCLK_EPLL;
290 else if (parent == &clk_epllref)
291 clksrc &= ~S3C2443_CLKSRC_ESYSCLK_EPLL;
292 else
293 return -EINVAL;
295 __raw_writel(clksrc, S3C2443_CLKSRC);
296 clk->parent = parent;
298 return 0;
301 static struct clk clk_esysclk = {
302 .name = "esysclk",
303 .parent = &clk_epll,
304 .id = -1,
305 .set_parent = s3c2443_setparent_esysclk,
308 /* uartclk
310 * UART baud-rate clock sourced from esysclk via a divisor
313 static unsigned long s3c2443_getrate_uart(struct clk *clk)
315 unsigned long parent_rate = clk_get_rate(clk->parent);
316 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
318 div &= S3C2443_CLKDIV1_UARTDIV_MASK;
319 div >>= S3C2443_CLKDIV1_UARTDIV_SHIFT;
321 return parent_rate / (div + 1);
325 static int s3c2443_setrate_uart(struct clk *clk, unsigned long rate)
327 unsigned long parent_rate = clk_get_rate(clk->parent);
328 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
330 rate = s3c2443_roundrate_clksrc16(clk, rate);
331 rate = parent_rate / rate;
333 clkdivn &= ~S3C2443_CLKDIV1_UARTDIV_MASK;
334 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_UARTDIV_SHIFT;
336 __raw_writel(clkdivn, S3C2443_CLKDIV1);
337 return 0;
340 static struct clk clk_uart = {
341 .name = "uartclk",
342 .id = -1,
343 .parent = &clk_esysclk,
344 .get_rate = s3c2443_getrate_uart,
345 .set_rate = s3c2443_setrate_uart,
346 .round_rate = s3c2443_roundrate_clksrc16,
349 /* hsspi
351 * high-speed spi clock, sourced from esysclk
354 static unsigned long s3c2443_getrate_hsspi(struct clk *clk)
356 unsigned long parent_rate = clk_get_rate(clk->parent);
357 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
359 div &= S3C2443_CLKDIV1_HSSPIDIV_MASK;
360 div >>= S3C2443_CLKDIV1_HSSPIDIV_SHIFT;
362 return parent_rate / (div + 1);
366 static int s3c2443_setrate_hsspi(struct clk *clk, unsigned long rate)
368 unsigned long parent_rate = clk_get_rate(clk->parent);
369 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
371 rate = s3c2443_roundrate_clksrc4(clk, rate);
372 rate = parent_rate / rate;
374 clkdivn &= ~S3C2443_CLKDIV1_HSSPIDIV_MASK;
375 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_HSSPIDIV_SHIFT;
377 __raw_writel(clkdivn, S3C2443_CLKDIV1);
378 return 0;
381 static struct clk clk_hsspi = {
382 .name = "hsspi",
383 .id = -1,
384 .parent = &clk_esysclk,
385 .ctrlbit = S3C2443_SCLKCON_HSSPICLK,
386 .enable = s3c2443_clkcon_enable_s,
387 .get_rate = s3c2443_getrate_hsspi,
388 .set_rate = s3c2443_setrate_hsspi,
389 .round_rate = s3c2443_roundrate_clksrc4,
392 /* usbhost
394 * usb host bus-clock, usually 48MHz to provide USB bus clock timing
397 static unsigned long s3c2443_getrate_usbhost(struct clk *clk)
399 unsigned long parent_rate = clk_get_rate(clk->parent);
400 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
402 div &= S3C2443_CLKDIV1_USBHOSTDIV_MASK;
403 div >>= S3C2443_CLKDIV1_USBHOSTDIV_SHIFT;
405 return parent_rate / (div + 1);
408 static int s3c2443_setrate_usbhost(struct clk *clk, unsigned long rate)
410 unsigned long parent_rate = clk_get_rate(clk->parent);
411 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
413 rate = s3c2443_roundrate_clksrc4(clk, rate);
414 rate = parent_rate / rate;
416 clkdivn &= ~S3C2443_CLKDIV1_USBHOSTDIV_MASK;
417 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_USBHOSTDIV_SHIFT;
419 __raw_writel(clkdivn, S3C2443_CLKDIV1);
420 return 0;
423 static struct clk clk_usb_bus_host = {
424 .name = "usb-bus-host-parent",
425 .id = -1,
426 .parent = &clk_esysclk,
427 .ctrlbit = S3C2443_SCLKCON_USBHOST,
428 .enable = s3c2443_clkcon_enable_s,
429 .get_rate = s3c2443_getrate_usbhost,
430 .set_rate = s3c2443_setrate_usbhost,
431 .round_rate = s3c2443_roundrate_clksrc4,
434 /* clk_hsmcc_div
436 * this clock is sourced from epll, and is fed through a divider,
437 * to a mux controlled by sclkcon where either it or a extclk can
438 * be fed to the hsmmc block
441 static unsigned long s3c2443_getrate_hsmmc_div(struct clk *clk)
443 unsigned long parent_rate = clk_get_rate(clk->parent);
444 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
446 div &= S3C2443_CLKDIV1_HSMMCDIV_MASK;
447 div >>= S3C2443_CLKDIV1_HSMMCDIV_SHIFT;
449 return parent_rate / (div + 1);
452 static int s3c2443_setrate_hsmmc_div(struct clk *clk, unsigned long rate)
454 unsigned long parent_rate = clk_get_rate(clk->parent);
455 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
457 rate = s3c2443_roundrate_clksrc4(clk, rate);
458 rate = parent_rate / rate;
460 clkdivn &= ~S3C2443_CLKDIV1_HSMMCDIV_MASK;
461 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_HSMMCDIV_SHIFT;
463 __raw_writel(clkdivn, S3C2443_CLKDIV1);
464 return 0;
467 static struct clk clk_hsmmc_div = {
468 .name = "hsmmc-div",
469 .id = -1,
470 .parent = &clk_esysclk,
471 .get_rate = s3c2443_getrate_hsmmc_div,
472 .set_rate = s3c2443_setrate_hsmmc_div,
473 .round_rate = s3c2443_roundrate_clksrc4,
476 static int s3c2443_setparent_hsmmc(struct clk *clk, struct clk *parent)
478 unsigned long clksrc = __raw_readl(S3C2443_SCLKCON);
480 clksrc &= ~(S3C2443_SCLKCON_HSMMCCLK_EXT |
481 S3C2443_SCLKCON_HSMMCCLK_EPLL);
483 if (parent == &clk_epll)
484 clksrc |= S3C2443_SCLKCON_HSMMCCLK_EPLL;
485 else if (parent == &clk_ext)
486 clksrc |= S3C2443_SCLKCON_HSMMCCLK_EXT;
487 else
488 return -EINVAL;
490 if (clk->usage > 0) {
491 __raw_writel(clksrc, S3C2443_SCLKCON);
494 clk->parent = parent;
495 return 0;
498 static int s3c2443_enable_hsmmc(struct clk *clk, int enable)
500 return s3c2443_setparent_hsmmc(clk, clk->parent);
503 static struct clk clk_hsmmc = {
504 .name = "hsmmc-if",
505 .id = -1,
506 .parent = &clk_hsmmc_div,
507 .enable = s3c2443_enable_hsmmc,
508 .set_parent = s3c2443_setparent_hsmmc,
511 /* i2s_eplldiv
513 * this clock is the output from the i2s divisor of esysclk
516 static unsigned long s3c2443_getrate_i2s_eplldiv(struct clk *clk)
518 unsigned long parent_rate = clk_get_rate(clk->parent);
519 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
521 div &= S3C2443_CLKDIV1_I2SDIV_MASK;
522 div >>= S3C2443_CLKDIV1_I2SDIV_SHIFT;
524 return parent_rate / (div + 1);
527 static int s3c2443_setrate_i2s_eplldiv(struct clk *clk, unsigned long rate)
529 unsigned long parent_rate = clk_get_rate(clk->parent);
530 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
532 rate = s3c2443_roundrate_clksrc16(clk, rate);
533 rate = parent_rate / rate;
535 clkdivn &= ~S3C2443_CLKDIV1_I2SDIV_MASK;
536 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_I2SDIV_SHIFT;
538 __raw_writel(clkdivn, S3C2443_CLKDIV1);
539 return 0;
542 static struct clk clk_i2s_eplldiv = {
543 .name = "i2s-eplldiv",
544 .id = -1,
545 .parent = &clk_esysclk,
546 .get_rate = s3c2443_getrate_i2s_eplldiv,
547 .set_rate = s3c2443_setrate_i2s_eplldiv,
548 .round_rate = s3c2443_roundrate_clksrc16,
551 /* i2s-ref
553 * i2s bus reference clock, selectable from external, esysclk or epllref
556 static int s3c2443_setparent_i2s(struct clk *clk, struct clk *parent)
558 unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
560 clksrc &= ~S3C2443_CLKSRC_I2S_MASK;
562 if (parent == &clk_epllref)
563 clksrc |= S3C2443_CLKSRC_I2S_EPLLREF;
564 else if (parent == &clk_i2s_ext)
565 clksrc |= S3C2443_CLKSRC_I2S_EXT;
566 else if (parent != &clk_i2s_eplldiv)
567 return -EINVAL;
569 clk->parent = parent;
570 __raw_writel(clksrc, S3C2443_CLKSRC);
572 return 0;
575 static struct clk clk_i2s = {
576 .name = "i2s-if",
577 .id = -1,
578 .parent = &clk_i2s_eplldiv,
579 .ctrlbit = S3C2443_SCLKCON_I2SCLK,
580 .enable = s3c2443_clkcon_enable_s,
581 .set_parent = s3c2443_setparent_i2s,
584 /* cam-if
586 * camera interface bus-clock, divided down from esysclk
589 static unsigned long s3c2443_getrate_cam(struct clk *clk)
591 unsigned long parent_rate = clk_get_rate(clk->parent);
592 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
594 div &= S3C2443_CLKDIV1_CAMDIV_MASK;
595 div >>= S3C2443_CLKDIV1_CAMDIV_SHIFT;
597 return parent_rate / (div + 1);
600 static int s3c2443_setrate_cam(struct clk *clk, unsigned long rate)
602 unsigned long parent_rate = clk_get_rate(clk->parent);
603 unsigned long clkdiv1 = __raw_readl(S3C2443_CLKDIV1);
605 rate = s3c2443_roundrate_clksrc16(clk, rate);
606 rate = parent_rate / rate;
608 clkdiv1 &= ~S3C2443_CLKDIV1_CAMDIV_MASK;
609 clkdiv1 |= (rate - 1) << S3C2443_CLKDIV1_CAMDIV_SHIFT;
611 __raw_writel(clkdiv1, S3C2443_CLKDIV1);
612 return 0;
615 static struct clk clk_cam = {
616 .name = "camif-upll", /* same as 2440 name */
617 .id = -1,
618 .parent = &clk_esysclk,
619 .ctrlbit = S3C2443_SCLKCON_CAMCLK,
620 .enable = s3c2443_clkcon_enable_s,
621 .get_rate = s3c2443_getrate_cam,
622 .set_rate = s3c2443_setrate_cam,
623 .round_rate = s3c2443_roundrate_clksrc16,
626 /* display-if
628 * display interface clock, divided from esysclk
631 static unsigned long s3c2443_getrate_display(struct clk *clk)
633 unsigned long parent_rate = clk_get_rate(clk->parent);
634 unsigned long div = __raw_readl(S3C2443_CLKDIV1);
636 div &= S3C2443_CLKDIV1_DISPDIV_MASK;
637 div >>= S3C2443_CLKDIV1_DISPDIV_SHIFT;
639 return parent_rate / (div + 1);
642 static int s3c2443_setrate_display(struct clk *clk, unsigned long rate)
644 unsigned long parent_rate = clk_get_rate(clk->parent);
645 unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
647 rate = s3c2443_roundrate_clksrc256(clk, rate);
648 rate = parent_rate / rate;
650 clkdivn &= ~S3C2443_CLKDIV1_UARTDIV_MASK;
651 clkdivn |= (rate - 1) << S3C2443_CLKDIV1_UARTDIV_SHIFT;
653 __raw_writel(clkdivn, S3C2443_CLKDIV1);
654 return 0;
657 static struct clk clk_display = {
658 .name = "display-if",
659 .id = -1,
660 .parent = &clk_esysclk,
661 .ctrlbit = S3C2443_SCLKCON_DISPCLK,
662 .enable = s3c2443_clkcon_enable_s,
663 .get_rate = s3c2443_getrate_display,
664 .set_rate = s3c2443_setrate_display,
665 .round_rate = s3c2443_roundrate_clksrc256,
668 /* prediv
670 * this divides the msysclk down to pass to h/p/etc.
673 static unsigned long s3c2443_prediv_getrate(struct clk *clk)
675 unsigned long rate = clk_get_rate(clk->parent);
676 unsigned long clkdiv0 = __raw_readl(S3C2443_CLKDIV0);
678 clkdiv0 &= S3C2443_CLKDIV0_PREDIV_MASK;
679 clkdiv0 >>= S3C2443_CLKDIV0_PREDIV_SHIFT;
681 return rate / (clkdiv0 + 1);
684 static struct clk clk_prediv = {
685 .name = "prediv",
686 .id = -1,
687 .parent = &clk_msysclk,
688 .get_rate = s3c2443_prediv_getrate,
691 /* standard clock definitions */
693 static struct clk init_clocks_disable[] = {
695 .name = "nand",
696 .id = -1,
697 .parent = &clk_h,
698 }, {
699 .name = "sdi",
700 .id = -1,
701 .parent = &clk_p,
702 .enable = s3c2443_clkcon_enable_p,
703 .ctrlbit = S3C2443_PCLKCON_SDI,
704 }, {
705 .name = "adc",
706 .id = -1,
707 .parent = &clk_p,
708 .enable = s3c2443_clkcon_enable_p,
709 .ctrlbit = S3C2443_PCLKCON_ADC,
710 }, {
711 .name = "i2c",
712 .id = -1,
713 .parent = &clk_p,
714 .enable = s3c2443_clkcon_enable_p,
715 .ctrlbit = S3C2443_PCLKCON_IIC,
716 }, {
717 .name = "iis",
718 .id = -1,
719 .parent = &clk_p,
720 .enable = s3c2443_clkcon_enable_p,
721 .ctrlbit = S3C2443_PCLKCON_IIS,
722 }, {
723 .name = "spi",
724 .id = 0,
725 .parent = &clk_p,
726 .enable = s3c2443_clkcon_enable_p,
727 .ctrlbit = S3C2443_PCLKCON_SPI0,
728 }, {
729 .name = "spi",
730 .id = 1,
731 .parent = &clk_p,
732 .enable = s3c2443_clkcon_enable_p,
733 .ctrlbit = S3C2443_PCLKCON_SPI1,
737 static struct clk init_clocks[] = {
739 .name = "dma",
740 .id = 0,
741 .parent = &clk_h,
742 .enable = s3c2443_clkcon_enable_h,
743 .ctrlbit = S3C2443_HCLKCON_DMA0,
744 }, {
745 .name = "dma",
746 .id = 1,
747 .parent = &clk_h,
748 .enable = s3c2443_clkcon_enable_h,
749 .ctrlbit = S3C2443_HCLKCON_DMA1,
750 }, {
751 .name = "dma",
752 .id = 2,
753 .parent = &clk_h,
754 .enable = s3c2443_clkcon_enable_h,
755 .ctrlbit = S3C2443_HCLKCON_DMA2,
756 }, {
757 .name = "dma",
758 .id = 3,
759 .parent = &clk_h,
760 .enable = s3c2443_clkcon_enable_h,
761 .ctrlbit = S3C2443_HCLKCON_DMA3,
762 }, {
763 .name = "dma",
764 .id = 4,
765 .parent = &clk_h,
766 .enable = s3c2443_clkcon_enable_h,
767 .ctrlbit = S3C2443_HCLKCON_DMA4,
768 }, {
769 .name = "dma",
770 .id = 5,
771 .parent = &clk_h,
772 .enable = s3c2443_clkcon_enable_h,
773 .ctrlbit = S3C2443_HCLKCON_DMA5,
774 }, {
775 .name = "lcd",
776 .id = -1,
777 .parent = &clk_h,
778 .enable = s3c2443_clkcon_enable_h,
779 .ctrlbit = S3C2443_HCLKCON_LCDC,
780 }, {
781 .name = "gpio",
782 .id = -1,
783 .parent = &clk_p,
784 .enable = s3c2443_clkcon_enable_p,
785 .ctrlbit = S3C2443_PCLKCON_GPIO,
786 }, {
787 .name = "usb-host",
788 .id = -1,
789 .parent = &clk_h,
790 .enable = s3c2443_clkcon_enable_h,
791 .ctrlbit = S3C2443_HCLKCON_USBH,
792 }, {
793 .name = "usb-device",
794 .id = -1,
795 .parent = &clk_h,
796 .enable = s3c2443_clkcon_enable_h,
797 .ctrlbit = S3C2443_HCLKCON_USBD,
798 }, {
799 .name = "hsmmc",
800 .id = -1,
801 .parent = &clk_h,
802 .enable = s3c2443_clkcon_enable_h,
803 .ctrlbit = S3C2443_HCLKCON_HSMMC,
804 }, {
805 .name = "cfc",
806 .id = -1,
807 .parent = &clk_h,
808 .enable = s3c2443_clkcon_enable_h,
809 .ctrlbit = S3C2443_HCLKCON_CFC,
810 }, {
811 .name = "ssmc",
812 .id = -1,
813 .parent = &clk_h,
814 .enable = s3c2443_clkcon_enable_h,
815 .ctrlbit = S3C2443_HCLKCON_SSMC,
816 }, {
817 .name = "timers",
818 .id = -1,
819 .parent = &clk_p,
820 .enable = s3c2443_clkcon_enable_p,
821 .ctrlbit = S3C2443_PCLKCON_PWMT,
822 }, {
823 .name = "uart",
824 .id = 0,
825 .parent = &clk_p,
826 .enable = s3c2443_clkcon_enable_p,
827 .ctrlbit = S3C2443_PCLKCON_UART0,
828 }, {
829 .name = "uart",
830 .id = 1,
831 .parent = &clk_p,
832 .enable = s3c2443_clkcon_enable_p,
833 .ctrlbit = S3C2443_PCLKCON_UART1,
834 }, {
835 .name = "uart",
836 .id = 2,
837 .parent = &clk_p,
838 .enable = s3c2443_clkcon_enable_p,
839 .ctrlbit = S3C2443_PCLKCON_UART2,
840 }, {
841 .name = "uart",
842 .id = 3,
843 .parent = &clk_p,
844 .enable = s3c2443_clkcon_enable_p,
845 .ctrlbit = S3C2443_PCLKCON_UART3,
846 }, {
847 .name = "rtc",
848 .id = -1,
849 .parent = &clk_p,
850 .enable = s3c2443_clkcon_enable_p,
851 .ctrlbit = S3C2443_PCLKCON_RTC,
852 }, {
853 .name = "watchdog",
854 .id = -1,
855 .parent = &clk_p,
856 .ctrlbit = S3C2443_PCLKCON_WDT,
857 }, {
858 .name = "usb-bus-host",
859 .id = -1,
860 .parent = &clk_usb_bus_host,
861 }, {
862 .name = "ac97",
863 .id = -1,
864 .parent = &clk_p,
865 .ctrlbit = S3C2443_PCLKCON_AC97,
869 /* clocks to add where we need to check their parentage */
871 /* s3c2443_clk_initparents
873 * Initialise the parents for the clocks that we get at start-time
876 static int __init clk_init_set_parent(struct clk *clk, struct clk *parent)
878 printk(KERN_DEBUG "clock %s: parent %s\n", clk->name, parent->name);
879 return clk_set_parent(clk, parent);
882 static void __init s3c2443_clk_initparents(void)
884 unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
885 struct clk *parent;
887 switch (clksrc & S3C2443_CLKSRC_EPLLREF_MASK) {
888 case S3C2443_CLKSRC_EPLLREF_EXTCLK:
889 parent = &clk_ext;
890 break;
892 case S3C2443_CLKSRC_EPLLREF_XTAL:
893 default:
894 parent = &clk_xtal;
895 break;
897 case S3C2443_CLKSRC_EPLLREF_MPLLREF:
898 case S3C2443_CLKSRC_EPLLREF_MPLLREF2:
899 parent = &clk_mpllref;
900 break;
903 clk_init_set_parent(&clk_epllref, parent);
905 switch (clksrc & S3C2443_CLKSRC_I2S_MASK) {
906 case S3C2443_CLKSRC_I2S_EXT:
907 parent = &clk_i2s_ext;
908 break;
910 case S3C2443_CLKSRC_I2S_EPLLDIV:
911 default:
912 parent = &clk_i2s_eplldiv;
913 break;
915 case S3C2443_CLKSRC_I2S_EPLLREF:
916 case S3C2443_CLKSRC_I2S_EPLLREF3:
917 parent = &clk_epllref;
920 clk_init_set_parent(&clk_i2s, &clk_epllref);
922 /* esysclk source */
924 parent = (clksrc & S3C2443_CLKSRC_ESYSCLK_EPLL) ?
925 &clk_epll : &clk_epllref;
927 clk_init_set_parent(&clk_esysclk, parent);
929 /* msysclk source */
931 if (clksrc & S3C2443_CLKSRC_MSYSCLK_MPLL) {
932 parent = &clk_mpll;
933 } else {
934 parent = (clksrc & S3C2443_CLKSRC_EXTCLK_DIV) ?
935 &clk_mdivclk : &clk_mpllref;
938 clk_init_set_parent(&clk_msysclk, parent);
940 /* arm */
942 if (__raw_readl(S3C2443_CLKDIV0) & S3C2443_CLKDIV0_DVS)
943 parent = &clk_h;
944 else
945 parent = &clk_armdiv;
947 clk_init_set_parent(&clk_arm, parent);
950 /* armdiv divisor table */
952 static unsigned int armdiv[16] = {
953 [S3C2443_CLKDIV0_ARMDIV_1 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 1,
954 [S3C2443_CLKDIV0_ARMDIV_2 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 2,
955 [S3C2443_CLKDIV0_ARMDIV_3 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 3,
956 [S3C2443_CLKDIV0_ARMDIV_4 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 4,
957 [S3C2443_CLKDIV0_ARMDIV_6 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 6,
958 [S3C2443_CLKDIV0_ARMDIV_8 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 8,
959 [S3C2443_CLKDIV0_ARMDIV_12 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 12,
960 [S3C2443_CLKDIV0_ARMDIV_16 >> S3C2443_CLKDIV0_ARMDIV_SHIFT] = 16,
963 static inline unsigned int s3c2443_fclk_div(unsigned long clkcon0)
965 clkcon0 &= S3C2443_CLKDIV0_ARMDIV_MASK;
967 return armdiv[clkcon0 >> S3C2443_CLKDIV0_ARMDIV_SHIFT];
970 static inline unsigned long s3c2443_get_hdiv(unsigned long clkcon0)
972 clkcon0 &= S3C2443_CLKDIV0_HCLKDIV_MASK;
974 return clkcon0 + 1;
977 /* clocks to add straight away */
979 static struct clk *clks[] __initdata = {
980 &clk_ext,
981 &clk_epll,
982 &clk_usb_bus_host,
983 &clk_usb_bus,
984 &clk_esysclk,
985 &clk_epllref,
986 &clk_mpllref,
987 &clk_msysclk,
988 &clk_uart,
989 &clk_display,
990 &clk_cam,
991 &clk_i2s_eplldiv,
992 &clk_i2s,
993 &clk_hsspi,
994 &clk_hsmmc_div,
995 &clk_hsmmc,
996 &clk_armdiv,
997 &clk_arm,
998 &clk_prediv,
1001 void __init_or_cpufreq s3c2443_setup_clocks(void)
1003 unsigned long mpllcon = __raw_readl(S3C2443_MPLLCON);
1004 unsigned long clkdiv0 = __raw_readl(S3C2443_CLKDIV0);
1005 struct clk *xtal_clk;
1006 unsigned long xtal;
1007 unsigned long pll;
1008 unsigned long fclk;
1009 unsigned long hclk;
1010 unsigned long pclk;
1012 xtal_clk = clk_get(NULL, "xtal");
1013 xtal = clk_get_rate(xtal_clk);
1014 clk_put(xtal_clk);
1016 pll = s3c2443_get_mpll(mpllcon, xtal);
1017 clk_msysclk.rate = pll;
1019 fclk = pll / s3c2443_fclk_div(clkdiv0);
1020 hclk = s3c2443_prediv_getrate(&clk_prediv);
1021 hclk /= s3c2443_get_hdiv(clkdiv0);
1022 pclk = hclk / ((clkdiv0 & S3C2443_CLKDIV0_HALF_PCLK) ? 2 : 1);
1024 s3c24xx_setup_clocks(fclk, hclk, pclk);
1026 printk("S3C2443: mpll %s %ld.%03ld MHz, cpu %ld.%03ld MHz, mem %ld.%03ld MHz, pclk %ld.%03ld MHz\n",
1027 (mpllcon & S3C2443_PLLCON_OFF) ? "off":"on",
1028 print_mhz(pll), print_mhz(fclk),
1029 print_mhz(hclk), print_mhz(pclk));
1031 s3c24xx_setup_clocks(fclk, hclk, pclk);
1034 void __init s3c2443_init_clocks(int xtal)
1036 struct clk *clkp;
1037 unsigned long epllcon = __raw_readl(S3C2443_EPLLCON);
1038 int ret;
1039 int ptr;
1041 /* s3c2443 parents h and p clocks from prediv */
1042 clk_h.parent = &clk_prediv;
1043 clk_p.parent = &clk_prediv;
1045 s3c24xx_register_baseclocks(xtal);
1046 s3c2443_setup_clocks();
1047 s3c2443_clk_initparents();
1049 for (ptr = 0; ptr < ARRAY_SIZE(clks); ptr++) {
1050 clkp = clks[ptr];
1052 ret = s3c24xx_register_clock(clkp);
1053 if (ret < 0) {
1054 printk(KERN_ERR "Failed to register clock %s (%d)\n",
1055 clkp->name, ret);
1059 clk_epll.rate = s3c2443_get_epll(epllcon, xtal);
1060 clk_epll.parent = &clk_epllref;
1061 clk_usb_bus.parent = &clk_usb_bus_host;
1063 /* ensure usb bus clock is within correct rate of 48MHz */
1065 if (clk_get_rate(&clk_usb_bus_host) != (48 * 1000 * 1000)) {
1066 printk(KERN_INFO "Warning: USB host bus not at 48MHz\n");
1067 clk_set_rate(&clk_usb_bus_host, 48*1000*1000);
1070 printk("S3C2443: epll %s %ld.%03ld MHz, usb-bus %ld.%03ld MHz\n",
1071 (epllcon & S3C2443_PLLCON_OFF) ? "off":"on",
1072 print_mhz(clk_get_rate(&clk_epll)),
1073 print_mhz(clk_get_rate(&clk_usb_bus)));
1075 /* register clocks from clock array */
1077 clkp = init_clocks;
1078 for (ptr = 0; ptr < ARRAY_SIZE(init_clocks); ptr++, clkp++) {
1079 ret = s3c24xx_register_clock(clkp);
1080 if (ret < 0) {
1081 printk(KERN_ERR "Failed to register clock %s (%d)\n",
1082 clkp->name, ret);
1086 /* We must be careful disabling the clocks we are not intending to
1087 * be using at boot time, as subsystems such as the LCD which do
1088 * their own DMA requests to the bus can cause the system to lockup
1089 * if they where in the middle of requesting bus access.
1091 * Disabling the LCD clock if the LCD is active is very dangerous,
1092 * and therefore the bootloader should be careful to not enable
1093 * the LCD clock if it is not needed.
1096 /* install (and disable) the clocks we do not need immediately */
1098 clkp = init_clocks_disable;
1099 for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) {
1101 ret = s3c24xx_register_clock(clkp);
1102 if (ret < 0) {
1103 printk(KERN_ERR "Failed to register clock %s (%d)\n",
1104 clkp->name, ret);
1107 (clkp->enable)(clkp, 0);
1110 s3c_pwmclk_init();