ARM: OMAP: Fix timer posted mode support

[pandora-kernel.git] / arch / arm / plat-omap / dmtimer.c

diff --git a/arch/arm/plat-omap/dmtimer.c b/arch/arm/plat-omap/dmtimer.c
index b9349e4..fea56d5 100644 (file)
--- a/arch/arm/plat-omap/dmtimer.c
+++ b/arch/arm/plat-omap/dmtimer.c
@@ -114,21 +114,17 @@ static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
 
 static void omap_dm_timer_reset(struct omap_dm_timer *timer)
 {
-       omap_dm_timer_enable(timer);
        if (timer->pdev->id != 1) {
                omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
                omap_dm_timer_wait_for_reset(timer);
        }
 
        __omap_dm_timer_reset(timer, 0, 0);
-       __omap_dm_timer_enable_posted(timer);
-       omap_dm_timer_disable(timer);
 }
 
 int omap_dm_timer_prepare(struct omap_dm_timer *timer)
 {
        struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
-       int ret;
 
        timer->fclk = clk_get(&timer->pdev->dev, "fck");
        if (WARN_ON_ONCE(IS_ERR_OR_NULL(timer->fclk))) {
@@ -137,13 +133,15 @@ int omap_dm_timer_prepare(struct omap_dm_timer *timer)
                return -EINVAL;
        }
 
+       omap_dm_timer_enable(timer);
+
        if (pdata->needs_manual_reset)
                omap_dm_timer_reset(timer);
 
-       ret = omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
+       __omap_dm_timer_enable_posted(timer);
+       omap_dm_timer_disable(timer);
 
-       timer->posted = 1;
-       return ret;
+       return omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
 }
 
 struct omap_dm_timer *omap_dm_timer_request(void)