From mboxrd@z Thu Jan 1 00:00:00 1970 From: ben-linux@fluff.org (Ben Dooks) Date: Fri, 29 Jan 2010 03:50:17 +0000 Subject: [PATCH v2 2/7] ARM: S5P6442: Add clock support for S5P6442 In-Reply-To: <1264730778-15995-1-git-send-email-kgene.kim@samsung.com> References: <1264730778-15995-1-git-send-email-kgene.kim@samsung.com> Message-ID: <20100129035017.GA390@trinity.fluff.org> To: linux-arm-kernel@lists.infradead.org List-Id: linux-arm-kernel.lists.infradead.org On Fri, Jan 29, 2010 at 11:06:18AM +0900, Kukjin Kim wrote: > This patch adds clock support for S5P6442. This patch adds the clock > register definitions and the various system clocks in S5P6442. > > Signed-off-by: Adityapratap Sharma > Signed-off-by: Atul Dahiya > Signed-off-by: Kukjin Kim > --- > arch/arm/mach-s5p6442/Makefile | 2 +- > arch/arm/mach-s5p6442/clock.c | 247 +++++++++++++++++++++++ > arch/arm/mach-s5p6442/include/mach/pwm-clock.h | 62 ++++++ > arch/arm/mach-s5p6442/include/mach/regs-clock.h | 103 ++++++++++ > arch/arm/mach-s5p6442/include/mach/tick.h | 24 +++ > 5 files changed, 437 insertions(+), 1 deletions(-) > create mode 100644 arch/arm/mach-s5p6442/clock.c > create mode 100644 arch/arm/mach-s5p6442/include/mach/pwm-clock.h > create mode 100644 arch/arm/mach-s5p6442/include/mach/regs-clock.h > create mode 100644 arch/arm/mach-s5p6442/include/mach/tick.h > > diff --git a/arch/arm/mach-s5p6442/Makefile b/arch/arm/mach-s5p6442/Makefile > index 0a45d01..f1b3e75 100644 > --- a/arch/arm/mach-s5p6442/Makefile > +++ b/arch/arm/mach-s5p6442/Makefile > @@ -12,7 +12,7 @@ obj- := > > # Core support for S5P6442 system > > -obj-$(CONFIG_CPU_S5P6442) += cpu.o init.o > +obj-$(CONFIG_CPU_S5P6442) += cpu.o init.o clock.o > > # machine support > > diff --git a/arch/arm/mach-s5p6442/clock.c b/arch/arm/mach-s5p6442/clock.c > new file mode 100644 > index 0000000..e8ba43e > --- /dev/null > +++ b/arch/arm/mach-s5p6442/clock.c > @@ -0,0 +1,248 @@ > +/* linux/arch/arm/mach-s5p6442/clock.c > + * > + * Copyright (c) 2010 Samsung Electronics Co., Ltd. > + * http://www.samsung.com/ > + * > + * S5P6442 - Clock support > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > +*/ > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +#include > + > +#include > +#include > +#include > +#include > +#include > +#include > +#include > +#include > + > +static struct clk clk_pd1 = { > + .name = "pclkd1", > + .id = -1, > + .ops = &clk_ops_def_setrate, > +}; > + > +static struct clksrc_clk clk_mout_apll = { > + .clk = { > + .name = "mout_apll", > + .id = -1, > + }, > + .sources = &clk_src_apll, > + .reg_src = { .reg = S5P_CLK_SRC0, .shift = 0, .size = 1 }, > +}; > + > +static struct clksrc_clk clk_mout_epll = { > + .clk = { > + .name = "mout_epll", > + .id = -1, > + }, > + .sources = &clk_src_epll, > + .reg_src = { .reg = S5P_CLK_SRC0, .shift = 8, .size = 1 }, > +}; > + > +static struct clksrc_clk clk_mout_mpll = { > + .clk = { > + .name = "mout_mpll", > + .id = -1, > + }, > + .sources = &clk_src_mpll, > + .reg_src = { .reg = S5P_CLK_SRC0, .shift = 4, .size = 1 }, > +}; > + > +int s5p6442_clk_ip3_ctrl(struct clk *clk, int enable) > +{ > + return s5p_gatectrl(S5P_CLKGATE_IP3, clk, enable); > +} > + > +/* Clock initialisation code */ > +static struct clksrc_clk *init_parents[] = { > + &clk_mout_apll, > + &clk_mout_epll, > + &clk_mout_mpll, > +}; > + > +#define GET_DIV(clk, field) ((((clk) & field##_MASK) >> field##_SHIFT) + 1) > + > +void __init_or_cpufreq s5p6442_setup_clocks(void) > +{ > + struct clk *xtal_clk; > + unsigned long xtal; > + unsigned long fclk; > + unsigned long a2m; > + unsigned long epll; > + unsigned long apll; > + unsigned long mpll; > + unsigned int ptr; > + unsigned long hclkd0 = 0; > + unsigned long hclkd1 = 0; > + unsigned long pclkd0 = 0; > + unsigned long pclkd1 = 0; > + u32 clkdiv0; > + u32 clkdiv3; > + u32 mux_stat0; > + u32 mux_stat1; > + > + printk(KERN_DEBUG "%s: registering clocks\n", __func__); > + > + clkdiv0 = __raw_readl(S5P_CLK_DIV0); > + printk(KERN_DEBUG "%s: clkdiv0 = %08x\n", __func__, clkdiv0); > + > + clkdiv3 = __raw_readl(S5P_CLK_DIV3); > + printk(KERN_DEBUG "%s: clkdiv3 = %08x\n", __func__, clkdiv3); > + > + xtal_clk = clk_get(NULL, "xtal"); > + BUG_ON(IS_ERR(xtal_clk)); > + > + xtal = clk_get_rate(xtal_clk); > + clk_put(xtal_clk); > + > + printk(KERN_DEBUG "%s: xtal is %ld\n", __func__, xtal); > + > + apll = s5p_get_pll45xx(xtal, __raw_readl(S5P_APLL_CON), pll_4508); > + mpll = s5p_get_pll45xx(xtal, __raw_readl(S5P_MPLL_CON), pll_4502); > + epll = s5p_get_pll45xx(xtal, __raw_readl(S5P_EPLL_CON), pll_4500); > + > + printk(KERN_INFO "S5P64XX: PLL settings, A=%ld.%ldMHz, M=%ld.%ldMHz," \ > + " E=%ld.%ldMHz\n", > + print_mhz(apll), print_mhz(mpll), print_mhz(epll)); > + > + fclk = apll / GET_DIV(clkdiv0, S5P_CLKDIV0_APLL); > + > + mux_stat1 = __raw_readl(S5P_CLK_MUX_STAT1); > + mux_stat0 = __raw_readl(S5P_CLK_MUX_STAT0); > + > + switch ((mux_stat1 & S5P_CLK_MUX_STAT1_D0SYNC_MASK) >> \ > + S5P_CLK_MUX_STAT1_D0SYNC_SHIFT) { > + case 0x1: /* Asynchronous mode */ > + switch ((mux_stat0 & S5P_CLK_MUX_STAT0_MUXD0_MASK) \ > + >> S5P_CLK_MUX_STAT0_MUXD0_SHIFT) { > + case 0x1: /* MPLL source */ > + hclkd0 = mpll / GET_DIV(clkdiv0, S5P_CLKDIV0_D0CLK); > + pclkd0 = hclkd0 / GET_DIV(clkdiv0, S5P_CLKDIV0_P0CLK); > + break; > + case 0x2: /* A2M source */ > + a2m = apll / GET_DIV(clkdiv0, S5P_CLKDIV0_A2M); > + hclkd0 = a2m / GET_DIV(clkdiv0, S5P_CLKDIV0_D0CLK); > + pclkd0 = hclkd0 / GET_DIV(clkdiv0, S5P_CLKDIV0_P0CLK); > + break; > + default: > + break; > + > + } > + > + switch ((mux_stat0 & S5P_CLK_MUX_STAT0_MUXD1_MASK) >> \ > + S5P_CLK_MUX_STAT0_MUXD1_SHIFT) { > + case 0x1: /* MPLL source */ > + hclkd1 = mpll / GET_DIV(clkdiv0, S5P_CLKDIV0_D1CLK); > + pclkd1 = hclkd0 / GET_DIV(clkdiv0, S5P_CLKDIV0_P1CLK); > + break; > + case 0x2: /* A2M source */ > + a2m = apll / GET_DIV(clkdiv0, S5P_CLKDIV0_A2M); > + hclkd1 = a2m / GET_DIV(clkdiv0, S5P_CLKDIV0_D1CLK); > + pclkd1 = hclkd0 / GET_DIV(clkdiv0, S5P_CLKDIV0_P1CLK); > + break; > + default: > + break; > + } > + break; > + > + case 0x2: /* Synchronous mode */ > + hclkd0 = fclk / GET_DIV(clkdiv0, S5P_CLKDIV0_D0CLK); > + pclkd0 = hclkd0 / GET_DIV(clkdiv0, S5P_CLKDIV0_P0CLK); > + hclkd1 = fclk / GET_DIV(clkdiv0, S5P_CLKDIV0_D1CLK); > + pclkd1 = hclkd1 / GET_DIV(clkdiv0, S5P_CLKDIV0_P1CLK); > + break; > + default: > + printk(KERN_ERR "failed to get sync/async mode status register\n"); > + break; > + } > + > + printk(KERN_INFO "S5P64XX: HCLKD0=%ld.%ldMHz, HCLKD1=%ld.%ldMHz," \ > + " PCLKD0=%ld.%ldMHz, PCLKD1=%ld.%ldMHz\n", > + print_mhz(hclkd0), print_mhz(hclkd1), > + print_mhz(pclkd0), print_mhz(pclkd1)); > + > + clk_fout_mpll.rate = mpll; > + clk_fout_epll.rate = epll; > + clk_fout_apll.rate = apll; > + > + clk_f.rate = fclk; > + clk_pd1.rate = pclkd1; > + > + /* For backward compatibility */ > + clk_h.rate = hclkd1; > + clk_p.rate = pclkd1; > + > + for (ptr = 0; ptr < ARRAY_SIZE(init_parents); ptr++) > + s3c_set_clksrc(init_parents[ptr], true); > +} > + > +static struct clk init_clocks[] = { > + { > + .name = "systimer", > + .id = -1, > + .parent = &clk_pd1, > + .enable = s5p6442_clk_ip3_ctrl, > + .ctrlbit = (1<<16), > + }, { > + .name = "uart", > + .id = 0, > + .parent = &clk_pd1, > + .enable = s5p6442_clk_ip3_ctrl, > + .ctrlbit = (1<<17), > + }, { > + .name = "uart", > + .id = 1, > + .parent = &clk_pd1, > + .enable = s5p6442_clk_ip3_ctrl, > + .ctrlbit = (1<<18), > + }, { > + .name = "uart", > + .id = 2, > + .parent = &clk_pd1, > + .enable = s5p6442_clk_ip3_ctrl, > + .ctrlbit = (1<<19), > + }, { > + .name = "timers", > + .id = -1, > + .parent = &clk_pd1, > + .enable = s5p6442_clk_ip3_ctrl, > + .ctrlbit = (1<<23), > + }, > +}; > + > +static struct clk *clks[] __initdata = { > + &clk_ext, > + &clk_epll, > + &clk_pd1, > + &clk_mout_epll.clk, > + &clk_mout_mpll.clk, > +}; > + > +void __init s5p6442_register_clocks(void) > +{ > + int ret; > + > + ret = s3c24xx_register_clocks(clks, ARRAY_SIZE(clks)); > + if (ret > 0) > + printk(KERN_ERR "Failed to register %u clocks\n", ret); Not needed any more, s3c24xx_register_clocks() prints an error for each failed clock. > + s3c_register_clocks(init_clocks, ARRAY_SIZE(init_clocks)); > + > + s3c_pwmclk_init(); > +} > diff --git a/arch/arm/mach-s5p6442/include/mach/pwm-clock.h b/arch/arm/mach-s5p6442/include/mach/pwm-clock.h > new file mode 100644 > index 0000000..081247e > --- /dev/null > +++ b/arch/arm/mach-s5p6442/include/mach/pwm-clock.h > @@ -0,0 +1,69 @@ > +/* linux/arch/arm/mach-s5p6442/include/mach/pwm-clock.h > + * > + * Copyright 2008 Simtec Electronics > + * Ben Dooks > + * http://armlinux.simtec.co.uk/ > + * > + * Copyright 2010 Samsung Electronics Co., Ltd. > + * http://www.samsung.com/ > + * > + * Based on arch/arm/plat-s3c24xx/include/mach/pwm-clock.h > + * > + * S5P6442 - pwm clock and timer support > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > +*/ > + > +#ifndef __ASM_ARCH_PWMCLK_H > +#define __ASM_ARCH_PWMCLK_H __FILE__ > + > +/** > + * pwm_cfg_src_is_tclk() - return whether the given mux config is a tclk > + * @cfg: The timer TCFG1 register bits shifted down to 0. > + * > + * Return true if the given configuration from TCFG1 is a TCLK instead > + * any of the TDIV clocks. > + */ > +static inline int pwm_cfg_src_is_tclk(unsigned long tcfg) > +{ > + return tcfg == S3C2410_TCFG1_MUX_TCLK; > +} > + > +/** > + * tcfg_to_divisor() - convert tcfg1 setting to a divisor > + * @tcfg1: The tcfg1 setting, shifted down. > + * > + * Get the divisor value for the given tcfg1 setting. We assume the > + * caller has already checked to see if this is not a TCLK source. > + */ > +static inline unsigned long tcfg_to_divisor(unsigned long tcfg1) > +{ > + return 1 << (1 + tcfg1); > +} > + > +/** > + * pwm_tdiv_has_div1() - does the tdiv setting have a /1 > + * > + * Return true if we have a /1 in the tdiv setting. > + */ > +static inline unsigned int pwm_tdiv_has_div1(void) > +{ > + return 0; > +} > + > +/** > + * pwm_tdiv_div_bits() - calculate TCFG1 divisor value. > + * @div: The divisor to calculate the bit information for. > + * > + * Turn a divisor into the necessary bit field for TCFG1. > + */ > +static inline unsigned long pwm_tdiv_div_bits(unsigned int div) > +{ > + return ilog2(div) - 1; > +} > + > +#define S3C_TCFG1_MUX_TCLK S3C2410_TCFG1_MUX_TCLK > + > +#endif /* __ASM_ARCH_PWMCLK_H */ > diff --git a/arch/arm/mach-s5p6442/include/mach/regs-clock.h b/arch/arm/mach-s5p6442/include/mach/regs-clock.h > new file mode 100644 > index 0000000..ec4911a > --- /dev/null > +++ b/arch/arm/mach-s5p6442/include/mach/regs-clock.h > @@ -0,0 +1,103 @@ > +/* linux/arch/arm/mach-s5p6442/include/mach/regs-clock.h > + * > + * Copyright (c) 2010 Samsung Electronics Co., Ltd. > + * http://www.samsung.com/ > + * > + * S5P6442 - Clock register definitions > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > +*/ > + > +#ifndef __ASM_ARCH_REGS_CLOCK_H > +#define __ASM_ARCH_REGS_CLOCK_H __FILE__ > + > +#include > + > +#define S5P_CLKREG(x) (S3C_VA_SYS + (x)) > + > +#define S5P_APLL_LOCK S5P_CLKREG(0x00) > +#define S5P_MPLL_LOCK S5P_CLKREG(0x08) > +#define S5P_EPLL_LOCK S5P_CLKREG(0x10) > +#define S5P_VPLL_LOCK S5P_CLKREG(0x20) > + > +#define S5P_APLL_CON S5P_CLKREG(0x100) > +#define S5P_MPLL_CON S5P_CLKREG(0x108) > +#define S5P_EPLL_CON S5P_CLKREG(0x110) > +#define S5P_VPLL_CON S5P_CLKREG(0x120) > + > +#define S5P_CLK_SRC0 S5P_CLKREG(0x200) > +#define S5P_CLK_SRC1 S5P_CLKREG(0x204) > +#define S5P_CLK_SRC2 S5P_CLKREG(0x208) > +#define S5P_CLK_SRC3 S5P_CLKREG(0x20C) > +#define S5P_CLK_SRC4 S5P_CLKREG(0x210) > +#define S5P_CLK_SRC5 S5P_CLKREG(0x214) > +#define S5P_CLK_SRC6 S5P_CLKREG(0x218) > + > +#define S5P_CLK_SRC_MASK0 S5P_CLKREG(0x280) > +#define S5P_CLK_SRC_MASK1 S5P_CLKREG(0x284) > + > +#define S5P_CLK_DIV0 S5P_CLKREG(0x300) > +#define S5P_CLK_DIV1 S5P_CLKREG(0x304) > +#define S5P_CLK_DIV2 S5P_CLKREG(0x308) > +#define S5P_CLK_DIV3 S5P_CLKREG(0x30C) > +#define S5P_CLK_DIV4 S5P_CLKREG(0x310) > +#define S5P_CLK_DIV5 S5P_CLKREG(0x314) > +#define S5P_CLK_DIV6 S5P_CLKREG(0x318) > + > +#define S5P_CLKGATE_IP3 S5P_CLKREG(0x46C) > + > +/* CLK_OUT */ > +#define S5P_CLK_OUT_SHIFT (12) > +#define S5P_CLK_OUT_MASK (0x1F << S5P_CLK_OUT_SHIFT) > +#define S5P_CLK_OUT S5P_CLKREG(0x500) > + > +#define S5P_CLK_DIV_STAT0 S5P_CLKREG(0x1000) > +#define S5P_CLK_DIV_STAT1 S5P_CLKREG(0x1004) > + > +#define S5P_CLK_MUX_STAT0 S5P_CLKREG(0x1100) > +#define S5P_CLK_MUX_STAT1 S5P_CLKREG(0x1104) > + > +#define S5P_MDNIE_SEL S5P_CLKREG(0x7008) > + > +/* Register Bit definition */ > +#define S5P_EPLL_EN (1<<31) > +#define S5P_EPLL_MASK 0xffffffff > +#define S5P_EPLLVAL(_m, _p, _s) ((_m) << 16 | ((_p) << 8) | ((_s))) > + > +/* CLKDIV0 */ > +#define S5P_CLKDIV0_APLL_SHIFT (0) > +#define S5P_CLKDIV0_APLL_MASK (0x7 << S5P_CLKDIV0_APLL_SHIFT) > +#define S5P_CLKDIV0_A2M_SHIFT (4) > +#define S5P_CLKDIV0_A2M_MASK (0x7 << S5P_CLKDIV0_A2M_SHIFT) > +#define S5P_CLKDIV0_D0CLK_SHIFT (16) > +#define S5P_CLKDIV0_D0CLK_MASK (0xF << S5P_CLKDIV0_D0CLK_SHIFT) > +#define S5P_CLKDIV0_P0CLK_SHIFT (20) > +#define S5P_CLKDIV0_P0CLK_MASK (0x7 << S5P_CLKDIV0_P0CLK_SHIFT) > +#define S5P_CLKDIV0_D1CLK_SHIFT (24) > +#define S5P_CLKDIV0_D1CLK_MASK (0xF << S5P_CLKDIV0_D1CLK_SHIFT) > +#define S5P_CLKDIV0_P1CLK_SHIFT (28) > +#define S5P_CLKDIV0_P1CLK_MASK (0x7 << S5P_CLKDIV0_P1CLK_SHIFT) > + > +/* Clock MUX status Registers */ > +#define S5P_CLK_MUX_STAT0_APLL_SHIFT (0) > +#define S5P_CLK_MUX_STAT0_APLL_MASK (0x7 << S5P_CLK_MUX_STAT0_APLL_SHIFT) > +#define S5P_CLK_MUX_STAT0_MPLL_SHIFT (4) > +#define S5P_CLK_MUX_STAT0_MPLL_MASK (0x7 << S5P_CLK_MUX_STAT0_MPLL_SHIFT) > +#define S5P_CLK_MUX_STAT0_EPLL_SHIFT (8) > +#define S5P_CLK_MUX_STAT0_EPLL_MASK (0x7 << S5P_CLK_MUX_STAT0_EPLL_SHIFT) > +#define S5P_CLK_MUX_STAT0_VPLL_SHIFT (12) > +#define S5P_CLK_MUX_STAT0_VPLL_MASK (0x7 << S5P_CLK_MUX_STAT0_VPLL_SHIFT) > +#define S5P_CLK_MUX_STAT0_MUXARM_SHIFT (16) > +#define S5P_CLK_MUX_STAT0_MUXARM_MASK (0x7 << S5P_CLK_MUX_STAT0_MUXARM_SHIFT) > +#define S5P_CLK_MUX_STAT0_MUXD0_SHIFT (20) > +#define S5P_CLK_MUX_STAT0_MUXD0_MASK (0x7 << S5P_CLK_MUX_STAT0_MUXD0_SHIFT) > +#define S5P_CLK_MUX_STAT0_MUXD1_SHIFT (24) > +#define S5P_CLK_MUX_STAT0_MUXD1_MASK (0x7 << S5P_CLK_MUX_STAT0_MUXD1_SHIFT) > +#define S5P_CLK_MUX_STAT1_D1SYNC_SHIFT (24) > +#define S5P_CLK_MUX_STAT1_D1SYNC_MASK (0x7 << S5P_CLK_MUX_STAT1_D1SYNC_SHIFT) > +#define S5P_CLK_MUX_STAT1_D0SYNC_SHIFT (28) > +#define S5P_CLK_MUX_STAT1_D0SYNC_MASK (0x7 << S5P_CLK_MUX_STAT1_D0SYNC_SHIFT) > + > +#endif /* __ASM_ARCH_REGS_CLOCK_H */ > diff --git a/arch/arm/mach-s5p6442/include/mach/tick.h b/arch/arm/mach-s5p6442/include/mach/tick.h > new file mode 100644 > index 0000000..2763c08 > --- /dev/null > +++ b/arch/arm/mach-s5p6442/include/mach/tick.h > @@ -0,0 +1,26 @@ > +/* linux/arch/arm/mach-s5p6442/include/mach/tick.h > + * > + * Copyright (c) 2010 Samsung Electronics Co., Ltd. > + * http://www.samsung.com/ > + * > + * Based on arch/arm/mach-s3c6400/include/mach/tick.h > + * > + * S5P6442 - Timer tick support definitions > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > +*/ > + > +#ifndef __ASM_ARCH_TICK_H > +#define __ASM_ARCH_TICK_H __FILE__ > + > +static inline u32 s3c24xx_ostimer_pending(void) > +{ > + u32 pend = __raw_readl(VA_VIC0 + VIC_RAW_STATUS); > + return pend & (1 << (IRQ_TIMER4_VIC - S5P_IRQ_VIC0(0))); > +} > + > +#define TICK_MAX (0xffffffff) > + > +#endif /* __ASM_ARCH_TICK_H */ > -- > 1.6.2.5 > -- -- Ben Q: What's a light-year? A: One-third less calories than a regular year.