Signed-off-by: Sylwester Nawrocki <s.nawro...@samsung.com>
Signed-off-by: Kyungmin Park <kyungmin.p...@samsung.com>
Signed-off-by: Pawel Osciak <p.osc...@samsung.com>
---
 arch/arm/mach-s5pv210/Kconfig              |    5 ++++
 arch/arm/mach-s5pv210/Makefile             |    2 +
 arch/arm/mach-s5pv210/common-aquila-goni.c |   35 ++++++++++++++++++++++++++++
 arch/arm/mach-s5pv210/common-aquila-goni.h |    2 +
 4 files changed, 44 insertions(+), 0 deletions(-)
 create mode 100644 arch/arm/mach-s5pv210/common-aquila-goni.c
 create mode 100644 arch/arm/mach-s5pv210/common-aquila-goni.h

diff --git a/arch/arm/mach-s5pv210/Kconfig b/arch/arm/mach-s5pv210/Kconfig
index 12a2c6b..039ba8c 100644
--- a/arch/arm/mach-s5pv210/Kconfig
+++ b/arch/arm/mach-s5pv210/Kconfig
@@ -90,6 +90,11 @@ config MACH_SMDKC110
 
 endmenu
 
+config COMMON_AQUILA_GONI
+       bool
+       help
+         Compile common code for Samsung Aquila and Samsung GONI machines
+
 config S5PC110_DEV_ONENAND
        bool
        help
diff --git a/arch/arm/mach-s5pv210/Makefile b/arch/arm/mach-s5pv210/Makefile
index 05048c5..a4c0bc9 100644
--- a/arch/arm/mach-s5pv210/Makefile
+++ b/arch/arm/mach-s5pv210/Makefile
@@ -22,6 +22,8 @@ obj-$(CONFIG_MACH_SMDKV210)   += mach-smdkv210.o
 obj-$(CONFIG_MACH_SMDKC110)    += mach-smdkc110.o
 obj-$(CONFIG_MACH_GONI)                += mach-goni.o
 
+obj-$(CONFIG_COMMON_AQUILA_GONI)       += common-aquila-goni.o
+
 # device support
 
 obj-y                          += dev-audio.o
diff --git a/arch/arm/mach-s5pv210/common-aquila-goni.c 
b/arch/arm/mach-s5pv210/common-aquila-goni.c
new file mode 100644
index 0000000..4d72531
--- /dev/null
+++ b/arch/arm/mach-s5pv210/common-aquila-goni.c
@@ -0,0 +1,35 @@
+#include <linux/clk.h>
+#include <linux/err.h>
+#include <plat/fimc.h>
+
+#include "common-aquila-goni.h"
+
+void __init s5pv210_common_fimc_clk_init(void)
+{
+       int i;
+       struct clk *clk_fimc, *parent;
+
+       struct device *fimc_devs[] = {
+               &s5p_device_fimc0.dev,
+               &s5p_device_fimc1.dev,
+               &s5p_device_fimc2.dev
+       };
+
+       parent = clk_get(NULL, "mout_epll");
+       if (IS_ERR(parent))
+               return;
+
+       for (i = 0; i < ARRAY_SIZE(fimc_devs); i++) {
+               if (fimc_devs[i]) {
+                       clk_fimc = clk_get(fimc_devs[i], "sclk_fimc");
+
+                       if (IS_ERR(clk_fimc))
+                               continue;
+
+                       clk_set_parent(clk_fimc, parent);
+                       clk_set_rate(clk_fimc, 133000000);
+                       clk_enable(clk_fimc);
+               }
+       }
+       clk_put(parent);
+}
diff --git a/arch/arm/mach-s5pv210/common-aquila-goni.h 
b/arch/arm/mach-s5pv210/common-aquila-goni.h
new file mode 100644
index 0000000..f666462
--- /dev/null
+++ b/arch/arm/mach-s5pv210/common-aquila-goni.h
@@ -0,0 +1,2 @@
+
+extern void s5pv210_common_fimc_clk_init(void);
-- 
1.7.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