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.krawczuk@xxxxxxxxxxxxxxxxxxx> --- 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 majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html