s5pc2xx: clock: add get_uclk function

Signed-off-by: Minkyu Kang <mk7.kang@samsung.com>

diff --git a/arch/arm/cpu/armv7/s5pc2xx/clock.c b/arch/arm/cpu/armv7/s5pc2xx/clock.c
index f6b5003..dd30030 100644 (file)
--- a/arch/arm/cpu/armv7/s5pc2xx/clock.c
+++ b/arch/arm/cpu/armv7/s5pc2xx/clock.c
@@ -30,6 +30,7 @@
 #define CONFIG_SYS_CLK_FREQ_C210       24000000
 #endif
 
+unsigned long (*get_uclk)(void);
 unsigned long (*get_pclk)(void);
 unsigned long (*get_arm_clk)(void);
 unsigned long (*get_pll_clk)(int);
@@ -106,7 +107,7 @@ static unsigned long s5pc210_get_arm_clk(void)
        struct s5pc210_clock *clk =
                (struct s5pc210_clock *)samsung_get_base_clock();
        unsigned long div;
-       unsigned long dout_apll, armclk;
+       unsigned long dout_apll;
        unsigned int apll_ratio;
 
        div = readl(&clk->div_cpu0);
@@ -115,9 +116,8 @@ static unsigned long s5pc210_get_arm_clk(void)
        apll_ratio = (div >> 24) & 0x7;
 
        dout_apll = get_pll_clk(APLL) / (apll_ratio + 1);
-       armclk = dout_apll;
 
-       return armclk;
+       return dout_apll;
 }
 
 /* s5pc210: return peripheral clock frequency */
@@ -126,11 +126,42 @@ static unsigned long s5pc210_get_pclk(void)
        return get_pll_clk(MPLL);
 }
 
+/* s5pc210: return uart clock frequency */
+static unsigned long s5pc210_get_uclk(int dev_index)
+{
+       struct s5pc210_clock *clk =
+               (struct s5pc210_clock *)samsung_get_base_clock();
+       unsigned long div;
+       unsigned long uclk, sclk;
+       unsigned int uart_sel;
+       unsigned int uart_ratio;
+
+       uart_sel = readl(&clk->src_peril0);
+       uart_sel = (uart_sel >> (dev_index << 2)) & 0xf;
+
+       if (uart_sel == 0x6)
+               sclk = get_pll_clk(MPLL);
+       else if (uart_sel == 0x7)
+               sclk = get_pll_clk(EPLL);
+       else if (uart_sel == 0x8)
+               sclk = get_pll_clk(VPLL);
+       else
+               return 0;
+
+       uart_ratio = readl(&clk->div_peril0);
+       uart_ratio = (uart_ratio >> (dev_index << 2)) & 0xf;
+
+       uclk = sclk / (uart_ratio + 1);
+
+       return uclk;
+}
+
 void s5p_clock_init(void)
 {
        if (cpu_is_s5pc210()) {
                get_pll_clk = s5pc210_get_pll_clk;
                get_arm_clk = s5pc210_get_arm_clk;
                get_pclk = s5pc210_get_pclk;
+               get_uclk = s5pc210_get_uclk;
        }
 }

diff --git a/arch/arm/include/asm/arch-s5pc2xx/clk.h b/arch/arm/include/asm/arch-s5pc2xx/clk.h
index 3e59abe..c368fec 100644 (file)
--- a/arch/arm/include/asm/arch-s5pc2xx/clk.h
+++ b/arch/arm/include/asm/arch-s5pc2xx/clk.h
@@ -34,5 +34,6 @@ void s5pc1xx_clock_init(void);
 extern unsigned long (*get_pll_clk)(int pllreg);
 extern unsigned long (*get_arm_clk)(void);
 extern unsigned long (*get_pclk)(void);
+extern unsigned long (*get_uclk)(int dev_index);
 
 #endif