forked from luck/tmp_suning_uos_patched
9d325f2341
The S3C64XX timer is running at the wrong rate due to the assumptions made in the timer initialisation about the way the pwm dividers work. This means that time on the S3C64XX runs twice as fast as it should. Fix the problem by moving to using the clk framework to setup the pwm timer clock muxes, as the pwm-clock code has all the necessary knowledge of how the timer clock inputs are routed. Signed-off-by: Ben Dooks <ben-linux@fluff.org>
278 lines
6.6 KiB
C
278 lines
6.6 KiB
C
/* linux/arch/arm/mach-s3c2410/clock.c
|
|
*
|
|
* Copyright (c) 2006 Simtec Electronics
|
|
* Ben Dooks <ben@simtec.co.uk>
|
|
*
|
|
* S3C2410,S3C2440,S3C2442 Clock control support
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/list.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/err.h>
|
|
#include <linux/sysdev.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/mutex.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/serial_core.h>
|
|
#include <linux/io.h>
|
|
|
|
#include <asm/mach/map.h>
|
|
|
|
#include <mach/hardware.h>
|
|
|
|
#include <plat/regs-serial.h>
|
|
#include <mach/regs-clock.h>
|
|
#include <mach/regs-gpio.h>
|
|
|
|
#include <plat/s3c2410.h>
|
|
#include <plat/clock.h>
|
|
#include <plat/cpu.h>
|
|
|
|
int s3c2410_clkcon_enable(struct clk *clk, int enable)
|
|
{
|
|
unsigned int clocks = clk->ctrlbit;
|
|
unsigned long clkcon;
|
|
|
|
clkcon = __raw_readl(S3C2410_CLKCON);
|
|
|
|
if (enable)
|
|
clkcon |= clocks;
|
|
else
|
|
clkcon &= ~clocks;
|
|
|
|
/* ensure none of the special function bits set */
|
|
clkcon &= ~(S3C2410_CLKCON_IDLE|S3C2410_CLKCON_POWER);
|
|
|
|
__raw_writel(clkcon, S3C2410_CLKCON);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int s3c2410_upll_enable(struct clk *clk, int enable)
|
|
{
|
|
unsigned long clkslow = __raw_readl(S3C2410_CLKSLOW);
|
|
unsigned long orig = clkslow;
|
|
|
|
if (enable)
|
|
clkslow &= ~S3C2410_CLKSLOW_UCLK_OFF;
|
|
else
|
|
clkslow |= S3C2410_CLKSLOW_UCLK_OFF;
|
|
|
|
__raw_writel(clkslow, S3C2410_CLKSLOW);
|
|
|
|
/* if we started the UPLL, then allow to settle */
|
|
|
|
if (enable && (orig & S3C2410_CLKSLOW_UCLK_OFF))
|
|
udelay(200);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* standard clock definitions */
|
|
|
|
static struct clk init_clocks_disable[] = {
|
|
{
|
|
.name = "nand",
|
|
.id = -1,
|
|
.parent = &clk_h,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_NAND,
|
|
}, {
|
|
.name = "sdi",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_SDI,
|
|
}, {
|
|
.name = "adc",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_ADC,
|
|
}, {
|
|
.name = "i2c",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_IIC,
|
|
}, {
|
|
.name = "iis",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_IIS,
|
|
}, {
|
|
.name = "spi",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_SPI,
|
|
}
|
|
};
|
|
|
|
static struct clk init_clocks[] = {
|
|
{
|
|
.name = "lcd",
|
|
.id = -1,
|
|
.parent = &clk_h,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_LCDC,
|
|
}, {
|
|
.name = "gpio",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_GPIO,
|
|
}, {
|
|
.name = "usb-host",
|
|
.id = -1,
|
|
.parent = &clk_h,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_USBH,
|
|
}, {
|
|
.name = "usb-device",
|
|
.id = -1,
|
|
.parent = &clk_h,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_USBD,
|
|
}, {
|
|
.name = "timers",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_PWMT,
|
|
}, {
|
|
.name = "uart",
|
|
.id = 0,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_UART0,
|
|
}, {
|
|
.name = "uart",
|
|
.id = 1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_UART1,
|
|
}, {
|
|
.name = "uart",
|
|
.id = 2,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_UART2,
|
|
}, {
|
|
.name = "rtc",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.enable = s3c2410_clkcon_enable,
|
|
.ctrlbit = S3C2410_CLKCON_RTC,
|
|
}, {
|
|
.name = "watchdog",
|
|
.id = -1,
|
|
.parent = &clk_p,
|
|
.ctrlbit = 0,
|
|
}, {
|
|
.name = "usb-bus-host",
|
|
.id = -1,
|
|
.parent = &clk_usb_bus,
|
|
}, {
|
|
.name = "usb-bus-gadget",
|
|
.id = -1,
|
|
.parent = &clk_usb_bus,
|
|
},
|
|
};
|
|
|
|
/* s3c2410_baseclk_add()
|
|
*
|
|
* Add all the clocks used by the s3c2410 or compatible CPUs
|
|
* such as the S3C2440 and S3C2442.
|
|
*
|
|
* We cannot use a system device as we are needed before any
|
|
* of the init-calls that initialise the devices are actually
|
|
* done.
|
|
*/
|
|
|
|
int __init s3c2410_baseclk_add(void)
|
|
{
|
|
unsigned long clkslow = __raw_readl(S3C2410_CLKSLOW);
|
|
unsigned long clkcon = __raw_readl(S3C2410_CLKCON);
|
|
struct clk *clkp;
|
|
struct clk *xtal;
|
|
int ret;
|
|
int ptr;
|
|
|
|
clk_upll.enable = s3c2410_upll_enable;
|
|
|
|
if (s3c24xx_register_clock(&clk_usb_bus) < 0)
|
|
printk(KERN_ERR "failed to register usb bus clock\n");
|
|
|
|
/* register clocks from clock array */
|
|
|
|
clkp = init_clocks;
|
|
for (ptr = 0; ptr < ARRAY_SIZE(init_clocks); ptr++, clkp++) {
|
|
/* ensure that we note the clock state */
|
|
|
|
clkp->usage = clkcon & clkp->ctrlbit ? 1 : 0;
|
|
|
|
ret = s3c24xx_register_clock(clkp);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "Failed to register clock %s (%d)\n",
|
|
clkp->name, ret);
|
|
}
|
|
}
|
|
|
|
/* We must be careful disabling the clocks we are not intending to
|
|
* be using at boot time, as subsystems such as the LCD which do
|
|
* their own DMA requests to the bus can cause the system to lockup
|
|
* if they where in the middle of requesting bus access.
|
|
*
|
|
* Disabling the LCD clock if the LCD is active is very dangerous,
|
|
* and therefore the bootloader should be careful to not enable
|
|
* the LCD clock if it is not needed.
|
|
*/
|
|
|
|
/* install (and disable) the clocks we do not need immediately */
|
|
|
|
clkp = init_clocks_disable;
|
|
for (ptr = 0; ptr < ARRAY_SIZE(init_clocks_disable); ptr++, clkp++) {
|
|
|
|
ret = s3c24xx_register_clock(clkp);
|
|
if (ret < 0) {
|
|
printk(KERN_ERR "Failed to register clock %s (%d)\n",
|
|
clkp->name, ret);
|
|
}
|
|
|
|
s3c2410_clkcon_enable(clkp, 0);
|
|
}
|
|
|
|
/* show the clock-slow value */
|
|
|
|
xtal = clk_get(NULL, "xtal");
|
|
|
|
printk("CLOCK: Slow mode (%ld.%ld MHz), %s, MPLL %s, UPLL %s\n",
|
|
print_mhz(clk_get_rate(xtal) /
|
|
( 2 * S3C2410_CLKSLOW_GET_SLOWVAL(clkslow))),
|
|
(clkslow & S3C2410_CLKSLOW_SLOW) ? "slow" : "fast",
|
|
(clkslow & S3C2410_CLKSLOW_MPLL_OFF) ? "off" : "on",
|
|
(clkslow & S3C2410_CLKSLOW_UCLK_OFF) ? "off" : "on");
|
|
|
|
s3c_pwmclk_init();
|
|
return 0;
|
|
}
|