ENGR00307558-13 usb: chipidea: otg-fsm: enable low power mode for otg fsm mode.

This patch enables runtime pm support for otg fsm mode.

Signed-off-by: Li Jun <b47624@freescale.com>

1 files changed, 15 insertions, 3 deletions

diff --git a/drivers/usb/chipidea/otg_fsm.c b/drivers/usb/chipidea/otg_fsm.c
index 028f7687ad29..630ae7560b75 100644
--- a/drivers/usb/chipidea/otg_fsm.c
+++ b/drivers/usb/chipidea/otg_fsm.c
@@ -229,6 +229,9 @@ static void ci_otg_add_timer(struct ci_hdrc *ci, enum ci_otg_fsm_timer_index t)
                         return;
                 }
 
+        if (list_empty(active_timers))
+                pm_runtime_get(ci->dev);
+
         timer->count = timer->expires;
         list_add_tail(&timer->list, active_timers);
 
@@ -245,17 +248,22 @@ static void ci_otg_del_timer(struct ci_hdrc *ci, enum ci_otg_fsm_timer_index t)
         struct ci_otg_fsm_timer *tmp_timer, *del_tmp;
         struct ci_otg_fsm_timer *timer = ci->fsm_timer->timer_list[t];
         struct list_head *active_timers = &ci->fsm_timer->active_timers;
+        int flag = 0;
 
         if (t >= NUM_CI_OTG_FSM_TIMERS)
                 return;
 
         list_for_each_entry_safe(tmp_timer, del_tmp, active_timers, list)
-                if (tmp_timer == timer)
+                if (tmp_timer == timer) {
                         list_del(&timer->list);
+                        flag = 1;
+                }
 
         /* Disable 1ms irq if there is no any active timer */
-        if (list_empty(active_timers))
+        if (list_empty(active_timers) && (flag == 1)) {
                 hw_write_otgsc(ci, OTGSC_1MSIE, 0);
+                pm_runtime_put(ci->dev);
+        }
 }
 
 /*
@@ -279,8 +287,10 @@ static inline int ci_otg_tick_timer(struct ci_hdrc *ci)
         }
 
         /* disable 1ms irq if there is no any timer active */
-        if ((expired == 1) && list_empty(active_timers))
+        if ((expired == 1) && list_empty(active_timers)) {
                 hw_write_otgsc(ci, OTGSC_1MSIE, 0);
+                pm_runtime_put(ci->dev);
+        }
 
         return expired;
 }
@@ -605,6 +615,7 @@ int ci_otg_fsm_work(struct ci_hdrc *ci)
                 return 0;
         }
 
+        pm_runtime_get_sync(ci->dev);
         if (otg_statemachine(&ci->fsm)) {
                 if (ci->transceiver->state == OTG_STATE_A_IDLE) {
                         /*
@@ -634,6 +645,7 @@ int ci_otg_fsm_work(struct ci_hdrc *ci)
                         }
                 }
         }
+        pm_runtime_put_sync(ci->dev);
         return 0;
 }