This patch sets and unsets is_sr_reset is appropriate places so that
trying to enable smart reflex in a non-supported OMAP chip does not
lead to unnecessary crash

Signed-off-by: Thara Gopinath <th...@ti.com>
---
 arch/arm/mach-omap2/smartreflex.c |   31 +++++++++++++++++++++----------
 1 files changed, 21 insertions(+), 10 deletions(-)

diff --git a/arch/arm/mach-omap2/smartreflex.c 
b/arch/arm/mach-omap2/smartreflex.c
index ca2223d..7aa84ab 100644
--- a/arch/arm/mach-omap2/smartreflex.c
+++ b/arch/arm/mach-omap2/smartreflex.c
@@ -108,9 +108,14 @@ static int sr_clk_enable(struct omap_sr *sr)
 {
        struct omap_smartreflex_data *pdata = sr->pdev->dev.platform_data;
 
+       if (!sr->is_sr_reset)
+               return 0;
+
        if (pdata->device_enable)
                pdata->device_enable(sr->pdev);
 
+       sr->is_sr_reset = 0;
+
        return 0;
 }
 
@@ -118,6 +123,9 @@ static void sr_clk_disable(struct omap_sr *sr)
 {
        struct omap_smartreflex_data *pdata = sr->pdev->dev.platform_data;
 
+       if (sr->is_sr_reset)
+               return;
+
        if (pdata->device_idle)
                pdata->device_idle(sr->pdev);
 
@@ -262,7 +270,6 @@ static void sr_configure(struct omap_sr *sr)
                         ERRCONFIG_MCUVALIDINTEN | ERRCONFIG_MCUVALIDINTST |
                         ERRCONFIG_MCUBOUNDINTEN | ERRCONFIG_MCUBOUNDINTST));
        }
-       sr->is_sr_reset = 0;
 }
 
 static void sr_start_vddautocomap(int srid)
@@ -283,8 +290,7 @@ static void sr_start_vddautocomap(int srid)
        sr->is_autocomp_active = 1;
        if (!sr_class->enable(srid)) {
                sr->is_autocomp_active = 0;
-               if (sr->is_sr_reset == 1)
-                       sr_clk_disable(sr);
+               sr_clk_disable(sr);
        }
 }
 
@@ -303,8 +309,10 @@ static void sr_stop_vddautocomap(int srid)
        }
 
        if (sr->is_autocomp_active == 1) {
-               sr_class->disable(srid);
-               sr_clk_disable(sr);
+               if (!sr->is_sr_reset) {
+                       sr_class->disable(srid);
+                       sr_clk_disable(sr);
+               }
                sr->is_autocomp_active = 0;
        }
 
@@ -357,6 +365,11 @@ int sr_enable(int srid, u32 target_opp_no)
 
        /* Enable the clocks and configure SR */
        sr_clk_enable(sr);
+
+       /* Check if SR is already enabled. If yes do nothing */
+       if (sr_read_reg(sr, SRCONFIG) & SRCONFIG_SRENABLE)
+               return true;
+
        sr_configure(sr);
 
        nvalue_reciprocal = pdata->sr_nvalue[target_opp_no - 1];
@@ -447,10 +460,8 @@ void omap_smartreflex_enable(int srid)
        }
 
        if (sr->is_autocomp_active == 1) {
-               if (sr->is_sr_reset == 1) {
-                       if (!sr_class->enable(srid))
-                               sr_clk_disable(sr);
-               }
+               if (!sr_class->enable(srid))
+                       sr_clk_disable(sr);
        }
 }
 
@@ -478,7 +489,7 @@ void omap_smartreflex_disable(int srid)
        }
 
        if (sr->is_autocomp_active == 1) {
-               if (sr->is_sr_reset == 0) {
+               if (!sr->is_sr_reset) {
                        sr_class->disable(srid);
                        /* Disable SR clk */
                        sr_clk_disable(sr);
-- 
1.7.0.rc1.33.g07cf0f

--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to