arch/arm/mach-imx/clk-imx51-imx53.c

   1 /*
   2  * Copyright (C) 2011 Sascha Hauer, Pengutronix <s.hauer@pengutronix.de>
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License version 2 as
   6  * published by the Free Software Foundation.
   7  *
   8  */
   9 #include <linux/mm.h>
  10 #include <linux/delay.h>
  11 #include <linux/clk.h>
  12 #include <linux/io.h>
  13 #include <linux/clkdev.h>
  14 #include <linux/of.h>
  15 #include <linux/err.h>
  16
  17 #include "crm-regs-imx5.h"
  18 #include "clk.h"
  19 #include "common.h"
  20 #include "hardware.h"
  21
  22 /* Low-power Audio Playback Mode clock */
  23 static const char *lp_apm_sel[] = { "osc", };
  24
  25 /* This is used multiple times */
  26 static const char *standard_pll_sel[] = { "pll1_sw", "pll2_sw", "pll3_sw", "lp_apm", };
  27 static const char *periph_apm_sel[] = { "pll1_sw", "pll3_sw", "lp_apm", };
  28 static const char *main_bus_sel[] = { "pll2_sw", "periph_apm", };
  29 static const char *per_lp_apm_sel[] = { "main_bus", "lp_apm", };
  30 static const char *per_root_sel[] = { "per_podf", "ipg", };
  31 static const char *esdhc_c_sel[] = { "esdhc_a_podf", "esdhc_b_podf", };
  32 static const char *esdhc_d_sel[] = { "esdhc_a_podf", "esdhc_b_podf", };
  33 static const char *ssi_apm_sels[] = { "ckih1", "lp_amp", "ckih2", };
  34 static const char *ssi_clk_sels[] = { "pll1_sw", "pll2_sw", "pll3_sw", "ssi_apm", };
  35 static const char *ssi3_clk_sels[] = { "ssi1_root_gate", "ssi2_root_gate", };
  36 static const char *ssi_ext1_com_sels[] = { "ssi_ext1_podf", "ssi1_root_gate", };
  37 static const char *ssi_ext2_com_sels[] = { "ssi_ext2_podf", "ssi2_root_gate", };
  38 static const char *emi_slow_sel[] = { "main_bus", "ahb", };
  39 static const char *usb_phy_sel_str[] = { "osc", "usb_phy_podf", };
  40 static const char *mx51_ipu_di0_sel[] = { "di_pred", "osc", "ckih1", "tve_di", };
  41 static const char *mx53_ipu_di0_sel[] = { "di_pred", "osc", "ckih1", "di_pll4_podf", "dummy", "ldb_di0_gate", };
  42 static const char *mx53_ldb_di0_sel[] = { "pll3_sw", "pll4_sw", };
  43 static const char *mx51_ipu_di1_sel[] = { "di_pred", "osc", "ckih1", "tve_di", "ipp_di1", };
  44 static const char *mx53_ipu_di1_sel[] = { "di_pred", "osc", "ckih1", "tve_di", "ipp_di1", "ldb_di1_gate", };
  45 static const char *mx53_ldb_di1_sel[] = { "pll3_sw", "pll4_sw", };
  46 static const char *mx51_tve_ext_sel[] = { "osc", "ckih1", };
  47 static const char *mx53_tve_ext_sel[] = { "pll4_sw", "ckih1", };
  48 static const char *tve_sel[] = { "tve_pred", "tve_ext_sel", };
  49 static const char *ipu_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb", };
  50 static const char *gpu3d_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb" };
  51 static const char *gpu2d_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb" };
  52 static const char *vpu_sel[] = { "axi_a", "axi_b", "emi_slow_gate", "ahb", };
  53 static const char *mx53_can_sel[] = { "ipg", "ckih1", "ckih2", "lp_apm", };
  54 static const char *mx53_cko1_sel[] = {
  55         "cpu_podf", "pll1_sw", "pll2_sw", "pll3_sw",
  56         "emi_slow_podf", "pll4_sw", "nfc_podf", "dummy",
  57         "di_pred", "dummy", "dummy", "ahb",
  58         "ipg", "per_root", "ckil", "dummy",};
  59 static const char *mx53_cko2_sel[] = {
  60         "dummy"/* dptc_core */, "dummy"/* dptc_perich */,
  61         "dummy", "esdhc_a_podf",
  62         "usboh3_podf", "dummy"/* wrck_clk_root */,
  63         "ecspi_podf", "dummy"/* pll1_ref_clk */,
  64         "esdhc_b_podf", "dummy"/* ddr_clk_root */,
  65         "dummy"/* arm_axi_clk_root */, "dummy"/* usb_phy_out */,
  66         "vpu_sel", "ipu_sel",
  67         "osc", "ckih1",
  68         "dummy", "esdhc_c_sel",
  69         "ssi1_root_podf", "ssi2_root_podf",
  70         "dummy", "dummy",
  71         "dummy"/* lpsr_clk_root */, "dummy"/* pgc_clk_root */,
  72         "dummy"/* tve_out */, "usb_phy_sel",
  73         "tve_sel", "lp_apm",
  74         "uart_root", "dummy"/* spdif0_clk_root */,
  75         "dummy", "dummy", };
  76
  77 enum imx5_clks {
  78         dummy, ckil, osc, ckih1, ckih2, ahb, ipg, axi_a, axi_b, uart_pred,
  79         uart_root, esdhc_a_pred, esdhc_b_pred, esdhc_c_s, esdhc_d_s,
  80         emi_sel, emi_slow_podf, nfc_podf, ecspi_pred, ecspi_podf, usboh3_pred,
  81         usboh3_podf, usb_phy_pred, usb_phy_podf, cpu_podf, di_pred, tve_di,
  82         tve_s, uart1_ipg_gate, uart1_per_gate, uart2_ipg_gate,
  83         uart2_per_gate, uart3_ipg_gate, uart3_per_gate, i2c1_gate, i2c2_gate,
  84         gpt_ipg_gate, pwm1_ipg_gate, pwm1_hf_gate, pwm2_ipg_gate, pwm2_hf_gate,
  85         gpt_hf_gate, fec_gate, usboh3_per_gate, esdhc1_ipg_gate, esdhc2_ipg_gate,
  86         esdhc3_ipg_gate, esdhc4_ipg_gate, ssi1_ipg_gate, ssi2_ipg_gate,
  87         ssi3_ipg_gate, ecspi1_ipg_gate, ecspi1_per_gate, ecspi2_ipg_gate,
  88         ecspi2_per_gate, cspi_ipg_gate, sdma_gate, emi_slow_gate, ipu_s,
  89         ipu_gate, nfc_gate, ipu_di1_gate, vpu_s, vpu_gate,
  90         vpu_reference_gate, uart4_ipg_gate, uart4_per_gate, uart5_ipg_gate,
  91         uart5_per_gate, tve_gate, tve_pred, esdhc1_per_gate, esdhc2_per_gate,
  92         esdhc3_per_gate, esdhc4_per_gate, usb_phy_gate, hsi2c_gate,
  93         mipi_hsc1_gate, mipi_hsc2_gate, mipi_esc_gate, mipi_hsp_gate,
  94         ldb_di1_div_3_5, ldb_di1_div, ldb_di0_div_3_5, ldb_di0_div,
  95         ldb_di1_gate, can2_serial_gate, can2_ipg_gate, i2c3_gate, lp_apm,
  96         periph_apm, main_bus, ahb_max, aips_tz1, aips_tz2, tmax1, tmax2,
  97         tmax3, spba, uart_sel, esdhc_a_sel, esdhc_b_sel, esdhc_a_podf,
  98         esdhc_b_podf, ecspi_sel, usboh3_sel, usb_phy_sel, iim_gate,
  99         usboh3_gate, emi_fast_gate, ipu_di0_gate,gpc_dvfs, pll1_sw, pll2_sw,
 100         pll3_sw, ipu_di0_sel, ipu_di1_sel, tve_ext_sel, mx51_mipi, pll4_sw,
 101         ldb_di1_sel, di_pll4_podf, ldb_di0_sel, ldb_di0_gate, usb_phy1_gate,
 102         usb_phy2_gate, per_lp_apm, per_pred1, per_pred2, per_podf, per_root,
 103         ssi_apm, ssi1_root_sel, ssi2_root_sel, ssi3_root_sel, ssi_ext1_sel,
 104         ssi_ext2_sel, ssi_ext1_com_sel, ssi_ext2_com_sel, ssi1_root_pred,
 105         ssi1_root_podf, ssi2_root_pred, ssi2_root_podf, ssi_ext1_pred,
 106         ssi_ext1_podf, ssi_ext2_pred, ssi_ext2_podf, ssi1_root_gate,
 107         ssi2_root_gate, ssi3_root_gate, ssi_ext1_gate, ssi_ext2_gate,
 108         epit1_ipg_gate, epit1_hf_gate, epit2_ipg_gate, epit2_hf_gate,
 109         can_sel, can1_serial_gate, can1_ipg_gate,
 110         owire_gate, gpu3d_s, gpu2d_s, gpu3d_gate, gpu2d_gate, garb_gate,
 111         cko1_sel, cko1_podf, cko1,
 112         cko2_sel, cko2_podf, cko2,
 113         clk_max
 114 };
 115
 116 static struct clk *clk[clk_max];
 117 static struct clk_onecell_data clk_data;
 118
 119 static void __init mx5_clocks_common_init(unsigned long rate_ckil,
 120                 unsigned long rate_osc, unsigned long rate_ckih1,
 121                 unsigned long rate_ckih2)
 122 {
 123         int i;
 124
 125         clk[dummy] = imx_clk_fixed("dummy", 0);
 126         clk[ckil] = imx_clk_fixed("ckil", rate_ckil);
 127         clk[osc] = imx_clk_fixed("osc", rate_osc);
 128         clk[ckih1] = imx_clk_fixed("ckih1", rate_ckih1);
 129         clk[ckih2] = imx_clk_fixed("ckih2", rate_ckih2);
 130
 131         clk[lp_apm] = imx_clk_mux("lp_apm", MXC_CCM_CCSR, 9, 1,
 132                                 lp_apm_sel, ARRAY_SIZE(lp_apm_sel));
 133         clk[periph_apm] = imx_clk_mux("periph_apm", MXC_CCM_CBCMR, 12, 2,
 134                                 periph_apm_sel, ARRAY_SIZE(periph_apm_sel));
 135         clk[main_bus] = imx_clk_mux("main_bus", MXC_CCM_CBCDR, 25, 1,
 136                                 main_bus_sel, ARRAY_SIZE(main_bus_sel));
 137         clk[per_lp_apm] = imx_clk_mux("per_lp_apm", MXC_CCM_CBCMR, 1, 1,
 138                                 per_lp_apm_sel, ARRAY_SIZE(per_lp_apm_sel));
 139         clk[per_pred1] = imx_clk_divider("per_pred1", "per_lp_apm", MXC_CCM_CBCDR, 6, 2);
 140         clk[per_pred2] = imx_clk_divider("per_pred2", "per_pred1", MXC_CCM_CBCDR, 3, 3);
 141         clk[per_podf] = imx_clk_divider("per_podf", "per_pred2", MXC_CCM_CBCDR, 0, 3);
 142         clk[per_root] = imx_clk_mux("per_root", MXC_CCM_CBCMR, 0, 1,
 143                                 per_root_sel, ARRAY_SIZE(per_root_sel));
 144         clk[ahb] = imx_clk_divider("ahb", "main_bus", MXC_CCM_CBCDR, 10, 3);
 145         clk[ahb_max] = imx_clk_gate2("ahb_max", "ahb", MXC_CCM_CCGR0, 28);
 146         clk[aips_tz1] = imx_clk_gate2("aips_tz1", "ahb", MXC_CCM_CCGR0, 24);
 147         clk[aips_tz2] = imx_clk_gate2("aips_tz2", "ahb", MXC_CCM_CCGR0, 26);
 148         clk[tmax1] = imx_clk_gate2("tmax1", "ahb", MXC_CCM_CCGR1, 0);
 149         clk[tmax2] = imx_clk_gate2("tmax2", "ahb", MXC_CCM_CCGR1, 2);
 150         clk[tmax3] = imx_clk_gate2("tmax3", "ahb", MXC_CCM_CCGR1, 4);
 151         clk[spba] = imx_clk_gate2("spba", "ipg", MXC_CCM_CCGR5, 0);
 152         clk[ipg] = imx_clk_divider("ipg", "ahb", MXC_CCM_CBCDR, 8, 2);
 153         clk[axi_a] = imx_clk_divider("axi_a", "main_bus", MXC_CCM_CBCDR, 16, 3);
 154         clk[axi_b] = imx_clk_divider("axi_b", "main_bus", MXC_CCM_CBCDR, 19, 3);
 155         clk[uart_sel] = imx_clk_mux("uart_sel", MXC_CCM_CSCMR1, 24, 2,
 156                                 standard_pll_sel, ARRAY_SIZE(standard_pll_sel));
 157         clk[uart_pred] = imx_clk_divider("uart_pred", "uart_sel", MXC_CCM_CSCDR1, 3, 3);
 158         clk[uart_root] = imx_clk_divider("uart_root", "uart_pred", MXC_CCM_CSCDR1, 0, 3);
 159
 160         clk[esdhc_a_sel] = imx_clk_mux("esdhc_a_sel", MXC_CCM_CSCMR1, 20, 2,
 161                                 standard_pll_sel, ARRAY_SIZE(standard_pll_sel));
 162         clk[esdhc_b_sel] = imx_clk_mux("esdhc_b_sel", MXC_CCM_CSCMR1, 16, 2,
 163                                 standard_pll_sel, ARRAY_SIZE(standard_pll_sel));
 164         clk[esdhc_a_pred] = imx_clk_divider("esdhc_a_pred", "esdhc_a_sel", MXC_CCM_CSCDR1, 16, 3);
 165         clk[esdhc_a_podf] = imx_clk_divider("esdhc_a_podf", "esdhc_a_pred", MXC_CCM_CSCDR1, 11, 3);
 166         clk[esdhc_b_pred] = imx_clk_divider("esdhc_b_pred", "esdhc_b_sel", MXC_CCM_CSCDR1, 22, 3);
 167         clk[esdhc_b_podf] = imx_clk_divider("esdhc_b_podf", "esdhc_b_pred", MXC_CCM_CSCDR1, 19, 3);
 168         clk[esdhc_c_s] = imx_clk_mux("esdhc_c_sel", MXC_CCM_CSCMR1, 19, 1, esdhc_c_sel, ARRAY_SIZE(esdhc_c_sel));
 169         clk[esdhc_d_s] = imx_clk_mux("esdhc_d_sel", MXC_CCM_CSCMR1, 18, 1, esdhc_d_sel, ARRAY_SIZE(esdhc_d_sel));
 170
 171         clk[emi_sel] = imx_clk_mux("emi_sel", MXC_CCM_CBCDR, 26, 1,
 172                                 emi_slow_sel, ARRAY_SIZE(emi_slow_sel));
 173         clk[emi_slow_podf] = imx_clk_divider("emi_slow_podf", "emi_sel", MXC_CCM_CBCDR, 22, 3);
 174         clk[nfc_podf] = imx_clk_divider("nfc_podf", "emi_slow_podf", MXC_CCM_CBCDR, 13, 3);
 175         clk[ecspi_sel] = imx_clk_mux("ecspi_sel", MXC_CCM_CSCMR1, 4, 2,
 176                                 standard_pll_sel, ARRAY_SIZE(standard_pll_sel));
 177         clk[ecspi_pred] = imx_clk_divider("ecspi_pred", "ecspi_sel", MXC_CCM_CSCDR2, 25, 3);
 178         clk[ecspi_podf] = imx_clk_divider("ecspi_podf", "ecspi_pred", MXC_CCM_CSCDR2, 19, 6);
 179         clk[usboh3_sel] = imx_clk_mux("usboh3_sel", MXC_CCM_CSCMR1, 22, 2,
 180                                 standard_pll_sel, ARRAY_SIZE(standard_pll_sel));
 181         clk[usboh3_pred] = imx_clk_divider("usboh3_pred", "usboh3_sel", MXC_CCM_CSCDR1, 8, 3);
 182         clk[usboh3_podf] = imx_clk_divider("usboh3_podf", "usboh3_pred", MXC_CCM_CSCDR1, 6, 2);
 183         clk[usb_phy_pred] = imx_clk_divider("usb_phy_pred", "pll3_sw", MXC_CCM_CDCDR, 3, 3);
 184         clk[usb_phy_podf] = imx_clk_divider("usb_phy_podf", "usb_phy_pred", MXC_CCM_CDCDR, 0, 3);
 185         clk[usb_phy_sel] = imx_clk_mux("usb_phy_sel", MXC_CCM_CSCMR1, 26, 1,
 186                                 usb_phy_sel_str, ARRAY_SIZE(usb_phy_sel_str));
 187         clk[cpu_podf] = imx_clk_divider("cpu_podf", "pll1_sw", MXC_CCM_CACRR, 0, 3);
 188         clk[di_pred] = imx_clk_divider("di_pred", "pll3_sw", MXC_CCM_CDCDR, 6, 3);
 189         clk[tve_di] = imx_clk_fixed("tve_di", 65000000); /* FIXME */
 190         clk[tve_s] = imx_clk_mux("tve_sel", MXC_CCM_CSCMR1, 7, 1, tve_sel, ARRAY_SIZE(tve_sel));
 191         clk[iim_gate] = imx_clk_gate2("iim_gate", "ipg", MXC_CCM_CCGR0, 30);
 192         clk[uart1_ipg_gate] = imx_clk_gate2("uart1_ipg_gate", "ipg", MXC_CCM_CCGR1, 6);
 193         clk[uart1_per_gate] = imx_clk_gate2("uart1_per_gate", "uart_root", MXC_CCM_CCGR1, 8);
 194         clk[uart2_ipg_gate] = imx_clk_gate2("uart2_ipg_gate", "ipg", MXC_CCM_CCGR1, 10);
 195         clk[uart2_per_gate] = imx_clk_gate2("uart2_per_gate", "uart_root", MXC_CCM_CCGR1, 12);
 196         clk[uart3_ipg_gate] = imx_clk_gate2("uart3_ipg_gate", "ipg", MXC_CCM_CCGR1, 14);
 197         clk[uart3_per_gate] = imx_clk_gate2("uart3_per_gate", "uart_root", MXC_CCM_CCGR1, 16);
 198         clk[i2c1_gate] = imx_clk_gate2("i2c1_gate", "per_root", MXC_CCM_CCGR1, 18);
 199         clk[i2c2_gate] = imx_clk_gate2("i2c2_gate", "per_root", MXC_CCM_CCGR1, 20);
 200         clk[pwm1_ipg_gate] = imx_clk_gate2("pwm1_ipg_gate", "ipg", MXC_CCM_CCGR2, 10);
 201         clk[pwm1_hf_gate] = imx_clk_gate2("pwm1_hf_gate", "per_root", MXC_CCM_CCGR2, 12);
 202         clk[pwm2_ipg_gate] = imx_clk_gate2("pwm2_ipg_gate", "ipg", MXC_CCM_CCGR2, 14);
 203         clk[pwm2_hf_gate] = imx_clk_gate2("pwm2_hf_gate", "per_root", MXC_CCM_CCGR2, 16);
 204         clk[gpt_ipg_gate] = imx_clk_gate2("gpt_ipg_gate", "ipg", MXC_CCM_CCGR2, 18);
 205         clk[gpt_hf_gate] = imx_clk_gate2("gpt_hf_gate", "per_root", MXC_CCM_CCGR2, 20);
 206         clk[fec_gate] = imx_clk_gate2("fec_gate", "ipg", MXC_CCM_CCGR2, 24);
 207         clk[usboh3_gate] = imx_clk_gate2("usboh3_gate", "ipg", MXC_CCM_CCGR2, 26);
 208         clk[usboh3_per_gate] = imx_clk_gate2("usboh3_per_gate", "usboh3_podf", MXC_CCM_CCGR2, 28);
 209         clk[esdhc1_ipg_gate] = imx_clk_gate2("esdhc1_ipg_gate", "ipg", MXC_CCM_CCGR3, 0);
 210         clk[esdhc2_ipg_gate] = imx_clk_gate2("esdhc2_ipg_gate", "ipg", MXC_CCM_CCGR3, 4);
 211         clk[esdhc3_ipg_gate] = imx_clk_gate2("esdhc3_ipg_gate", "ipg", MXC_CCM_CCGR3, 8);
 212         clk[esdhc4_ipg_gate] = imx_clk_gate2("esdhc4_ipg_gate", "ipg", MXC_CCM_CCGR3, 12);
 213         clk[ssi1_ipg_gate] = imx_clk_gate2("ssi1_ipg_gate", "ipg", MXC_CCM_CCGR3, 16);
 214         clk[ssi2_ipg_gate] = imx_clk_gate2("ssi2_ipg_gate", "ipg", MXC_CCM_CCGR3, 20);
 215         clk[ssi3_ipg_gate] = imx_clk_gate2("ssi3_ipg_gate", "ipg", MXC_CCM_CCGR3, 24);
 216         clk[ecspi1_ipg_gate] = imx_clk_gate2("ecspi1_ipg_gate", "ipg", MXC_CCM_CCGR4, 18);
 217         clk[ecspi1_per_gate] = imx_clk_gate2("ecspi1_per_gate", "ecspi_podf", MXC_CCM_CCGR4, 20);
 218         clk[ecspi2_ipg_gate] = imx_clk_gate2("ecspi2_ipg_gate", "ipg", MXC_CCM_CCGR4, 22);
 219         clk[ecspi2_per_gate] = imx_clk_gate2("ecspi2_per_gate", "ecspi_podf", MXC_CCM_CCGR4, 24);
 220         clk[cspi_ipg_gate] = imx_clk_gate2("cspi_ipg_gate", "ipg", MXC_CCM_CCGR4, 26);
 221         clk[sdma_gate] = imx_clk_gate2("sdma_gate", "ipg", MXC_CCM_CCGR4, 30);
 222         clk[emi_fast_gate] = imx_clk_gate2("emi_fast_gate", "dummy", MXC_CCM_CCGR5, 14);
 223         clk[emi_slow_gate] = imx_clk_gate2("emi_slow_gate", "emi_slow_podf", MXC_CCM_CCGR5, 16);
 224         clk[ipu_s] = imx_clk_mux("ipu_sel", MXC_CCM_CBCMR, 6, 2, ipu_sel, ARRAY_SIZE(ipu_sel));
 225         clk[ipu_gate] = imx_clk_gate2("ipu_gate", "ipu_sel", MXC_CCM_CCGR5, 10);
 226         clk[nfc_gate] = imx_clk_gate2("nfc_gate", "nfc_podf", MXC_CCM_CCGR5, 20);
 227         clk[ipu_di0_gate] = imx_clk_gate2("ipu_di0_gate", "ipu_di0_sel", MXC_CCM_CCGR6, 10);
 228         clk[ipu_di1_gate] = imx_clk_gate2("ipu_di1_gate", "ipu_di1_sel", MXC_CCM_CCGR6, 12);
 229         clk[gpu3d_s] = imx_clk_mux("gpu3d_sel", MXC_CCM_CBCMR, 4, 2, gpu3d_sel, ARRAY_SIZE(gpu3d_sel));
 230         clk[gpu2d_s] = imx_clk_mux("gpu2d_sel", MXC_CCM_CBCMR, 16, 2, gpu2d_sel, ARRAY_SIZE(gpu2d_sel));
 231         clk[gpu3d_gate] = imx_clk_gate2("gpu3d_gate", "gpu3d_sel", MXC_CCM_CCGR5, 2);
 232         clk[garb_gate] = imx_clk_gate2("garb_gate", "axi_a", MXC_CCM_CCGR5, 4);
 233         clk[gpu2d_gate] = imx_clk_gate2("gpu2d_gate", "gpu2d_sel", MXC_CCM_CCGR6, 14);
 234         clk[vpu_s] = imx_clk_mux("vpu_sel", MXC_CCM_CBCMR, 14, 2, vpu_sel, ARRAY_SIZE(vpu_sel));
 235         clk[vpu_gate] = imx_clk_gate2("vpu_gate", "vpu_sel", MXC_CCM_CCGR5, 6);
 236         clk[vpu_reference_gate] = imx_clk_gate2("vpu_reference_gate", "osc", MXC_CCM_CCGR5, 8);
 237         clk[uart4_ipg_gate] = imx_clk_gate2("uart4_ipg_gate", "ipg", MXC_CCM_CCGR7, 8);
 238         clk[uart4_per_gate] = imx_clk_gate2("uart4_per_gate", "uart_root", MXC_CCM_CCGR7, 10);
 239         clk[uart5_ipg_gate] = imx_clk_gate2("uart5_ipg_gate", "ipg", MXC_CCM_CCGR7, 12);
 240         clk[uart5_per_gate] = imx_clk_gate2("uart5_per_gate", "uart_root", MXC_CCM_CCGR7, 14);
 241         clk[gpc_dvfs] = imx_clk_gate2("gpc_dvfs", "dummy", MXC_CCM_CCGR5, 24);
 242
 243         clk[ssi_apm] = imx_clk_mux("ssi_apm", MXC_CCM_CSCMR1, 8, 2, ssi_apm_sels, ARRAY_SIZE(ssi_apm_sels));
 244         clk[ssi1_root_sel] = imx_clk_mux("ssi1_root_sel", MXC_CCM_CSCMR1, 14, 2, ssi_clk_sels, ARRAY_SIZE(ssi_clk_sels));
 245         clk[ssi2_root_sel] = imx_clk_mux("ssi2_root_sel", MXC_CCM_CSCMR1, 12, 2, ssi_clk_sels, ARRAY_SIZE(ssi_clk_sels));
 246         clk[ssi3_root_sel] = imx_clk_mux("ssi3_root_sel", MXC_CCM_CSCMR1, 11, 1, ssi3_clk_sels, ARRAY_SIZE(ssi3_clk_sels));
 247         clk[ssi_ext1_sel] = imx_clk_mux("ssi_ext1_sel", MXC_CCM_CSCMR1, 28, 2, ssi_clk_sels, ARRAY_SIZE(ssi_clk_sels));
 248         clk[ssi_ext2_sel] = imx_clk_mux("ssi_ext2_sel", MXC_CCM_CSCMR1, 30, 2, ssi_clk_sels, ARRAY_SIZE(ssi_clk_sels));
 249         clk[ssi_ext1_com_sel] = imx_clk_mux("ssi_ext1_com_sel", MXC_CCM_CSCMR1, 0, 1, ssi_ext1_com_sels, ARRAY_SIZE(ssi_ext1_com_sels));
 250         clk[ssi_ext2_com_sel] = imx_clk_mux("ssi_ext2_com_sel", MXC_CCM_CSCMR1, 1, 1, ssi_ext2_com_sels, ARRAY_SIZE(ssi_ext2_com_sels));
 251         clk[ssi1_root_pred] = imx_clk_divider("ssi1_root_pred", "ssi1_root_sel", MXC_CCM_CS1CDR, 6, 3);
 252         clk[ssi1_root_podf] = imx_clk_divider("ssi1_root_podf", "ssi1_root_pred", MXC_CCM_CS1CDR, 0, 6);
 253         clk[ssi2_root_pred] = imx_clk_divider("ssi2_root_pred", "ssi2_root_sel", MXC_CCM_CS2CDR, 6, 3);
 254         clk[ssi2_root_podf] = imx_clk_divider("ssi2_root_podf", "ssi2_root_pred", MXC_CCM_CS2CDR, 0, 6);
 255         clk[ssi_ext1_pred] = imx_clk_divider("ssi_ext1_pred", "ssi_ext1_sel", MXC_CCM_CS1CDR, 22, 3);
 256         clk[ssi_ext1_podf] = imx_clk_divider("ssi_ext1_podf", "ssi_ext1_pred", MXC_CCM_CS1CDR, 16, 6);
 257         clk[ssi_ext2_pred] = imx_clk_divider("ssi_ext2_pred", "ssi_ext2_sel", MXC_CCM_CS2CDR, 22, 3);
 258         clk[ssi_ext2_podf] = imx_clk_divider("ssi_ext2_podf", "ssi_ext2_pred", MXC_CCM_CS2CDR, 16, 6);
 259         clk[ssi1_root_gate] = imx_clk_gate2("ssi1_root_gate", "ssi1_root_podf", MXC_CCM_CCGR3, 18);
 260         clk[ssi2_root_gate] = imx_clk_gate2("ssi2_root_gate", "ssi2_root_podf", MXC_CCM_CCGR3, 22);
 261         clk[ssi3_root_gate] = imx_clk_gate2("ssi3_root_gate", "ssi3_root_sel", MXC_CCM_CCGR3, 26);
 262         clk[ssi_ext1_gate] = imx_clk_gate2("ssi_ext1_gate", "ssi_ext1_com_sel", MXC_CCM_CCGR3, 28);
 263         clk[ssi_ext2_gate] = imx_clk_gate2("ssi_ext2_gate", "ssi_ext2_com_sel", MXC_CCM_CCGR3, 30);
 264         clk[epit1_ipg_gate] = imx_clk_gate2("epit1_ipg_gate", "ipg", MXC_CCM_CCGR2, 2);
 265         clk[epit1_hf_gate] = imx_clk_gate2("epit1_hf_gate", "per_root", MXC_CCM_CCGR2, 4);
 266         clk[epit2_ipg_gate] = imx_clk_gate2("epit2_ipg_gate", "ipg", MXC_CCM_CCGR2, 6);
 267         clk[epit2_hf_gate] = imx_clk_gate2("epit2_hf_gate", "per_root", MXC_CCM_CCGR2, 8);
 268         clk[owire_gate] = imx_clk_gate2("owire_gate", "per_root", MXC_CCM_CCGR2, 22);
 269
 270         for (i = 0; i < ARRAY_SIZE(clk); i++)
 271                 if (IS_ERR(clk[i]))
 272                         pr_err("i.MX5 clk %d: register failed with %ld\n",
 273                                 i, PTR_ERR(clk[i]));
 274
 275         clk_register_clkdev(clk[gpt_hf_gate], "per", "imx-gpt.0");
 276         clk_register_clkdev(clk[gpt_ipg_gate], "ipg", "imx-gpt.0");
 277         clk_register_clkdev(clk[uart1_per_gate], "per", "imx21-uart.0");
 278         clk_register_clkdev(clk[uart1_ipg_gate], "ipg", "imx21-uart.0");
 279         clk_register_clkdev(clk[uart2_per_gate], "per", "imx21-uart.1");
 280         clk_register_clkdev(clk[uart2_ipg_gate], "ipg", "imx21-uart.1");
 281         clk_register_clkdev(clk[uart3_per_gate], "per", "imx21-uart.2");
 282         clk_register_clkdev(clk[uart3_ipg_gate], "ipg", "imx21-uart.2");
 283         clk_register_clkdev(clk[uart4_per_gate], "per", "imx21-uart.3");
 284         clk_register_clkdev(clk[uart4_ipg_gate], "ipg", "imx21-uart.3");
 285         clk_register_clkdev(clk[uart5_per_gate], "per", "imx21-uart.4");
 286         clk_register_clkdev(clk[uart5_ipg_gate], "ipg", "imx21-uart.4");
 287         clk_register_clkdev(clk[ecspi1_per_gate], "per", "imx51-ecspi.0");
 288         clk_register_clkdev(clk[ecspi1_ipg_gate], "ipg", "imx51-ecspi.0");
 289         clk_register_clkdev(clk[ecspi2_per_gate], "per", "imx51-ecspi.1");
 290         clk_register_clkdev(clk[ecspi2_ipg_gate], "ipg", "imx51-ecspi.1");
 291         clk_register_clkdev(clk[cspi_ipg_gate], NULL, "imx35-cspi.2");
 292         clk_register_clkdev(clk[pwm1_ipg_gate], "pwm", "mxc_pwm.0");
 293         clk_register_clkdev(clk[pwm2_ipg_gate], "pwm", "mxc_pwm.1");
 294         clk_register_clkdev(clk[i2c1_gate], NULL, "imx21-i2c.0");
 295         clk_register_clkdev(clk[i2c2_gate], NULL, "imx21-i2c.1");
 296         clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.0");
 297         clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.0");
 298         clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.0");
 299         clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.1");
 300         clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.1");
 301         clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.1");
 302         clk_register_clkdev(clk[usboh3_per_gate], "per", "mxc-ehci.2");
 303         clk_register_clkdev(clk[usboh3_gate], "ipg", "mxc-ehci.2");
 304         clk_register_clkdev(clk[usboh3_gate], "ahb", "mxc-ehci.2");
 305         clk_register_clkdev(clk[usboh3_per_gate], "per", "imx-udc-mx51");
 306         clk_register_clkdev(clk[usboh3_gate], "ipg", "imx-udc-mx51");
 307         clk_register_clkdev(clk[usboh3_gate], "ahb", "imx-udc-mx51");
 308         clk_register_clkdev(clk[nfc_gate], NULL, "imx51-nand");
 309         clk_register_clkdev(clk[ssi1_ipg_gate], NULL, "imx-ssi.0");
 310         clk_register_clkdev(clk[ssi2_ipg_gate], NULL, "imx-ssi.1");
 311         clk_register_clkdev(clk[ssi3_ipg_gate], NULL, "imx-ssi.2");
 312         clk_register_clkdev(clk[ssi_ext1_gate], "ssi_ext1", NULL);
 313         clk_register_clkdev(clk[ssi_ext2_gate], "ssi_ext2", NULL);
 314         clk_register_clkdev(clk[sdma_gate], NULL, "imx35-sdma");
 315         clk_register_clkdev(clk[cpu_podf], "cpu", NULL);
 316         clk_register_clkdev(clk[iim_gate], "iim", NULL);
 317         clk_register_clkdev(clk[dummy], NULL, "imx2-wdt.0");
 318         clk_register_clkdev(clk[dummy], NULL, "imx2-wdt.1");
 319         clk_register_clkdev(clk[dummy], NULL, "imx-keypad");
 320         clk_register_clkdev(clk[tve_gate], NULL, "imx-tve.0");
 321         clk_register_clkdev(clk[ipu_di1_gate], "di1", "imx-tve.0");
 322         clk_register_clkdev(clk[gpc_dvfs], "gpc_dvfs", NULL);
 323         clk_register_clkdev(clk[epit1_ipg_gate], "ipg", "imx-epit.0");
 324         clk_register_clkdev(clk[epit1_hf_gate], "per", "imx-epit.0");
 325         clk_register_clkdev(clk[epit2_ipg_gate], "ipg", "imx-epit.1");
 326         clk_register_clkdev(clk[epit2_hf_gate], "per", "imx-epit.1");
 327
 328         /* Set SDHC parents to be PLL2 */
 329         clk_set_parent(clk[esdhc_a_sel], clk[pll2_sw]);
 330         clk_set_parent(clk[esdhc_b_sel], clk[pll2_sw]);
 331
 332         /* move usb phy clk to 24MHz */
 333         clk_set_parent(clk[usb_phy_sel], clk[osc]);
 334
 335         clk_prepare_enable(clk[gpc_dvfs]);
 336         clk_prepare_enable(clk[ahb_max]); /* esdhc3 */
 337         clk_prepare_enable(clk[aips_tz1]);
 338         clk_prepare_enable(clk[aips_tz2]); /* fec */
 339         clk_prepare_enable(clk[spba]);
 340         clk_prepare_enable(clk[emi_fast_gate]); /* fec */
 341         clk_prepare_enable(clk[emi_slow_gate]); /* eim */
 342         clk_prepare_enable(clk[mipi_hsc1_gate]);
 343         clk_prepare_enable(clk[mipi_hsc2_gate]);
 344         clk_prepare_enable(clk[mipi_esc_gate]);
 345         clk_prepare_enable(clk[mipi_hsp_gate]);
 346         clk_prepare_enable(clk[tmax1]);
 347         clk_prepare_enable(clk[tmax2]); /* esdhc2, fec */
 348         clk_prepare_enable(clk[tmax3]); /* esdhc1, esdhc4 */
 349 }
 350
 351 int __init mx51_clocks_init(unsigned long rate_ckil, unsigned long rate_osc,
 352                         unsigned long rate_ckih1, unsigned long rate_ckih2)
 353 {
 354         int i;
 355         u32 val;
 356         struct device_node *np;
 357
 358         clk[pll1_sw] = imx_clk_pllv2("pll1_sw", "osc", MX51_DPLL1_BASE);
 359         clk[pll2_sw] = imx_clk_pllv2("pll2_sw", "osc", MX51_DPLL2_BASE);
 360         clk[pll3_sw] = imx_clk_pllv2("pll3_sw", "osc", MX51_DPLL3_BASE);
 361         clk[ipu_di0_sel] = imx_clk_mux("ipu_di0_sel", MXC_CCM_CSCMR2, 26, 3,
 362                                 mx51_ipu_di0_sel, ARRAY_SIZE(mx51_ipu_di0_sel));
 363         clk[ipu_di1_sel] = imx_clk_mux("ipu_di1_sel", MXC_CCM_CSCMR2, 29, 3,
 364                                 mx51_ipu_di1_sel, ARRAY_SIZE(mx51_ipu_di1_sel));
 365         clk[tve_ext_sel] = imx_clk_mux("tve_ext_sel", MXC_CCM_CSCMR1, 6, 1,
 366                                 mx51_tve_ext_sel, ARRAY_SIZE(mx51_tve_ext_sel));
 367         clk[tve_gate] = imx_clk_gate2("tve_gate", "tve_sel", MXC_CCM_CCGR2, 30);
 368         clk[tve_pred] = imx_clk_divider("tve_pred", "pll3_sw", MXC_CCM_CDCDR, 28, 3);
 369         clk[esdhc1_per_gate] = imx_clk_gate2("esdhc1_per_gate", "esdhc_a_podf", MXC_CCM_CCGR3, 2);
 370         clk[esdhc2_per_gate] = imx_clk_gate2("esdhc2_per_gate", "esdhc_b_podf", MXC_CCM_CCGR3, 6);
 371         clk[esdhc3_per_gate] = imx_clk_gate2("esdhc3_per_gate", "esdhc_c_sel", MXC_CCM_CCGR3, 10);
 372         clk[esdhc4_per_gate] = imx_clk_gate2("esdhc4_per_gate", "esdhc_d_sel", MXC_CCM_CCGR3, 14);
 373         clk[usb_phy_gate] = imx_clk_gate2("usb_phy_gate", "usb_phy_sel", MXC_CCM_CCGR2, 0);
 374         clk[hsi2c_gate] = imx_clk_gate2("hsi2c_gate", "ipg", MXC_CCM_CCGR1, 22);
 375         clk[mipi_hsc1_gate] = imx_clk_gate2("mipi_hsc1_gate", "ipg", MXC_CCM_CCGR4, 6);
 376         clk[mipi_hsc2_gate] = imx_clk_gate2("mipi_hsc2_gate", "ipg", MXC_CCM_CCGR4, 8);
 377         clk[mipi_esc_gate] = imx_clk_gate2("mipi_esc_gate", "ipg", MXC_CCM_CCGR4, 10);
 378         clk[mipi_hsp_gate] = imx_clk_gate2("mipi_hsp_gate", "ipg", MXC_CCM_CCGR4, 12);
 379
 380         for (i = 0; i < ARRAY_SIZE(clk); i++)
 381                 if (IS_ERR(clk[i]))
 382                         pr_err("i.MX51 clk %d: register failed with %ld\n",
 383                                 i, PTR_ERR(clk[i]));
 384
 385         np = of_find_compatible_node(NULL, NULL, "fsl,imx51-ccm");
 386         clk_data.clks = clk;
 387         clk_data.clk_num = ARRAY_SIZE(clk);
 388         of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data);
 389
 390         mx5_clocks_common_init(rate_ckil, rate_osc, rate_ckih1, rate_ckih2);
 391
 392         clk_register_clkdev(clk[hsi2c_gate], NULL, "imx21-i2c.2");
 393         clk_register_clkdev(clk[mx51_mipi], "mipi_hsp", NULL);
 394         clk_register_clkdev(clk[vpu_gate], NULL, "imx51-vpu.0");
 395         clk_register_clkdev(clk[fec_gate], NULL, "imx27-fec.0");
 396         clk_register_clkdev(clk[ipu_gate], "bus", "40000000.ipu");
 397         clk_register_clkdev(clk[ipu_di0_gate], "di0", "40000000.ipu");
 398         clk_register_clkdev(clk[ipu_di1_gate], "di1", "40000000.ipu");
 399         clk_register_clkdev(clk[usb_phy_gate], "phy", "mxc-ehci.0");
 400         clk_register_clkdev(clk[esdhc1_ipg_gate], "ipg", "sdhci-esdhc-imx51.0");
 401         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.0");
 402         clk_register_clkdev(clk[esdhc1_per_gate], "per", "sdhci-esdhc-imx51.0");
 403         clk_register_clkdev(clk[esdhc2_ipg_gate], "ipg", "sdhci-esdhc-imx51.1");
 404         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.1");
 405         clk_register_clkdev(clk[esdhc2_per_gate], "per", "sdhci-esdhc-imx51.1");
 406         clk_register_clkdev(clk[esdhc3_ipg_gate], "ipg", "sdhci-esdhc-imx51.2");
 407         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.2");
 408         clk_register_clkdev(clk[esdhc3_per_gate], "per", "sdhci-esdhc-imx51.2");
 409         clk_register_clkdev(clk[esdhc4_ipg_gate], "ipg", "sdhci-esdhc-imx51.3");
 410         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx51.3");
 411         clk_register_clkdev(clk[esdhc4_per_gate], "per", "sdhci-esdhc-imx51.3");
 412
 413         /* set the usboh3 parent to pll2_sw */
 414         clk_set_parent(clk[usboh3_sel], clk[pll2_sw]);
 415
 416         /* set SDHC root clock to 166.25MHZ*/
 417         clk_set_rate(clk[esdhc_a_podf], 166250000);
 418         clk_set_rate(clk[esdhc_b_podf], 166250000);
 419
 420         /* System timer */
 421         mxc_timer_init(MX51_IO_ADDRESS(MX51_GPT1_BASE_ADDR), MX51_INT_GPT);
 422
 423         clk_prepare_enable(clk[iim_gate]);
 424         imx_print_silicon_rev("i.MX51", mx51_revision());
 425         clk_disable_unprepare(clk[iim_gate]);
 426
 427         /*
 428          * Reference Manual says: Functionality of CCDR[18] and CLPCR[23] is no
 429          * longer supported. Set to one for better power saving.
 430          *
 431          * The effect of not setting these bits is that MIPI clocks can't be
 432          * enabled without the IPU clock being enabled aswell.
 433          */
 434         val = readl(MXC_CCM_CCDR);
 435         val |= 1 << 18;
 436         writel(val, MXC_CCM_CCDR);
 437
 438         val = readl(MXC_CCM_CLPCR);
 439         val |= 1 << 23;
 440         writel(val, MXC_CCM_CLPCR);
 441
 442         return 0;
 443 }
 444
 445 int __init mx53_clocks_init(unsigned long rate_ckil, unsigned long rate_osc,
 446                         unsigned long rate_ckih1, unsigned long rate_ckih2)
 447 {
 448         int i;
 449         unsigned long r;
 450         struct device_node *np;
 451
 452         clk[pll1_sw] = imx_clk_pllv2("pll1_sw", "osc", MX53_DPLL1_BASE);
 453         clk[pll2_sw] = imx_clk_pllv2("pll2_sw", "osc", MX53_DPLL2_BASE);
 454         clk[pll3_sw] = imx_clk_pllv2("pll3_sw", "osc", MX53_DPLL3_BASE);
 455         clk[pll4_sw] = imx_clk_pllv2("pll4_sw", "osc", MX53_DPLL4_BASE);
 456
 457         clk[ldb_di1_div_3_5] = imx_clk_fixed_factor("ldb_di1_div_3_5", "ldb_di1_sel", 2, 7);
 458         clk[ldb_di1_div] = imx_clk_divider_flags("ldb_di1_div", "ldb_di1_div_3_5", MXC_CCM_CSCMR2, 11, 1, 0);
 459         clk[ldb_di1_sel] = imx_clk_mux_flags("ldb_di1_sel", MXC_CCM_CSCMR2, 9, 1,
 460                                 mx53_ldb_di1_sel, ARRAY_SIZE(mx53_ldb_di1_sel), CLK_SET_RATE_PARENT);
 461         clk[di_pll4_podf] = imx_clk_divider("di_pll4_podf", "pll4_sw", MXC_CCM_CDCDR, 16, 3);
 462         clk[ldb_di0_div_3_5] = imx_clk_fixed_factor("ldb_di0_div_3_5", "ldb_di0_sel", 2, 7);
 463         clk[ldb_di0_div] = imx_clk_divider_flags("ldb_di0_div", "ldb_di0_div_3_5", MXC_CCM_CSCMR2, 10, 1, 0);
 464         clk[ldb_di0_sel] = imx_clk_mux_flags("ldb_di0_sel", MXC_CCM_CSCMR2, 8, 1,
 465                                 mx53_ldb_di0_sel, ARRAY_SIZE(mx53_ldb_di0_sel), CLK_SET_RATE_PARENT);
 466         clk[ldb_di0_gate] = imx_clk_gate2("ldb_di0_gate", "ldb_di0_div", MXC_CCM_CCGR6, 28);
 467         clk[ldb_di1_gate] = imx_clk_gate2("ldb_di1_gate", "ldb_di1_div", MXC_CCM_CCGR6, 30);
 468         clk[ipu_di0_sel] = imx_clk_mux("ipu_di0_sel", MXC_CCM_CSCMR2, 26, 3,
 469                                 mx53_ipu_di0_sel, ARRAY_SIZE(mx53_ipu_di0_sel));
 470         clk[ipu_di1_sel] = imx_clk_mux("ipu_di1_sel", MXC_CCM_CSCMR2, 29, 3,
 471                                 mx53_ipu_di1_sel, ARRAY_SIZE(mx53_ipu_di1_sel));
 472         clk[tve_ext_sel] = imx_clk_mux("tve_ext_sel", MXC_CCM_CSCMR1, 6, 1,
 473                                 mx53_tve_ext_sel, ARRAY_SIZE(mx53_tve_ext_sel));
 474         clk[tve_gate] = imx_clk_gate2("tve_gate", "tve_pred", MXC_CCM_CCGR2, 30);
 475         clk[tve_pred] = imx_clk_divider("tve_pred", "tve_ext_sel", MXC_CCM_CDCDR, 28, 3);
 476         clk[esdhc1_per_gate] = imx_clk_gate2("esdhc1_per_gate", "esdhc_a_podf", MXC_CCM_CCGR3, 2);
 477         clk[esdhc2_per_gate] = imx_clk_gate2("esdhc2_per_gate", "esdhc_c_sel", MXC_CCM_CCGR3, 6);
 478         clk[esdhc3_per_gate] = imx_clk_gate2("esdhc3_per_gate", "esdhc_b_podf", MXC_CCM_CCGR3, 10);
 479         clk[esdhc4_per_gate] = imx_clk_gate2("esdhc4_per_gate", "esdhc_d_sel", MXC_CCM_CCGR3, 14);
 480         clk[usb_phy1_gate] = imx_clk_gate2("usb_phy1_gate", "usb_phy_sel", MXC_CCM_CCGR4, 10);
 481         clk[usb_phy2_gate] = imx_clk_gate2("usb_phy2_gate", "usb_phy_sel", MXC_CCM_CCGR4, 12);
 482         clk[can_sel] = imx_clk_mux("can_sel", MXC_CCM_CSCMR2, 6, 2,
 483                                 mx53_can_sel, ARRAY_SIZE(mx53_can_sel));
 484         clk[can1_serial_gate] = imx_clk_gate2("can1_serial_gate", "can_sel", MXC_CCM_CCGR6, 22);
 485         clk[can1_ipg_gate] = imx_clk_gate2("can1_ipg_gate", "ipg", MXC_CCM_CCGR6, 20);
 486         clk[can2_serial_gate] = imx_clk_gate2("can2_serial_gate", "can_sel", MXC_CCM_CCGR4, 8);
 487         clk[can2_ipg_gate] = imx_clk_gate2("can2_ipg_gate", "ipg", MXC_CCM_CCGR4, 6);
 488         clk[i2c3_gate] = imx_clk_gate2("i2c3_gate", "per_root", MXC_CCM_CCGR1, 22);
 489
 490         clk[cko1_sel] = imx_clk_mux("cko1_sel", MXC_CCM_CCOSR, 0, 4,
 491                                 mx53_cko1_sel, ARRAY_SIZE(mx53_cko1_sel));
 492         clk[cko1_podf] = imx_clk_divider("cko1_podf", "cko1_sel", MXC_CCM_CCOSR, 4, 3);
 493         clk[cko1] = imx_clk_gate2("cko1", "cko1_podf", MXC_CCM_CCOSR, 7);
 494
 495         clk[cko2_sel] = imx_clk_mux("cko2_sel", MXC_CCM_CCOSR, 16, 5,
 496                                 mx53_cko2_sel, ARRAY_SIZE(mx53_cko2_sel));
 497         clk[cko2_podf] = imx_clk_divider("cko2_podf", "cko2_sel", MXC_CCM_CCOSR, 21, 3);
 498         clk[cko2] = imx_clk_gate2("cko2", "cko2_podf", MXC_CCM_CCOSR, 24);
 499
 500         for (i = 0; i < ARRAY_SIZE(clk); i++)
 501                 if (IS_ERR(clk[i]))
 502                         pr_err("i.MX53 clk %d: register failed with %ld\n",
 503                                 i, PTR_ERR(clk[i]));
 504
 505         np = of_find_compatible_node(NULL, NULL, "fsl,imx53-ccm");
 506         clk_data.clks = clk;
 507         clk_data.clk_num = ARRAY_SIZE(clk);
 508         of_clk_add_provider(np, of_clk_src_onecell_get, &clk_data);
 509
 510         mx5_clocks_common_init(rate_ckil, rate_osc, rate_ckih1, rate_ckih2);
 511
 512         clk_register_clkdev(clk[vpu_gate], NULL, "imx53-vpu.0");
 513         clk_register_clkdev(clk[i2c3_gate], NULL, "imx21-i2c.2");
 514         clk_register_clkdev(clk[fec_gate], NULL, "imx25-fec.0");
 515         clk_register_clkdev(clk[ipu_gate], "bus", "18000000.ipu");
 516         clk_register_clkdev(clk[ipu_di0_gate], "di0", "18000000.ipu");
 517         clk_register_clkdev(clk[ipu_di1_gate], "di1", "18000000.ipu");
 518         clk_register_clkdev(clk[ipu_gate], "hsp", "18000000.ipu");
 519         clk_register_clkdev(clk[usb_phy1_gate], "usb_phy1", "mxc-ehci.0");
 520         clk_register_clkdev(clk[esdhc1_ipg_gate], "ipg", "sdhci-esdhc-imx53.0");
 521         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.0");
 522         clk_register_clkdev(clk[esdhc1_per_gate], "per", "sdhci-esdhc-imx53.0");
 523         clk_register_clkdev(clk[esdhc2_ipg_gate], "ipg", "sdhci-esdhc-imx53.1");
 524         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.1");
 525         clk_register_clkdev(clk[esdhc2_per_gate], "per", "sdhci-esdhc-imx53.1");
 526         clk_register_clkdev(clk[esdhc3_ipg_gate], "ipg", "sdhci-esdhc-imx53.2");
 527         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.2");
 528         clk_register_clkdev(clk[esdhc3_per_gate], "per", "sdhci-esdhc-imx53.2");
 529         clk_register_clkdev(clk[esdhc4_ipg_gate], "ipg", "sdhci-esdhc-imx53.3");
 530         clk_register_clkdev(clk[dummy], "ahb", "sdhci-esdhc-imx53.3");
 531         clk_register_clkdev(clk[esdhc4_per_gate], "per", "sdhci-esdhc-imx53.3");
 532
 533         /* set SDHC root clock to 200MHZ*/
 534         clk_set_rate(clk[esdhc_a_podf], 200000000);
 535         clk_set_rate(clk[esdhc_b_podf], 200000000);
 536
 537         /* System timer */
 538         mxc_timer_init(MX53_IO_ADDRESS(MX53_GPT1_BASE_ADDR), MX53_INT_GPT);
 539
 540         clk_prepare_enable(clk[iim_gate]);
 541         imx_print_silicon_rev("i.MX53", mx53_revision());
 542         clk_disable_unprepare(clk[iim_gate]);
 543
 544         r = clk_round_rate(clk[usboh3_per_gate], 54000000);
 545         clk_set_rate(clk[usboh3_per_gate], r);
 546
 547         return 0;
 548 }
 549
 550 #ifdef CONFIG_OF
 551 static void __init clk_get_freq_dt(unsigned long *ckil, unsigned long *osc,
 552                                    unsigned long *ckih1, unsigned long *ckih2)
 553 {
 554         struct device_node *np;
 555
 556         /* retrieve the freqency of fixed clocks from device tree */
 557         for_each_compatible_node(np, NULL, "fixed-clock") {
 558                 u32 rate;
 559                 if (of_property_read_u32(np, "clock-frequency", &rate))
 560                         continue;
 561
 562                 if (of_device_is_compatible(np, "fsl,imx-ckil"))
 563                         *ckil = rate;
 564                 else if (of_device_is_compatible(np, "fsl,imx-osc"))
 565                         *osc = rate;
 566                 else if (of_device_is_compatible(np, "fsl,imx-ckih1"))
 567                         *ckih1 = rate;
 568                 else if (of_device_is_compatible(np, "fsl,imx-ckih2"))
 569                         *ckih2 = rate;
 570         }
 571 }
 572
 573 int __init mx51_clocks_init_dt(void)
 574 {
 575         unsigned long ckil, osc, ckih1, ckih2;
 576
 577         clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2);
 578         return mx51_clocks_init(ckil, osc, ckih1, ckih2);
 579 }
 580
 581 int __init mx53_clocks_init_dt(void)
 582 {
 583         unsigned long ckil, osc, ckih1, ckih2;
 584
 585         clk_get_freq_dt(&ckil, &osc, &ckih1, &ckih2);
 586         return mx53_clocks_init(ckil, osc, ckih1, ckih2);
 587 }
 588 #endif