This patch adds code that sets correct parents and rates for clocks
used by FIMC and FIMD on Goni board.

Signed-off-by: Mateusz Krawczuk <m.krawc...@partner.samsung.com>
---
 arch/arm/mach-s5pv210/mach-goni.c | 48 +++++++++++++++++++++++++++++++++++++++
 1 file changed, 48 insertions(+)

diff --git a/arch/arm/mach-s5pv210/mach-goni.c 
b/arch/arm/mach-s5pv210/mach-goni.c
index e5cd9fb..309b5ad 100644
--- a/arch/arm/mach-s5pv210/mach-goni.c
+++ b/arch/arm/mach-s5pv210/mach-goni.c
@@ -55,6 +55,7 @@
 #include <media/s5p_fimc.h>
 #include <media/noon010pc30.h>
 
+#include <linux/clk.h>
 #include "common.h"
 
 /* Following are default values for UCON, ULCON and UFCON UART registers */
@@ -195,6 +196,49 @@ static struct platform_device goni_spi_gpio = {
        },
 };
 
+static void set_fimd_clock(void)
+{
+       struct clk *lcd_clk, *parent_clk;
+
+       lcd_clk = clk_get(NULL, "sclk_fimd");
+       parent_clk = clk_get(NULL, "mout_mpll");
+       clk_set_parent(lcd_clk, parent_clk);
+       clk_set_rate(lcd_clk, clk_get_rate(parent_clk)/3);
+
+       clk_put(parent_clk);
+       clk_put(lcd_clk);
+}
+
+static void set_fimc_clock(void)
+{
+       struct clk *cam0_clk, *cam1_clk, *fimc2_clk, *fimc1_clk,
+                       *fimc0_clk, *parent_clk, *vpll_clk, *csis_clk;
+
+       parent_clk = clk_get(NULL, "mout_mpll");
+       vpll_clk = clk_get(NULL, "mout_vpll");
+       cam0_clk = clk_get(NULL, "mout_cam0");
+       cam1_clk = clk_get(NULL, "mout_cam1");
+       fimc2_clk = clk_get(NULL, "mout_fimc2");
+       fimc1_clk = clk_get(NULL, "mout_fimc1");
+       fimc0_clk = clk_get(NULL, "mout_fimc0");
+       csis_clk = clk_get(NULL, "mout_csis");
+
+       clk_set_parent(cam0_clk, vpll_clk);
+       clk_set_parent(cam1_clk, vpll_clk);
+       clk_set_parent(fimc2_clk, parent_clk);
+       clk_set_parent(fimc1_clk, parent_clk);
+       clk_set_parent(fimc0_clk, parent_clk);
+       clk_set_parent(csis_clk, parent_clk);
+
+       clk_put(parent_clk);
+       clk_put(vpll_clk);
+       clk_put(cam0_clk);
+       clk_put(cam1_clk);
+       clk_put(fimc2_clk);
+       clk_put(fimc1_clk);
+       clk_put(fimc0_clk);
+}
+
 /* KEYPAD */
 static uint32_t keymap[] __initdata = {
        /* KEY(row, col, keycode) */
@@ -931,6 +975,10 @@ static void __init goni_machine_init(void)
        s3c_i2c2_set_platdata(&i2c2_data);
        i2c_register_board_info(2, i2c2_devs, ARRAY_SIZE(i2c2_devs));
 
+       /* FIMD AND FIMC set clock config */
+       set_fimd_clock();
+       set_fimc_clock();
+
        /* PMIC */
        goni_pmic_init();
        i2c_register_board_info(AP_I2C_GPIO_PMIC_BUS_4, i2c_gpio_pmic_devs,
-- 
1.8.1.2

--
To unsubscribe from this list: send the line "unsubscribe linux-samsung-soc" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to