imx: mx7ulp: Add clock framework and functions
authorPeng Fan <peng.fan@nxp.com>
Wed, 22 Feb 2017 08:21:42 +0000 (16:21 +0800)
committerStefano Babic <sbabic@denx.de>
Fri, 17 Mar 2017 08:27:08 +0000 (09:27 +0100)
Add a clock framework to support SCG1/PCC2/PCC3 for A7 to support get/set
clock source, divider, clock rate and parent source.
Users need to include pcc.h to use the APIs to for peripherals clock. Each
peripheral clock is defined in enum pcc_clk type.

SCG relevants APIs are defined in scg.h which supports clock rate get, PLL/PFD
enablement and settings, and all SCG clock initialization. User need use enum
scg_clk to access each clock source.

In clock.c, we initialize necessary clocks at u-boot s_init and implement the
clock functions used by driver modules to operate clocks dynamically.

Signed-off-by: Peng Fan <peng.fan@nxp.com>
Signed-off-by: Ye Li <ye.li@nxp.com>
Cc: Stefano Babic <sbabic@denx.de>
arch/arm/cpu/armv7/mx7ulp/Makefile
arch/arm/cpu/armv7/mx7ulp/clock.c [new file with mode: 0644]
arch/arm/cpu/armv7/mx7ulp/pcc.c [new file with mode: 0644]
arch/arm/cpu/armv7/mx7ulp/scg.c [new file with mode: 0644]
arch/arm/include/asm/arch-mx7ulp/clock.h [new file with mode: 0644]
arch/arm/include/asm/arch-mx7ulp/pcc.h [new file with mode: 0644]
arch/arm/include/asm/arch-mx7ulp/scg.h [new file with mode: 0644]

index be038e716ba02ae974e87d2a7746294b4307cab1..6f37e8cc77931982b8ac7980177ee3c3a873326d 100644 (file)
@@ -5,4 +5,4 @@
 #
 #
 
-obj-y  := iomux.o
+obj-y  := clock.o iomux.o pcc.o scg.o
diff --git a/arch/arm/cpu/armv7/mx7ulp/clock.c b/arch/arm/cpu/armv7/mx7ulp/clock.c
new file mode 100644 (file)
index 0000000..e6225bb
--- /dev/null
@@ -0,0 +1,315 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <div64.h>
+#include <asm/io.h>
+#include <errno.h>
+#include <asm/arch/clock.h>
+#include <asm/arch/sys_proto.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
+int get_clocks(void)
+{
+#ifdef CONFIG_FSL_ESDHC
+#if CONFIG_SYS_FSL_ESDHC_ADDR == USDHC0_RBASE
+       gd->arch.sdhc_clk = mxc_get_clock(MXC_ESDHC_CLK);
+#elif CONFIG_SYS_FSL_ESDHC_ADDR == USDHC1_RBASE
+       gd->arch.sdhc_clk = mxc_get_clock(MXC_ESDHC2_CLK);
+#endif
+#endif
+       return 0;
+}
+
+static u32 get_fast_plat_clk(void)
+{
+       return scg_clk_get_rate(SCG_NIC0_CLK);
+}
+
+static u32 get_slow_plat_clk(void)
+{
+       return scg_clk_get_rate(SCG_NIC1_CLK);
+}
+
+static u32 get_ipg_clk(void)
+{
+       return scg_clk_get_rate(SCG_NIC1_BUS_CLK);
+}
+
+u32 get_lpuart_clk(void)
+{
+       int index = 0;
+
+       const u32 lpuart_array[] = {
+               LPUART0_RBASE,
+               LPUART1_RBASE,
+               LPUART2_RBASE,
+               LPUART3_RBASE,
+               LPUART4_RBASE,
+               LPUART5_RBASE,
+               LPUART6_RBASE,
+               LPUART7_RBASE,
+       };
+
+       const enum pcc_clk lpuart_pcc_clks[] = {
+               PER_CLK_LPUART4,
+               PER_CLK_LPUART5,
+               PER_CLK_LPUART6,
+               PER_CLK_LPUART7,
+       };
+
+       for (index = 0; index < 8; index++) {
+               if (lpuart_array[index] == LPUART_BASE)
+                       break;
+       }
+
+       if (index < 4 || index > 7)
+               return 0;
+
+       return pcc_clock_get_rate(lpuart_pcc_clks[index - 4]);
+}
+
+unsigned int mxc_get_clock(enum mxc_clock clk)
+{
+       switch (clk) {
+       case MXC_ARM_CLK:
+               return scg_clk_get_rate(SCG_CORE_CLK);
+       case MXC_AXI_CLK:
+               return get_fast_plat_clk();
+       case MXC_AHB_CLK:
+               return get_slow_plat_clk();
+       case MXC_IPG_CLK:
+               return get_ipg_clk();
+       case MXC_I2C_CLK:
+               return pcc_clock_get_rate(PER_CLK_LPI2C4);
+       case MXC_UART_CLK:
+               return get_lpuart_clk();
+       case MXC_ESDHC_CLK:
+               return pcc_clock_get_rate(PER_CLK_USDHC0);
+       case MXC_ESDHC2_CLK:
+               return pcc_clock_get_rate(PER_CLK_USDHC1);
+       case MXC_DDR_CLK:
+               return scg_clk_get_rate(SCG_DDR_CLK);
+       default:
+               printf("Unsupported mxc_clock %d\n", clk);
+               break;
+       }
+
+       return 0;
+}
+
+void init_clk_usdhc(u32 index)
+{
+       switch (index) {
+       case 0:
+               /*Disable the clock before configure it */
+               pcc_clock_enable(PER_CLK_USDHC0, false);
+
+               /* 158MHz / 1 = 158MHz */
+               pcc_clock_sel(PER_CLK_USDHC0, SCG_NIC1_CLK);
+               pcc_clock_div_config(PER_CLK_USDHC0, false, 1);
+               pcc_clock_enable(PER_CLK_USDHC0, true);
+               break;
+       case 1:
+               /*Disable the clock before configure it */
+               pcc_clock_enable(PER_CLK_USDHC1, false);
+
+               /* 158MHz / 1 = 158MHz */
+               pcc_clock_sel(PER_CLK_USDHC1, SCG_NIC1_CLK);
+               pcc_clock_div_config(PER_CLK_USDHC1, false, 1);
+               pcc_clock_enable(PER_CLK_USDHC1, true);
+               break;
+       default:
+               printf("Invalid index for USDHC %d\n", index);
+               break;
+       }
+}
+
+#ifdef CONFIG_MXC_OCOTP
+
+#define OCOTP_CTRL_PCC1_SLOT           (38)
+#define OCOTP_CTRL_HIGH4K_PCC1_SLOT    (39)
+
+void enable_ocotp_clk(unsigned char enable)
+{
+       u32 val;
+
+       /*
+        * Seems the OCOTP CLOCKs have been enabled at default,
+        * check its inuse flag
+        */
+
+       val = readl(PCC1_RBASE + 4 * OCOTP_CTRL_PCC1_SLOT);
+       if (!(val & PCC_INUSE_MASK))
+               writel(PCC_CGC_MASK, (PCC1_RBASE + 4 * OCOTP_CTRL_PCC1_SLOT));
+
+       val = readl(PCC1_RBASE + 4 * OCOTP_CTRL_HIGH4K_PCC1_SLOT);
+       if (!(val & PCC_INUSE_MASK))
+               writel(PCC_CGC_MASK,
+                      (PCC1_RBASE + 4 * OCOTP_CTRL_HIGH4K_PCC1_SLOT));
+}
+#endif
+
+void enable_usboh3_clk(unsigned char enable)
+{
+       if (enable) {
+               pcc_clock_enable(PER_CLK_USB0, false);
+               pcc_clock_sel(PER_CLK_USB0, SCG_NIC1_BUS_CLK);
+               pcc_clock_enable(PER_CLK_USB0, true);
+
+#ifdef CONFIG_USB_MAX_CONTROLLER_COUNT
+               if (CONFIG_USB_MAX_CONTROLLER_COUNT > 1) {
+                       pcc_clock_enable(PER_CLK_USB1, false);
+                       pcc_clock_sel(PER_CLK_USB1, SCG_NIC1_BUS_CLK);
+                       pcc_clock_enable(PER_CLK_USB1, true);
+               }
+#endif
+
+               pcc_clock_enable(PER_CLK_USB_PHY, true);
+               pcc_clock_enable(PER_CLK_USB_PL301, true);
+       } else {
+               pcc_clock_enable(PER_CLK_USB0, false);
+               pcc_clock_enable(PER_CLK_USB1, false);
+               pcc_clock_enable(PER_CLK_USB_PHY, false);
+               pcc_clock_enable(PER_CLK_USB_PL301, false);
+       }
+}
+
+static void lpuart_set_clk(uint32_t index, enum scg_clk clk)
+{
+       const enum pcc_clk lpuart_pcc_clks[] = {
+               PER_CLK_LPUART4,
+               PER_CLK_LPUART5,
+               PER_CLK_LPUART6,
+               PER_CLK_LPUART7,
+       };
+
+       if (index < 4 || index > 7)
+               return;
+
+#ifndef CONFIG_CLK_DEBUG
+       pcc_clock_enable(lpuart_pcc_clks[index - 4], false);
+#endif
+       pcc_clock_sel(lpuart_pcc_clks[index - 4], clk);
+       pcc_clock_enable(lpuart_pcc_clks[index - 4], true);
+}
+
+static void init_clk_lpuart(void)
+{
+       u32 index = 0, i;
+
+       const u32 lpuart_array[] = {
+               LPUART0_RBASE,
+               LPUART1_RBASE,
+               LPUART2_RBASE,
+               LPUART3_RBASE,
+               LPUART4_RBASE,
+               LPUART5_RBASE,
+               LPUART6_RBASE,
+               LPUART7_RBASE,
+       };
+
+       for (i = 0; i < 8; i++) {
+               if (lpuart_array[i] == LPUART_BASE) {
+                       index = i;
+                       break;
+               }
+       }
+
+       lpuart_set_clk(index, SCG_SOSC_DIV2_CLK);
+}
+
+static void init_clk_rgpio2p(void)
+{
+       /*Enable RGPIO2P1 clock */
+       pcc_clock_enable(PER_CLK_RGPIO2P1, true);
+
+       /*
+        * Hard code to enable RGPIO2P0 clock since it is not
+        * in clock frame for A7 domain
+        */
+       writel(PCC_CGC_MASK, (PCC0_RBASE + 0x3C));
+}
+
+/* Configure PLL/PFD freq */
+void clock_init(void)
+{
+       /*
+        * ROM has enabled clocks:
+        * A4 side: SIRC 16Mhz (DIV1-3 off),  FIRC 48Mhz (DIV1-2 on),
+        *          Non-LP-boot:  SOSC, SPLL PFD0 (scs selected)
+        * A7 side:  SPLL PFD0 (scs selected, 413Mhz),
+        *           APLL PFD0 (352Mhz), DDRCLK, all NIC clocks
+        *           A7 Plat0 (NIC0) = 176Mhz, Plat1 (NIC1) = 176Mhz,
+        *           IP BUS (NIC1_BUS) = 58.6Mhz
+        *
+        * In u-boot:
+        * 1. Enable PFD1-3 of APLL for A7 side. Enable FIRC and DIVs.
+        * 2. Enable USB PLL
+        * 3. Init the clocks of peripherals used in u-boot bu
+        *    without set rate interface.The clocks for these
+        *    peripherals are enabled in this intialization.
+        * 4.Other peripherals with set clock rate interface
+        *   does not be set in this function.
+        */
+
+       scg_a7_firc_init();
+
+       scg_a7_soscdiv_init();
+
+       /* APLL PFD1 = 270Mhz, PFD2=480Mhz, PFD3=800Mhz */
+       scg_enable_pll_pfd(SCG_APLL_PFD1_CLK, 35);
+       scg_enable_pll_pfd(SCG_APLL_PFD2_CLK, 20);
+       scg_enable_pll_pfd(SCG_APLL_PFD3_CLK, 12);
+
+       init_clk_lpuart();
+
+       init_clk_rgpio2p();
+
+       enable_usboh3_clk(1);
+}
+
+/*
+ * Dump some core clockes.
+ */
+int do_mx7_showclocks(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
+{
+       u32 addr = 0;
+       u32 freq;
+       freq = decode_pll(PLL_A7_SPLL);
+       printf("PLL_A7_SPLL    %8d MHz\n", freq / 1000000);
+
+       freq = decode_pll(PLL_A7_APLL);
+       printf("PLL_A7_APLL    %8d MHz\n", freq / 1000000);
+
+       freq = decode_pll(PLL_USB);
+       printf("PLL_USB    %8d MHz\n", freq / 1000000);
+
+       printf("\n");
+
+       printf("CORE       %8d kHz\n", scg_clk_get_rate(SCG_CORE_CLK) / 1000);
+       printf("IPG        %8d kHz\n", mxc_get_clock(MXC_IPG_CLK) / 1000);
+       printf("UART       %8d kHz\n", mxc_get_clock(MXC_UART_CLK) / 1000);
+       printf("AHB        %8d kHz\n", mxc_get_clock(MXC_AHB_CLK) / 1000);
+       printf("AXI        %8d kHz\n", mxc_get_clock(MXC_AXI_CLK) / 1000);
+       printf("DDR        %8d kHz\n", mxc_get_clock(MXC_DDR_CLK) / 1000);
+       printf("USDHC1     %8d kHz\n", mxc_get_clock(MXC_ESDHC_CLK) / 1000);
+       printf("USDHC2     %8d kHz\n", mxc_get_clock(MXC_ESDHC2_CLK) / 1000);
+       printf("I2C4       %8d kHz\n", mxc_get_clock(MXC_I2C_CLK) / 1000);
+
+       addr = (u32) clock_init;
+       printf("[%s] addr = 0x%08X\r\n", __func__, addr);
+       scg_a7_info();
+
+       return 0;
+}
+
+U_BOOT_CMD(
+       clocks, CONFIG_SYS_MAXARGS, 1, do_mx7_showclocks,
+       "display clocks",
+       ""
+);
diff --git a/arch/arm/cpu/armv7/mx7ulp/pcc.c b/arch/arm/cpu/armv7/mx7ulp/pcc.c
new file mode 100644 (file)
index 0000000..edd84e5
--- /dev/null
@@ -0,0 +1,286 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <div64.h>
+#include <asm/io.h>
+#include <errno.h>
+#include <asm/arch/imx-regs.h>
+#include <asm/arch/pcc.h>
+#include <asm/arch/sys_proto.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
+#define PCC_CLKSRC_TYPES 2
+#define PCC_CLKSRC_NUM 7
+
+static enum scg_clk pcc_clksrc[PCC_CLKSRC_TYPES][PCC_CLKSRC_NUM] = {
+       {       SCG_NIC1_BUS_CLK,
+               SCG_NIC1_CLK,
+               SCG_DDR_CLK,
+               SCG_APLL_PFD2_CLK,
+               SCG_APLL_PFD1_CLK,
+               SCG_APLL_PFD0_CLK,
+               USB_PLL_OUT,
+       },
+       {       SCG_SOSC_DIV2_CLK,  /* SOSC BUS clock */
+               MIPI_PLL_OUT,
+               SCG_FIRC_DIV2_CLK,  /* FIRC BUS clock */
+               SCG_ROSC_CLK,
+               SCG_NIC1_BUS_CLK,
+               SCG_NIC1_CLK,
+               SCG_APLL_PFD3_CLK,
+       },
+};
+
+static struct pcc_entry pcc_arrays[] = {
+       {PCC2_RBASE, DMA1_PCC2_SLOT,            CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, RGPIO1_PCC2_SLOT,          CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, FLEXBUS0_PCC2_SLOT,        CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, SEMA42_1_PCC2_SLOT,        CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, DMA1_CH_MUX0_PCC2_SLOT,    CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, SNVS_PCC2_SLOT,            CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, CAAM_PCC2_SLOT,            CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, LPTPM4_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPTPM5_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPIT1_PCC2_SLOT,           CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPSPI2_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPSPI3_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPI2C4_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPI2C5_PCC2_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPUART4_PCC2_SLOT,         CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, LPUART5_PCC2_SLOT,         CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, FLEXIO1_PCC2_SLOT,         CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC2_RBASE, USBOTG0_PCC2_SLOT,         CLKSRC_PER_PLAT, PCC_HAS_DIV},
+       {PCC2_RBASE, USBOTG1_PCC2_SLOT,         CLKSRC_PER_PLAT, PCC_HAS_DIV},
+       {PCC2_RBASE, USBPHY_PCC2_SLOT,          CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, USB_PL301_PCC2_SLOT,       CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC2_RBASE, USDHC0_PCC2_SLOT,          CLKSRC_PER_PLAT, PCC_HAS_DIV},
+       {PCC2_RBASE, USDHC1_PCC2_SLOT,          CLKSRC_PER_PLAT, PCC_HAS_DIV},
+       {PCC2_RBASE, WDG1_PCC2_SLOT,            CLKSRC_PER_BUS, PCC_HAS_DIV},
+       {PCC2_RBASE, WDG2_PCC2_SLOT,            CLKSRC_PER_BUS, PCC_HAS_DIV},
+
+       {PCC3_RBASE, LPTPM6_PCC3_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, LPTPM7_PCC3_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, LPI2C6_PCC3_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, LPI2C7_PCC3_SLOT,          CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, LPUART6_PCC3_SLOT,         CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, LPUART7_PCC3_SLOT,         CLKSRC_PER_BUS, PCC_NO_DIV},
+       {PCC3_RBASE, VIU0_PCC3_SLOT,            CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, DSI0_PCC3_SLOT,            CLKSRC_PER_BUS, PCC_HAS_DIV},
+       {PCC3_RBASE, LCDIF0_PCC3_SLOT,          CLKSRC_PER_PLAT, PCC_HAS_DIV},
+       {PCC3_RBASE, MMDC0_PCC3_SLOT,           CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, PORTC_PCC3_SLOT,           CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, PORTD_PCC3_SLOT,           CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, PORTE_PCC3_SLOT,           CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, PORTF_PCC3_SLOT,           CLKSRC_NO_PCS, PCC_NO_DIV},
+       {PCC3_RBASE, GPU3D_PCC3_SLOT,           CLKSRC_PER_PLAT, PCC_NO_DIV},
+       {PCC3_RBASE, GPU2D_PCC3_SLOT,           CLKSRC_PER_PLAT, PCC_NO_DIV},
+};
+
+int pcc_clock_enable(enum pcc_clk clk, bool enable)
+{
+       u32 reg, val;
+
+       if (clk >= ARRAY_SIZE(pcc_arrays))
+               return -EINVAL;
+
+       reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+
+       val = readl(reg);
+
+       clk_debug("pcc_clock_enable: clk %d, reg 0x%x, val 0x%x, enable %d\n",
+                 clk, reg, val, enable);
+
+       if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK))
+               return -EPERM;
+
+       if (enable)
+               val |= PCC_CGC_MASK;
+       else
+               val &= ~PCC_CGC_MASK;
+
+       writel(val, reg);
+
+       clk_debug("pcc_clock_enable: val 0x%x\n", val);
+
+       return 0;
+}
+
+/* The clock source select needs clock is disabled */
+int pcc_clock_sel(enum pcc_clk clk, enum scg_clk src)
+{
+       u32 reg, val, i, clksrc_type;
+
+       if (clk >= ARRAY_SIZE(pcc_arrays))
+               return -EINVAL;
+
+       clksrc_type = pcc_arrays[clk].clksrc;
+       if (clksrc_type >= CLKSRC_NO_PCS) {
+               printf("No PCS field for the PCC %d, clksrc type %d\n",
+                      clk, clksrc_type);
+               return -EPERM;
+       }
+
+       for (i = 0; i < PCC_CLKSRC_NUM; i++) {
+               if (pcc_clksrc[clksrc_type][i] == src) {
+                       /* Find the clock src, then set it to PCS */
+                       break;
+               }
+       }
+
+       if (i == PCC_CLKSRC_NUM) {
+               printf("Not find the parent scg_clk in PCS of PCC %d, invalid scg_clk %d\n", clk, src);
+               return -EINVAL;
+       }
+
+       reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+
+       val = readl(reg);
+
+       clk_debug("pcc_clock_sel: clk %d, reg 0x%x, val 0x%x, clksrc_type %d\n",
+                 clk, reg, val, clksrc_type);
+
+       if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK) ||
+           (val & PCC_CGC_MASK)) {
+               printf("Not permit to select clock source val = 0x%x\n", val);
+               return -EPERM;
+       }
+
+       val &= ~PCC_PCS_MASK;
+       val |= ((i + 1) << PCC_PCS_OFFSET);
+
+       writel(val, reg);
+
+       clk_debug("pcc_clock_sel: val 0x%x\n", val);
+
+       return 0;
+}
+
+int pcc_clock_div_config(enum pcc_clk clk, bool frac, u8 div)
+{
+       u32 reg, val;
+
+       if (clk >= ARRAY_SIZE(pcc_arrays) || div > 8 ||
+           (div == 1 && frac != 0))
+               return -EINVAL;
+
+       if (pcc_arrays[clk].div >= PCC_NO_DIV) {
+               printf("No DIV/FRAC field for the PCC %d\n", clk);
+               return -EPERM;
+       }
+
+       reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+
+       val = readl(reg);
+
+       if (!(val & PCC_PR_MASK) || (val & PCC_INUSE_MASK) ||
+           (val & PCC_CGC_MASK)) {
+               printf("Not permit to set div/frac val = 0x%x\n", val);
+               return -EPERM;
+       }
+
+       if (frac)
+               val |= PCC_FRAC_MASK;
+       else
+               val &= ~PCC_FRAC_MASK;
+
+       val &= ~PCC_PCD_MASK;
+       val |= (div - 1) & PCC_PCD_MASK;
+
+       writel(val, reg);
+
+       return 0;
+}
+
+bool pcc_clock_is_enable(enum pcc_clk clk)
+{
+       u32 reg, val;
+
+       if (clk >= ARRAY_SIZE(pcc_arrays))
+               return -EINVAL;
+
+       reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+       val = readl(reg);
+
+       if ((val & PCC_INUSE_MASK) || (val & PCC_CGC_MASK))
+               return true;
+
+       return false;
+}
+
+int pcc_clock_get_clksrc(enum pcc_clk clk, enum scg_clk *src)
+{
+       u32 reg, val, clksrc_type;
+
+       if (clk >= ARRAY_SIZE(pcc_arrays))
+               return -EINVAL;
+
+       clksrc_type = pcc_arrays[clk].clksrc;
+       if (clksrc_type >= CLKSRC_NO_PCS) {
+               printf("No PCS field for the PCC %d, clksrc type %d\n",
+                      clk, clksrc_type);
+               return -EPERM;
+       }
+
+       reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+
+       val = readl(reg);
+
+       clk_debug("pcc_clock_get_clksrc: clk %d, reg 0x%x, val 0x%x, type %d\n",
+                 clk, reg, val, clksrc_type);
+
+       if (!(val & PCC_PR_MASK)) {
+               printf("This pcc slot is not present = 0x%x\n", val);
+               return -EPERM;
+       }
+
+       val &= PCC_PCS_MASK;
+       val = (val >> PCC_PCS_OFFSET);
+
+       if (!val) {
+               printf("Clock source is off\n");
+               return -EIO;
+       }
+
+       *src = pcc_clksrc[clksrc_type][val - 1];
+
+       clk_debug("pcc_clock_get_clksrc: parent scg clk %d\n", *src);
+
+       return 0;
+}
+
+u32 pcc_clock_get_rate(enum pcc_clk clk)
+{
+       u32 reg, val, rate, frac, div;
+       enum scg_clk parent;
+       int ret;
+
+       ret = pcc_clock_get_clksrc(clk, &parent);
+       if (ret)
+               return 0;
+
+       rate = scg_clk_get_rate(parent);
+
+       clk_debug("pcc_clock_get_rate: parent rate %u\n", rate);
+
+       if (pcc_arrays[clk].div == PCC_HAS_DIV) {
+               reg = pcc_arrays[clk].pcc_base + pcc_arrays[clk].pcc_slot * 4;
+               val = readl(reg);
+
+               frac = (val & PCC_FRAC_MASK) >> PCC_FRAC_OFFSET;
+               div = (val & PCC_PCD_MASK) >> PCC_PCD_OFFSET;
+
+               /*
+                * Theoretically don't have overflow in the calc,
+                * the rate won't exceed 2G
+                */
+               rate = rate * (frac + 1) / (div + 1);
+       }
+
+       clk_debug("pcc_clock_get_rate: rate %u\n", rate);
+       return rate;
+}
diff --git a/arch/arm/cpu/armv7/mx7ulp/scg.c b/arch/arm/cpu/armv7/mx7ulp/scg.c
new file mode 100644 (file)
index 0000000..ca8252d
--- /dev/null
@@ -0,0 +1,1086 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+#include <div64.h>
+#include <asm/io.h>
+#include <errno.h>
+#include <asm/arch/imx-regs.h>
+#include <asm/arch/pcc.h>
+#include <asm/arch/sys_proto.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
+scg_p scg1_regs = (scg_p)SCG1_RBASE;
+
+static u32 scg_src_get_rate(enum scg_clk clksrc)
+{
+       u32 reg;
+
+       switch (clksrc) {
+       case SCG_SOSC_CLK:
+               reg = readl(&scg1_regs->sosccsr);
+               if (!(reg & SCG_SOSC_CSR_SOSCVLD_MASK))
+                       return 0;
+
+               return 24000000;
+       case SCG_FIRC_CLK:
+               reg = readl(&scg1_regs->firccsr);
+               if (!(reg & SCG_FIRC_CSR_FIRCVLD_MASK))
+                       return 0;
+
+               return 48000000;
+       case SCG_SIRC_CLK:
+               reg = readl(&scg1_regs->sirccsr);
+               if (!(reg & SCG_SIRC_CSR_SIRCVLD_MASK))
+                       return 0;
+
+               return 16000000;
+       case SCG_ROSC_CLK:
+               reg = readl(&scg1_regs->rtccsr);
+               if (!(reg & SCG_ROSC_CSR_ROSCVLD_MASK))
+                       return 0;
+
+               return 32768;
+       default:
+               break;
+       }
+
+       return 0;
+}
+
+static u32 scg_sircdiv_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask;
+
+       switch (clk) {
+       case SCG_SIRC_DIV1_CLK:
+               mask = SCG_SIRCDIV_DIV1_MASK;
+               shift = SCG_SIRCDIV_DIV1_SHIFT;
+               break;
+       case SCG_SIRC_DIV2_CLK:
+               mask = SCG_SIRCDIV_DIV2_MASK;
+               shift = SCG_SIRCDIV_DIV2_SHIFT;
+               break;
+       case SCG_SIRC_DIV3_CLK:
+               mask = SCG_SIRCDIV_DIV3_MASK;
+               shift = SCG_SIRCDIV_DIV3_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       reg = readl(&scg1_regs->sirccsr);
+       if (!(reg & SCG_SIRC_CSR_SIRCVLD_MASK))
+               return 0;
+
+       reg = readl(&scg1_regs->sircdiv);
+       val = (reg & mask) >> shift;
+
+       if (!val) /*clock disabled*/
+               return 0;
+
+       rate = scg_src_get_rate(SCG_SIRC_CLK);
+       rate = rate / (1 << (val - 1));
+
+       return rate;
+}
+
+static u32 scg_fircdiv_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask;
+
+       switch (clk) {
+       case SCG_FIRC_DIV1_CLK:
+               mask = SCG_FIRCDIV_DIV1_MASK;
+               shift = SCG_FIRCDIV_DIV1_SHIFT;
+               break;
+       case SCG_FIRC_DIV2_CLK:
+               mask = SCG_FIRCDIV_DIV2_MASK;
+               shift = SCG_FIRCDIV_DIV2_SHIFT;
+               break;
+       case SCG_FIRC_DIV3_CLK:
+               mask = SCG_FIRCDIV_DIV3_MASK;
+               shift = SCG_FIRCDIV_DIV3_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       reg = readl(&scg1_regs->firccsr);
+       if (!(reg & SCG_FIRC_CSR_FIRCVLD_MASK))
+               return 0;
+
+       reg = readl(&scg1_regs->fircdiv);
+       val = (reg & mask) >> shift;
+
+       if (!val) /*clock disabled*/
+               return 0;
+
+       rate = scg_src_get_rate(SCG_FIRC_CLK);
+       rate = rate / (1 << (val - 1));
+
+       return rate;
+}
+
+static u32 scg_soscdiv_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask;
+
+       switch (clk) {
+       case SCG_SOSC_DIV1_CLK:
+               mask = SCG_SOSCDIV_DIV1_MASK;
+               shift = SCG_SOSCDIV_DIV1_SHIFT;
+               break;
+       case SCG_SOSC_DIV2_CLK:
+               mask = SCG_SOSCDIV_DIV2_MASK;
+               shift = SCG_SOSCDIV_DIV2_SHIFT;
+               break;
+       case SCG_SOSC_DIV3_CLK:
+               mask = SCG_SOSCDIV_DIV3_MASK;
+               shift = SCG_SOSCDIV_DIV3_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       reg = readl(&scg1_regs->sosccsr);
+       if (!(reg & SCG_SOSC_CSR_SOSCVLD_MASK))
+               return 0;
+
+       reg = readl(&scg1_regs->soscdiv);
+       val = (reg & mask) >> shift;
+
+       if (!val) /*clock disabled*/
+               return 0;
+
+       rate = scg_src_get_rate(SCG_SOSC_CLK);
+       rate = rate / (1 << (val - 1));
+
+       return rate;
+}
+
+static u32 scg_apll_pfd_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask, gate, valid;
+
+       switch (clk) {
+       case SCG_APLL_PFD0_CLK:
+               gate = SCG_PLL_PFD0_GATE_MASK;
+               valid = SCG_PLL_PFD0_VALID_MASK;
+               mask = SCG_PLL_PFD0_FRAC_MASK;
+               shift = SCG_PLL_PFD0_FRAC_SHIFT;
+               break;
+       case SCG_APLL_PFD1_CLK:
+               gate = SCG_PLL_PFD1_GATE_MASK;
+               valid = SCG_PLL_PFD1_VALID_MASK;
+               mask = SCG_PLL_PFD1_FRAC_MASK;
+               shift = SCG_PLL_PFD1_FRAC_SHIFT;
+               break;
+       case SCG_APLL_PFD2_CLK:
+               gate = SCG_PLL_PFD2_GATE_MASK;
+               valid = SCG_PLL_PFD2_VALID_MASK;
+               mask = SCG_PLL_PFD2_FRAC_MASK;
+               shift = SCG_PLL_PFD2_FRAC_SHIFT;
+               break;
+       case SCG_APLL_PFD3_CLK:
+               gate = SCG_PLL_PFD3_GATE_MASK;
+               valid = SCG_PLL_PFD3_VALID_MASK;
+               mask = SCG_PLL_PFD3_FRAC_MASK;
+               shift = SCG_PLL_PFD3_FRAC_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       reg = readl(&scg1_regs->apllpfd);
+       if (reg & gate || !(reg & valid))
+               return 0;
+
+       clk_debug("scg_apll_pfd_get_rate reg 0x%x\n", reg);
+
+       val = (reg & mask) >> shift;
+       rate = decode_pll(PLL_A7_APLL);
+
+       rate = rate / val * 18;
+
+       clk_debug("scg_apll_pfd_get_rate rate %u\n", rate);
+
+       return rate;
+}
+
+static u32 scg_spll_pfd_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask, gate, valid;
+
+       switch (clk) {
+       case SCG_SPLL_PFD0_CLK:
+               gate = SCG_PLL_PFD0_GATE_MASK;
+               valid = SCG_PLL_PFD0_VALID_MASK;
+               mask = SCG_PLL_PFD0_FRAC_MASK;
+               shift = SCG_PLL_PFD0_FRAC_SHIFT;
+               break;
+       case SCG_SPLL_PFD1_CLK:
+               gate = SCG_PLL_PFD1_GATE_MASK;
+               valid = SCG_PLL_PFD1_VALID_MASK;
+               mask = SCG_PLL_PFD1_FRAC_MASK;
+               shift = SCG_PLL_PFD1_FRAC_SHIFT;
+               break;
+       case SCG_SPLL_PFD2_CLK:
+               gate = SCG_PLL_PFD2_GATE_MASK;
+               valid = SCG_PLL_PFD2_VALID_MASK;
+               mask = SCG_PLL_PFD2_FRAC_MASK;
+               shift = SCG_PLL_PFD2_FRAC_SHIFT;
+               break;
+       case SCG_SPLL_PFD3_CLK:
+               gate = SCG_PLL_PFD3_GATE_MASK;
+               valid = SCG_PLL_PFD3_VALID_MASK;
+               mask = SCG_PLL_PFD3_FRAC_MASK;
+               shift = SCG_PLL_PFD3_FRAC_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       reg = readl(&scg1_regs->spllpfd);
+       if (reg & gate || !(reg & valid))
+               return 0;
+
+       clk_debug("scg_spll_pfd_get_rate reg 0x%x\n", reg);
+
+       val = (reg & mask) >> shift;
+       rate = decode_pll(PLL_A7_SPLL);
+
+       rate = rate / val * 18;
+
+       clk_debug("scg_spll_pfd_get_rate rate %u\n", rate);
+
+       return rate;
+}
+
+static u32 scg_apll_get_rate(void)
+{
+       u32 reg, val, rate;
+
+       reg = readl(&scg1_regs->apllcfg);
+       val = (reg & SCG_PLL_CFG_PLLSEL_MASK) >> SCG_PLL_CFG_PLLSEL_SHIFT;
+
+       if (!val) {
+               /* APLL clock after two dividers */
+               rate = decode_pll(PLL_A7_APLL);
+
+               val = (reg & SCG_PLL_CFG_POSTDIV1_MASK) >>
+                       SCG_PLL_CFG_POSTDIV1_SHIFT;
+               rate = rate / (val + 1);
+
+               val = (reg & SCG_PLL_CFG_POSTDIV2_MASK) >>
+                       SCG_PLL_CFG_POSTDIV2_SHIFT;
+               rate = rate / (val + 1);
+       } else {
+               /* APLL PFD clock */
+               val = (reg & SCG_PLL_CFG_PFDSEL_MASK) >>
+                       SCG_PLL_CFG_PFDSEL_SHIFT;
+               rate = scg_apll_pfd_get_rate(SCG_APLL_PFD0_CLK + val);
+       }
+
+       return rate;
+}
+
+static u32 scg_spll_get_rate(void)
+{
+       u32 reg, val, rate;
+
+       reg = readl(&scg1_regs->spllcfg);
+       val = (reg & SCG_PLL_CFG_PLLSEL_MASK) >> SCG_PLL_CFG_PLLSEL_SHIFT;
+
+       clk_debug("scg_spll_get_rate reg 0x%x\n", reg);
+
+       if (!val) {
+               /* APLL clock after two dividers */
+               rate = decode_pll(PLL_A7_SPLL);
+
+               val = (reg & SCG_PLL_CFG_POSTDIV1_MASK) >>
+                       SCG_PLL_CFG_POSTDIV1_SHIFT;
+               rate = rate / (val + 1);
+
+               val = (reg & SCG_PLL_CFG_POSTDIV2_MASK) >>
+                       SCG_PLL_CFG_POSTDIV2_SHIFT;
+               rate = rate / (val + 1);
+
+               clk_debug("scg_spll_get_rate SPLL %u\n", rate);
+
+       } else {
+               /* APLL PFD clock */
+               val = (reg & SCG_PLL_CFG_PFDSEL_MASK) >>
+                       SCG_PLL_CFG_PFDSEL_SHIFT;
+               rate = scg_spll_pfd_get_rate(SCG_SPLL_PFD0_CLK + val);
+
+               clk_debug("scg_spll_get_rate PFD %u\n", rate);
+       }
+
+       return rate;
+}
+
+static u32 scg_ddr_get_rate(void)
+{
+       u32 reg, val, rate, div;
+
+       reg = readl(&scg1_regs->ddrccr);
+       val = (reg & SCG_DDRCCR_DDRCS_MASK) >> SCG_DDRCCR_DDRCS_SHIFT;
+       div = (reg & SCG_DDRCCR_DDRDIV_MASK) >> SCG_DDRCCR_DDRDIV_SHIFT;
+
+       if (!div)
+               return 0;
+
+       if (!val) {
+               reg = readl(&scg1_regs->apllcfg);
+               val = (reg & SCG_PLL_CFG_PFDSEL_MASK) >>
+                       SCG_PLL_CFG_PFDSEL_SHIFT;
+               rate = scg_apll_pfd_get_rate(SCG_APLL_PFD0_CLK + val);
+       } else {
+               rate = decode_pll(PLL_USB);
+       }
+
+       rate = rate / (1 << (div - 1));
+       return rate;
+}
+
+static u32 scg_nic_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+       u32 shift, mask;
+
+       reg = readl(&scg1_regs->niccsr);
+       val = (reg & SCG_NICCSR_NICCS_MASK) >> SCG_NICCSR_NICCS_SHIFT;
+
+       clk_debug("scg_nic_get_rate niccsr 0x%x\n", reg);
+
+       if (!val)
+               rate = scg_src_get_rate(SCG_FIRC_CLK);
+       else
+               rate = scg_ddr_get_rate();
+
+       clk_debug("scg_nic_get_rate parent rate %u\n", rate);
+
+       val = (reg & SCG_NICCSR_NIC0DIV_MASK) >> SCG_NICCSR_NIC0DIV_SHIFT;
+
+       rate = rate / (val + 1);
+
+       clk_debug("scg_nic_get_rate NIC0 rate %u\n", rate);
+
+       switch (clk) {
+       case SCG_NIC0_CLK:
+               return rate;
+       case SCG_GPU_CLK:
+               mask = SCG_NICCSR_GPUDIV_MASK;
+               shift = SCG_NICCSR_GPUDIV_SHIFT;
+               break;
+       case SCG_NIC1_EXT_CLK:
+       case SCG_NIC1_BUS_CLK:
+       case SCG_NIC1_CLK:
+               mask = SCG_NICCSR_NIC1DIV_MASK;
+               shift = SCG_NICCSR_NIC1DIV_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       val = (reg & mask) >> shift;
+       rate = rate / (val + 1);
+
+       clk_debug("scg_nic_get_rate NIC1 rate %u\n", rate);
+
+       switch (clk) {
+       case SCG_GPU_CLK:
+       case SCG_NIC1_CLK:
+               return rate;
+       case SCG_NIC1_EXT_CLK:
+               mask = SCG_NICCSR_NIC1EXTDIV_MASK;
+               shift = SCG_NICCSR_NIC1EXTDIV_SHIFT;
+               break;
+       case SCG_NIC1_BUS_CLK:
+               mask = SCG_NICCSR_NIC1BUSDIV_MASK;
+               shift = SCG_NICCSR_NIC1BUSDIV_SHIFT;
+               break;
+       default:
+               return 0;
+       }
+
+       val = (reg & mask) >> shift;
+       rate = rate / (val + 1);
+
+       clk_debug("scg_nic_get_rate NIC1 bus rate %u\n", rate);
+       return rate;
+}
+
+
+static enum scg_clk scg_scs_array[4] = {
+       SCG_SOSC_CLK, SCG_SIRC_CLK, SCG_FIRC_CLK, SCG_ROSC_CLK,
+};
+
+static u32 scg_sys_get_rate(enum scg_clk clk)
+{
+       u32 reg, val, rate;
+
+       if (clk != SCG_CORE_CLK && clk != SCG_BUS_CLK)
+               return 0;
+
+       reg = readl(&scg1_regs->csr);
+       val = (reg & SCG_CCR_SCS_MASK) >> SCG_CCR_SCS_SHIFT;
+
+       clk_debug("scg_sys_get_rate reg 0x%x\n", reg);
+
+       switch (val) {
+       case SCG_SCS_SYS_OSC:
+       case SCG_SCS_SLOW_IRC:
+       case SCG_SCS_FAST_IRC:
+       case SCG_SCS_RTC_OSC:
+               rate = scg_src_get_rate(scg_scs_array[val]);
+               break;
+       case 5:
+               rate = scg_apll_get_rate();
+               break;
+       case 6:
+               rate = scg_spll_get_rate();
+               break;
+       default:
+               return 0;
+       }
+
+       clk_debug("scg_sys_get_rate parent rate %u\n", rate);
+
+       val = (reg & SCG_CCR_DIVCORE_MASK) >> SCG_CCR_DIVCORE_SHIFT;
+
+       rate = rate / (val + 1);
+
+       if (clk == SCG_BUS_CLK) {
+               val = (reg & SCG_CCR_DIVBUS_MASK) >> SCG_CCR_DIVBUS_SHIFT;
+               rate = rate / (val + 1);
+       }
+
+       return rate;
+}
+
+u32 decode_pll(enum pll_clocks pll)
+{
+       u32 reg,  pre_div, infreq, mult;
+       u32 num, denom;
+
+       /*
+        * Alought there are four choices for the bypass src,
+        * we choose OSC_24M which is the default set in ROM.
+        */
+       switch (pll) {
+       case PLL_A7_SPLL:
+               reg = readl(&scg1_regs->spllcsr);
+
+               if (!(reg & SCG_SPLL_CSR_SPLLVLD_MASK))
+                       return 0;
+
+               reg = readl(&scg1_regs->spllcfg);
+
+               pre_div = (reg & SCG_PLL_CFG_PREDIV_MASK) >>
+                          SCG_PLL_CFG_PREDIV_SHIFT;
+               pre_div += 1;
+
+               mult = (reg & SCG1_SPLL_CFG_MULT_MASK) >>
+                          SCG_PLL_CFG_MULT_SHIFT;
+
+               infreq = (reg & SCG_PLL_CFG_CLKSRC_MASK) >>
+                          SCG_PLL_CFG_CLKSRC_SHIFT;
+               if (!infreq)
+                       infreq = scg_src_get_rate(SCG_SOSC_CLK);
+               else
+                       infreq = scg_src_get_rate(SCG_FIRC_CLK);
+
+               num = readl(&scg1_regs->spllnum);
+               denom = readl(&scg1_regs->splldenom);
+
+               return (infreq / pre_div) * (mult + num / denom);
+
+       case PLL_A7_APLL:
+               reg = readl(&scg1_regs->apllcsr);
+
+               if (!(reg & SCG_APLL_CSR_APLLVLD_MASK))
+                       return 0;
+
+               reg = readl(&scg1_regs->apllcfg);
+
+               pre_div = (reg & SCG_PLL_CFG_PREDIV_MASK) >>
+                          SCG_PLL_CFG_PREDIV_SHIFT;
+               pre_div += 1;
+
+               mult = (reg & SCG_APLL_CFG_MULT_MASK) >>
+                          SCG_PLL_CFG_MULT_SHIFT;
+
+               infreq = (reg & SCG_PLL_CFG_CLKSRC_MASK) >>
+                          SCG_PLL_CFG_CLKSRC_SHIFT;
+               if (!infreq)
+                       infreq = scg_src_get_rate(SCG_SOSC_CLK);
+               else
+                       infreq = scg_src_get_rate(SCG_FIRC_CLK);
+
+               num = readl(&scg1_regs->apllnum);
+               denom = readl(&scg1_regs->aplldenom);
+
+               return (infreq / pre_div) * (mult + num / denom);
+
+       case PLL_USB:
+               reg = readl(&scg1_regs->upllcsr);
+
+               if (!(reg & SCG_UPLL_CSR_UPLLVLD_MASK))
+                       return 0;
+
+               return 480000000u;
+
+       case PLL_MIPI:
+               return 480000000u;
+       default:
+               printf("Unsupported pll clocks %d\n", pll);
+               break;
+       }
+
+       return 0;
+}
+
+u32 scg_clk_get_rate(enum scg_clk clk)
+{
+       switch (clk) {
+       case SCG_SIRC_DIV1_CLK:
+       case SCG_SIRC_DIV2_CLK:
+       case SCG_SIRC_DIV3_CLK:
+               return scg_sircdiv_get_rate(clk);
+
+       case SCG_FIRC_DIV1_CLK:
+       case SCG_FIRC_DIV2_CLK:
+       case SCG_FIRC_DIV3_CLK:
+               return scg_fircdiv_get_rate(clk);
+
+       case SCG_SOSC_DIV1_CLK:
+       case SCG_SOSC_DIV2_CLK:
+       case SCG_SOSC_DIV3_CLK:
+               return scg_soscdiv_get_rate(clk);
+
+       case SCG_CORE_CLK:
+       case SCG_BUS_CLK:
+               return scg_sys_get_rate(clk);
+
+       case SCG_SPLL_PFD0_CLK:
+       case SCG_SPLL_PFD1_CLK:
+       case SCG_SPLL_PFD2_CLK:
+       case SCG_SPLL_PFD3_CLK:
+               return scg_spll_pfd_get_rate(clk);
+
+       case SCG_APLL_PFD0_CLK:
+       case SCG_APLL_PFD1_CLK:
+       case SCG_APLL_PFD2_CLK:
+       case SCG_APLL_PFD3_CLK:
+               return scg_apll_pfd_get_rate(clk);
+
+       case SCG_DDR_CLK:
+               return scg_ddr_get_rate();
+
+       case SCG_NIC0_CLK:
+       case SCG_GPU_CLK:
+       case SCG_NIC1_CLK:
+       case SCG_NIC1_BUS_CLK:
+       case SCG_NIC1_EXT_CLK:
+               return scg_nic_get_rate(clk);
+
+       case USB_PLL_OUT:
+               return decode_pll(PLL_USB);
+
+       case MIPI_PLL_OUT:
+               return decode_pll(PLL_MIPI);
+
+       case SCG_SOSC_CLK:
+       case SCG_FIRC_CLK:
+       case SCG_SIRC_CLK:
+       case SCG_ROSC_CLK:
+               return scg_src_get_rate(clk);
+       default:
+               return 0;
+       }
+}
+
+int scg_enable_pll_pfd(enum scg_clk clk, u32 frac)
+{
+       u32 reg;
+       u32 shift, mask, gate, valid;
+       u32 addr;
+
+       if (frac < 12 || frac > 35)
+               return -EINVAL;
+
+       switch (clk) {
+       case SCG_SPLL_PFD0_CLK:
+       case SCG_APLL_PFD0_CLK:
+               gate = SCG_PLL_PFD0_GATE_MASK;
+               valid = SCG_PLL_PFD0_VALID_MASK;
+               mask = SCG_PLL_PFD0_FRAC_MASK;
+               shift = SCG_PLL_PFD0_FRAC_SHIFT;
+
+               if (clk == SCG_SPLL_PFD0_CLK)
+                       addr = (u32)(&scg1_regs->spllpfd);
+               else
+                       addr = (u32)(&scg1_regs->apllpfd);
+               break;
+       case SCG_SPLL_PFD1_CLK:
+       case SCG_APLL_PFD1_CLK:
+               gate = SCG_PLL_PFD1_GATE_MASK;
+               valid = SCG_PLL_PFD1_VALID_MASK;
+               mask = SCG_PLL_PFD1_FRAC_MASK;
+               shift = SCG_PLL_PFD1_FRAC_SHIFT;
+
+               if (clk == SCG_SPLL_PFD1_CLK)
+                       addr = (u32)(&scg1_regs->spllpfd);
+               else
+                       addr = (u32)(&scg1_regs->apllpfd);
+               break;
+       case SCG_SPLL_PFD2_CLK:
+       case SCG_APLL_PFD2_CLK:
+               gate = SCG_PLL_PFD2_GATE_MASK;
+               valid = SCG_PLL_PFD2_VALID_MASK;
+               mask = SCG_PLL_PFD2_FRAC_MASK;
+               shift = SCG_PLL_PFD2_FRAC_SHIFT;
+
+               if (clk == SCG_SPLL_PFD2_CLK)
+                       addr = (u32)(&scg1_regs->spllpfd);
+               else
+                       addr = (u32)(&scg1_regs->apllpfd);
+               break;
+       case SCG_SPLL_PFD3_CLK:
+       case SCG_APLL_PFD3_CLK:
+               gate = SCG_PLL_PFD3_GATE_MASK;
+               valid = SCG_PLL_PFD3_VALID_MASK;
+               mask = SCG_PLL_PFD3_FRAC_MASK;
+               shift = SCG_PLL_PFD3_FRAC_SHIFT;
+
+               if (clk == SCG_SPLL_PFD3_CLK)
+                       addr = (u32)(&scg1_regs->spllpfd);
+               else
+                       addr = (u32)(&scg1_regs->apllpfd);
+               break;
+       default:
+               return -EINVAL;
+       }
+
+       /* Gate the PFD */
+       reg = readl(addr);
+       reg |= gate;
+       writel(reg, addr);
+
+       /* Write Frac divider */
+       reg &= ~mask;
+       reg |= (frac << shift) & mask;
+       writel(reg, addr);
+
+       /*
+        * Un-gate the PFD
+        * (Need un-gate before checking valid, not align with RM)
+        */
+       reg &= ~gate;
+       writel(reg, addr);
+
+       /* Wait for PFD clock being valid */
+       do {
+               reg = readl(addr);
+       } while (!(reg & valid));
+
+       return 0;
+}
+
+#define SIM_MISC_CTRL0_USB_PLL_EN_MASK (0x1 << 2)
+int scg_enable_usb_pll(bool usb_control)
+{
+       u32 sosc_rate;
+       s32 timeout = 1000000;
+       u32 reg;
+
+       struct usbphy_regs *usbphy =
+               (struct usbphy_regs *)USBPHY_RBASE;
+
+       sosc_rate = scg_src_get_rate(SCG_SOSC_CLK);
+       if (!sosc_rate)
+               return -EPERM;
+
+       reg = readl(SIM0_RBASE + 0x3C);
+       if (usb_control)
+               reg &= ~SIM_MISC_CTRL0_USB_PLL_EN_MASK;
+       else
+               reg |= SIM_MISC_CTRL0_USB_PLL_EN_MASK;
+       writel(reg, SIM0_RBASE + 0x3C);
+
+       if (!(readl(&usbphy->usb1_pll_480_ctrl) & PLL_USB_LOCK_MASK)) {
+               writel(0x1c00000, &usbphy->usb1_pll_480_ctrl_clr);
+
+               switch (sosc_rate) {
+               case 24000000:
+                       writel(0xc00000, &usbphy->usb1_pll_480_ctrl_set);
+                       break;
+
+               case 30000000:
+                       writel(0x800000, &usbphy->usb1_pll_480_ctrl_set);
+                       break;
+
+               case 19200000:
+                       writel(0x1400000, &usbphy->usb1_pll_480_ctrl_set);
+                       break;
+
+               default:
+                       writel(0xc00000, &usbphy->usb1_pll_480_ctrl_set);
+                       break;
+               }
+
+               /* Enable the regulator first */
+               writel(PLL_USB_REG_ENABLE_MASK,
+                      &usbphy->usb1_pll_480_ctrl_set);
+
+               /* Wait at least 15us */
+               udelay(15);
+
+               /* Enable the power */
+               writel(PLL_USB_PWR_MASK, &usbphy->usb1_pll_480_ctrl_set);
+
+               /* Wait lock */
+               while (timeout--) {
+                       if (readl(&usbphy->usb1_pll_480_ctrl) &
+                           PLL_USB_LOCK_MASK)
+                               break;
+               }
+
+               if (timeout <= 0) {
+                       /* If timeout, we power down the pll */
+                       writel(PLL_USB_PWR_MASK,
+                              &usbphy->usb1_pll_480_ctrl_clr);
+                       return -ETIME;
+               }
+       }
+
+       /* Clear the bypass */
+       writel(PLL_USB_BYPASS_MASK, &usbphy->usb1_pll_480_ctrl_clr);
+
+       /* Enable the PLL clock out to USB */
+       writel((PLL_USB_EN_USB_CLKS_MASK | PLL_USB_ENABLE_MASK),
+              &usbphy->usb1_pll_480_ctrl_set);
+
+       if (!usb_control) {
+               while (timeout--) {
+                       if (readl(&scg1_regs->upllcsr) &
+                           SCG_UPLL_CSR_UPLLVLD_MASK)
+                               break;
+               }
+
+               if (timeout <= 0) {
+                       reg = readl(SIM0_RBASE + 0x3C);
+                       reg &= ~SIM_MISC_CTRL0_USB_PLL_EN_MASK;
+                       writel(reg, SIM0_RBASE + 0x3C);
+                       return -ETIME;
+               }
+       }
+
+       return 0;
+}
+
+
+/* A7 domain system clock source is SPLL */
+#define SCG1_RCCR_SCS_NUM      ((SCG_SCS_SYS_PLL) << SCG_CCR_SCS_SHIFT)
+
+/* A7 Core clck = SPLL PFD0 / 1 = 500MHz / 1 = 500MHz */
+#define SCG1_RCCR_DIVCORE_NUM  ((0x0)  << SCG_CCR_DIVCORE_SHIFT)
+#define SCG1_RCCR_CFG_MASK     (SCG_CCR_SCS_MASK | SCG_CCR_DIVBUS_MASK)
+
+/* A7 Plat clck = A7 Core Clock / 2 = 250MHz / 1 = 250MHz */
+#define SCG1_RCCR_DIVBUS_NUM   ((0x1)  << SCG_CCR_DIVBUS_SHIFT)
+#define SCG1_RCCR_CFG_NUM      (SCG1_RCCR_SCS_NUM | SCG1_RCCR_DIVBUS_NUM)
+
+void scg_a7_rccr_init(void)
+{
+       u32 rccr_reg_val = 0;
+
+       rccr_reg_val = readl(&scg1_regs->rccr);
+
+       rccr_reg_val &= (~SCG1_RCCR_CFG_MASK);
+       rccr_reg_val |= (SCG1_RCCR_CFG_NUM);
+
+       writel(rccr_reg_val, &scg1_regs->rccr);
+}
+
+/* POSTDIV2 = 1 */
+#define SCG1_SPLL_CFG_POSTDIV2_NUM     ((0x0)  << SCG_PLL_CFG_POSTDIV2_SHIFT)
+/* POSTDIV1 = 1 */
+#define SCG1_SPLL_CFG_POSTDIV1_NUM     ((0x0)  << SCG_PLL_CFG_POSTDIV1_SHIFT)
+
+/* MULT = 22 */
+#define SCG1_SPLL_CFG_MULT_NUM         ((22)   << SCG_PLL_CFG_MULT_SHIFT)
+
+/* PFD0 output clock selected */
+#define SCG1_SPLL_CFG_PFDSEL_NUM       ((0) << SCG_PLL_CFG_PFDSEL_SHIFT)
+/* PREDIV = 1 */
+#define SCG1_SPLL_CFG_PREDIV_NUM       ((0x0)  << SCG_PLL_CFG_PREDIV_SHIFT)
+/* SPLL output clocks (including PFD outputs) selected */
+#define SCG1_SPLL_CFG_BYPASS_NUM       ((0x0)  << SCG_PLL_CFG_BYPASS_SHIFT)
+/* SPLL PFD output clock selected */
+#define SCG1_SPLL_CFG_PLLSEL_NUM       ((0x1)  << SCG_PLL_CFG_PLLSEL_SHIFT)
+/* Clock source is System OSC */
+#define SCG1_SPLL_CFG_CLKSRC_NUM       ((0x0)  << SCG_PLL_CFG_CLKSRC_SHIFT)
+#define SCG1_SPLL_CFG_NUM_24M_OSC      (SCG1_SPLL_CFG_POSTDIV2_NUM     | \
+                                        SCG1_SPLL_CFG_POSTDIV1_NUM     | \
+                                        (22 << SCG_PLL_CFG_MULT_SHIFT) | \
+                                        SCG1_SPLL_CFG_PFDSEL_NUM       | \
+                                        SCG1_SPLL_CFG_PREDIV_NUM       | \
+                                        SCG1_SPLL_CFG_BYPASS_NUM       | \
+                                        SCG1_SPLL_CFG_PLLSEL_NUM       | \
+                                        SCG1_SPLL_CFG_CLKSRC_NUM)
+/*413Mhz = A7 SPLL(528MHz) * 18/23 */
+#define SCG1_SPLL_PFD0_FRAC_NUM                ((23) << SCG_PLL_PFD0_FRAC_SHIFT)
+
+void scg_a7_spll_init(void)
+{
+       u32 val = 0;
+
+       /* Disable A7 System PLL */
+       val = readl(&scg1_regs->spllcsr);
+       val &= ~SCG_SPLL_CSR_SPLLEN_MASK;
+       writel(val, &scg1_regs->spllcsr);
+
+       /*
+        * Per block guide,
+        * "When changing PFD values, it is recommneded PFDx clock
+        * gets gated first by writing a value of 1 to PFDx_CLKGATE register,
+        * then program the new PFD value, then poll the PFDx_VALID
+        * flag to set before writing a value of 0 to PFDx_CLKGATE
+        * to ungate the PFDx clock and allow PFDx clock to run"
+        */
+
+       /* Gate off A7 SPLL PFD0 ~ PDF4  */
+       val = readl(&scg1_regs->spllpfd);
+       val |= (SCG_PLL_PFD3_GATE_MASK |
+                       SCG_PLL_PFD2_GATE_MASK |
+                       SCG_PLL_PFD1_GATE_MASK |
+                       SCG_PLL_PFD0_GATE_MASK);
+       writel(val, &scg1_regs->spllpfd);
+
+       /* ================ A7 SPLL Configuration Start ============== */
+
+       /* Configure A7 System PLL */
+       writel(SCG1_SPLL_CFG_NUM_24M_OSC, &scg1_regs->spllcfg);
+
+       /* Enable A7 System PLL */
+       val = readl(&scg1_regs->spllcsr);
+       val |= SCG_SPLL_CSR_SPLLEN_MASK;
+       writel(val, &scg1_regs->spllcsr);
+
+       /* Wait for A7 SPLL clock ready */
+       while (!(readl(&scg1_regs->spllcsr) & SCG_SPLL_CSR_SPLLVLD_MASK))
+               ;
+
+       /* Configure A7 SPLL PFD0 */
+       val = readl(&scg1_regs->spllpfd);
+       val &= ~SCG_PLL_PFD0_FRAC_MASK;
+       val |= SCG1_SPLL_PFD0_FRAC_NUM;
+       writel(val, &scg1_regs->spllpfd);
+
+       /* Un-gate A7 SPLL PFD0 */
+       val = readl(&scg1_regs->spllpfd);
+       val &= ~SCG_PLL_PFD0_GATE_MASK;
+       writel(val, &scg1_regs->spllpfd);
+
+       /* Wait for A7 SPLL PFD0 clock being valid */
+       while (!(readl(&scg1_regs->spllpfd) & SCG_PLL_PFD0_VALID_MASK))
+               ;
+
+       /* ================ A7 SPLL Configuration End ============== */
+}
+
+/* DDR clock source is APLL PFD0 (396MHz) */
+#define SCG1_DDRCCR_DDRCS_NUM          ((0x0) << SCG_DDRCCR_DDRCS_SHIFT)
+/* DDR clock = APLL PFD0 / 1 = 396MHz / 1 = 396MHz */
+#define SCG1_DDRCCR_DDRDIV_NUM         ((0x1) << SCG_DDRCCR_DDRDIV_SHIFT)
+/* DDR clock = APLL PFD0 / 2 = 396MHz / 2 = 198MHz */
+#define SCG1_DDRCCR_DDRDIV_LF_NUM      ((0x2) << SCG_DDRCCR_DDRDIV_SHIFT)
+#define SCG1_DDRCCR_CFG_NUM            (SCG1_DDRCCR_DDRCS_NUM  | \
+                                        SCG1_DDRCCR_DDRDIV_NUM)
+#define SCG1_DDRCCR_CFG_LF_NUM         (SCG1_DDRCCR_DDRCS_NUM  | \
+                                        SCG1_DDRCCR_DDRDIV_LF_NUM)
+void scg_a7_ddrclk_init(void)
+{
+       writel(SCG1_DDRCCR_CFG_NUM, &scg1_regs->ddrccr);
+}
+
+/* SCG1(A7) APLLCFG configurations */
+/* divide by 1 <<28 */
+#define SCG1_APLL_CFG_POSTDIV2_NUM      ((0x0) << SCG_PLL_CFG_POSTDIV2_SHIFT)
+/* divide by 1 <<24 */
+#define SCG1_APLL_CFG_POSTDIV1_NUM      ((0x0) << SCG_PLL_CFG_POSTDIV1_SHIFT)
+/* MULT is 22  <<16 */
+#define SCG1_APLL_CFG_MULT_NUM          ((22)  << SCG_PLL_CFG_MULT_SHIFT)
+/* PFD0 output clock selected  <<14 */
+#define SCG1_APLL_CFG_PFDSEL_NUM        ((0) << SCG_PLL_CFG_PFDSEL_SHIFT)
+/* PREDIV = 1  <<8 */
+#define SCG1_APLL_CFG_PREDIV_NUM        ((0x0) << SCG_PLL_CFG_PREDIV_SHIFT)
+/* APLL output clocks (including PFD outputs) selected <<2 */
+#define SCG1_APLL_CFG_BYPASS_NUM        ((0x0) << SCG_PLL_CFG_BYPASS_SHIFT)
+/* APLL PFD output clock selected <<1 */
+#define SCG1_APLL_CFG_PLLSEL_NUM        ((0x0) << SCG_PLL_CFG_PLLSEL_SHIFT)
+/* Clock source is System OSC <<0 */
+#define SCG1_APLL_CFG_CLKSRC_NUM        ((0x0) << SCG_PLL_CFG_CLKSRC_SHIFT)
+
+/*
+ * A7 APLL = 24MHz / 1 * 22 / 1 / 1 = 528MHz,
+ * system PLL is sourced from APLL,
+ * APLL clock source is system OSC (24MHz)
+ */
+#define SCG1_APLL_CFG_NUM_24M_OSC (SCG1_APLL_CFG_POSTDIV2_NUM     |   \
+                                  SCG1_APLL_CFG_POSTDIV1_NUM     |   \
+                                  (22 << SCG_PLL_CFG_MULT_SHIFT) |   \
+                                  SCG1_APLL_CFG_PFDSEL_NUM       |   \
+                                  SCG1_APLL_CFG_PREDIV_NUM       |   \
+                                  SCG1_APLL_CFG_BYPASS_NUM       |   \
+                                  SCG1_APLL_CFG_PLLSEL_NUM       |   \
+                                  SCG1_APLL_CFG_CLKSRC_NUM)
+
+/* PFD0 Freq = A7 APLL(528MHz) * 18 / 27 = 352MHz */
+#define SCG1_APLL_PFD0_FRAC_NUM (27)
+
+
+void scg_a7_apll_init(void)
+{
+       u32 val = 0;
+
+       /* Disable A7 Auxiliary PLL */
+       val = readl(&scg1_regs->apllcsr);
+       val &= ~SCG_APLL_CSR_APLLEN_MASK;
+       writel(val, &scg1_regs->apllcsr);
+
+       /* Gate off A7 APLL PFD0 ~ PDF4  */
+       val = readl(&scg1_regs->apllpfd);
+       val |= 0x80808080;
+       writel(val, &scg1_regs->apllpfd);
+
+       /* ================ A7 APLL Configuration Start ============== */
+       /* Configure A7 Auxiliary PLL */
+       writel(SCG1_APLL_CFG_NUM_24M_OSC, &scg1_regs->apllcfg);
+
+       /* Enable A7 Auxiliary PLL */
+       val = readl(&scg1_regs->apllcsr);
+       val |= SCG_APLL_CSR_APLLEN_MASK;
+       writel(val, &scg1_regs->apllcsr);
+
+       /* Wait for A7 APLL clock ready */
+       while (!(readl(&scg1_regs->apllcsr) & SCG_APLL_CSR_APLLVLD_MASK))
+               ;
+
+       /* Configure A7 APLL PFD0 */
+       val = readl(&scg1_regs->apllpfd);
+       val &= ~SCG_PLL_PFD0_FRAC_MASK;
+       val |= SCG1_APLL_PFD0_FRAC_NUM;
+       writel(val, &scg1_regs->apllpfd);
+
+       /* Un-gate A7 APLL PFD0 */
+       val = readl(&scg1_regs->apllpfd);
+       val &= ~SCG_PLL_PFD0_GATE_MASK;
+       writel(val, &scg1_regs->apllpfd);
+
+       /* Wait for A7 APLL PFD0 clock being valid */
+       while (!(readl(&scg1_regs->apllpfd) & SCG_PLL_PFD0_VALID_MASK))
+               ;
+}
+
+/* SCG1(A7) FIRC DIV configurations */
+/* Disable FIRC DIV3 */
+#define SCG1_FIRCDIV_DIV3_NUM           ((0x0) << SCG_FIRCDIV_DIV3_SHIFT)
+/* FIRC DIV2 = 48MHz / 1 = 48MHz */
+#define SCG1_FIRCDIV_DIV2_NUM           ((0x1) << SCG_FIRCDIV_DIV2_SHIFT)
+/* Disable FIRC DIV1 */
+#define SCG1_FIRCDIV_DIV1_NUM           ((0x0) << SCG_FIRCDIV_DIV1_SHIFT)
+
+void scg_a7_firc_init(void)
+{
+       /* Wait for FIRC clock ready */
+       while (!(readl(&scg1_regs->firccsr) & SCG_FIRC_CSR_FIRCVLD_MASK))
+               ;
+
+       /* Configure A7 FIRC DIV1 ~ DIV3 */
+       writel((SCG1_FIRCDIV_DIV3_NUM |
+                       SCG1_FIRCDIV_DIV2_NUM |
+                       SCG1_FIRCDIV_DIV1_NUM), &scg1_regs->fircdiv);
+}
+
+/* SCG1(A7) NICCCR configurations */
+/* NIC clock source is DDR clock (396/198MHz) */
+#define SCG1_NICCCR_NICCS_NUM          ((0x1) << SCG_NICCCR_NICCS_SHIFT)
+
+/* NIC0 clock = DDR Clock / 2 = 396MHz / 2 = 198MHz */
+#define SCG1_NICCCR_NIC0_DIV_NUM       ((0x1) << SCG_NICCCR_NIC0_DIV_SHIFT)
+/* NIC0 clock = DDR Clock / 1 = 198MHz / 1 = 198MHz */
+#define SCG1_NICCCR_NIC0_DIV_LF_NUM    ((0x0) << SCG_NICCCR_NIC0_DIV_SHIFT)
+/* NIC1 clock = NIC0 Clock / 1 = 198MHz / 2 = 198MHz */
+#define SCG1_NICCCR_NIC1_DIV_NUM       ((0x0) << SCG_NICCCR_NIC1_DIV_SHIFT)
+/* NIC1 bus clock = NIC1 Clock / 3 = 198MHz / 3 = 66MHz */
+#define SCG1_NICCCR_NIC1_DIVBUS_NUM    ((0x2) << SCG_NICCCR_NIC1_DIVBUS_SHIFT)
+#define SCG1_NICCCR_CFG_NUM            (SCG1_NICCCR_NICCS_NUM      | \
+                                        SCG1_NICCCR_NIC0_DIV_NUM   | \
+                                        SCG1_NICCCR_NIC1_DIV_NUM   | \
+                                        SCG1_NICCCR_NIC1_DIVBUS_NUM)
+
+void scg_a7_nicclk_init(void)
+{
+       writel(SCG1_NICCCR_CFG_NUM, &scg1_regs->nicccr);
+}
+
+/* SCG1(A7) FIRC DIV configurations */
+/* Enable FIRC DIV3 */
+#define SCG1_SOSCDIV_DIV3_NUM          ((0x1) << SCG_SOSCDIV_DIV3_SHIFT)
+/* FIRC DIV2 = 48MHz / 1 = 48MHz */
+#define SCG1_SOSCDIV_DIV2_NUM          ((0x1) << SCG_SOSCDIV_DIV2_SHIFT)
+/* Enable FIRC DIV1 */
+#define SCG1_SOSCDIV_DIV1_NUM          ((0x1) << SCG_SOSCDIV_DIV1_SHIFT)
+
+void scg_a7_soscdiv_init(void)
+{
+       /* Wait for FIRC clock ready */
+       while (!(readl(&scg1_regs->sosccsr) & SCG_SOSC_CSR_SOSCVLD_MASK))
+               ;
+
+       /* Configure A7 FIRC DIV1 ~ DIV3 */
+       writel((SCG1_SOSCDIV_DIV3_NUM | SCG1_SOSCDIV_DIV2_NUM |
+              SCG1_SOSCDIV_DIV1_NUM), &scg1_regs->soscdiv);
+}
+
+void scg_a7_sys_clk_sel(enum scg_sys_src clk)
+{
+       u32 rccr_reg_val = 0;
+
+       clk_debug("%s: system clock selected as %s\n", "[SCG]",
+                 clk == SCG_SCS_SYS_OSC ? "SYS_OSC" :
+                 clk == SCG_SCS_SLOW_IRC  ? "SLOW_IRC" :
+                 clk == SCG_SCS_FAST_IRC  ? "FAST_IRC" :
+                 clk == SCG_SCS_RTC_OSC   ? "RTC_OSC" :
+                 clk == SCG_SCS_AUX_PLL   ? "AUX_PLL" :
+                 clk == SCG_SCS_SYS_PLL   ? "SYS_PLL" :
+                 clk == SCG_SCS_USBPHY_PLL ? "USBPHY_PLL" :
+                 "Invalid source"
+       );
+
+       rccr_reg_val = readl(&scg1_regs->rccr);
+       rccr_reg_val &= ~SCG_CCR_SCS_MASK;
+       rccr_reg_val |= (clk << SCG_CCR_SCS_SHIFT);
+       writel(rccr_reg_val, &scg1_regs->rccr);
+}
+
+void scg_a7_info(void)
+{
+       debug("SCG Version: 0x%x\n", readl(&scg1_regs->verid));
+       debug("SCG Parameter: 0x%x\n", readl(&scg1_regs->param));
+       debug("SCG RCCR Value: 0x%x\n", readl(&scg1_regs->rccr));
+       debug("SCG Clock Status: 0x%x\n", readl(&scg1_regs->csr));
+}
diff --git a/arch/arm/include/asm/arch-mx7ulp/clock.h b/arch/arm/include/asm/arch-mx7ulp/clock.h
new file mode 100644 (file)
index 0000000..f21052e
--- /dev/null
@@ -0,0 +1,38 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#ifndef _ASM_ARCH_CLOCK_H
+#define _ASM_ARCH_CLOCK_H
+
+#include <common.h>
+#include <asm/arch/pcc.h>
+#include <asm/arch/scg.h>
+
+/* Mainly for compatible to imx common code. */
+enum mxc_clock {
+       MXC_ARM_CLK = 0,
+       MXC_AHB_CLK,
+       MXC_IPG_CLK,
+       MXC_UART_CLK,
+       MXC_CSPI_CLK,
+       MXC_AXI_CLK,
+       MXC_DDR_CLK,
+       MXC_ESDHC_CLK,
+       MXC_ESDHC2_CLK,
+       MXC_I2C_CLK,
+};
+
+u32 mxc_get_clock(enum mxc_clock clk);
+u32 get_lpuart_clk(void);
+#ifdef CONFIG_MXC_OCOTP
+void enable_ocotp_clk(unsigned char enable);
+#endif
+#ifdef CONFIG_USB_EHCI
+void enable_usboh3_clk(unsigned char enable);
+#endif
+void init_clk_usdhc(u32 index);
+void clock_init(void);
+#endif
diff --git a/arch/arm/include/asm/arch-mx7ulp/pcc.h b/arch/arm/include/asm/arch-mx7ulp/pcc.h
new file mode 100644 (file)
index 0000000..8a57175
--- /dev/null
@@ -0,0 +1,373 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#ifndef _ASM_ARCH_PCC_H
+#define _ASM_ARCH_PCC_H
+
+#include <common.h>
+#include <asm/arch/scg.h>
+
+/* PCC2 */
+
+enum pcc2_entry {
+       /* On-Platform (32 entries) */
+       RSVD0_PCC2_SLOT                 = 0,
+       RSVD1_PCC2_SLOT                 = 1,
+       CA7_GIC_PCC2_SLOT               = 2,
+       RSVD3_PCC2_SLOT                 = 3,
+       RSVD4_PCC2_SLOT                 = 4,
+       RSVD5_PCC2_SLOT                 = 5,
+       RSVD6_PCC2_SLOT                 = 6,
+       RSVD7_PCC2_SLOT                 = 7,
+       DMA1_PCC2_SLOT                  = 8,
+       RSVD9_PCC2_SLOT                 = 9,
+       RSVD10_PCC2_SLOT                = 10,
+       RSVD11_PCC2_SLOT                = 11,
+       RSVD12_PCC2_SLOT                = 12,
+       RSVD13_PCC2_SLOT                = 13,
+       RSVD14_PCC2_SLOT                = 14,
+       RGPIO1_PCC2_SLOT                = 15,
+       FLEXBUS0_PCC2_SLOT              = 16,
+       RSVD17_PCC2_SLOT                = 17,
+       RSVD18_PCC2_SLOT                = 18,
+       RSVD19_PCC2_SLOT                = 19,
+       RSVD20_PCC2_SLOT                = 20,
+       RSVD21_PCC2_SLOT                = 21,
+       RSVD22_PCC2_SLOT                = 22,
+       RSVD23_PCC2_SLOT                = 23,
+       RSVD24_PCC2_SLOT                = 24,
+       RSVD25_PCC2_SLOT                = 25,
+       RSVD26_PCC2_SLOT                = 26,
+       SEMA42_1_PCC2_SLOT              = 27,
+       RSVD28_PCC2_SLOT                = 28,
+       RSVD29_PCC2_SLOT                = 29,
+       RSVD30_PCC2_SLOT                = 30,
+       RSVD31_PCC2_SLOT                = 31,
+
+       /* Off-Platform (96 entries) */
+       RSVD32_PCC2_SLOT                = 32,
+       DMA1_CH_MUX0_PCC2_SLOT          = 33,
+       MU_B_PCC2_SLOT                  = 34,
+       SNVS_PCC2_SLOT                  = 35,
+       CAAM_PCC2_SLOT                  = 36,
+       LPTPM4_PCC2_SLOT                = 37,
+       LPTPM5_PCC2_SLOT                = 38,
+       LPIT1_PCC2_SLOT                 = 39,
+       RSVD40_PCC2_SLOT                = 40,
+       LPSPI2_PCC2_SLOT                = 41,
+       LPSPI3_PCC2_SLOT                = 42,
+       LPI2C4_PCC2_SLOT                = 43,
+       LPI2C5_PCC2_SLOT                = 44,
+       LPUART4_PCC2_SLOT               = 45,
+       LPUART5_PCC2_SLOT               = 46,
+       RSVD47_PCC2_SLOT                = 47,
+       RSVD48_PCC2_SLOT                = 48,
+       FLEXIO1_PCC2_SLOT               = 49,
+       RSVD50_PCC2_SLOT                = 50,
+       USBOTG0_PCC2_SLOT               = 51,
+       USBOTG1_PCC2_SLOT               = 52,
+       USBPHY_PCC2_SLOT                = 53,
+       USB_PL301_PCC2_SLOT             = 54,
+       USDHC0_PCC2_SLOT                = 55,
+       USDHC1_PCC2_SLOT                = 56,
+       RSVD57_PCC2_SLOT                = 57,
+       TRGMUX1_PCC2_SLOT               = 58,
+       RSVD59_PCC2_SLOT                = 59,
+       RSVD60_PCC2_SLOT                = 60,
+       WDG1_PCC2_SLOT                  = 61,
+       SCG1_PCC2_SLOT                  = 62,
+       PCC2_PCC2_SLOT                  = 63,
+       PMC1_PCC2_SLOT                  = 64,
+       SMC1_PCC2_SLOT                  = 65,
+       RCM1_PCC2_SLOT                  = 66,
+       WDG2_PCC2_SLOT                  = 67,
+       RSVD68_PCC2_SLOT                = 68,
+       TEST_SPACE1_PCC2_SLOT           = 69,
+       TEST_SPACE2_PCC2_SLOT           = 70,
+       TEST_SPACE3_PCC2_SLOT           = 71,
+       RSVD72_PCC2_SLOT                = 72,
+       RSVD73_PCC2_SLOT                = 73,
+       RSVD74_PCC2_SLOT                = 74,
+       RSVD75_PCC2_SLOT                = 75,
+       RSVD76_PCC2_SLOT                = 76,
+       RSVD77_PCC2_SLOT                = 77,
+       RSVD78_PCC2_SLOT                = 78,
+       RSVD79_PCC2_SLOT                = 79,
+       RSVD80_PCC2_SLOT                = 80,
+       RSVD81_PCC2_SLOT                = 81,
+       RSVD82_PCC2_SLOT                = 82,
+       RSVD83_PCC2_SLOT                = 83,
+       RSVD84_PCC2_SLOT                = 84,
+       RSVD85_PCC2_SLOT                = 85,
+       RSVD86_PCC2_SLOT                = 86,
+       RSVD87_PCC2_SLOT                = 87,
+       RSVD88_PCC2_SLOT                = 88,
+       RSVD89_PCC2_SLOT                = 89,
+       RSVD90_PCC2_SLOT                = 90,
+       RSVD91_PCC2_SLOT                = 91,
+       RSVD92_PCC2_SLOT                = 92,
+       RSVD93_PCC2_SLOT                = 93,
+       RSVD94_PCC2_SLOT                = 94,
+       RSVD95_PCC2_SLOT                = 95,
+       RSVD96_PCC2_SLOT                = 96,
+       RSVD97_PCC2_SLOT                = 97,
+       RSVD98_PCC2_SLOT                = 98,
+       RSVD99_PCC2_SLOT                = 99,
+       RSVD100_PCC2_SLOT               = 100,
+       RSVD101_PCC2_SLOT               = 101,
+       RSVD102_PCC2_SLOT               = 102,
+       RSVD103_PCC2_SLOT               = 103,
+       RSVD104_PCC2_SLOT               = 104,
+       RSVD105_PCC2_SLOT               = 105,
+       RSVD106_PCC2_SLOT               = 106,
+       RSVD107_PCC2_SLOT               = 107,
+       RSVD108_PCC2_SLOT               = 108,
+       RSVD109_PCC2_SLOT               = 109,
+       RSVD110_PCC2_SLOT               = 110,
+       RSVD111_PCC2_SLOT               = 111,
+       RSVD112_PCC2_SLOT               = 112,
+       RSVD113_PCC2_SLOT               = 113,
+       RSVD114_PCC2_SLOT               = 114,
+       RSVD115_PCC2_SLOT               = 115,
+       RSVD116_PCC2_SLOT               = 116,
+       RSVD117_PCC2_SLOT               = 117,
+       RSVD118_PCC2_SLOT               = 118,
+       RSVD119_PCC2_SLOT               = 119,
+       RSVD120_PCC2_SLOT               = 120,
+       RSVD121_PCC2_SLOT               = 121,
+       RSVD122_PCC2_SLOT               = 122,
+       RSVD123_PCC2_SLOT               = 123,
+       RSVD124_PCC2_SLOT               = 124,
+       RSVD125_PCC2_SLOT               = 125,
+       RSVD126_PCC2_SLOT               = 126,
+       RSVD127_PCC2_SLOT               = 127,
+};
+
+enum pcc3_entry {
+       /* On-Platform (32 entries) */
+       RSVD0_PCC3_SLOT                 = 0,
+       RSVD1_PCC3_SLOT                 = 1,
+       RSVD2_PCC3_SLOT                 = 2,
+       RSVD3_PCC3_SLOT                 = 3,
+       RSVD4_PCC3_SLOT                 = 4,
+       RSVD5_PCC3_SLOT                 = 5,
+       RSVD6_PCC3_SLOT                 = 6,
+       RSVD7_PCC3_SLOT                 = 7,
+       RSVD8_PCC3_SLOT                 = 8,
+       RSVD9_PCC3_SLOT                 = 9,
+       RSVD10_PCC3_SLOT                = 10,
+       RSVD11_PCC3_SLOT                = 11,
+       RSVD12_PCC3_SLOT                = 12,
+       RSVD13_PCC3_SLOT                = 13,
+       RSVD14_PCC3_SLOT                = 14,
+       RSVD15_PCC3_SLOT                = 15,
+       ROMCP1_PCC3_SLOT                = 16,
+       RSVD17_PCC3_SLOT                = 17,
+       RSVD18_PCC3_SLOT                = 18,
+       RSVD19_PCC3_SLOT                = 19,
+       RSVD20_PCC3_SLOT                = 20,
+       RSVD21_PCC3_SLOT                = 21,
+       RSVD22_PCC3_SLOT                = 22,
+       RSVD23_PCC3_SLOT                = 23,
+       RSVD24_PCC3_SLOT                = 24,
+       RSVD25_PCC3_SLOT                = 25,
+       RSVD26_PCC3_SLOT                = 26,
+       RSVD27_PCC3_SLOT                = 27,
+       RSVD28_PCC3_SLOT                = 28,
+       RSVD29_PCC3_SLOT                = 29,
+       RSVD30_PCC3_SLOT                = 30,
+       RSVD31_PCC3_SLOT                = 31,
+
+       /* Off-Platform (96 entries) */
+       RSVD32_PCC3_SLOT                = 32,
+       LPTPM6_PCC3_SLOT                = 33,
+       LPTPM7_PCC3_SLOT                = 34,
+       RSVD35_PCC3_SLOT                = 35,
+       LPI2C6_PCC3_SLOT                = 36,
+       LPI2C7_PCC3_SLOT                = 37,
+       LPUART6_PCC3_SLOT               = 38,
+       LPUART7_PCC3_SLOT               = 39,
+       VIU0_PCC3_SLOT                  = 40,
+       DSI0_PCC3_SLOT                  = 41,
+       LCDIF0_PCC3_SLOT                = 42,
+       MMDC0_PCC3_SLOT                 = 43,
+       IOMUXC1_PCC3_SLOT               = 44,
+       IOMUXC_DDR_PCC3_SLOT            = 45,
+       PORTC_PCC3_SLOT                 = 46,
+       PORTD_PCC3_SLOT                 = 47,
+       PORTE_PCC3_SLOT                 = 48,
+       PORTF_PCC3_SLOT                 = 49,
+       RSVD50_PCC3_SLOT                = 50,
+       PCC3_PCC3_SLOT                  = 51,
+       RSVD52_PCC3_SLOT                = 52,
+       WKPU_PCC3_SLOT                  = 53,
+       RSVD54_PCC3_SLOT                = 54,
+       RSVD55_PCC3_SLOT                = 55,
+       RSVD56_PCC3_SLOT                = 56,
+       RSVD57_PCC3_SLOT                = 57,
+       RSVD58_PCC3_SLOT                = 58,
+       RSVD59_PCC3_SLOT                = 59,
+       RSVD60_PCC3_SLOT                = 60,
+       RSVD61_PCC3_SLOT                = 61,
+       RSVD62_PCC3_SLOT                = 62,
+       RSVD63_PCC3_SLOT                = 63,
+       RSVD64_PCC3_SLOT                = 64,
+       RSVD65_PCC3_SLOT                = 65,
+       RSVD66_PCC3_SLOT                = 66,
+       RSVD67_PCC3_SLOT                = 67,
+       RSVD68_PCC3_SLOT                = 68,
+       RSVD69_PCC3_SLOT                = 69,
+       RSVD70_PCC3_SLOT                = 70,
+       RSVD71_PCC3_SLOT                = 71,
+       RSVD72_PCC3_SLOT                = 72,
+       RSVD73_PCC3_SLOT                = 73,
+       RSVD74_PCC3_SLOT                = 74,
+       RSVD75_PCC3_SLOT                = 75,
+       RSVD76_PCC3_SLOT                = 76,
+       RSVD77_PCC3_SLOT                = 77,
+       RSVD78_PCC3_SLOT                = 78,
+       RSVD79_PCC3_SLOT                = 79,
+       RSVD80_PCC3_SLOT                = 80,
+       GPU3D_PCC3_SLOT                 = 81,
+       GPU2D_PCC3_SLOT                 = 82,
+       RSVD83_PCC3_SLOT                = 83,
+       RSVD84_PCC3_SLOT                = 84,
+       RSVD85_PCC3_SLOT                = 85,
+       RSVD86_PCC3_SLOT                = 86,
+       RSVD87_PCC3_SLOT                = 87,
+       RSVD88_PCC3_SLOT                = 88,
+       RSVD89_PCC3_SLOT                = 89,
+       RSVD90_PCC3_SLOT                = 90,
+       RSVD91_PCC3_SLOT                = 91,
+       RSVD92_PCC3_SLOT                = 92,
+       RSVD93_PCC3_SLOT                = 93,
+       RSVD94_PCC3_SLOT                = 94,
+       RSVD95_PCC3_SLOT                = 95,
+       RSVD96_PCC3_SLOT                = 96,
+       RSVD97_PCC3_SLOT                = 97,
+       RSVD98_PCC3_SLOT                = 98,
+       RSVD99_PCC3_SLOT                = 99,
+       RSVD100_PCC3_SLOT               = 100,
+       RSVD101_PCC3_SLOT               = 101,
+       RSVD102_PCC3_SLOT               = 102,
+       RSVD103_PCC3_SLOT               = 103,
+       RSVD104_PCC3_SLOT               = 104,
+       RSVD105_PCC3_SLOT               = 105,
+       RSVD106_PCC3_SLOT               = 106,
+       RSVD107_PCC3_SLOT               = 107,
+       RSVD108_PCC3_SLOT               = 108,
+       RSVD109_PCC3_SLOT               = 109,
+       RSVD110_PCC3_SLOT               = 110,
+       RSVD111_PCC3_SLOT               = 111,
+       RSVD112_PCC3_SLOT               = 112,
+       RSVD113_PCC3_SLOT               = 113,
+       RSVD114_PCC3_SLOT               = 114,
+       RSVD115_PCC3_SLOT               = 115,
+       RSVD116_PCC3_SLOT               = 116,
+       RSVD117_PCC3_SLOT               = 117,
+       RSVD118_PCC3_SLOT               = 118,
+       RSVD119_PCC3_SLOT               = 119,
+       RSVD120_PCC3_SLOT               = 120,
+       RSVD121_PCC3_SLOT               = 121,
+       RSVD122_PCC3_SLOT               = 122,
+       RSVD123_PCC3_SLOT               = 123,
+       RSVD124_PCC3_SLOT               = 124,
+       RSVD125_PCC3_SLOT               = 125,
+       RSVD126_PCC3_SLOT               = 126,
+       RSVD127_PCC3_SLOT               = 127,
+};
+
+
+/* PCC registers */
+#define PCC_PR_OFFSET  31
+#define PCC_PR_MASK            (0x1 << PCC_PR_OFFSET)
+#define PCC_CGC_OFFSET 30
+#define PCC_CGC_MASK   (0x1 << PCC_CGC_OFFSET)
+#define PCC_INUSE_OFFSET       29
+#define PCC_INUSE_MASK         (0x1 << PCC_INUSE_OFFSET)
+#define PCC_PCS_OFFSET 24
+#define PCC_PCS_MASK   (0x7 << PCC_PCS_OFFSET)
+#define PCC_FRAC_OFFSET        4
+#define PCC_FRAC_MASK  (0x1 << PCC_FRAC_OFFSET)
+#define PCC_PCD_OFFSET 0
+#define PCC_PCD_MASK   (0xf << PCC_PCD_OFFSET)
+
+
+enum pcc_clksrc_type {
+       CLKSRC_PER_PLAT = 0,
+       CLKSRC_PER_BUS = 1,
+       CLKSRC_NO_PCS = 2,
+};
+
+enum pcc_div_type {
+       PCC_HAS_DIV,
+       PCC_NO_DIV,
+};
+
+/* All peripheral clocks on A7 PCCs */
+enum pcc_clk {
+       /*PCC2 clocks*/
+       PER_CLK_DMA1 = 0,
+       PER_CLK_RGPIO2P1,
+       PER_CLK_FLEXBUS,
+       PER_CLK_SEMA42_1,
+       PER_CLK_DMA_MUX1,
+       PER_CLK_SNVS,
+       PER_CLK_CAAM,
+       PER_CLK_LPTPM4,
+       PER_CLK_LPTPM5,
+       PER_CLK_LPIT1,
+       PER_CLK_LPSPI2,
+       PER_CLK_LPSPI3,
+       PER_CLK_LPI2C4,
+       PER_CLK_LPI2C5,
+       PER_CLK_LPUART4,
+       PER_CLK_LPUART5,
+       PER_CLK_FLEXIO1,
+       PER_CLK_USB0,
+       PER_CLK_USB1,
+       PER_CLK_USB_PHY,
+       PER_CLK_USB_PL301,
+       PER_CLK_USDHC0,
+       PER_CLK_USDHC1,
+       PER_CLK_WDG1,
+       PER_CLK_WDG2,
+
+       /*PCC3 clocks*/
+       PER_CLK_LPTPM6,
+       PER_CLK_LPTPM7,
+       PER_CLK_LPI2C6,
+       PER_CLK_LPI2C7,
+       PER_CLK_LPUART6,
+       PER_CLK_LPUART7,
+       PER_CLK_VIU,
+       PER_CLK_DSI,
+       PER_CLK_LCDIF,
+       PER_CLK_MMDC,
+       PER_CLK_PCTLC,
+       PER_CLK_PCTLD,
+       PER_CLK_PCTLE,
+       PER_CLK_PCTLF,
+       PER_CLK_GPU3D,
+       PER_CLK_GPU2D,
+};
+
+
+/* This structure keeps info for each pcc slot */
+struct pcc_entry {
+       u32 pcc_base;
+       u32 pcc_slot;
+       enum pcc_clksrc_type clksrc;
+       enum pcc_div_type div;
+};
+
+int pcc_clock_enable(enum pcc_clk clk, bool enable);
+int pcc_clock_sel(enum pcc_clk clk, enum scg_clk src);
+int pcc_clock_div_config(enum pcc_clk clk, bool frac, u8 div);
+bool pcc_clock_is_enable(enum pcc_clk clk);
+int pcc_clock_get_clksrc(enum pcc_clk clk, enum scg_clk *src);
+u32 pcc_clock_get_rate(enum pcc_clk clk);
+#endif
diff --git a/arch/arm/include/asm/arch-mx7ulp/scg.h b/arch/arm/include/asm/arch-mx7ulp/scg.h
new file mode 100644 (file)
index 0000000..06a6e9f
--- /dev/null
@@ -0,0 +1,342 @@
+/*
+ * Copyright (C) 2016 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#ifndef _ASM_ARCH_SCG_H
+#define _ASM_ARCH_SCG_H
+
+#include <common.h>
+
+#ifdef CONFIG_CLK_DEBUG
+#define clk_debug(fmt, args...)        printf(fmt, ##args)
+#else
+#define clk_debug(fmt, args...)
+#endif
+
+#define SCG_CCR_SCS_SHIFT              (24)
+#define SCG_CCR_SCS_MASK               ((0xFUL) << SCG_CCR_SCS_SHIFT)
+#define SCG_CCR_DIVCORE_SHIFT          (16)
+#define SCG_CCR_DIVCORE_MASK           ((0xFUL) << SCG_CCR_DIVCORE_SHIFT)
+#define SCG_CCR_DIVPLAT_SHIFT          (12)
+#define SCG_CCR_DIVPLAT_MASK           ((0xFUL) << SCG_CCR_DIVPLAT_SHIFT)
+#define SCG_CCR_DIVEXT_SHIFT           (8)
+#define SCG_CCR_DIVEXT_MASK            ((0xFUL) << SCG_CCR_DIVEXT_SHIFT)
+#define SCG_CCR_DIVBUS_SHIFT           (4)
+#define SCG_CCR_DIVBUS_MASK            ((0xFUL) << SCG_CCR_DIVBUS_SHIFT)
+#define SCG_CCR_DIVSLOW_SHIFT          (0)
+#define SCG_CCR_DIVSLOW_MASK           ((0xFUL) << SCG_CCR_DIVSLOW_SHIFT)
+
+/* SCG DDR Clock Control Register */
+#define SCG_DDRCCR_DDRCS_SHIFT         (24)
+#define SCG_DDRCCR_DDRCS_MASK          ((0x1UL) << SCG_DDRCCR_DDRCS_SHIFT)
+
+#define SCG_DDRCCR_DDRDIV_SHIFT                (0)
+#define SCG_DDRCCR_DDRDIV_MASK         ((0x7UL) << SCG_DDRCCR_DDRDIV_SHIFT)
+
+/* SCG NIC Clock Control Register */
+#define SCG_NICCCR_NICCS_SHIFT         (28)
+#define SCG_NICCCR_NICCS_MASK          ((0x1UL) << SCG_NICCCR_NICCS_SHIFT)
+
+#define SCG_NICCCR_NIC0_DIV_SHIFT       (24)
+#define SCG_NICCCR_NIC0_DIV_MASK        ((0xFUL) << SCG_NICCCR_NIC0_DIV_SHIFT)
+
+#define SCG_NICCCR_GPU_DIV_SHIFT        (20)
+#define SCG_NICCCR_GPU_DIV_MASK         ((0xFUL) << SCG_NICCCR_GPU_DIV_SHIFT)
+
+#define SCG_NICCCR_NIC1_DIV_SHIFT       (16)
+#define SCG_NICCCR_NIC1_DIV_MASK        ((0xFUL) << SCG_NICCCR_NIC1_DIV_SHIFT)
+
+#define SCG_NICCCR_NIC1_DIVEXT_SHIFT    (8)
+#define SCG_NICCCR_NIC1_DIVEXT_MASK   ((0xFUL) << SCG_NICCCR_NIC1_DIVEXT_SHIFT)
+
+#define SCG_NICCCR_NIC1_DIVBUS_SHIFT    (4)
+#define SCG_NICCCR_NIC1_DIVBUS_MASK   ((0xFUL) << SCG_NICCCR_NIC1_DIVBUS_SHIFT)
+
+/* SCG NIC clock status register */
+#define SCG_NICCSR_NICCS_SHIFT          (28)
+#define SCG_NICCSR_NICCS_MASK           ((0x1UL) << SCG_NICCSR_NICCS_SHIFT)
+
+#define SCG_NICCSR_NIC0DIV_SHIFT        (24)
+#define SCG_NICCSR_NIC0DIV_MASK         ((0xFUL) << SCG_NICCSR_NIC0DIV_SHIFT)
+#define SCG_NICCSR_GPUDIV_SHIFT         (20)
+#define SCG_NICCSR_GPUDIV_MASK          ((0xFUL) << SCG_NICCSR_GPUDIV_SHIFT)
+#define SCG_NICCSR_NIC1DIV_SHIFT        (16)
+#define SCG_NICCSR_NIC1DIV_MASK         ((0xFUL) << SCG_NICCSR_NIC1DIV_SHIFT)
+#define SCG_NICCSR_NIC1EXTDIV_SHIFT     (8)
+#define SCG_NICCSR_NIC1EXTDIV_MASK      ((0xFUL) << SCG_NICCSR_NIC1EXTDIV_SHIFT)
+#define SCG_NICCSR_NIC1BUSDIV_SHIFT     (4)
+#define SCG_NICCSR_NIC1BUSDIV_MASK      ((0xFUL) << SCG_NICCSR_NIC1BUSDIV_SHIFT)
+
+/* SCG Slow IRC Control Status Register */
+#define SCG_SIRC_CSR_SIRCVLD_SHIFT      (24)
+#define SCG_SIRC_CSR_SIRCVLD_MASK       ((0x1UL) << SCG_SIRC_CSR_SIRCVLD_SHIFT)
+
+#define SCG_SIRC_CSR_SIRCEN_SHIFT       (0)
+#define SCG_SIRC_CSR_SIRCEN_MASK        ((0x1UL) << SCG_SIRC_CSR_SIRCEN_SHIFT)
+
+/* SCG Slow IRC Configuration Register */
+#define SCG_SIRCCFG_RANGE_SHIFT         (0)
+#define SCG_SIRCCFG_RANGE_MASK          ((0x1UL) << SCG_SIRCCFG_RANGE_SHIFT)
+#define SCG_SIRCCFG_RANGE_4M            ((0x0UL) << SCG_SIRCCFG_RANGE_SHIFT)
+#define SCG_SIRCCFG_RANGE_16M           ((0x1UL) << SCG_SIRCCFG_RANGE_SHIFT)
+
+/* SCG Slow IRC Divide Register */
+#define SCG_SIRCDIV_DIV3_SHIFT          (16)
+#define SCG_SIRCDIV_DIV3_MASK           ((0x7UL) << SCG_SIRCDIV_DIV3_SHIFT)
+
+#define SCG_SIRCDIV_DIV2_SHIFT          (8)
+#define SCG_SIRCDIV_DIV2_MASK           ((0x7UL) << SCG_SIRCDIV_DIV2_SHIFT)
+
+#define SCG_SIRCDIV_DIV1_SHIFT          (0)
+#define SCG_SIRCDIV_DIV1_MASK           ((0x7UL) << SCG_SIRCDIV_DIV1_SHIFT)
+/*
+ * FIRC/SIRC DIV1 ==> xIRC_PLAT_CLK
+ * FIRC/SIRC DIV2 ==> xIRC_BUS_CLK
+ * FIRC/SIRC DIV3 ==> xIRC_SLOW_CLK
+ */
+
+/* SCG Fast IRC Control Status Register */
+#define SCG_FIRC_CSR_FIRCVLD_SHIFT      (24)
+#define SCG_FIRC_CSR_FIRCVLD_MASK       ((0x1UL) << SCG_FIRC_CSR_FIRCVLD_SHIFT)
+
+#define SCG_FIRC_CSR_FIRCEN_SHIFT       (0)
+#define SCG_FIRC_CSR_FIRCEN_MASK        ((0x1UL) << SCG_FIRC_CSR_FIRCEN_SHIFT)
+
+/* SCG Fast IRC Divide Register */
+#define SCG_FIRCDIV_DIV3_SHIFT          (16)
+#define SCG_FIRCDIV_DIV3_MASK           ((0x7UL) << SCG_FIRCDIV_DIV3_SHIFT)
+
+#define SCG_FIRCDIV_DIV2_SHIFT          (8)
+#define SCG_FIRCDIV_DIV2_MASK           ((0x7UL) << SCG_FIRCDIV_DIV2_SHIFT)
+
+#define SCG_FIRCDIV_DIV1_SHIFT          (0)
+#define SCG_FIRCDIV_DIV1_MASK           ((0x7UL) << SCG_FIRCDIV_DIV1_SHIFT)
+
+#define SCG_FIRCCFG_RANGE_SHIFT         (0)
+#define SCG_FIRCCFG_RANGE_MASK          ((0x3UL) << SCG_FIRCCFG_RANGE_SHIFT)
+
+#define SCG_FIRCCFG_RANGE_SHIFT         (0)
+#define SCG_FIRCCFG_RANGE_48M           ((0x0UL) << SCG_FIRCCFG_RANGE_SHIFT)
+
+/* SCG System OSC Control Status Register */
+#define SCG_SOSC_CSR_SOSCVLD_SHIFT      (24)
+#define SCG_SOSC_CSR_SOSCVLD_MASK       ((0x1UL) << SCG_SOSC_CSR_SOSCVLD_SHIFT)
+
+/* SCG Fast IRC Divide Register */
+#define SCG_SOSCDIV_DIV3_SHIFT          (16)
+#define SCG_SOSCDIV_DIV3_MASK           ((0x7UL) << SCG_SOSCDIV_DIV3_SHIFT)
+
+#define SCG_SOSCDIV_DIV2_SHIFT          (8)
+#define SCG_SOSCDIV_DIV2_MASK           ((0x7UL) << SCG_SOSCDIV_DIV2_SHIFT)
+
+#define SCG_SOSCDIV_DIV1_SHIFT          (0)
+#define SCG_SOSCDIV_DIV1_MASK           ((0x7UL) << SCG_SOSCDIV_DIV1_SHIFT)
+
+/* SCG RTC OSC Control Status Register */
+#define SCG_ROSC_CSR_ROSCVLD_SHIFT      (24)
+#define SCG_ROSC_CSR_ROSCVLD_MASK       ((0x1UL) << SCG_ROSC_CSR_ROSCVLD_SHIFT)
+
+#define SCG_SPLL_CSR_SPLLVLD_SHIFT      (24)
+#define SCG_SPLL_CSR_SPLLVLD_MASK       ((0x1UL) << SCG_SPLL_CSR_SPLLVLD_SHIFT)
+#define SCG_SPLL_CSR_SPLLEN_SHIFT       (0)
+#define SCG_SPLL_CSR_SPLLEN_MASK        ((0x1UL) << SCG_SPLL_CSR_SPLLEN_SHIFT)
+#define SCG_APLL_CSR_APLLEN_SHIFT       (0)
+#define SCG_APLL_CSR_APLLEN_MASK        (0x1UL)
+#define SCG_APLL_CSR_APLLVLD_MASK       (0x01000000)
+
+#define SCG_UPLL_CSR_UPLLVLD_MASK       (0x01000000)
+
+
+#define SCG_PLL_PFD3_GATE_MASK          (0x80000000)
+#define SCG_PLL_PFD2_GATE_MASK          (0x00800000)
+#define SCG_PLL_PFD1_GATE_MASK          (0x00008000)
+#define SCG_PLL_PFD0_GATE_MASK          (0x00000080)
+#define SCG_PLL_PFD3_VALID_MASK         (0x40000000)
+#define SCG_PLL_PFD2_VALID_MASK         (0x00400000)
+#define SCG_PLL_PFD1_VALID_MASK         (0x00004000)
+#define SCG_PLL_PFD0_VALID_MASK         (0x00000040)
+
+#define SCG_PLL_PFD0_FRAC_SHIFT         (0)
+#define SCG_PLL_PFD0_FRAC_MASK          ((0x3F) << SCG_PLL_PFD0_FRAC_SHIFT)
+#define SCG_PLL_PFD1_FRAC_SHIFT         (8)
+#define SCG_PLL_PFD1_FRAC_MASK          ((0x3F) << SCG_PLL_PFD1_FRAC_SHIFT)
+#define SCG_PLL_PFD2_FRAC_SHIFT         (16)
+#define SCG_PLL_PFD2_FRAC_MASK          ((0x3F) << SCG_PLL_PFD2_FRAC_SHIFT)
+#define SCG_PLL_PFD3_FRAC_SHIFT         (24)
+#define SCG_PLL_PFD3_FRAC_MASK          ((0x3F) << SCG_PLL_PFD3_FRAC_SHIFT)
+
+#define SCG_PLL_CFG_POSTDIV2_SHIFT      (28)
+#define SCG_PLL_CFG_POSTDIV2_MASK       ((0xFUL) << SCG_PLL_CFG_POSTDIV2_SHIFT)
+#define SCG_PLL_CFG_POSTDIV1_SHIFT      (24)
+#define SCG_PLL_CFG_POSTDIV1_MASK       ((0xFUL) << SCG_PLL_CFG_POSTDIV1_SHIFT)
+#define SCG_PLL_CFG_MULT_SHIFT          (16)
+#define SCG1_SPLL_CFG_MULT_MASK         ((0x7FUL) << SCG_PLL_CFG_MULT_SHIFT)
+#define SCG_APLL_CFG_MULT_MASK          ((0x7FUL) << SCG_PLL_CFG_MULT_SHIFT)
+#define SCG_PLL_CFG_PFDSEL_SHIFT        (14)
+#define SCG_PLL_CFG_PFDSEL_MASK         ((0x3UL) << SCG_PLL_CFG_PFDSEL_SHIFT)
+#define SCG_PLL_CFG_PREDIV_SHIFT        (8)
+#define SCG_PLL_CFG_PREDIV_MASK         ((0x7UL) << SCG_PLL_CFG_PREDIV_SHIFT)
+#define SCG_PLL_CFG_BYPASS_SHIFT        (2)
+/* 0: SPLL, 1: bypass */
+#define SCG_PLL_CFG_BYPASS_MASK         ((0x1UL) << SCG_PLL_CFG_BYPASS_SHIFT)
+#define SCG_PLL_CFG_PLLSEL_SHIFT        (1)
+/* 0: pll, 1: pfd */
+#define SCG_PLL_CFG_PLLSEL_MASK         ((0x1UL) << SCG_PLL_CFG_PLLSEL_SHIFT)
+#define SCG_PLL_CFG_CLKSRC_SHIFT        (0)
+/* 0: Sys-OSC, 1: FIRC */
+#define SCG_PLL_CFG_CLKSRC_MASK         ((0x1UL) << SCG_PLL_CFG_CLKSRC_SHIFT)
+#define SCG0_SPLL_CFG_MULT_SHIFT        (17)
+/* 0: Multiplier = 20, 1: Multiplier = 22 */
+#define SCG0_SPLL_CFG_MULT_MASK         ((0x1UL) << SCG0_SPLL_CFG_MULT_SHIFT)
+
+#define PLL_USB_EN_USB_CLKS_MASK       (0x01 << 6)
+#define PLL_USB_PWR_MASK               (0x01 << 12)
+#define PLL_USB_ENABLE_MASK            (0x01 << 13)
+#define PLL_USB_BYPASS_MASK            (0x01 << 16)
+#define PLL_USB_REG_ENABLE_MASK                (0x01 << 21)
+#define PLL_USB_DIV_SEL_MASK           (0x07 << 22)
+#define PLL_USB_LOCK_MASK              (0x01 << 31)
+
+enum scg_clk {
+       SCG_SOSC_CLK,
+       SCG_FIRC_CLK,
+       SCG_SIRC_CLK,
+       SCG_ROSC_CLK,
+       SCG_SIRC_DIV1_CLK,
+       SCG_SIRC_DIV2_CLK,
+       SCG_SIRC_DIV3_CLK,
+       SCG_FIRC_DIV1_CLK,
+       SCG_FIRC_DIV2_CLK,
+       SCG_FIRC_DIV3_CLK,
+       SCG_SOSC_DIV1_CLK,
+       SCG_SOSC_DIV2_CLK,
+       SCG_SOSC_DIV3_CLK,
+       SCG_CORE_CLK,
+       SCG_BUS_CLK,
+       SCG_SPLL_PFD0_CLK,
+       SCG_SPLL_PFD1_CLK,
+       SCG_SPLL_PFD2_CLK,
+       SCG_SPLL_PFD3_CLK,
+       SCG_DDR_CLK,
+       SCG_NIC0_CLK,
+       SCG_GPU_CLK,
+       SCG_NIC1_CLK,
+       SCG_NIC1_BUS_CLK,
+       SCG_NIC1_EXT_CLK,
+       SCG_APLL_PFD0_CLK,
+       SCG_APLL_PFD1_CLK,
+       SCG_APLL_PFD2_CLK,
+       SCG_APLL_PFD3_CLK,
+       USB_PLL_OUT,
+       MIPI_PLL_OUT
+};
+
+enum scg_sys_src {
+       SCG_SCS_SYS_OSC = 1,
+       SCG_SCS_SLOW_IRC,
+       SCG_SCS_FAST_IRC,
+       SCG_SCS_RTC_OSC,
+       SCG_SCS_AUX_PLL,
+       SCG_SCS_SYS_PLL,
+       SCG_SCS_USBPHY_PLL,
+};
+
+/* PLL supported by i.mx7ulp */
+enum pll_clocks {
+       PLL_M4_SPLL,    /* M4 SPLL */
+       PLL_M4_APLL,    /* M4 APLL*/
+       PLL_A7_SPLL,    /* A7 SPLL */
+       PLL_A7_APLL,    /* A7 APLL */
+       PLL_USB,        /* USB PLL*/
+       PLL_MIPI,       /* MIPI PLL */
+};
+
+typedef struct scg_regs {
+       u32 verid;      /* VERSION_ID */
+       u32 param;      /*  PARAMETER */
+       u32 rsvd11[2];
+
+       u32 csr;        /*  Clock Status Register */
+       u32 rccr;       /*  Run Clock Control Register */
+       u32 vccr;       /*  VLPR Clock Control Register */
+       u32 hccr;       /*  HSRUN Clock Control Register */
+       u32 clkoutcnfg; /*  SCG CLKOUT Configuration Register */
+       u32 rsvd12[3];
+       u32 ddrccr;     /*  SCG DDR Clock Control Register */
+       u32 rsvd13[3];
+       u32 nicccr;     /*  NIC Clock Control Register */
+       u32 niccsr;     /*  NIC Clock Status Register */
+       u32 rsvd10[46];
+
+       u32 sosccsr;    /*  System OSC Control Status Register, offset 0x100 */
+       u32 soscdiv;    /*  System OSC Divide Register */
+       u32 sosccfg;    /*  System Oscillator Configuration Register */
+       u32 sosctest;   /*  System Oscillator Test Register */
+       u32 rsvd20[60];
+
+       u32 sirccsr;    /*  Slow IRC Control Status Register, offset 0x200 */
+       u32 sircdiv;    /*  Slow IRC Divide Register */
+       u32 sirccfg;    /*  Slow IRC Configuration Register */
+       u32 sirctrim;   /*  Slow IRC Trim Register */
+       u32 loptrim;    /*  Low Power Oscillator Trim Register */
+       u32 sirctest;   /*  Slow IRC Test Register */
+       u32 rsvd30[58];
+
+       u32 firccsr;    /*  Fast IRC Control Status Register, offset 0x300 */
+       u32 fircdiv;
+       u32 firccfg;
+       u32 firctcfg;   /*  Fast IRC Trim Configuration Register */
+       u32 firctriml;  /*  Fast IRC Trim Low Register */
+       u32 firctrimh;
+       u32 fircstat;   /*  Fast IRC Status Register */
+       u32 firctest;   /*  Fast IRC Test Register */
+       u32 rsvd40[56];
+
+       u32 rtccsr;     /*  RTC OSC Control Status Register, offset 0x400 */
+       u32 rsvd50[63];
+
+       u32 apllcsr; /*  Auxiliary PLL Control Status Register, offset 0x500 */
+       u32 aplldiv;    /*  Auxiliary PLL Divider Register */
+       u32 apllcfg;    /*  Auxiliary PLL Configuration Register */
+       u32 apllpfd;    /*  Auxiliary PLL PFD Register */
+       u32 apllnum;    /*  Auxiliary PLL Numerator Register */
+       u32 aplldenom;  /*  Auxiliary PLL Denominator Register */
+       u32 apllss;     /*  Auxiliary PLL Spread Spectrum Register */
+       u32 rsvd60[55];
+       u32 apllock_cnfg; /*  Auxiliary PLL LOCK Configuration Register */
+       u32 rsvd61[1];
+
+       u32 spllcsr;    /*  System PLL Control Status Register, offset 0x600 */
+       u32 splldiv;    /*  System PLL Divide Register */
+       u32 spllcfg;    /*  System PLL Configuration Register */
+       u32 spllpfd;    /*  System PLL Test Register */
+       u32 spllnum;    /*  System PLL Numerator Register */
+       u32 splldenom;  /*  System PLL Denominator Register */
+       u32 spllss;     /*  System PLL Spread Spectrum Register */
+       u32 rsvd70[55];
+       u32 spllock_cnfg;       /*  System PLL LOCK Configuration Register */
+       u32 rsvd71[1];
+
+       u32 upllcsr;    /*  USB PLL Control Status Register, offset 0x700 */
+       u32 uplldiv;    /*  USB PLL Divide Register */
+       u32 upllcfg;    /*  USB PLL Configuration Register */
+} scg_t, *scg_p;
+
+u32 scg_clk_get_rate(enum scg_clk clk);
+int scg_enable_pll_pfd(enum scg_clk clk, u32 frac);
+int scg_enable_usb_pll(bool usb_control);
+u32 decode_pll(enum pll_clocks pll);
+
+void scg_a7_rccr_init(void);
+void scg_a7_spll_init(void);
+void scg_a7_ddrclk_init(void);
+void scg_a7_apll_init(void);
+void scg_a7_firc_init(void);
+void scg_a7_nicclk_init(void);
+void scg_a7_sys_clk_sel(enum scg_sys_src clk);
+void scg_a7_info(void);
+void scg_a7_soscdiv_init(void);
+
+#endif