diff options
Diffstat (limited to 'arch/arm/mach-s3c2412/clock.c')
| -rw-r--r-- | arch/arm/mach-s3c2412/clock.c | 716 |
1 files changed, 716 insertions, 0 deletions
diff --git a/arch/arm/mach-s3c2412/clock.c b/arch/arm/mach-s3c2412/clock.c new file mode 100644 index 000000000000..6a8e4448770b --- /dev/null +++ b/arch/arm/mach-s3c2412/clock.c | |||
| @@ -0,0 +1,716 @@ | |||
| 1 | /* linux/arch/arm/mach-s3c2412/clock.c | ||
| 2 | * | ||
| 3 | * Copyright (c) 2006 Simtec Electronics | ||
| 4 | * Ben Dooks <ben@simtec.co.uk> | ||
| 5 | * | ||
| 6 | * S3C2412,S3C2413 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-serial.h> | ||
| 41 | #include <asm/arch/regs-clock.h> | ||
| 42 | #include <asm/arch/regs-gpio.h> | ||
| 43 | |||
| 44 | #include <asm/plat-s3c24xx/s3c2412.h> | ||
| 45 | #include <asm/plat-s3c24xx/clock.h> | ||
| 46 | #include <asm/plat-s3c24xx/cpu.h> | ||
| 47 | |||
| 48 | /* We currently have to assume that the system is running | ||
| 49 | * from the XTPll input, and that all ***REFCLKs are being | ||
| 50 | * fed from it, as we cannot read the state of OM[4] from | ||
| 51 | * software. | ||
| 52 | * | ||
| 53 | * It would be possible for each board initialisation to | ||
| 54 | * set the correct muxing at initialisation | ||
| 55 | */ | ||
| 56 | |||
| 57 | static int s3c2412_clkcon_enable(struct clk *clk, int enable) | ||
| 58 | { | ||
| 59 | unsigned int clocks = clk->ctrlbit; | ||
| 60 | unsigned long clkcon; | ||
| 61 | |||
| 62 | clkcon = __raw_readl(S3C2410_CLKCON); | ||
| 63 | |||
| 64 | if (enable) | ||
| 65 | clkcon |= clocks; | ||
| 66 | else | ||
| 67 | clkcon &= ~clocks; | ||
| 68 | |||
| 69 | __raw_writel(clkcon, S3C2410_CLKCON); | ||
| 70 | |||
| 71 | return 0; | ||
| 72 | } | ||
| 73 | |||
| 74 | static int s3c2412_upll_enable(struct clk *clk, int enable) | ||
| 75 | { | ||
| 76 | unsigned long upllcon = __raw_readl(S3C2410_UPLLCON); | ||
| 77 | unsigned long orig = upllcon; | ||
| 78 | |||
| 79 | if (!enable) | ||
| 80 | upllcon |= S3C2412_PLLCON_OFF; | ||
| 81 | else | ||
| 82 | upllcon &= ~S3C2412_PLLCON_OFF; | ||
| 83 | |||
| 84 | __raw_writel(upllcon, S3C2410_UPLLCON); | ||
| 85 | |||
| 86 | /* allow ~150uS for the PLL to settle and lock */ | ||
| 87 | |||
| 88 | if (enable && (orig & S3C2412_PLLCON_OFF)) | ||
| 89 | udelay(150); | ||
| 90 | |||
| 91 | return 0; | ||
| 92 | } | ||
| 93 | |||
| 94 | /* clock selections */ | ||
| 95 | |||
| 96 | /* CPU EXTCLK input */ | ||
| 97 | static struct clk clk_ext = { | ||
| 98 | .name = "extclk", | ||
| 99 | .id = -1, | ||
| 100 | }; | ||
| 101 | |||
| 102 | static struct clk clk_erefclk = { | ||
| 103 | .name = "erefclk", | ||
| 104 | .id = -1, | ||
| 105 | }; | ||
| 106 | |||
| 107 | static struct clk clk_urefclk = { | ||
| 108 | .name = "urefclk", | ||
| 109 | .id = -1, | ||
| 110 | }; | ||
| 111 | |||
| 112 | static int s3c2412_setparent_usysclk(struct clk *clk, struct clk *parent) | ||
| 113 | { | ||
| 114 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 115 | |||
| 116 | if (parent == &clk_urefclk) | ||
| 117 | clksrc &= ~S3C2412_CLKSRC_USYSCLK_UPLL; | ||
| 118 | else if (parent == &clk_upll) | ||
| 119 | clksrc |= S3C2412_CLKSRC_USYSCLK_UPLL; | ||
| 120 | else | ||
| 121 | return -EINVAL; | ||
| 122 | |||
| 123 | clk->parent = parent; | ||
| 124 | |||
| 125 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 126 | return 0; | ||
| 127 | } | ||
| 128 | |||
| 129 | static struct clk clk_usysclk = { | ||
| 130 | .name = "usysclk", | ||
| 131 | .id = -1, | ||
| 132 | .parent = &clk_xtal, | ||
| 133 | .set_parent = s3c2412_setparent_usysclk, | ||
| 134 | }; | ||
| 135 | |||
| 136 | static struct clk clk_mrefclk = { | ||
| 137 | .name = "mrefclk", | ||
| 138 | .parent = &clk_xtal, | ||
| 139 | .id = -1, | ||
| 140 | }; | ||
| 141 | |||
| 142 | static struct clk clk_mdivclk = { | ||
| 143 | .name = "mdivclk", | ||
| 144 | .parent = &clk_xtal, | ||
| 145 | .id = -1, | ||
| 146 | }; | ||
| 147 | |||
| 148 | static int s3c2412_setparent_usbsrc(struct clk *clk, struct clk *parent) | ||
| 149 | { | ||
| 150 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 151 | |||
| 152 | if (parent == &clk_usysclk) | ||
| 153 | clksrc &= ~S3C2412_CLKSRC_USBCLK_HCLK; | ||
| 154 | else if (parent == &clk_h) | ||
| 155 | clksrc |= S3C2412_CLKSRC_USBCLK_HCLK; | ||
| 156 | else | ||
| 157 | return -EINVAL; | ||
| 158 | |||
| 159 | clk->parent = parent; | ||
| 160 | |||
| 161 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 162 | return 0; | ||
| 163 | } | ||
| 164 | |||
| 165 | static unsigned long s3c2412_roundrate_usbsrc(struct clk *clk, | ||
| 166 | unsigned long rate) | ||
| 167 | { | ||
| 168 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 169 | int div; | ||
| 170 | |||
| 171 | if (rate > parent_rate) | ||
| 172 | return parent_rate; | ||
| 173 | |||
| 174 | div = parent_rate / rate; | ||
| 175 | if (div > 2) | ||
| 176 | div = 2; | ||
| 177 | |||
| 178 | return parent_rate / div; | ||
| 179 | } | ||
| 180 | |||
| 181 | static unsigned long s3c2412_getrate_usbsrc(struct clk *clk) | ||
| 182 | { | ||
| 183 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 184 | unsigned long div = __raw_readl(S3C2410_CLKDIVN); | ||
| 185 | |||
| 186 | return parent_rate / ((div & S3C2412_CLKDIVN_USB48DIV) ? 2 : 1); | ||
| 187 | } | ||
| 188 | |||
| 189 | static int s3c2412_setrate_usbsrc(struct clk *clk, unsigned long rate) | ||
| 190 | { | ||
| 191 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 192 | unsigned long clkdivn = __raw_readl(S3C2410_CLKDIVN); | ||
| 193 | |||
| 194 | rate = s3c2412_roundrate_usbsrc(clk, rate); | ||
| 195 | |||
| 196 | if ((parent_rate / rate) == 2) | ||
| 197 | clkdivn |= S3C2412_CLKDIVN_USB48DIV; | ||
| 198 | else | ||
| 199 | clkdivn &= ~S3C2412_CLKDIVN_USB48DIV; | ||
| 200 | |||
| 201 | __raw_writel(clkdivn, S3C2410_CLKDIVN); | ||
| 202 | return 0; | ||
| 203 | } | ||
| 204 | |||
| 205 | static struct clk clk_usbsrc = { | ||
| 206 | .name = "usbsrc", | ||
| 207 | .id = -1, | ||
| 208 | .get_rate = s3c2412_getrate_usbsrc, | ||
| 209 | .set_rate = s3c2412_setrate_usbsrc, | ||
| 210 | .round_rate = s3c2412_roundrate_usbsrc, | ||
| 211 | .set_parent = s3c2412_setparent_usbsrc, | ||
| 212 | }; | ||
| 213 | |||
| 214 | static int s3c2412_setparent_msysclk(struct clk *clk, struct clk *parent) | ||
| 215 | { | ||
| 216 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 217 | |||
| 218 | if (parent == &clk_mdivclk) | ||
| 219 | clksrc &= ~S3C2412_CLKSRC_MSYSCLK_MPLL; | ||
| 220 | else if (parent == &clk_upll) | ||
| 221 | clksrc |= S3C2412_CLKSRC_MSYSCLK_MPLL; | ||
| 222 | else | ||
| 223 | return -EINVAL; | ||
| 224 | |||
| 225 | clk->parent = parent; | ||
| 226 | |||
| 227 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 228 | return 0; | ||
| 229 | } | ||
| 230 | |||
| 231 | static struct clk clk_msysclk = { | ||
| 232 | .name = "msysclk", | ||
| 233 | .id = -1, | ||
| 234 | .set_parent = s3c2412_setparent_msysclk, | ||
| 235 | }; | ||
| 236 | |||
| 237 | /* these next clocks have an divider immediately after them, | ||
| 238 | * so we can register them with their divider and leave out the | ||
| 239 | * intermediate clock stage | ||
| 240 | */ | ||
| 241 | static unsigned long s3c2412_roundrate_clksrc(struct clk *clk, | ||
| 242 | unsigned long rate) | ||
| 243 | { | ||
| 244 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 245 | int div; | ||
| 246 | |||
| 247 | if (rate > parent_rate) | ||
| 248 | return parent_rate; | ||
| 249 | |||
| 250 | /* note, we remove the +/- 1 calculations as they cancel out */ | ||
| 251 | |||
| 252 | div = (rate / parent_rate); | ||
| 253 | |||
| 254 | if (div < 1) | ||
| 255 | div = 1; | ||
| 256 | else if (div > 16) | ||
| 257 | div = 16; | ||
| 258 | |||
| 259 | return parent_rate / div; | ||
| 260 | } | ||
| 261 | |||
| 262 | static int s3c2412_setparent_uart(struct clk *clk, struct clk *parent) | ||
| 263 | { | ||
| 264 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 265 | |||
| 266 | if (parent == &clk_erefclk) | ||
| 267 | clksrc &= ~S3C2412_CLKSRC_UARTCLK_MPLL; | ||
| 268 | else if (parent == &clk_mpll) | ||
| 269 | clksrc |= S3C2412_CLKSRC_UARTCLK_MPLL; | ||
| 270 | else | ||
| 271 | return -EINVAL; | ||
| 272 | |||
| 273 | clk->parent = parent; | ||
| 274 | |||
| 275 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 276 | return 0; | ||
| 277 | } | ||
| 278 | |||
| 279 | static unsigned long s3c2412_getrate_uart(struct clk *clk) | ||
| 280 | { | ||
| 281 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 282 | unsigned long div = __raw_readl(S3C2410_CLKDIVN); | ||
| 283 | |||
| 284 | div &= S3C2412_CLKDIVN_UARTDIV_MASK; | ||
| 285 | div >>= S3C2412_CLKDIVN_UARTDIV_SHIFT; | ||
| 286 | |||
| 287 | return parent_rate / (div + 1); | ||
| 288 | } | ||
| 289 | |||
| 290 | static int s3c2412_setrate_uart(struct clk *clk, unsigned long rate) | ||
| 291 | { | ||
| 292 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 293 | unsigned long clkdivn = __raw_readl(S3C2410_CLKDIVN); | ||
| 294 | |||
| 295 | rate = s3c2412_roundrate_clksrc(clk, rate); | ||
| 296 | |||
| 297 | clkdivn &= ~S3C2412_CLKDIVN_UARTDIV_MASK; | ||
| 298 | clkdivn |= ((parent_rate / rate) - 1) << S3C2412_CLKDIVN_UARTDIV_SHIFT; | ||
| 299 | |||
| 300 | __raw_writel(clkdivn, S3C2410_CLKDIVN); | ||
| 301 | return 0; | ||
| 302 | } | ||
| 303 | |||
| 304 | static struct clk clk_uart = { | ||
| 305 | .name = "uartclk", | ||
| 306 | .id = -1, | ||
| 307 | .get_rate = s3c2412_getrate_uart, | ||
| 308 | .set_rate = s3c2412_setrate_uart, | ||
| 309 | .set_parent = s3c2412_setparent_uart, | ||
| 310 | .round_rate = s3c2412_roundrate_clksrc, | ||
| 311 | }; | ||
| 312 | |||
| 313 | static int s3c2412_setparent_i2s(struct clk *clk, struct clk *parent) | ||
| 314 | { | ||
| 315 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 316 | |||
| 317 | if (parent == &clk_erefclk) | ||
| 318 | clksrc &= ~S3C2412_CLKSRC_I2SCLK_MPLL; | ||
| 319 | else if (parent == &clk_mpll) | ||
| 320 | clksrc |= S3C2412_CLKSRC_I2SCLK_MPLL; | ||
| 321 | else | ||
| 322 | return -EINVAL; | ||
| 323 | |||
| 324 | clk->parent = parent; | ||
| 325 | |||
| 326 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 327 | return 0; | ||
| 328 | } | ||
| 329 | |||
| 330 | static unsigned long s3c2412_getrate_i2s(struct clk *clk) | ||
| 331 | { | ||
| 332 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 333 | unsigned long div = __raw_readl(S3C2410_CLKDIVN); | ||
| 334 | |||
| 335 | div &= S3C2412_CLKDIVN_I2SDIV_MASK; | ||
| 336 | div >>= S3C2412_CLKDIVN_I2SDIV_SHIFT; | ||
| 337 | |||
| 338 | return parent_rate / (div + 1); | ||
| 339 | } | ||
| 340 | |||
| 341 | static int s3c2412_setrate_i2s(struct clk *clk, unsigned long rate) | ||
| 342 | { | ||
| 343 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 344 | unsigned long clkdivn = __raw_readl(S3C2410_CLKDIVN); | ||
| 345 | |||
| 346 | rate = s3c2412_roundrate_clksrc(clk, rate); | ||
| 347 | |||
| 348 | clkdivn &= ~S3C2412_CLKDIVN_I2SDIV_MASK; | ||
| 349 | clkdivn |= ((parent_rate / rate) - 1) << S3C2412_CLKDIVN_I2SDIV_SHIFT; | ||
| 350 | |||
| 351 | __raw_writel(clkdivn, S3C2410_CLKDIVN); | ||
| 352 | return 0; | ||
| 353 | } | ||
| 354 | |||
| 355 | static struct clk clk_i2s = { | ||
| 356 | .name = "i2sclk", | ||
| 357 | .id = -1, | ||
| 358 | .get_rate = s3c2412_getrate_i2s, | ||
| 359 | .set_rate = s3c2412_setrate_i2s, | ||
| 360 | .set_parent = s3c2412_setparent_i2s, | ||
| 361 | .round_rate = s3c2412_roundrate_clksrc, | ||
| 362 | }; | ||
| 363 | |||
| 364 | static int s3c2412_setparent_cam(struct clk *clk, struct clk *parent) | ||
| 365 | { | ||
| 366 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 367 | |||
| 368 | if (parent == &clk_usysclk) | ||
| 369 | clksrc &= ~S3C2412_CLKSRC_CAMCLK_HCLK; | ||
| 370 | else if (parent == &clk_h) | ||
| 371 | clksrc |= S3C2412_CLKSRC_CAMCLK_HCLK; | ||
| 372 | else | ||
| 373 | return -EINVAL; | ||
| 374 | |||
| 375 | clk->parent = parent; | ||
| 376 | |||
| 377 | __raw_writel(clksrc, S3C2412_CLKSRC); | ||
| 378 | return 0; | ||
| 379 | } | ||
| 380 | static unsigned long s3c2412_getrate_cam(struct clk *clk) | ||
| 381 | { | ||
| 382 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 383 | unsigned long div = __raw_readl(S3C2410_CLKDIVN); | ||
| 384 | |||
| 385 | div &= S3C2412_CLKDIVN_CAMDIV_MASK; | ||
| 386 | div >>= S3C2412_CLKDIVN_CAMDIV_SHIFT; | ||
| 387 | |||
| 388 | return parent_rate / (div + 1); | ||
| 389 | } | ||
| 390 | |||
| 391 | static int s3c2412_setrate_cam(struct clk *clk, unsigned long rate) | ||
| 392 | { | ||
| 393 | unsigned long parent_rate = clk_get_rate(clk->parent); | ||
| 394 | unsigned long clkdivn = __raw_readl(S3C2410_CLKDIVN); | ||
| 395 | |||
| 396 | rate = s3c2412_roundrate_clksrc(clk, rate); | ||
| 397 | |||
| 398 | clkdivn &= ~S3C2412_CLKDIVN_CAMDIV_MASK; | ||
| 399 | clkdivn |= ((parent_rate / rate) - 1) << S3C2412_CLKDIVN_CAMDIV_SHIFT; | ||
| 400 | |||
| 401 | __raw_writel(clkdivn, S3C2410_CLKDIVN); | ||
| 402 | return 0; | ||
| 403 | } | ||
| 404 | |||
| 405 | static struct clk clk_cam = { | ||
| 406 | .name = "camif-upll", /* same as 2440 name */ | ||
| 407 | .id = -1, | ||
| 408 | .get_rate = s3c2412_getrate_cam, | ||
| 409 | .set_rate = s3c2412_setrate_cam, | ||
| 410 | .set_parent = s3c2412_setparent_cam, | ||
| 411 | .round_rate = s3c2412_roundrate_clksrc, | ||
| 412 | }; | ||
| 413 | |||
| 414 | /* standard clock definitions */ | ||
| 415 | |||
| 416 | static struct clk init_clocks_disable[] = { | ||
| 417 | { | ||
| 418 | .name = "nand", | ||
| 419 | .id = -1, | ||
| 420 | .parent = &clk_h, | ||
| 421 | .enable = s3c2412_clkcon_enable, | ||
| 422 | .ctrlbit = S3C2412_CLKCON_NAND, | ||
| 423 | }, { | ||
| 424 | .name = "sdi", | ||
| 425 | .id = -1, | ||
| 426 | .parent = &clk_p, | ||
| 427 | .enable = s3c2412_clkcon_enable, | ||
| 428 | .ctrlbit = S3C2412_CLKCON_SDI, | ||
| 429 | }, { | ||
| 430 | .name = "adc", | ||
| 431 | .id = -1, | ||
| 432 | .parent = &clk_p, | ||
| 433 | .enable = s3c2412_clkcon_enable, | ||
| 434 | .ctrlbit = S3C2412_CLKCON_ADC, | ||
| 435 | }, { | ||
| 436 | .name = "i2c", | ||
| 437 | .id = -1, | ||
| 438 | .parent = &clk_p, | ||
| 439 | .enable = s3c2412_clkcon_enable, | ||
| 440 | .ctrlbit = S3C2412_CLKCON_IIC, | ||
| 441 | }, { | ||
| 442 | .name = "iis", | ||
| 443 | .id = -1, | ||
| 444 | .parent = &clk_p, | ||
| 445 | .enable = s3c2412_clkcon_enable, | ||
| 446 | .ctrlbit = S3C2412_CLKCON_IIS, | ||
| 447 | }, { | ||
| 448 | .name = "spi", | ||
| 449 | .id = -1, | ||
| 450 | .parent = &clk_p, | ||
| 451 | .enable = s3c2412_clkcon_enable, | ||
| 452 | .ctrlbit = S3C2412_CLKCON_SPI, | ||
| 453 | } | ||
| 454 | }; | ||
| 455 | |||
| 456 | static struct clk init_clocks[] = { | ||
| 457 | { | ||
| 458 | .name = "dma", | ||
| 459 | .id = 0, | ||
| 460 | .parent = &clk_h, | ||
| 461 | .enable = s3c2412_clkcon_enable, | ||
| 462 | .ctrlbit = S3C2412_CLKCON_DMA0, | ||
| 463 | }, { | ||
| 464 | .name = "dma", | ||
| 465 | .id = 1, | ||
| 466 | .parent = &clk_h, | ||
| 467 | .enable = s3c2412_clkcon_enable, | ||
| 468 | .ctrlbit = S3C2412_CLKCON_DMA1, | ||
| 469 | }, { | ||
| 470 | .name = "dma", | ||
| 471 | .id = 2, | ||
| 472 | .parent = &clk_h, | ||
| 473 | .enable = s3c2412_clkcon_enable, | ||
| 474 | .ctrlbit = S3C2412_CLKCON_DMA2, | ||
| 475 | }, { | ||
| 476 | .name = "dma", | ||
| 477 | .id = 3, | ||
| 478 | .parent = &clk_h, | ||
| 479 | .enable = s3c2412_clkcon_enable, | ||
| 480 | .ctrlbit = S3C2412_CLKCON_DMA3, | ||
| 481 | }, { | ||
| 482 | .name = "lcd", | ||
| 483 | .id = -1, | ||
| 484 | .parent = &clk_h, | ||
| 485 | .enable = s3c2412_clkcon_enable, | ||
| 486 | .ctrlbit = S3C2412_CLKCON_LCDC, | ||
| 487 | }, { | ||
| 488 | .name = "gpio", | ||
| 489 | .id = -1, | ||
| 490 | .parent = &clk_p, | ||
| 491 | .enable = s3c2412_clkcon_enable, | ||
| 492 | .ctrlbit = S3C2412_CLKCON_GPIO, | ||
| 493 | }, { | ||
| 494 | .name = "usb-host", | ||
| 495 | .id = -1, | ||
| 496 | .parent = &clk_h, | ||
| 497 | .enable = s3c2412_clkcon_enable, | ||
| 498 | .ctrlbit = S3C2412_CLKCON_USBH, | ||
| 499 | }, { | ||
| 500 | .name = "usb-device", | ||
| 501 | .id = -1, | ||
| 502 | .parent = &clk_h, | ||
| 503 | .enable = s3c2412_clkcon_enable, | ||
| 504 | .ctrlbit = S3C2412_CLKCON_USBD, | ||
| 505 | }, { | ||
| 506 | .name = "timers", | ||
| 507 | .id = -1, | ||
| 508 | .parent = &clk_p, | ||
| 509 | .enable = s3c2412_clkcon_enable, | ||
| 510 | .ctrlbit = S3C2412_CLKCON_PWMT, | ||
| 511 | }, { | ||
| 512 | .name = "uart", | ||
| 513 | .id = 0, | ||
| 514 | .parent = &clk_p, | ||
| 515 | .enable = s3c2412_clkcon_enable, | ||
| 516 | .ctrlbit = S3C2412_CLKCON_UART0, | ||
| 517 | }, { | ||
| 518 | .name = "uart", | ||
| 519 | .id = 1, | ||
| 520 | .parent = &clk_p, | ||
| 521 | .enable = s3c2412_clkcon_enable, | ||
| 522 | .ctrlbit = S3C2412_CLKCON_UART1, | ||
| 523 | }, { | ||
| 524 | .name = "uart", | ||
| 525 | .id = 2, | ||
| 526 | .parent = &clk_p, | ||
| 527 | .enable = s3c2412_clkcon_enable, | ||
| 528 | .ctrlbit = S3C2412_CLKCON_UART2, | ||
| 529 | }, { | ||
| 530 | .name = "rtc", | ||
| 531 | .id = -1, | ||
| 532 | .parent = &clk_p, | ||
| 533 | .enable = s3c2412_clkcon_enable, | ||
| 534 | .ctrlbit = S3C2412_CLKCON_RTC, | ||
| 535 | }, { | ||
| 536 | .name = "watchdog", | ||
| 537 | .id = -1, | ||
| 538 | .parent = &clk_p, | ||
| 539 | .ctrlbit = 0, | ||
| 540 | }, { | ||
| 541 | .name = "usb-bus-gadget", | ||
| 542 | .id = -1, | ||
| 543 | .parent = &clk_usb_bus, | ||
| 544 | .enable = s3c2412_clkcon_enable, | ||
| 545 | .ctrlbit = S3C2412_CLKCON_USB_DEV48, | ||
| 546 | }, { | ||
| 547 | .name = "usb-bus-host", | ||
| 548 | .id = -1, | ||
| 549 | .parent = &clk_usb_bus, | ||
| 550 | .enable = s3c2412_clkcon_enable, | ||
| 551 | .ctrlbit = S3C2412_CLKCON_USB_HOST48, | ||
| 552 | } | ||
| 553 | }; | ||
| 554 | |||
| 555 | /* clocks to add where we need to check their parentage */ | ||
| 556 | |||
| 557 | struct clk_init { | ||
| 558 | struct clk *clk; | ||
| 559 | unsigned int bit; | ||
| 560 | struct clk *src_0; | ||
| 561 | struct clk *src_1; | ||
| 562 | }; | ||
| 563 | |||
| 564 | static struct clk_init clks_src[] __initdata = { | ||
| 565 | { | ||
| 566 | .clk = &clk_usysclk, | ||
| 567 | .bit = S3C2412_CLKSRC_USBCLK_HCLK, | ||
| 568 | .src_0 = &clk_urefclk, | ||
| 569 | .src_1 = &clk_upll, | ||
| 570 | }, { | ||
| 571 | .clk = &clk_i2s, | ||
| 572 | .bit = S3C2412_CLKSRC_I2SCLK_MPLL, | ||
| 573 | .src_0 = &clk_erefclk, | ||
| 574 | .src_1 = &clk_mpll, | ||
| 575 | }, { | ||
| 576 | .clk = &clk_cam, | ||
| 577 | .bit = S3C2412_CLKSRC_CAMCLK_HCLK, | ||
| 578 | .src_0 = &clk_usysclk, | ||
| 579 | .src_1 = &clk_h, | ||
| 580 | }, { | ||
| 581 | .clk = &clk_msysclk, | ||
| 582 | .bit = S3C2412_CLKSRC_MSYSCLK_MPLL, | ||
| 583 | .src_0 = &clk_mdivclk, | ||
| 584 | .src_1 = &clk_mpll, | ||
| 585 | }, { | ||
| 586 | .clk = &clk_uart, | ||
| 587 | .bit = S3C2412_CLKSRC_UARTCLK_MPLL, | ||
| 588 | .src_0 = &clk_erefclk, | ||
| 589 | .src_1 = &clk_mpll, | ||
| 590 | }, { | ||
| 591 | .clk = &clk_usbsrc, | ||
| 592 | .bit = S3C2412_CLKSRC_USBCLK_HCLK, | ||
| 593 | .src_0 = &clk_usysclk, | ||
| 594 | .src_1 = &clk_h, | ||
| 595 | }, | ||
| 596 | }; | ||
| 597 | |||
| 598 | /* s3c2412_clk_initparents | ||
| 599 | * | ||
| 600 | * Initialise the parents for the clocks that we get at start-time | ||
| 601 | */ | ||
| 602 | |||
| 603 | static void __init s3c2412_clk_initparents(void) | ||
| 604 | { | ||
| 605 | unsigned long clksrc = __raw_readl(S3C2412_CLKSRC); | ||
| 606 | struct clk_init *cip = clks_src; | ||
| 607 | struct clk *src; | ||
| 608 | int ptr; | ||
| 609 | int ret; | ||
| 610 | |||
| 611 | for (ptr = 0; ptr < ARRAY_SIZE(clks_src); ptr++, cip++) { | ||
| 612 | ret = s3c24xx_register_clock(cip->clk); | ||
| 613 | if (ret < 0) { | ||
| 614 | printk(KERN_ERR "Failed to register clock %s (%d)\n", | ||
| 615 | cip->clk->name, ret); | ||
| 616 | } | ||
| 617 | |||
| 618 | src = (clksrc & cip->bit) ? cip->src_1 : cip->src_0; | ||
| 619 | |||
| 620 | printk(KERN_INFO "%s: parent %s\n", cip->clk->name, src->name); | ||
| 621 | clk_set_parent(cip->clk, src); | ||
| 622 | } | ||
| 623 | } | ||
| 624 | |||
| 625 | /* clocks to add straight away */ | ||
| 626 | |||
| 627 | static struct clk *clks[] __initdata = { | ||
| 628 | &clk_ext, | ||
| 629 | &clk_usb_bus, | ||
| 630 | &clk_erefclk, | ||
| 631 | &clk_urefclk, | ||
| 632 | &clk_mrefclk, | ||
| 633 | }; | ||
| 634 | |||
| 635 | int __init s3c2412_baseclk_add(void) | ||
| 636 | { | ||
| 637 | unsigned long clkcon = __raw_readl(S3C2410_CLKCON); | ||
| 638 | struct clk *clkp; | ||
| 639 | int ret; | ||
| 640 | int ptr; | ||
| 641 | |||
| 642 | clk_upll.enable = s3c2412_upll_enable; | ||
| 643 | clk_usb_bus.parent = &clk_usbsrc; | ||
| 644 | clk_usb_bus.rate = 0x0; | ||
| 645 | |||
| 646 | s3c2412_clk_initparents(); | ||
| 647 | |||
| 648 | for (ptr = 0; ptr < ARRAY_SIZE(clks); ptr++) { | ||
| 649 | clkp = clks[ptr]; | ||
| 650 | |||
| 651 | ret = s3c24xx_register_clock(clkp); | ||
| 652 | if (ret < 0) { | ||
| 653 | printk(KERN_ERR "Failed to register clock %s (%d)\n", | ||
| 654 | clkp->name, ret); | ||
| 655 | } | ||
| 656 | } | ||
| 657 | |||
| 658 | /* ensure usb bus clock is within correct rate of 48MHz */ | ||
| 659 | |||
| 660 | if (clk_get_rate(&clk_usb_bus) != (48 * 1000 * 1000)) { | ||
| 661 | printk(KERN_INFO "Warning: USB bus clock not at 48MHz\n"); | ||
| 662 | |||
| 663 | /* for the moment, let's use the UPLL, and see if we can | ||
| 664 | * get 48MHz */ | ||
| 665 | |||
| 666 | clk_set_parent(&clk_usysclk, &clk_upll); | ||
| 667 | clk_set_parent(&clk_usbsrc, &clk_usysclk); | ||
| 668 | clk_set_rate(&clk_usbsrc, 48*1000*1000); | ||
| 669 | } | ||
| 670 | |||
| 671 | printk("S3C2412: upll %s, %ld.%03ld MHz, usb-bus %ld.%03ld MHz\n", | ||
| 672 | (__raw_readl(S3C2410_UPLLCON) & S3C2412_PLLCON_OFF) ? "off":"on", | ||
| 673 | print_mhz(clk_get_rate(&clk_upll)), | ||
| 674 | print_mhz(clk_get_rate(&clk_usb_bus))); | ||
| 675 | |||
| 676 | /* register clocks from clock array */ | ||
| 677 | |||
| 678 | clkp = init_clocks; | ||
| 679 | for (ptr = 0; ptr < ARRAY_SIZE(init_clocks); ptr++, clkp++) { | ||
| 680 | /* ensure that we note the clock state */ | ||
| 681 | |||
| 682 | clkp->usage = clkcon & clkp->ctrlbit ? 1 : 0; | ||
| 683 | |||
| 684 | ret = s3c24xx_register_clock(clkp); | ||
| 685 | if (ret < 0) { | ||
| 686 | printk(KERN_ERR "Failed to register clock %s (%d)\n", | ||
| 687 | clkp->name, ret); | ||
| 688 | } | ||
| 689 | } | ||
| 690 | |||
| 691 | /* We must be careful disabling the clocks we are not intending to | ||
| 692 | * be using at boot time, as subsytems such as the LCD which do | ||
| 693 | * their own DMA requests to the bus can cause the system to lockup | ||
| 694 | * if they where in the middle of requesting bus access. | ||
| 695 | * | ||
| 696 | * Disabling the LCD clock if the LCD is active is very dangerous, | ||
| 697 | * and therefore the bootloader should be careful to not enable | ||
| 698 | * the LCD clock if it is not needed. | ||
| 699 | */ | ||
| 700 | |||
| 701 | /* install (and disable) the clocks we do not need immediately */ | ||
| 702 | |||
| 703 | clkp = init_clocks_disable; | ||
| 704 | for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) { | ||
| 705 | |||
| 706 | ret = s3c24xx_register_clock(clkp); | ||
| 707 | if (ret < 0) { | ||
| 708 | printk(KERN_ERR "Failed to register clock %s (%d)\n", | ||
| 709 | clkp->name, ret); | ||
| 710 | } | ||
| 711 | |||
| 712 | s3c2412_clkcon_enable(clkp, 0); | ||
| 713 | } | ||
| 714 | |||
| 715 | return 0; | ||
| 716 | } | ||
