ARM: imx6q_sabrelite: clk_register_clkdev cko1 for sgtl5000

Signed-off-by: Richard Zhao <richard.zhao@freescale.com>
Signed-off-by: Shawn Guo <shawn.guo@linaro.org>

1 files changed, 28 insertions, 0 deletions

diff --git a/arch/arm/mach-imx/mach-imx6q.c b/arch/arm/mach-imx/mach-imx6q.c
index e0cc3dac3bec..095c5c5de7bc 100644
--- a/arch/arm/mach-imx/mach-imx6q.c
+++ b/arch/arm/mach-imx/mach-imx6q.c
@@ -10,6 +10,8 @@
  * http://www.gnu.org/copyleft/gpl.html
  */
 
+#include <linux/clk.h>
+#include <linux/clkdev.h>
 #include <linux/delay.h>
 #include <linux/init.h>
 #include <linux/io.h>
@@ -77,11 +79,37 @@ static int ksz9021rn_phy_fixup(struct phy_device *phydev)
         return 0;
 }
 
+static void __init imx6q_sabrelite_cko1_setup(void)
+{
+        struct clk *cko1_sel, *ahb, *cko1;
+        unsigned long rate;
+
+        cko1_sel = clk_get_sys(NULL, "cko1_sel");
+        ahb = clk_get_sys(NULL, "ahb");
+        cko1 = clk_get_sys(NULL, "cko1");
+        if (IS_ERR(cko1_sel) || IS_ERR(ahb) || IS_ERR(cko1)) {
+                pr_err("cko1 setup failed!\n");
+                goto put_clk;
+        }
+        clk_set_parent(cko1_sel, ahb);
+        rate = clk_round_rate(cko1, 16000000);
+        clk_set_rate(cko1, rate);
+        clk_register_clkdev(cko1, NULL, "0-000a");
+put_clk:
+        if (!IS_ERR(cko1_sel))
+                clk_put(cko1_sel);
+        if (!IS_ERR(ahb))
+                clk_put(ahb);
+        if (!IS_ERR(cko1))
+                clk_put(cko1);
+}
+
 static void __init imx6q_sabrelite_init(void)
 {
         if (IS_ENABLED(CONFIG_PHYLIB))
                 phy_register_fixup_for_uid(PHY_ID_KSZ9021, MICREL_PHY_ID_MASK,
                                 ksz9021rn_phy_fixup);
+        imx6q_sabrelite_cko1_setup();
 }
 
 static void __init imx6q_init_machine(void)