|  | /* linux/arch/arm/plat-s3c64xx/s3c6400-clock.c | 
|  | * | 
|  | * Copyright 2008 Openmoko, Inc. | 
|  | * Copyright 2008 Simtec Electronics | 
|  | *	Ben Dooks <ben@simtec.co.uk> | 
|  | *	http://armlinux.simtec.co.uk/ | 
|  | * | 
|  | * S3C6400 based common 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 <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/clk.h> | 
|  | #include <linux/sysdev.h> | 
|  | #include <linux/io.h> | 
|  |  | 
|  | #include <mach/hardware.h> | 
|  | #include <mach/map.h> | 
|  |  | 
|  | #include <plat/cpu-freq.h> | 
|  |  | 
|  | #include <plat/regs-clock.h> | 
|  | #include <plat/clock.h> | 
|  | #include <plat/cpu.h> | 
|  | #include <plat/pll.h> | 
|  |  | 
|  | /* fin_apll, fin_mpll and fin_epll are all the same clock, which we call | 
|  | * ext_xtal_mux for want of an actual name from the manual. | 
|  | */ | 
|  |  | 
|  | static struct clk clk_ext_xtal_mux = { | 
|  | .name		= "ext_xtal", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | #define clk_fin_apll clk_ext_xtal_mux | 
|  | #define clk_fin_mpll clk_ext_xtal_mux | 
|  | #define clk_fin_epll clk_ext_xtal_mux | 
|  |  | 
|  | #define clk_fout_mpll	clk_mpll | 
|  |  | 
|  | struct clk_sources { | 
|  | unsigned int	nr_sources; | 
|  | struct clk	**sources; | 
|  | }; | 
|  |  | 
|  | struct clksrc_clk { | 
|  | struct clk		clk; | 
|  | unsigned int		mask; | 
|  | unsigned int		shift; | 
|  |  | 
|  | struct clk_sources	*sources; | 
|  |  | 
|  | unsigned int		divider_shift; | 
|  | void __iomem		*reg_divider; | 
|  | }; | 
|  |  | 
|  | static struct clk clk_fout_apll = { | 
|  | .name		= "fout_apll", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | static struct clk *clk_src_apll_list[] = { | 
|  | [0] = &clk_fin_apll, | 
|  | [1] = &clk_fout_apll, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clk_src_apll = { | 
|  | .sources	= clk_src_apll_list, | 
|  | .nr_sources	= ARRAY_SIZE(clk_src_apll_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_mout_apll = { | 
|  | .clk	= { | 
|  | .name		= "mout_apll", | 
|  | .id		= -1, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_APLL_MOUT_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_APLL_MOUT, | 
|  | .sources	= &clk_src_apll, | 
|  | }; | 
|  |  | 
|  | static struct clk clk_fout_epll = { | 
|  | .name		= "fout_epll", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | static struct clk *clk_src_epll_list[] = { | 
|  | [0] = &clk_fin_epll, | 
|  | [1] = &clk_fout_epll, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clk_src_epll = { | 
|  | .sources	= clk_src_epll_list, | 
|  | .nr_sources	= ARRAY_SIZE(clk_src_epll_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_mout_epll = { | 
|  | .clk	= { | 
|  | .name		= "mout_epll", | 
|  | .id		= -1, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_EPLL_MOUT_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_EPLL_MOUT, | 
|  | .sources	= &clk_src_epll, | 
|  | }; | 
|  |  | 
|  | static struct clk *clk_src_mpll_list[] = { | 
|  | [0] = &clk_fin_mpll, | 
|  | [1] = &clk_fout_mpll, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clk_src_mpll = { | 
|  | .sources	= clk_src_mpll_list, | 
|  | .nr_sources	= ARRAY_SIZE(clk_src_mpll_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_mout_mpll = { | 
|  | .clk = { | 
|  | .name		= "mout_mpll", | 
|  | .id		= -1, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_MPLL_MOUT_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_MPLL_MOUT, | 
|  | .sources	= &clk_src_mpll, | 
|  | }; | 
|  |  | 
|  | static unsigned int armclk_mask; | 
|  |  | 
|  | static unsigned long s3c64xx_clk_arm_get_rate(struct clk *clk) | 
|  | { | 
|  | unsigned long rate = clk_get_rate(clk->parent); | 
|  | u32 clkdiv; | 
|  |  | 
|  | /* divisor mask starts at bit0, so no need to shift */ | 
|  | clkdiv = __raw_readl(S3C_CLK_DIV0) & armclk_mask; | 
|  |  | 
|  | return rate / (clkdiv + 1); | 
|  | } | 
|  |  | 
|  | static unsigned long s3c64xx_clk_arm_round_rate(struct clk *clk, | 
|  | unsigned long rate) | 
|  | { | 
|  | unsigned long parent = clk_get_rate(clk->parent); | 
|  | u32 div; | 
|  |  | 
|  | if (parent < rate) | 
|  | return parent; | 
|  |  | 
|  | div = (parent / rate) - 1; | 
|  | if (div > armclk_mask) | 
|  | div = armclk_mask; | 
|  |  | 
|  | return parent / (div + 1); | 
|  | } | 
|  |  | 
|  | static int s3c64xx_clk_arm_set_rate(struct clk *clk, unsigned long rate) | 
|  | { | 
|  | unsigned long parent = clk_get_rate(clk->parent); | 
|  | u32 div; | 
|  | u32 val; | 
|  |  | 
|  | if (rate < parent / (armclk_mask + 1)) | 
|  | return -EINVAL; | 
|  |  | 
|  | rate = clk_round_rate(clk, rate); | 
|  | div = clk_get_rate(clk->parent) / rate; | 
|  |  | 
|  | val = __raw_readl(S3C_CLK_DIV0); | 
|  | val &= ~armclk_mask; | 
|  | val |= (div - 1); | 
|  | __raw_writel(val, S3C_CLK_DIV0); | 
|  |  | 
|  | return 0; | 
|  |  | 
|  | } | 
|  |  | 
|  | static struct clk clk_arm = { | 
|  | .name		= "armclk", | 
|  | .id		= -1, | 
|  | .parent		= &clk_mout_apll.clk, | 
|  | .get_rate	= s3c64xx_clk_arm_get_rate, | 
|  | .set_rate	= s3c64xx_clk_arm_set_rate, | 
|  | .round_rate	= s3c64xx_clk_arm_round_rate, | 
|  | }; | 
|  |  | 
|  | static unsigned long s3c64xx_clk_doutmpll_get_rate(struct clk *clk) | 
|  | { | 
|  | unsigned long rate = clk_get_rate(clk->parent); | 
|  |  | 
|  | printk(KERN_DEBUG "%s: parent is %ld\n", __func__, rate); | 
|  |  | 
|  | if (__raw_readl(S3C_CLK_DIV0) & S3C6400_CLKDIV0_MPLL_MASK) | 
|  | rate /= 2; | 
|  |  | 
|  | return rate; | 
|  | } | 
|  |  | 
|  | static struct clk clk_dout_mpll = { | 
|  | .name		= "dout_mpll", | 
|  | .id		= -1, | 
|  | .parent		= &clk_mout_mpll.clk, | 
|  | .get_rate	= s3c64xx_clk_doutmpll_get_rate, | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_spi_mmc_list[] = { | 
|  | &clk_mout_epll.clk, | 
|  | &clk_dout_mpll, | 
|  | &clk_fin_epll, | 
|  | &clk_27m, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_spi_mmc = { | 
|  | .sources	= clkset_spi_mmc_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_spi_mmc_list), | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_irda_list[] = { | 
|  | &clk_mout_epll.clk, | 
|  | &clk_dout_mpll, | 
|  | NULL, | 
|  | &clk_27m, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_irda = { | 
|  | .sources	= clkset_irda_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_irda_list), | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_uart_list[] = { | 
|  | &clk_mout_epll.clk, | 
|  | &clk_dout_mpll, | 
|  | NULL, | 
|  | NULL | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_uart = { | 
|  | .sources	= clkset_uart_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_uart_list), | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_uhost_list[] = { | 
|  | &clk_48m, | 
|  | &clk_mout_epll.clk, | 
|  | &clk_dout_mpll, | 
|  | &clk_fin_epll, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_uhost = { | 
|  | .sources	= clkset_uhost_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_uhost_list), | 
|  | }; | 
|  |  | 
|  |  | 
|  | /* The peripheral clocks are all controlled via clocksource followed | 
|  | * by an optional divider and gate stage. We currently roll this into | 
|  | * one clock which hides the intermediate clock from the mux. | 
|  | * | 
|  | * Note, the JPEG clock can only be an even divider... | 
|  | * | 
|  | * The scaler and LCD clocks depend on the S3C64XX version, and also | 
|  | * have a common parent divisor so are not included here. | 
|  | */ | 
|  |  | 
|  | static inline struct clksrc_clk *to_clksrc(struct clk *clk) | 
|  | { | 
|  | return container_of(clk, struct clksrc_clk, clk); | 
|  | } | 
|  |  | 
|  | static unsigned long s3c64xx_getrate_clksrc(struct clk *clk) | 
|  | { | 
|  | struct clksrc_clk *sclk = to_clksrc(clk); | 
|  | unsigned long rate = clk_get_rate(clk->parent); | 
|  | u32 clkdiv = __raw_readl(sclk->reg_divider); | 
|  |  | 
|  | clkdiv >>= sclk->divider_shift; | 
|  | clkdiv &= 0xf; | 
|  | clkdiv++; | 
|  |  | 
|  | rate /= clkdiv; | 
|  | return rate; | 
|  | } | 
|  |  | 
|  | static int s3c64xx_setrate_clksrc(struct clk *clk, unsigned long rate) | 
|  | { | 
|  | struct clksrc_clk *sclk = to_clksrc(clk); | 
|  | void __iomem *reg = sclk->reg_divider; | 
|  | unsigned int div; | 
|  | u32 val; | 
|  |  | 
|  | rate = clk_round_rate(clk, rate); | 
|  | div = clk_get_rate(clk->parent) / rate; | 
|  | if (div > 16) | 
|  | return -EINVAL; | 
|  |  | 
|  | val = __raw_readl(reg); | 
|  | val &= ~(0xf << sclk->divider_shift); | 
|  | val |= (div - 1) << sclk->divider_shift; | 
|  | __raw_writel(val, reg); | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | static int s3c64xx_setparent_clksrc(struct clk *clk, struct clk *parent) | 
|  | { | 
|  | struct clksrc_clk *sclk = to_clksrc(clk); | 
|  | struct clk_sources *srcs = sclk->sources; | 
|  | u32 clksrc = __raw_readl(S3C_CLK_SRC); | 
|  | int src_nr = -1; | 
|  | int ptr; | 
|  |  | 
|  | for (ptr = 0; ptr < srcs->nr_sources; ptr++) | 
|  | if (srcs->sources[ptr] == parent) { | 
|  | src_nr = ptr; | 
|  | break; | 
|  | } | 
|  |  | 
|  | if (src_nr >= 0) { | 
|  | clksrc &= ~sclk->mask; | 
|  | clksrc |= src_nr << sclk->shift; | 
|  |  | 
|  | __raw_writel(clksrc, S3C_CLK_SRC); | 
|  |  | 
|  | clk->parent = parent; | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | return -EINVAL; | 
|  | } | 
|  |  | 
|  | static unsigned long s3c64xx_roundrate_clksrc(struct clk *clk, | 
|  | unsigned long rate) | 
|  | { | 
|  | unsigned long parent_rate = clk_get_rate(clk->parent); | 
|  | int div; | 
|  |  | 
|  | if (rate > parent_rate) | 
|  | rate = parent_rate; | 
|  | else { | 
|  | div = parent_rate / rate; | 
|  |  | 
|  | if (div == 0) | 
|  | div = 1; | 
|  | if (div > 16) | 
|  | div = 16; | 
|  |  | 
|  | rate = parent_rate / div; | 
|  | } | 
|  |  | 
|  | return rate; | 
|  | } | 
|  |  | 
|  | static struct clksrc_clk clk_mmc0 = { | 
|  | .clk	= { | 
|  | .name		= "mmc_bus", | 
|  | .id		= 0, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_MMC0, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_MMC0_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_MMC0_MASK, | 
|  | .sources	= &clkset_spi_mmc, | 
|  | .divider_shift	= S3C6400_CLKDIV1_MMC0_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV1, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_mmc1 = { | 
|  | .clk	= { | 
|  | .name		= "mmc_bus", | 
|  | .id		= 1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_MMC1, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_MMC1_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_MMC1_MASK, | 
|  | .sources	= &clkset_spi_mmc, | 
|  | .divider_shift	= S3C6400_CLKDIV1_MMC1_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV1, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_mmc2 = { | 
|  | .clk	= { | 
|  | .name		= "mmc_bus", | 
|  | .id		= 2, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_MMC2, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_MMC2_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_MMC2_MASK, | 
|  | .sources	= &clkset_spi_mmc, | 
|  | .divider_shift	= S3C6400_CLKDIV1_MMC2_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV1, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_usbhost = { | 
|  | .clk	= { | 
|  | .name		= "usb-bus-host", | 
|  | .id		= -1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_UHOST, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_UHOST_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_UHOST_MASK, | 
|  | .sources	= &clkset_uhost, | 
|  | .divider_shift	= S3C6400_CLKDIV1_UHOST_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV1, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_uart_uclk1 = { | 
|  | .clk	= { | 
|  | .name		= "uclk1", | 
|  | .id		= -1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_UART, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_UART_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_UART_MASK, | 
|  | .sources	= &clkset_uart, | 
|  | .divider_shift	= S3C6400_CLKDIV2_UART_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | /* Where does UCLK0 come from? */ | 
|  |  | 
|  | static struct clksrc_clk clk_spi0 = { | 
|  | .clk	= { | 
|  | .name		= "spi-bus", | 
|  | .id		= 0, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_SPI0, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_SPI0_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_SPI0_MASK, | 
|  | .sources	= &clkset_spi_mmc, | 
|  | .divider_shift	= S3C6400_CLKDIV2_SPI0_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_spi1 = { | 
|  | .clk	= { | 
|  | .name		= "spi-bus", | 
|  | .id		= 1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_SPI1, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_SPI1_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_SPI1_MASK, | 
|  | .sources	= &clkset_spi_mmc, | 
|  | .divider_shift	= S3C6400_CLKDIV2_SPI1_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | static struct clk clk_iis_cd0 = { | 
|  | .name		= "iis_cdclk0", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | static struct clk clk_iis_cd1 = { | 
|  | .name		= "iis_cdclk1", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | static struct clk clk_pcm_cd = { | 
|  | .name		= "pcm_cdclk", | 
|  | .id		= -1, | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_audio0_list[] = { | 
|  | [0] = &clk_mout_epll.clk, | 
|  | [1] = &clk_dout_mpll, | 
|  | [2] = &clk_fin_epll, | 
|  | [3] = &clk_iis_cd0, | 
|  | [4] = &clk_pcm_cd, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_audio0 = { | 
|  | .sources	= clkset_audio0_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_audio0_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_audio0 = { | 
|  | .clk	= { | 
|  | .name		= "audio-bus", | 
|  | .id		= 0, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_AUDIO0, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_AUDIO0_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_AUDIO0_MASK, | 
|  | .sources	= &clkset_audio0, | 
|  | .divider_shift	= S3C6400_CLKDIV2_AUDIO0_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_audio1_list[] = { | 
|  | [0] = &clk_mout_epll.clk, | 
|  | [1] = &clk_dout_mpll, | 
|  | [2] = &clk_fin_epll, | 
|  | [3] = &clk_iis_cd1, | 
|  | [4] = &clk_pcm_cd, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_audio1 = { | 
|  | .sources	= clkset_audio1_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_audio1_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_audio1 = { | 
|  | .clk	= { | 
|  | .name		= "audio-bus", | 
|  | .id		= 1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_AUDIO1, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_AUDIO1_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_AUDIO1_MASK, | 
|  | .sources	= &clkset_audio1, | 
|  | .divider_shift	= S3C6400_CLKDIV2_AUDIO1_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_irda = { | 
|  | .clk	= { | 
|  | .name		= "irda-bus", | 
|  | .id		= 0, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_IRDA, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= S3C6400_CLKSRC_IRDA_SHIFT, | 
|  | .mask		= S3C6400_CLKSRC_IRDA_MASK, | 
|  | .sources	= &clkset_irda, | 
|  | .divider_shift	= S3C6400_CLKDIV2_IRDA_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV2, | 
|  | }; | 
|  |  | 
|  | static struct clk *clkset_camif_list[] = { | 
|  | &clk_h2, | 
|  | }; | 
|  |  | 
|  | static struct clk_sources clkset_camif = { | 
|  | .sources	= clkset_camif_list, | 
|  | .nr_sources	= ARRAY_SIZE(clkset_camif_list), | 
|  | }; | 
|  |  | 
|  | static struct clksrc_clk clk_camif = { | 
|  | .clk	= { | 
|  | .name		= "camera", | 
|  | .id		= -1, | 
|  | .ctrlbit        = S3C_CLKCON_SCLK_CAM, | 
|  | .enable		= s3c64xx_sclk_ctrl, | 
|  | .set_parent	= s3c64xx_setparent_clksrc, | 
|  | .get_rate	= s3c64xx_getrate_clksrc, | 
|  | .set_rate	= s3c64xx_setrate_clksrc, | 
|  | .round_rate	= s3c64xx_roundrate_clksrc, | 
|  | }, | 
|  | .shift		= 0, | 
|  | .mask		= 0, | 
|  | .sources	= &clkset_camif, | 
|  | .divider_shift	= S3C6400_CLKDIV0_CAM_SHIFT, | 
|  | .reg_divider	= S3C_CLK_DIV0, | 
|  | }; | 
|  |  | 
|  | /* Clock initialisation code */ | 
|  |  | 
|  | static struct clksrc_clk *init_parents[] = { | 
|  | &clk_mout_apll, | 
|  | &clk_mout_epll, | 
|  | &clk_mout_mpll, | 
|  | &clk_mmc0, | 
|  | &clk_mmc1, | 
|  | &clk_mmc2, | 
|  | &clk_usbhost, | 
|  | &clk_uart_uclk1, | 
|  | &clk_spi0, | 
|  | &clk_spi1, | 
|  | &clk_audio0, | 
|  | &clk_audio1, | 
|  | &clk_irda, | 
|  | &clk_camif, | 
|  | }; | 
|  |  | 
|  | static void __init_or_cpufreq s3c6400_set_clksrc(struct clksrc_clk *clk) | 
|  | { | 
|  | struct clk_sources *srcs = clk->sources; | 
|  | u32 clksrc = __raw_readl(S3C_CLK_SRC); | 
|  |  | 
|  | clksrc &= clk->mask; | 
|  | clksrc >>= clk->shift; | 
|  |  | 
|  | if (clksrc > srcs->nr_sources || !srcs->sources[clksrc]) { | 
|  | printk(KERN_ERR "%s: bad source %d\n", | 
|  | clk->clk.name, clksrc); | 
|  | return; | 
|  | } | 
|  |  | 
|  | clk->clk.parent = srcs->sources[clksrc]; | 
|  |  | 
|  | printk(KERN_INFO "%s: source is %s (%d), rate is %ld\n", | 
|  | clk->clk.name, clk->clk.parent->name, clksrc, | 
|  | clk_get_rate(&clk->clk)); | 
|  | } | 
|  |  | 
|  | #define GET_DIV(clk, field) ((((clk) & field##_MASK) >> field##_SHIFT) + 1) | 
|  |  | 
|  | void __init_or_cpufreq s3c6400_setup_clocks(void) | 
|  | { | 
|  | struct clk *xtal_clk; | 
|  | unsigned long xtal; | 
|  | unsigned long fclk; | 
|  | unsigned long hclk; | 
|  | unsigned long hclk2; | 
|  | unsigned long pclk; | 
|  | unsigned long epll; | 
|  | unsigned long apll; | 
|  | unsigned long mpll; | 
|  | unsigned int ptr; | 
|  | u32 clkdiv0; | 
|  |  | 
|  | printk(KERN_DEBUG "%s: registering clocks\n", __func__); | 
|  |  | 
|  | clkdiv0 = __raw_readl(S3C_CLK_DIV0); | 
|  | printk(KERN_DEBUG "%s: clkdiv0 = %08x\n", __func__, clkdiv0); | 
|  |  | 
|  | 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); | 
|  |  | 
|  | /* For now assume the mux always selects the crystal */ | 
|  | clk_ext_xtal_mux.parent = xtal_clk; | 
|  |  | 
|  | epll = s3c6400_get_epll(xtal); | 
|  | mpll = s3c6400_get_pll(xtal, __raw_readl(S3C_MPLL_CON)); | 
|  | apll = s3c6400_get_pll(xtal, __raw_readl(S3C_APLL_CON)); | 
|  |  | 
|  | fclk = mpll; | 
|  |  | 
|  | printk(KERN_INFO "S3C64XX: PLL settings, A=%ld, M=%ld, E=%ld\n", | 
|  | apll, mpll, epll); | 
|  |  | 
|  | hclk2 = mpll / GET_DIV(clkdiv0, S3C6400_CLKDIV0_HCLK2); | 
|  | hclk = hclk2 / GET_DIV(clkdiv0, S3C6400_CLKDIV0_HCLK); | 
|  | pclk = hclk2 / GET_DIV(clkdiv0, S3C6400_CLKDIV0_PCLK); | 
|  |  | 
|  | printk(KERN_INFO "S3C64XX: HCLK2=%ld, HCLK=%ld, PCLK=%ld\n", | 
|  | hclk2, hclk, pclk); | 
|  |  | 
|  | clk_fout_mpll.rate = mpll; | 
|  | clk_fout_epll.rate = epll; | 
|  | clk_fout_apll.rate = apll; | 
|  |  | 
|  | clk_h2.rate = hclk2; | 
|  | clk_h.rate = hclk; | 
|  | clk_p.rate = pclk; | 
|  | clk_f.rate = fclk; | 
|  |  | 
|  | for (ptr = 0; ptr < ARRAY_SIZE(init_parents); ptr++) | 
|  | s3c6400_set_clksrc(init_parents[ptr]); | 
|  | } | 
|  |  | 
|  | static struct clk *clks[] __initdata = { | 
|  | &clk_ext_xtal_mux, | 
|  | &clk_iis_cd0, | 
|  | &clk_iis_cd1, | 
|  | &clk_pcm_cd, | 
|  | &clk_mout_epll.clk, | 
|  | &clk_fout_epll, | 
|  | &clk_mout_mpll.clk, | 
|  | &clk_dout_mpll, | 
|  | &clk_mmc0.clk, | 
|  | &clk_mmc1.clk, | 
|  | &clk_mmc2.clk, | 
|  | &clk_usbhost.clk, | 
|  | &clk_uart_uclk1.clk, | 
|  | &clk_spi0.clk, | 
|  | &clk_spi1.clk, | 
|  | &clk_audio0.clk, | 
|  | &clk_audio1.clk, | 
|  | &clk_irda.clk, | 
|  | &clk_camif.clk, | 
|  | &clk_arm, | 
|  | }; | 
|  |  | 
|  | /** | 
|  | * s3c6400_register_clocks - register clocks for s3c6400 and above | 
|  | * @armclk_divlimit: Divisor mask for ARMCLK | 
|  | * | 
|  | * Register the clocks for the S3C6400 and above SoC range, such | 
|  | * as ARMCLK and the clocks which have divider chains attached. | 
|  | * | 
|  | * This call does not setup the clocks, which is left to the | 
|  | * s3c6400_setup_clocks() call which may be needed by the cpufreq | 
|  | * or resume code to re-set the clocks if the bootloader has changed | 
|  | * them. | 
|  | */ | 
|  | void __init s3c6400_register_clocks(unsigned armclk_divlimit) | 
|  | { | 
|  | struct clk *clkp; | 
|  | int ret; | 
|  | int ptr; | 
|  |  | 
|  | armclk_mask = armclk_divlimit; | 
|  |  | 
|  | for (ptr = 0; ptr < ARRAY_SIZE(clks); ptr++) { | 
|  | clkp = clks[ptr]; | 
|  | ret = s3c24xx_register_clock(clkp); | 
|  | if (ret < 0) { | 
|  | printk(KERN_ERR "Failed to register clock %s (%d)\n", | 
|  | clkp->name, ret); | 
|  | } | 
|  | } | 
|  |  | 
|  | clk_mpll.parent = &clk_mout_mpll.clk; | 
|  | clk_epll.parent = &clk_mout_epll.clk; | 
|  | } |