From: daeinki <inki.dae@samsung.com>
Date: Fri, 2 Apr 2010 05:22:55 +0000 (+0900)
Subject: s5pc110: fb: changed source clock frequency for fimd to 222MHz.
X-Git-Tag: JD03_20100405
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=2e4697b19ccdf6dcc5fe29d62812d16a901000e3;p=kernel%2Fu-boot.git

s5pc110: fb: changed source clock frequency for fimd to 222MHz.

Signed-off-by: daeinki <inki.dae@samsung.com>
---

diff --git a/drivers/video/s5p-fimd.c b/drivers/video/s5p-fimd.c
index 261657c..cb52faf 100644
--- a/drivers/video/s5p-fimd.c
+++ b/drivers/video/s5p-fimd.c
@@ -25,6 +25,7 @@
 #include <linux/types.h>
 #include <asm/io.h>
 #include <lcd.h>
+#include <div64.h>
 
 #include <asm/arch/clk.h>
 #include <asm/arch/clock.h>
@@ -131,9 +132,11 @@ static void s5pc_fimd_set_buffer_address(unsigned int win_id)
 
 static void s5pc_fimd_set_clock(void)
 {
-	unsigned int cfg = 0, div = 0, fimd_ratio = 0, temp = 0;
+	unsigned int cfg = 0, div = 0, fimd_ratio = 0, temp = 0,
+		     remainder, remainder_div;
 	unsigned long pixel_clock, src_clock, max_clock;
 	struct s5pc110_clock *clk = (struct s5pc110_clock *)S5PC1XX_CLOCK_BASE;
+	u64 div64;
 
 	s5pc1xx_clock_init();
 
@@ -171,7 +174,7 @@ static void s5pc_fimd_set_clock(void)
 
 	/* set fimd ratio to 3. */
 	temp = readl(&clk->div1);
-	writel((temp & ~0xf00000) | 0x300000, &clk->div1);
+	writel((temp & ~0xf00000) | 0x200000, &clk->div1);
 	temp = 0;
 
 	/* get mpll ratio */
@@ -179,8 +182,18 @@ static void s5pc_fimd_set_clock(void)
 	fimd_ratio = (temp & 0xf00000) >> 20;
 	temp = 0;
 
-	/* It can get source clock speed as (mpll / fimd_ratio + 1) */
-	div = (unsigned int)((src_clock / (fimd_ratio + 1)) / pixel_clock);
+	div64 = ((u64)src_clock) / (fimd_ratio + 1);
+
+	/* get quotient and remainder. */
+	remainder = do_div(div64, pixel_clock);
+	div = (u32) div64;
+
+	remainder *= 10;
+	remainder_div = remainder / pixel_clock;
+
+	/* round about one places of decimals. */
+	if (remainder_div >= 5)
+		div++;
 
 	/* in case of dual lcd mode. */
 	if (pvid->dual_lcd_enabled)
@@ -190,7 +203,7 @@ static void s5pc_fimd_set_clock(void)
 	writel(cfg, ctrl_base + S5P_VIDCON0);
 
 	udebug("fimd_ratio = %d, src_clock = %d, pixel_clock = %d, div = %d\n",
-		fimd_ratio, src_clock, pixel_clock, div);
+		fimd_ratio, src_clock / (fimd_ratio + 1), pixel_clock, div);
 
 	return;
 }