arch/arm/mach-s3c2443/clock.c

   1 /* linux/arch/arm/mach-s3c2443/clock.c
   2  *
   3  * Copyright (c) 2007 Simtec Electronics
   4  *      Ben Dooks <ben@simtec.co.uk>
   5  *
   6  * S3C2443 Clock control support
   7  *
   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.
  12  *
  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.
  17  *
  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
  21 */
  22
  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/delay.h>
  33 #include <linux/serial_core.h>
  34
  35 #include <asm/mach/map.h>
  36
  37 #include <asm/hardware.h>
  38 #include <asm/io.h>
  39
  40 #include <asm/arch/regs-s3c2443-clock.h>
  41
  42 #include <asm/plat-s3c24xx/s3c2443.h>
  43 #include <asm/plat-s3c24xx/clock.h>
  44 #include <asm/plat-s3c24xx/cpu.h>
  45
  46 /* We currently have to assume that the system is running
  47  * from the XTPll input, and that all ***REFCLKs are being
  48  * fed from it, as we cannot read the state of OM[4] from
  49  * software.
  50  *
  51  * It would be possible for each board initialisation to
  52  * set the correct muxing at initialisation
  53 */
  54
  55 static int s3c2443_clkcon_enable_h(struct clk *clk, int enable)
  56 {
  57         unsigned int clocks = clk->ctrlbit;
  58         unsigned long clkcon;
  59
  60         clkcon = __raw_readl(S3C2443_HCLKCON);
  61
  62         if (enable)
  63                 clkcon |= clocks;
  64         else
  65                 clkcon &= ~clocks;
  66
  67         __raw_writel(clkcon, S3C2443_HCLKCON);
  68
  69         return 0;
  70 }
  71
  72 static int s3c2443_clkcon_enable_p(struct clk *clk, int enable)
  73 {
  74         unsigned int clocks = clk->ctrlbit;
  75         unsigned long clkcon;
  76
  77         clkcon = __raw_readl(S3C2443_PCLKCON);
  78
  79         if (enable)
  80                 clkcon |= clocks;
  81         else
  82                 clkcon &= ~clocks;
  83
  84         __raw_writel(clkcon, S3C2443_HCLKCON);
  85
  86         return 0;
  87 }
  88
  89 static int s3c2443_clkcon_enable_s(struct clk *clk, int enable)
  90 {
  91         unsigned int clocks = clk->ctrlbit;
  92         unsigned long clkcon;
  93
  94         clkcon = __raw_readl(S3C2443_SCLKCON);
  95
  96         if (enable)
  97                 clkcon |= clocks;
  98         else
  99                 clkcon &= ~clocks;
 100
 101         __raw_writel(clkcon, S3C2443_SCLKCON);
 102
 103         return 0;
 104 }
 105
 106 static unsigned long s3c2443_roundrate_clksrc(struct clk *clk,
 107                                               unsigned long rate,
 108                                               unsigned int max)
 109 {
 110         unsigned long parent_rate = clk_get_rate(clk->parent);
 111         int div;
 112
 113         if (rate > parent_rate)
 114                 return parent_rate;
 115
 116         /* note, we remove the +/- 1 calculations as they cancel out */
 117
 118         div = (rate / parent_rate);
 119
 120         if (div < 1)
 121                 div = 1;
 122         else if (div > max)
 123                 div = max;
 124
 125         return parent_rate / div;
 126 }
 127
 128 static unsigned long s3c2443_roundrate_clksrc4(struct clk *clk,
 129                                                unsigned long rate)
 130 {
 131         return s3c2443_roundrate_clksrc(clk, rate, 4);
 132 }
 133
 134 static unsigned long s3c2443_roundrate_clksrc16(struct clk *clk,
 135                                                 unsigned long rate)
 136 {
 137         return s3c2443_roundrate_clksrc(clk, rate, 16);
 138 }
 139
 140 static unsigned long s3c2443_roundrate_clksrc256(struct clk *clk,
 141                                                  unsigned long rate)
 142 {
 143         return s3c2443_roundrate_clksrc(clk, rate, 256);
 144 }
 145
 146 /* clock selections */
 147
 148 /* CPU EXTCLK input */
 149 static struct clk clk_ext = {
 150         .name           = "ext",
 151         .id             = -1,
 152 };
 153
 154 static struct clk clk_mpllref = {
 155         .name           = "mpllref",
 156         .parent         = &clk_xtal,
 157         .id             = -1,
 158 };
 159
 160 #if 0
 161 static struct clk clk_mpll = {
 162         .name           = "mpll",
 163         .parent         = &clk_mpllref,
 164         .id             = -1,
 165 };
 166 #endif
 167
 168 static struct clk clk_epllref;
 169
 170 static struct clk clk_epll = {
 171         .name           = "epll",
 172         .parent         = &clk_epllref,
 173         .id             = -1,
 174 };
 175
 176 static struct clk clk_i2s_ext = {
 177         .name           = "i2s-ext",
 178         .id             = -1,
 179 };
 180
 181 static int s3c2443_setparent_epllref(struct clk *clk, struct clk *parent)
 182 {
 183         unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
 184
 185         clksrc &= ~S3C2443_CLKSRC_EPLLREF_MASK;
 186
 187         if (parent == &clk_xtal)
 188                 clksrc |= S3C2443_CLKSRC_EPLLREF_XTAL;
 189         else if (parent == &clk_ext)
 190                 clksrc |= S3C2443_CLKSRC_EPLLREF_EXTCLK;
 191         else if (parent != &clk_mpllref)
 192                 return -EINVAL;
 193
 194         __raw_writel(clksrc, S3C2443_CLKSRC);
 195         clk->parent = parent;
 196
 197         return 0;
 198 }
 199
 200 static struct clk clk_epllref = {
 201         .name           = "epllref",
 202         .id             = -1,
 203         .set_parent     = s3c2443_setparent_epllref,
 204 };
 205
 206 static unsigned long s3c2443_getrate_mdivclk(struct clk *clk)
 207 {
 208         unsigned long parent_rate = clk_get_rate(clk->parent);
 209         unsigned long div = __raw_readl(S3C2443_CLKDIV0);
 210
 211         div  &= S3C2443_CLKDIV0_EXTDIV_MASK;
 212         div >>= (S3C2443_CLKDIV0_EXTDIV_SHIFT-1);       /* x2 */
 213
 214         return parent_rate / (div + 1);
 215 }
 216
 217 static struct clk clk_mdivclk = {
 218         .name           = "mdivclk",
 219         .parent         = &clk_mpllref,
 220         .id             = -1,
 221         .get_rate       = s3c2443_getrate_mdivclk,
 222 };
 223
 224
 225 static int s3c2443_setparent_msysclk(struct clk *clk, struct clk *parent)
 226 {
 227         unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
 228
 229         clksrc &= ~(S3C2443_CLKSRC_MSYSCLK_MPLL |
 230                     S3C2443_CLKSRC_EXTCLK_DIV);
 231
 232         if (parent == &clk_mpll)
 233                 clksrc |= S3C2443_CLKSRC_MSYSCLK_MPLL;
 234         else if (parent == &clk_mdivclk)
 235                 clksrc |= S3C2443_CLKSRC_EXTCLK_DIV;
 236         else if (parent != &clk_mpllref)
 237                 return -EINVAL;
 238
 239         __raw_writel(clksrc, S3C2443_CLKSRC);
 240         clk->parent = parent;
 241
 242         return 0;
 243 }
 244
 245 static struct clk clk_msysclk = {
 246         .name           = "msysclk",
 247         .parent         = &clk_xtal,
 248         .id             = -1,
 249         .set_parent     = s3c2443_setparent_msysclk,
 250 };
 251
 252
 253 /* esysclk
 254  *
 255  * this is sourced from either the EPLL or the EPLLref clock
 256 */
 257
 258 static int s3c2443_setparent_esysclk(struct clk *clk, struct clk *parent)
 259 {
 260         unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
 261
 262         if (parent == &clk_epll)
 263                 clksrc |= S3C2443_CLKSRC_ESYSCLK_EPLL;
 264         else if (parent == &clk_epllref)
 265                 clksrc &= ~S3C2443_CLKSRC_ESYSCLK_EPLL;
 266         else
 267                 return -EINVAL;
 268
 269         __raw_writel(clksrc, S3C2443_CLKSRC);
 270         clk->parent = parent;
 271
 272         return 0;
 273 }
 274
 275 static struct clk clk_esysclk = {
 276         .name           = "esysclk",
 277         .parent         = &clk_epll,
 278         .id             = -1,
 279         .set_parent     = s3c2443_setparent_esysclk,
 280 };
 281
 282 /* uartclk
 283  *
 284  * UART baud-rate clock sourced from esysclk via a divisor
 285 */
 286
 287 static unsigned long s3c2443_getrate_uart(struct clk *clk)
 288 {
 289         unsigned long parent_rate = clk_get_rate(clk->parent);
 290         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 291
 292         div &= S3C2443_CLKDIV1_UARTDIV_MASK;
 293         div >>= S3C2443_CLKDIV1_UARTDIV_SHIFT;
 294
 295         return parent_rate / (div + 1);
 296 }
 297
 298
 299 static int s3c2443_setrate_uart(struct clk *clk, unsigned long rate)
 300 {
 301         unsigned long parent_rate = clk_get_rate(clk->parent);
 302         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 303
 304         rate = s3c2443_roundrate_clksrc16(clk, rate);
 305         rate = parent_rate / rate;
 306
 307         clkdivn &= ~S3C2443_CLKDIV1_UARTDIV_MASK;
 308         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_UARTDIV_SHIFT;
 309
 310         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 311         return 0;
 312 }
 313
 314 static struct clk clk_uart = {
 315         .name           = "uartclk",
 316         .id             = -1,
 317         .parent         = &clk_esysclk,
 318         .get_rate       = s3c2443_getrate_uart,
 319         .set_rate       = s3c2443_setrate_uart,
 320         .round_rate     = s3c2443_roundrate_clksrc16,
 321 };
 322
 323 /* hsspi
 324  *
 325  * high-speed spi clock, sourced from esysclk
 326 */
 327
 328 static unsigned long s3c2443_getrate_hsspi(struct clk *clk)
 329 {
 330         unsigned long parent_rate = clk_get_rate(clk->parent);
 331         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 332
 333         div &= S3C2443_CLKDIV1_HSSPIDIV_MASK;
 334         div >>= S3C2443_CLKDIV1_HSSPIDIV_SHIFT;
 335
 336         return parent_rate / (div + 1);
 337 }
 338
 339
 340 static int s3c2443_setrate_hsspi(struct clk *clk, unsigned long rate)
 341 {
 342         unsigned long parent_rate = clk_get_rate(clk->parent);
 343         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 344
 345         rate = s3c2443_roundrate_clksrc4(clk, rate);
 346         rate = parent_rate / rate;
 347
 348         clkdivn &= ~S3C2443_CLKDIV1_HSSPIDIV_MASK;
 349         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_HSSPIDIV_SHIFT;
 350
 351         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 352         return 0;
 353 }
 354
 355 static struct clk clk_hsspi = {
 356         .name           = "hsspi",
 357         .id             = -1,
 358         .parent         = &clk_esysclk,
 359         .ctrlbit        = S3C2443_SCLKCON_HSSPICLK,
 360         .enable         = s3c2443_clkcon_enable_s,
 361         .get_rate       = s3c2443_getrate_hsspi,
 362         .set_rate       = s3c2443_setrate_hsspi,
 363         .round_rate     = s3c2443_roundrate_clksrc4,
 364 };
 365
 366 /* usbhost
 367  *
 368  * usb host bus-clock, usually 48MHz to provide USB bus clock timing
 369 */
 370
 371 static unsigned long s3c2443_getrate_usbhost(struct clk *clk)
 372 {
 373         unsigned long parent_rate = clk_get_rate(clk->parent);
 374         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 375
 376         div &= S3C2443_CLKDIV1_USBHOSTDIV_MASK;
 377         div >>= S3C2443_CLKDIV1_USBHOSTDIV_SHIFT;
 378
 379         return parent_rate / (div + 1);
 380 }
 381
 382 static int s3c2443_setrate_usbhost(struct clk *clk, unsigned long rate)
 383 {
 384         unsigned long parent_rate = clk_get_rate(clk->parent);
 385         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 386
 387         rate = s3c2443_roundrate_clksrc4(clk, rate);
 388         rate = parent_rate / rate;
 389
 390         clkdivn &= ~S3C2443_CLKDIV1_USBHOSTDIV_MASK;
 391         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_USBHOSTDIV_SHIFT;
 392
 393         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 394         return 0;
 395 }
 396
 397 static struct clk clk_usb_bus_host = {
 398         .name           = "usb-bus-host-parent",
 399         .id             = -1,
 400         .parent         = &clk_esysclk,
 401         .ctrlbit        = S3C2443_SCLKCON_USBHOST,
 402         .enable         = s3c2443_clkcon_enable_s,
 403         .get_rate       = s3c2443_getrate_usbhost,
 404         .set_rate       = s3c2443_setrate_usbhost,
 405         .round_rate     = s3c2443_roundrate_clksrc4,
 406 };
 407
 408 /* clk_hsmcc_div
 409  *
 410  * this clock is sourced from epll, and is fed through a divider,
 411  * to a mux controlled by sclkcon where either it or a extclk can
 412  * be fed to the hsmmc block
 413 */
 414
 415 static unsigned long s3c2443_getrate_hsmmc_div(struct clk *clk)
 416 {
 417         unsigned long parent_rate = clk_get_rate(clk->parent);
 418         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 419
 420         div &= S3C2443_CLKDIV1_HSMMCDIV_MASK;
 421         div >>= S3C2443_CLKDIV1_HSMMCDIV_SHIFT;
 422
 423         return parent_rate / (div + 1);
 424 }
 425
 426 static int s3c2443_setrate_hsmmc_div(struct clk *clk, unsigned long rate)
 427 {
 428         unsigned long parent_rate = clk_get_rate(clk->parent);
 429         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 430
 431         rate = s3c2443_roundrate_clksrc4(clk, rate);
 432         rate = parent_rate / rate;
 433
 434         clkdivn &= ~S3C2443_CLKDIV1_HSMMCDIV_MASK;
 435         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_HSMMCDIV_SHIFT;
 436
 437         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 438         return 0;
 439 }
 440
 441 static struct clk clk_hsmmc_div = {
 442         .name           = "hsmmc-div",
 443         .id             = -1,
 444         .parent         = &clk_esysclk,
 445         .get_rate       = s3c2443_getrate_hsmmc_div,
 446         .set_rate       = s3c2443_setrate_hsmmc_div,
 447         .round_rate     = s3c2443_roundrate_clksrc4,
 448 };
 449
 450 static int s3c2443_setparent_hsmmc(struct clk *clk, struct clk *parent)
 451 {
 452         unsigned long clksrc = __raw_readl(S3C2443_SCLKCON);
 453
 454         clksrc &= ~(S3C2443_SCLKCON_HSMMCCLK_EXT |
 455                     S3C2443_SCLKCON_HSMMCCLK_EPLL);
 456
 457         if (parent == &clk_epll)
 458                 clksrc |= S3C2443_SCLKCON_HSMMCCLK_EPLL;
 459         else if (parent == &clk_ext)
 460                 clksrc |= S3C2443_SCLKCON_HSMMCCLK_EXT;
 461         else
 462                 return -EINVAL;
 463
 464         if (clk->usage > 0) {
 465                 __raw_writel(clksrc, S3C2443_SCLKCON);
 466         }
 467
 468         clk->parent = parent;
 469         return 0;
 470 }
 471
 472 static int s3c2443_enable_hsmmc(struct clk *clk, int enable)
 473 {
 474         return s3c2443_setparent_hsmmc(clk, clk->parent);
 475 }
 476
 477 static struct clk clk_hsmmc = {
 478         .name           = "hsmmc-if",
 479         .id             = -1,
 480         .parent         = &clk_hsmmc_div,
 481         .enable         = s3c2443_enable_hsmmc,
 482         .set_parent     = s3c2443_setparent_hsmmc,
 483 };
 484
 485 /* i2s_eplldiv
 486  *
 487  * this clock is the output from the i2s divisor of esysclk
 488 */
 489
 490 static unsigned long s3c2443_getrate_i2s_eplldiv(struct clk *clk)
 491 {
 492         unsigned long parent_rate = clk_get_rate(clk->parent);
 493         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 494
 495         div &= S3C2443_CLKDIV1_I2SDIV_MASK;
 496         div >>= S3C2443_CLKDIV1_I2SDIV_SHIFT;
 497
 498         return parent_rate / (div + 1);
 499 }
 500
 501 static int s3c2443_setrate_i2s_eplldiv(struct clk *clk, unsigned long rate)
 502 {
 503         unsigned long parent_rate = clk_get_rate(clk->parent);
 504         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 505
 506         rate = s3c2443_roundrate_clksrc16(clk, rate);
 507         rate = parent_rate / rate;
 508
 509         clkdivn &= ~S3C2443_CLKDIV1_I2SDIV_MASK;
 510         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_I2SDIV_SHIFT;
 511
 512         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 513         return 0;
 514 }
 515
 516 static struct clk clk_i2s_eplldiv = {
 517         .name           = "i2s-eplldiv",
 518         .id             = -1,
 519         .parent         = &clk_esysclk,
 520         .get_rate       = s3c2443_getrate_i2s_eplldiv,
 521         .set_rate       = s3c2443_setrate_i2s_eplldiv,
 522         .round_rate     = s3c2443_roundrate_clksrc16,
 523 };
 524
 525 /* i2s-ref
 526  *
 527  * i2s bus reference clock, selectable from external, esysclk or epllref
 528 */
 529
 530 static int s3c2443_setparent_i2s(struct clk *clk, struct clk *parent)
 531 {
 532         unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
 533
 534         clksrc &= ~S3C2443_CLKSRC_I2S_MASK;
 535
 536         if (parent == &clk_epllref)
 537                 clksrc |= S3C2443_CLKSRC_I2S_EPLLREF;
 538         else if (parent == &clk_i2s_ext)
 539                 clksrc |= S3C2443_CLKSRC_I2S_EXT;
 540         else if (parent != &clk_i2s_eplldiv)
 541                 return -EINVAL;
 542
 543         clk->parent = parent;
 544         __raw_writel(clksrc, S3C2443_CLKSRC);
 545
 546         return 0;
 547 }
 548
 549 static struct clk clk_i2s = {
 550         .name           = "i2s-if",
 551         .id             = -1,
 552         .parent         = &clk_i2s_eplldiv,
 553         .ctrlbit        = S3C2443_SCLKCON_I2SCLK,
 554         .enable         = s3c2443_clkcon_enable_s,
 555         .set_parent     = s3c2443_setparent_i2s,
 556 };
 557
 558 /* cam-if
 559  *
 560  * camera interface bus-clock, divided down from esysclk
 561 */
 562
 563 static unsigned long s3c2443_getrate_cam(struct clk *clk)
 564 {
 565         unsigned long parent_rate = clk_get_rate(clk->parent);
 566         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 567
 568         div  &= S3C2443_CLKDIV1_CAMDIV_MASK;
 569         div >>= S3C2443_CLKDIV1_CAMDIV_SHIFT;
 570
 571         return parent_rate / (div + 1);
 572 }
 573
 574 static int s3c2443_setrate_cam(struct clk *clk, unsigned long rate)
 575 {
 576         unsigned long parent_rate = clk_get_rate(clk->parent);
 577         unsigned long clkdiv1 = __raw_readl(S3C2443_CLKDIV1);
 578
 579         rate = s3c2443_roundrate_clksrc16(clk, rate);
 580         rate = parent_rate / rate;
 581
 582         clkdiv1 &= ~S3C2443_CLKDIV1_CAMDIV_MASK;
 583         clkdiv1 |= (rate - 1) << S3C2443_CLKDIV1_CAMDIV_SHIFT;
 584
 585         __raw_writel(clkdiv1, S3C2443_CLKDIV1);
 586         return 0;
 587 }
 588
 589 static struct clk clk_cam = {
 590         .name           = "camif-upll",         /* same as 2440 name */
 591         .id             = -1,
 592         .parent         = &clk_esysclk,
 593         .ctrlbit        = S3C2443_SCLKCON_CAMCLK,
 594         .enable         = s3c2443_clkcon_enable_s,
 595         .get_rate       = s3c2443_getrate_cam,
 596         .set_rate       = s3c2443_setrate_cam,
 597         .round_rate     = s3c2443_roundrate_clksrc16,
 598 };
 599
 600 /* display-if
 601  *
 602  * display interface clock, divided from esysclk
 603 */
 604
 605 static unsigned long s3c2443_getrate_display(struct clk *clk)
 606 {
 607         unsigned long parent_rate = clk_get_rate(clk->parent);
 608         unsigned long div = __raw_readl(S3C2443_CLKDIV1);
 609
 610         div &= S3C2443_CLKDIV1_DISPDIV_MASK;
 611         div >>= S3C2443_CLKDIV1_DISPDIV_SHIFT;
 612
 613         return parent_rate / (div + 1);
 614 }
 615
 616 static int s3c2443_setrate_display(struct clk *clk, unsigned long rate)
 617 {
 618         unsigned long parent_rate = clk_get_rate(clk->parent);
 619         unsigned long clkdivn = __raw_readl(S3C2443_CLKDIV1);
 620
 621         rate = s3c2443_roundrate_clksrc256(clk, rate);
 622         rate = parent_rate / rate;
 623
 624         clkdivn &= ~S3C2443_CLKDIV1_UARTDIV_MASK;
 625         clkdivn |= (rate - 1) << S3C2443_CLKDIV1_UARTDIV_SHIFT;
 626
 627         __raw_writel(clkdivn, S3C2443_CLKDIV1);
 628         return 0;
 629 }
 630
 631 static struct clk clk_display = {
 632         .name           = "display-if",
 633         .id             = -1,
 634         .parent         = &clk_esysclk,
 635         .ctrlbit        = S3C2443_SCLKCON_DISPCLK,
 636         .enable         = s3c2443_clkcon_enable_s,
 637         .get_rate       = s3c2443_getrate_display,
 638         .set_rate       = s3c2443_setrate_display,
 639         .round_rate     = s3c2443_roundrate_clksrc256,
 640 };
 641
 642 /* standard clock definitions */
 643
 644 static struct clk init_clocks_disable[] = {
 645         {
 646                 .name           = "nand",
 647                 .id             = -1,
 648                 .parent         = &clk_h,
 649         }, {
 650                 .name           = "sdi",
 651                 .id             = -1,
 652                 .parent         = &clk_p,
 653                 .enable         = s3c2443_clkcon_enable_p,
 654                 .ctrlbit        = S3C2443_PCLKCON_SDI,
 655         }, {
 656                 .name           = "adc",
 657                 .id             = -1,
 658                 .parent         = &clk_p,
 659                 .enable         = s3c2443_clkcon_enable_p,
 660                 .ctrlbit        = S3C2443_PCLKCON_ADC,
 661         }, {
 662                 .name           = "i2c",
 663                 .id             = -1,
 664                 .parent         = &clk_p,
 665                 .enable         = s3c2443_clkcon_enable_p,
 666                 .ctrlbit        = S3C2443_PCLKCON_IIC,
 667         }, {
 668                 .name           = "iis",
 669                 .id             = -1,
 670                 .parent         = &clk_p,
 671                 .enable         = s3c2443_clkcon_enable_p,
 672                 .ctrlbit        = S3C2443_PCLKCON_IIS,
 673         }, {
 674                 .name           = "spi",
 675                 .id             = 0,
 676                 .parent         = &clk_p,
 677                 .enable         = s3c2443_clkcon_enable_p,
 678                 .ctrlbit        = S3C2443_PCLKCON_SPI0,
 679         }, {
 680                 .name           = "spi",
 681                 .id             = 1,
 682                 .parent         = &clk_p,
 683                 .enable         = s3c2443_clkcon_enable_p,
 684                 .ctrlbit        = S3C2443_PCLKCON_SPI1,
 685         }
 686 };
 687
 688 static struct clk init_clocks[] = {
 689         {
 690                 .name           = "dma",
 691                 .id             = 0,
 692                 .parent         = &clk_h,
 693                 .enable         = s3c2443_clkcon_enable_h,
 694                 .ctrlbit        = S3C2443_HCLKCON_DMA0,
 695         }, {
 696                 .name           = "dma",
 697                 .id             = 1,
 698                 .parent         = &clk_h,
 699                 .enable         = s3c2443_clkcon_enable_h,
 700                 .ctrlbit        = S3C2443_HCLKCON_DMA1,
 701         }, {
 702                 .name           = "dma",
 703                 .id             = 2,
 704                 .parent         = &clk_h,
 705                 .enable         = s3c2443_clkcon_enable_h,
 706                 .ctrlbit        = S3C2443_HCLKCON_DMA2,
 707         }, {
 708                 .name           = "dma",
 709                 .id             = 3,
 710                 .parent         = &clk_h,
 711                 .enable         = s3c2443_clkcon_enable_h,
 712                 .ctrlbit        = S3C2443_HCLKCON_DMA3,
 713         }, {
 714                 .name           = "dma",
 715                 .id             = 4,
 716                 .parent         = &clk_h,
 717                 .enable         = s3c2443_clkcon_enable_h,
 718                 .ctrlbit        = S3C2443_HCLKCON_DMA4,
 719         }, {
 720                 .name           = "dma",
 721                 .id             = 5,
 722                 .parent         = &clk_h,
 723                 .enable         = s3c2443_clkcon_enable_h,
 724                 .ctrlbit        = S3C2443_HCLKCON_DMA5,
 725         }, {
 726                 .name           = "lcd",
 727                 .id             = -1,
 728                 .parent         = &clk_h,
 729                 .enable         = s3c2443_clkcon_enable_h,
 730                 .ctrlbit        = S3C2443_HCLKCON_LCDC,
 731         }, {
 732                 .name           = "gpio",
 733                 .id             = -1,
 734                 .parent         = &clk_p,
 735                 .enable         = s3c2443_clkcon_enable_p,
 736                 .ctrlbit        = S3C2443_PCLKCON_GPIO,
 737         }, {
 738                 .name           = "usb-host",
 739                 .id             = -1,
 740                 .parent         = &clk_h,
 741                 .enable         = s3c2443_clkcon_enable_h,
 742                 .ctrlbit        = S3C2443_HCLKCON_USBH,
 743         }, {
 744                 .name           = "usb-device",
 745                 .id             = -1,
 746                 .parent         = &clk_h,
 747                 .enable         = s3c2443_clkcon_enable_h,
 748                 .ctrlbit        = S3C2443_HCLKCON_USBD,
 749         }, {
 750                 .name           = "hsmmc",
 751                 .id             = -1,
 752                 .parent         = &clk_h,
 753                 .enable         = s3c2443_clkcon_enable_h,
 754                 .ctrlbit        = S3C2443_HCLKCON_HSMMC,
 755         }, {
 756                 .name           = "cfc",
 757                 .id             = -1,
 758                 .parent         = &clk_h,
 759                 .enable         = s3c2443_clkcon_enable_h,
 760                 .ctrlbit        = S3C2443_HCLKCON_CFC,
 761         }, {
 762                 .name           = "ssmc",
 763                 .id             = -1,
 764                 .parent         = &clk_h,
 765                 .enable         = s3c2443_clkcon_enable_h,
 766                 .ctrlbit        = S3C2443_HCLKCON_SSMC,
 767         }, {
 768                 .name           = "timers",
 769                 .id             = -1,
 770                 .parent         = &clk_p,
 771                 .enable         = s3c2443_clkcon_enable_p,
 772                 .ctrlbit        = S3C2443_PCLKCON_PWMT,
 773         }, {
 774                 .name           = "uart",
 775                 .id             = 0,
 776                 .parent         = &clk_p,
 777                 .enable         = s3c2443_clkcon_enable_p,
 778                 .ctrlbit        = S3C2443_PCLKCON_UART0,
 779         }, {
 780                 .name           = "uart",
 781                 .id             = 1,
 782                 .parent         = &clk_p,
 783                 .enable         = s3c2443_clkcon_enable_p,
 784                 .ctrlbit        = S3C2443_PCLKCON_UART1,
 785         }, {
 786                 .name           = "uart",
 787                 .id             = 2,
 788                 .parent         = &clk_p,
 789                 .enable         = s3c2443_clkcon_enable_p,
 790                 .ctrlbit        = S3C2443_PCLKCON_UART2,
 791         }, {
 792                 .name           = "uart",
 793                 .id             = 3,
 794                 .parent         = &clk_p,
 795                 .enable         = s3c2443_clkcon_enable_p,
 796                 .ctrlbit        = S3C2443_PCLKCON_UART3,
 797         }, {
 798                 .name           = "rtc",
 799                 .id             = -1,
 800                 .parent         = &clk_p,
 801                 .enable         = s3c2443_clkcon_enable_p,
 802                 .ctrlbit        = S3C2443_PCLKCON_RTC,
 803         }, {
 804                 .name           = "watchdog",
 805                 .id             = -1,
 806                 .parent         = &clk_p,
 807                 .ctrlbit        = S3C2443_PCLKCON_WDT,
 808         }, {
 809                 .name           = "usb-bus-host",
 810                 .id             = -1,
 811                 .parent         = &clk_usb_bus_host,
 812         }, {
 813                 .name           = "ac97",
 814                 .id             = -1,
 815                 .parent         = &clk_p,
 816                 .ctrlbit        = S3C2443_PCLKCON_AC97,
 817         }
 818 };
 819
 820 /* clocks to add where we need to check their parentage */
 821
 822 /* s3c2443_clk_initparents
 823  *
 824  * Initialise the parents for the clocks that we get at start-time
 825 */
 826
 827 static int __init clk_init_set_parent(struct clk *clk, struct clk *parent)
 828 {
 829         printk(KERN_DEBUG "clock %s: parent %s\n", clk->name, parent->name);
 830         return clk_set_parent(clk, parent);
 831 }
 832
 833 static void __init s3c2443_clk_initparents(void)
 834 {
 835         unsigned long clksrc = __raw_readl(S3C2443_CLKSRC);
 836         struct clk *parent;
 837
 838         switch (clksrc & S3C2443_CLKSRC_EPLLREF_MASK) {
 839         case S3C2443_CLKSRC_EPLLREF_EXTCLK:
 840                 parent = &clk_ext;
 841                 break;
 842
 843         case S3C2443_CLKSRC_EPLLREF_XTAL:
 844         default:
 845                 parent = &clk_xtal;
 846                 break;
 847
 848         case S3C2443_CLKSRC_EPLLREF_MPLLREF:
 849         case S3C2443_CLKSRC_EPLLREF_MPLLREF2:
 850                 parent = &clk_mpllref;
 851                 break;
 852         }
 853
 854         clk_init_set_parent(&clk_epllref, parent);
 855
 856         switch (clksrc & S3C2443_CLKSRC_I2S_MASK) {
 857         case S3C2443_CLKSRC_I2S_EXT:
 858                 parent = &clk_i2s_ext;
 859                 break;
 860
 861         case S3C2443_CLKSRC_I2S_EPLLDIV:
 862         default:
 863                 parent = &clk_i2s_eplldiv;
 864                 break;
 865
 866         case S3C2443_CLKSRC_I2S_EPLLREF:
 867         case S3C2443_CLKSRC_I2S_EPLLREF3:
 868                 parent = &clk_epllref;
 869         }
 870
 871         clk_init_set_parent(&clk_i2s, &clk_epllref);
 872
 873         /* esysclk source */
 874
 875         parent = (clksrc & S3C2443_CLKSRC_ESYSCLK_EPLL) ?
 876                 &clk_epll : &clk_epllref;
 877
 878         clk_init_set_parent(&clk_esysclk, parent);
 879
 880         /* msysclk source */
 881
 882         if (clksrc & S3C2443_CLKSRC_MSYSCLK_MPLL) {
 883                 parent = &clk_mpll;
 884         } else {
 885                 parent = (clksrc & S3C2443_CLKSRC_EXTCLK_DIV) ?
 886                         &clk_mdivclk : &clk_mpllref;
 887         }
 888
 889         clk_init_set_parent(&clk_msysclk, parent);
 890 }
 891
 892 /* armdiv divisor table */
 893
 894 static unsigned int armdiv[16] = {
 895         [S3C2443_CLKDIV0_ARMDIV_1 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 1,
 896         [S3C2443_CLKDIV0_ARMDIV_2 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 2,
 897         [S3C2443_CLKDIV0_ARMDIV_3 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 3,
 898         [S3C2443_CLKDIV0_ARMDIV_4 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 4,
 899         [S3C2443_CLKDIV0_ARMDIV_6 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 6,
 900         [S3C2443_CLKDIV0_ARMDIV_8 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]      = 8,
 901         [S3C2443_CLKDIV0_ARMDIV_12 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]     = 12,
 902         [S3C2443_CLKDIV0_ARMDIV_16 >> S3C2443_CLKDIV0_ARMDIV_SHIFT]     = 16,
 903 };
 904
 905 static inline unsigned int s3c2443_fclk_div(unsigned long clkcon0)
 906 {
 907         clkcon0 &= S3C2443_CLKDIV0_ARMDIV_MASK;
 908
 909         return armdiv[clkcon0 >> S3C2443_CLKDIV0_ARMDIV_SHIFT];
 910 }
 911
 912 static inline unsigned long s3c2443_get_prediv(unsigned long clkcon0)
 913 {
 914         clkcon0 &= S3C2443_CLKDIV0_PREDIV_MASK;
 915         clkcon0 >>= S3C2443_CLKDIV0_PREDIV_SHIFT;
 916
 917         return clkcon0 + 1;
 918 }
 919
 920 /* clocks to add straight away */
 921
 922 static struct clk *clks[] __initdata = {
 923         &clk_ext,
 924         &clk_epll,
 925         &clk_usb_bus_host,
 926         &clk_usb_bus,
 927         &clk_esysclk,
 928         &clk_epllref,
 929         &clk_mpllref,
 930         &clk_msysclk,
 931         &clk_uart,
 932         &clk_display,
 933         &clk_cam,
 934         &clk_i2s_eplldiv,
 935         &clk_i2s,
 936         &clk_hsspi,
 937         &clk_hsmmc_div,
 938         &clk_hsmmc,
 939 };
 940
 941 void __init s3c2443_init_clocks(int xtal)
 942 {
 943         unsigned long epllcon = __raw_readl(S3C2443_EPLLCON);
 944         unsigned long mpllcon = __raw_readl(S3C2443_MPLLCON);
 945         unsigned long clkdiv0 = __raw_readl(S3C2443_CLKDIV0);
 946         unsigned long pll;
 947         unsigned long fclk;
 948         unsigned long hclk;
 949         unsigned long pclk;
 950         struct clk *clkp;
 951         int ret;
 952         int ptr;
 953
 954         pll = s3c2443_get_mpll(mpllcon, xtal);
 955
 956         fclk = pll / s3c2443_fclk_div(clkdiv0);
 957         hclk = fclk / s3c2443_get_prediv(clkdiv0);
 958         hclk = hclk / ((clkdiv0 & S3C2443_CLKDIV0_HALF_HCLK) ? 2 : 1);
 959         pclk = hclk / ((clkdiv0 & S3C2443_CLKDIV0_HALF_PCLK) ? 2 : 1);
 960
 961         s3c24xx_setup_clocks(xtal, fclk, hclk, pclk);
 962
 963         printk("S3C2443: mpll %s %ld.%03ld MHz, cpu %ld.%03ld MHz, mem %ld.%03ld MHz, pclk %ld.%03ld MHz\n",
 964                (mpllcon & S3C2443_PLLCON_OFF) ? "off":"on",
 965                print_mhz(pll), print_mhz(fclk),
 966                print_mhz(hclk), print_mhz(pclk));
 967
 968         s3c2443_clk_initparents();
 969
 970         for (ptr = 0; ptr < ARRAY_SIZE(clks); ptr++) {
 971                 clkp = clks[ptr];
 972
 973                 ret = s3c24xx_register_clock(clkp);
 974                 if (ret < 0) {
 975                         printk(KERN_ERR "Failed to register clock %s (%d)\n",
 976                                clkp->name, ret);
 977                 }
 978         }
 979
 980         clk_epll.rate = s3c2443_get_epll(epllcon, xtal);
 981
 982         clk_usb_bus.parent = &clk_usb_bus_host;
 983
 984         /* ensure usb bus clock is within correct rate of 48MHz */
 985
 986         if (clk_get_rate(&clk_usb_bus_host) != (48 * 1000 * 1000)) {
 987                 printk(KERN_INFO "Warning: USB host bus not at 48MHz\n");
 988                 clk_set_rate(&clk_usb_bus_host, 48*1000*1000);
 989         }
 990
 991         printk("S3C2443: epll %s %ld.%03ld MHz, usb-bus %ld.%03ld MHz\n",
 992                (epllcon & S3C2443_PLLCON_OFF) ? "off":"on",
 993                print_mhz(clk_get_rate(&clk_epll)),
 994                print_mhz(clk_get_rate(&clk_usb_bus)));
 995
 996         /* register clocks from clock array */
 997
 998         clkp = init_clocks;
 999         for (ptr = 0; ptr < ARRAY_SIZE(init_clocks); ptr++, clkp++) {
1000                 ret = s3c24xx_register_clock(clkp);
1001                 if (ret < 0) {
1002                         printk(KERN_ERR "Failed to register clock %s (%d)\n",
1003                                clkp->name, ret);
1004                 }
1005         }
1006
1007         /* We must be careful disabling the clocks we are not intending to
1008          * be using at boot time, as subsystems such as the LCD which do
1009          * their own DMA requests to the bus can cause the system to lockup
1010          * if they where in the middle of requesting bus access.
1011          *
1012          * Disabling the LCD clock if the LCD is active is very dangerous,
1013          * and therefore the bootloader should be careful to not enable
1014          * the LCD clock if it is not needed.
1015         */
1016
1017         /* install (and disable) the clocks we do not need immediately */
1018
1019         clkp = init_clocks_disable;
1020         for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) {
1021
1022                 ret = s3c24xx_register_clock(clkp);
1023                 if (ret < 0) {
1024                         printk(KERN_ERR "Failed to register clock %s (%d)\n",
1025                                clkp->name, ret);
1026                 }
1027
1028                 (clkp->enable)(clkp, 0);
1029         }
1030 }