wlcore: allow elp during wowlan suspend

when enabling wowlan and entering suspend the last write to the firmware
allowing it to go into elp mode was not completing before suspend, leaving
the firmware running in full active mode consuming high power.
Use an immediate call instead of a work queue for this last access
allowing the firmware to go into power save during wowlan uspend.

Signed-off-by: Eyal Reizer <eyalr@ti.com>
Signed-off-by: Kalle Valo <kvalo@codeaurora.org>

1 files changed, 28 insertions, 1 deletions

diff --git a/drivers/net/wireless/ti/wlcore/main.c b/drivers/net/wireless/ti/wlcore/main.c
index 946a7124b09e..6ce457022dc9 100644
--- a/drivers/net/wireless/ti/wlcore/main.c
+++ b/drivers/net/wireless/ti/wlcore/main.c
@@ -42,6 +42,7 @@
 #include "sysfs.h"
 
 #define WL1271_BOOT_RETRIES 3
+#define WL1271_SUSPEND_SLEEP 100
 
 static char *fwlog_param;
 static int fwlog_mem_blocks = -1;
@@ -977,6 +978,24 @@ static int wlcore_fw_wakeup(struct wl1271 *wl)
         return wlcore_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG, ELPCTRL_WAKE_UP);
 }
 
+static int wlcore_fw_sleep(struct wl1271 *wl)
+{
+        int ret;
+
+        mutex_lock(&wl->mutex);
+        ret = wlcore_raw_write32(wl, HW_ACCESS_ELP_CTRL_REG, ELPCTRL_SLEEP);
+        if (ret < 0) {
+                wl12xx_queue_recovery_work(wl);
+                goto out;
+        }
+        set_bit(WL1271_FLAG_IN_ELP, &wl->flags);
+out:
+        mutex_unlock(&wl->mutex);
+        mdelay(WL1271_SUSPEND_SLEEP);
+
+        return 0;
+}
+
 static int wl1271_setup(struct wl1271 *wl)
 {
         wl->raw_fw_status = kzalloc(wl->fw_status_len, GFP_KERNEL);
@@ -1747,7 +1766,6 @@ static int wl1271_op_suspend(struct ieee80211_hw *hw,
                 goto out_sleep;
 
 out_sleep:
-        wl1271_ps_elp_sleep(wl);
         mutex_unlock(&wl->mutex);
 
         if (ret < 0) {
@@ -1780,6 +1798,15 @@ out_sleep:
          */
         cancel_delayed_work(&wl->tx_watchdog_work);
 
+        /*
+         * Use an immediate call for allowing the firmware to go into power
+         * save during suspend.
+         * Using a workque for this last write was only hapenning on resume
+         * leaving the firmware with power save disabled during suspend,
+         * while consuming full power during wowlan suspend.
+         */
+        wlcore_fw_sleep(wl);
+
         return 0;
 }