OMAP2/3 clock: Extend find_idlest() to pass back idle state value
[pandora-kernel.git] / arch / arm / mach-omap2 / prcm.c
index 3ea8177..0f87fdc 100644 (file)
@@ -11,6 +11,7 @@
  * Rajendra Nayak <rnayak@ti.com>
  *
  * Some pieces of code Copyright (C) 2005 Texas Instruments, Inc.
+ * Upgraded with OMAP4 support by Abhijit Pagare <abhijitpagare@ti.com>
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License version 2 as
@@ -28,6 +29,7 @@
 #include <plat/control.h>
 
 #include "clock.h"
+#include "clock2xxx.h"
 #include "cm.h"
 #include "prm.h"
 #include "prm-regbits-24xx.h"
@@ -44,7 +46,6 @@ struct omap3_prcm_regs {
        u32 iva2_cm_clksel2;
        u32 cm_sysconfig;
        u32 sgx_cm_clksel;
-       u32 wkup_cm_clksel;
        u32 dss_cm_clksel;
        u32 cam_cm_clksel;
        u32 per_cm_clksel;
@@ -53,7 +54,6 @@ struct omap3_prcm_regs {
        u32 pll_cm_autoidle2;
        u32 pll_cm_clksel4;
        u32 pll_cm_clksel5;
-       u32 pll_cm_clken;
        u32 pll_cm_clken2;
        u32 cm_polctrl;
        u32 iva2_cm_fclken;
@@ -77,7 +77,6 @@ struct omap3_prcm_regs {
        u32 usbhost_cm_iclken;
        u32 iva2_cm_autiidle2;
        u32 mpu_cm_autoidle2;
-       u32 pll_cm_autoidle;
        u32 iva2_cm_clkstctrl;
        u32 mpu_cm_clkstctrl;
        u32 core_cm_clkstctrl;
@@ -124,7 +123,10 @@ struct omap3_prcm_regs prcm_context;
 u32 omap_prcm_get_reset_sources(void)
 {
        /* XXX This presumably needs modification for 34XX */
-       return prm_read_mod_reg(WKUP_MOD, RM_RSTST) & 0x7f;
+       if (cpu_is_omap24xx() | cpu_is_omap34xx())
+               return prm_read_mod_reg(WKUP_MOD, OMAP2_RM_RSTST) & 0x7f;
+       if (cpu_is_omap44xx())
+               return prm_read_mod_reg(WKUP_MOD, OMAP4_RM_RSTST) & 0x7f;
 }
 EXPORT_SYMBOL(omap_prcm_get_reset_sources);
 
@@ -132,11 +134,12 @@ EXPORT_SYMBOL(omap_prcm_get_reset_sources);
 void omap_prcm_arch_reset(char mode)
 {
        s16 prcm_offs;
-       omap2_clk_prepare_for_reboot();
 
-       if (cpu_is_omap24xx())
+       if (cpu_is_omap24xx()) {
+               omap2xxx_clk_prepare_for_reboot();
+
                prcm_offs = WKUP_MOD;
-       else if (cpu_is_omap34xx()) {
+       else if (cpu_is_omap34xx()) {
                u32 l;
 
                prcm_offs = OMAP3430_GR_MOD;
@@ -147,10 +150,17 @@ void omap_prcm_arch_reset(char mode)
                 * cf. OMAP34xx TRM, Initialization / Software Booting
                 * Configuration. */
                omap_writel(l, OMAP343X_SCRATCHPAD + 4);
-       } else
+       } else if (cpu_is_omap44xx())
+               prcm_offs = OMAP4430_PRM_DEVICE_MOD;
+       else
                WARN_ON(1);
 
-       prm_set_mod_reg_bits(OMAP_RST_DPLL3, prcm_offs, RM_RSTCTRL);
+       if (cpu_is_omap24xx() | cpu_is_omap34xx())
+               prm_set_mod_reg_bits(OMAP_RST_DPLL3, prcm_offs,
+                                                OMAP2_RM_RSTCTRL);
+       if (cpu_is_omap44xx())
+               prm_set_mod_reg_bits(OMAP_RST_DPLL3, prcm_offs,
+                                                OMAP4_RM_RSTCTRL);
 }
 
 static inline u32 __omap_prcm_read(void __iomem *base, s16 module, u16 reg)
@@ -191,6 +201,18 @@ u32 prm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx)
        return v;
 }
 
+/* Read a PRM register, AND it, and shift the result down to bit 0 */
+u32 prm_read_mod_bits_shift(s16 domain, s16 idx, u32 mask)
+{
+       u32 v;
+
+       v = prm_read_mod_reg(domain, idx);
+       v &= mask;
+       v >>= __ffs(mask);
+
+       return v;
+}
+
 /* Read a register in a CM module */
 u32 cm_read_mod_reg(s16 module, u16 idx)
 {
@@ -220,26 +242,22 @@ u32 cm_rmw_mod_reg_bits(u32 mask, u32 bits, s16 module, s16 idx)
  * omap2_cm_wait_idlest - wait for IDLEST bit to indicate module readiness
  * @reg: physical address of module IDLEST register
  * @mask: value to mask against to determine if the module is active
+ * @idlest: idle state indicator (0 or 1) for the clock
  * @name: name of the clock (for printk)
  *
  * Returns 1 if the module indicated readiness in time, or 0 if it
  * failed to enable in roughly MAX_MODULE_ENABLE_WAIT microseconds.
  */
-int omap2_cm_wait_idlest(void __iomem *reg, u32 mask, const char *name)
+int omap2_cm_wait_idlest(void __iomem *reg, u32 mask, u8 idlest,
+                               const char *name)
 {
        int i = 0;
        int ena = 0;
 
-       /*
-        * 24xx uses 0 to indicate not ready, and 1 to indicate ready.
-        * 34xx reverses this, just to keep us on our toes
-        */
-       if (cpu_is_omap24xx())
-               ena = mask;
-       else if (cpu_is_omap34xx())
+       if (idlest)
                ena = 0;
        else
-               BUG();
+               ena = mask;
 
        /* Wait for lock */
        omap_test_timeout(((__raw_readl(reg) & mask) == ena),
@@ -274,7 +292,6 @@ void omap3_prcm_save_context(void)
        prcm_context.cm_sysconfig = __raw_readl(OMAP3430_CM_SYSCONFIG);
        prcm_context.sgx_cm_clksel =
                         cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_CLKSEL);
-       prcm_context.wkup_cm_clksel = cm_read_mod_reg(WKUP_MOD, CM_CLKSEL);
        prcm_context.dss_cm_clksel =
                         cm_read_mod_reg(OMAP3430_DSS_MOD, CM_CLKSEL);
        prcm_context.cam_cm_clksel =
@@ -284,15 +301,13 @@ void omap3_prcm_save_context(void)
        prcm_context.emu_cm_clksel =
                         cm_read_mod_reg(OMAP3430_EMU_MOD, CM_CLKSEL1);
        prcm_context.emu_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_EMU_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_EMU_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.pll_cm_autoidle2 =
                         cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE2);
        prcm_context.pll_cm_clksel4 =
                        cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL4);
        prcm_context.pll_cm_clksel5 =
                         cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKSEL5);
-       prcm_context.pll_cm_clken =
-                       cm_read_mod_reg(PLL_MOD, CM_CLKEN);
        prcm_context.pll_cm_clken2 =
                        cm_read_mod_reg(PLL_MOD, OMAP3430ES2_CM_CLKEN2);
        prcm_context.cm_polctrl = __raw_readl(OMAP3430_CM_POLCTRL);
@@ -338,26 +353,26 @@ void omap3_prcm_save_context(void)
                         cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_AUTOIDLE2);
        prcm_context.mpu_cm_autoidle2 =
                         cm_read_mod_reg(MPU_MOD, CM_AUTOIDLE2);
-       prcm_context.pll_cm_autoidle =
-                        cm_read_mod_reg(PLL_MOD, CM_AUTOIDLE);
        prcm_context.iva2_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_IVA2_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_IVA2_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.mpu_cm_clkstctrl =
-                        cm_read_mod_reg(MPU_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(MPU_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.core_cm_clkstctrl =
-                        cm_read_mod_reg(CORE_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(CORE_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.sgx_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430ES2_SGX_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430ES2_SGX_MOD,
+                                               OMAP2_CM_CLKSTCTRL);
        prcm_context.dss_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_DSS_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_DSS_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.cam_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_CAM_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_CAM_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.per_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_PER_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_PER_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.neon_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430_NEON_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430_NEON_MOD, OMAP2_CM_CLKSTCTRL);
        prcm_context.usbhost_cm_clkstctrl =
-                        cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD, CM_CLKSTCTRL);
+                        cm_read_mod_reg(OMAP3430ES2_USBHOST_MOD,
+                                               OMAP2_CM_CLKSTCTRL);
        prcm_context.core_cm_autoidle1 =
                         cm_read_mod_reg(CORE_MOD, CM_AUTOIDLE1);
        prcm_context.core_cm_autoidle2 =
@@ -431,7 +446,6 @@ void omap3_prcm_restore_context(void)
        __raw_writel(prcm_context.cm_sysconfig, OMAP3430_CM_SYSCONFIG);
        cm_write_mod_reg(prcm_context.sgx_cm_clksel, OMAP3430ES2_SGX_MOD,
                                         CM_CLKSEL);
-       cm_write_mod_reg(prcm_context.wkup_cm_clksel, WKUP_MOD, CM_CLKSEL);
        cm_write_mod_reg(prcm_context.dss_cm_clksel, OMAP3430_DSS_MOD,
                                         CM_CLKSEL);
        cm_write_mod_reg(prcm_context.cam_cm_clksel, OMAP3430_CAM_MOD,
@@ -441,14 +455,13 @@ void omap3_prcm_restore_context(void)
        cm_write_mod_reg(prcm_context.emu_cm_clksel, OMAP3430_EMU_MOD,
                                         CM_CLKSEL1);
        cm_write_mod_reg(prcm_context.emu_cm_clkstctrl, OMAP3430_EMU_MOD,
-                                        CM_CLKSTCTRL);
+                                        OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.pll_cm_autoidle2, PLL_MOD,
                                         CM_AUTOIDLE2);
        cm_write_mod_reg(prcm_context.pll_cm_clksel4, PLL_MOD,
                                        OMAP3430ES2_CM_CLKSEL4);
        cm_write_mod_reg(prcm_context.pll_cm_clksel5, PLL_MOD,
                                         OMAP3430ES2_CM_CLKSEL5);
-       cm_write_mod_reg(prcm_context.pll_cm_clken, PLL_MOD, CM_CLKEN);
        cm_write_mod_reg(prcm_context.pll_cm_clken2, PLL_MOD,
                                        OMAP3430ES2_CM_CLKEN2);
        __raw_writel(prcm_context.cm_polctrl, OMAP3430_CM_POLCTRL);
@@ -487,24 +500,24 @@ void omap3_prcm_restore_context(void)
        cm_write_mod_reg(prcm_context.iva2_cm_autiidle2, OMAP3430_IVA2_MOD,
                                        CM_AUTOIDLE2);
        cm_write_mod_reg(prcm_context.mpu_cm_autoidle2, MPU_MOD, CM_AUTOIDLE2);
-       cm_write_mod_reg(prcm_context.pll_cm_autoidle, PLL_MOD, CM_AUTOIDLE);
        cm_write_mod_reg(prcm_context.iva2_cm_clkstctrl, OMAP3430_IVA2_MOD,
-                                       CM_CLKSTCTRL);
-       cm_write_mod_reg(prcm_context.mpu_cm_clkstctrl, MPU_MOD, CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
+       cm_write_mod_reg(prcm_context.mpu_cm_clkstctrl, MPU_MOD,
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.core_cm_clkstctrl, CORE_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.sgx_cm_clkstctrl, OMAP3430ES2_SGX_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.dss_cm_clkstctrl, OMAP3430_DSS_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.cam_cm_clkstctrl, OMAP3430_CAM_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.per_cm_clkstctrl, OMAP3430_PER_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.neon_cm_clkstctrl, OMAP3430_NEON_MOD,
-                                       CM_CLKSTCTRL);
+                                       OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.usbhost_cm_clkstctrl,
-                                       OMAP3430ES2_USBHOST_MOD, CM_CLKSTCTRL);
+                               OMAP3430ES2_USBHOST_MOD, OMAP2_CM_CLKSTCTRL);
        cm_write_mod_reg(prcm_context.core_cm_autoidle1, CORE_MOD,
                                        CM_AUTOIDLE1);
        cm_write_mod_reg(prcm_context.core_cm_autoidle2, CORE_MOD,