drivers/net/wireless/ti/wl1251/ps.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * This file is part of wl1251
   4  *
   5  * Copyright (C) 2008 Nokia Corporation
   6  */
   7
   8 #include "reg.h"
   9 #include "ps.h"
  10 #include "cmd.h"
  11 #include "io.h"
  12
  13 /* in ms */
  14 #define WL1251_WAKEUP_TIMEOUT 100
  15
  16 void wl1251_elp_work(struct work_struct *work)
  17 {
  18         struct delayed_work *dwork;
  19         struct wl1251 *wl;
  20
  21         dwork = to_delayed_work(work);
  22         wl = container_of(dwork, struct wl1251, elp_work);
  23
  24         wl1251_debug(DEBUG_PSM, "elp work");
  25
  26         mutex_lock(&wl->mutex);
  27
  28         if (wl->elp || wl->station_mode == STATION_ACTIVE_MODE)
  29                 goto out;
  30
  31         wl1251_debug(DEBUG_PSM, "chip to elp");
  32         wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_SLEEP);
  33         wl->elp = true;
  34
  35 out:
  36         mutex_unlock(&wl->mutex);
  37 }
  38
  39 #define ELP_ENTRY_DELAY  5
  40
  41 /* Routines to toggle sleep mode while in ELP */
  42 void wl1251_ps_elp_sleep(struct wl1251 *wl)
  43 {
  44         unsigned long delay;
  45
  46         if (wl->station_mode != STATION_ACTIVE_MODE) {
  47                 delay = msecs_to_jiffies(ELP_ENTRY_DELAY);
  48                 ieee80211_queue_delayed_work(wl->hw, &wl->elp_work, delay);
  49         }
  50 }
  51
  52 int wl1251_ps_elp_wakeup(struct wl1251 *wl)
  53 {
  54         unsigned long timeout, start;
  55         u32 elp_reg;
  56
  57         cancel_delayed_work(&wl->elp_work);
  58
  59         if (!wl->elp)
  60                 return 0;
  61
  62         wl1251_debug(DEBUG_PSM, "waking up chip from elp");
  63
  64         start = jiffies;
  65         timeout = jiffies + msecs_to_jiffies(WL1251_WAKEUP_TIMEOUT);
  66
  67         wl1251_write_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR, ELPCTRL_WAKE_UP);
  68
  69         elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR);
  70
  71         /*
  72          * FIXME: we should wait for irq from chip but, as a temporary
  73          * solution to simplify locking, let's poll instead
  74          */
  75         while (!(elp_reg & ELPCTRL_WLAN_READY)) {
  76                 if (time_after(jiffies, timeout)) {
  77                         wl1251_error("elp wakeup timeout");
  78                         return -ETIMEDOUT;
  79                 }
  80                 msleep(1);
  81                 elp_reg = wl1251_read_elp(wl, HW_ACCESS_ELP_CTRL_REG_ADDR);
  82         }
  83
  84         wl1251_debug(DEBUG_PSM, "wakeup time: %u ms",
  85                      jiffies_to_msecs(jiffies - start));
  86
  87         wl->elp = false;
  88
  89         return 0;
  90 }
  91
  92 int wl1251_ps_set_mode(struct wl1251 *wl, enum wl1251_station_mode mode)
  93 {
  94         int ret;
  95
  96         switch (mode) {
  97         case STATION_POWER_SAVE_MODE:
  98                 wl1251_debug(DEBUG_PSM, "entering psm");
  99
 100                 /* enable beacon filtering */
 101                 ret = wl1251_acx_beacon_filter_opt(wl, true);
 102                 if (ret < 0)
 103                         return ret;
 104
 105                 ret = wl1251_acx_wake_up_conditions(wl,
 106                                                     WAKE_UP_EVENT_DTIM_BITMAP,
 107                                                     wl->listen_int);
 108                 if (ret < 0)
 109                         return ret;
 110
 111                 ret = wl1251_acx_bet_enable(wl, WL1251_ACX_BET_ENABLE,
 112                                             WL1251_DEFAULT_BET_CONSECUTIVE);
 113                 if (ret < 0)
 114                         return ret;
 115
 116                 ret = wl1251_cmd_ps_mode(wl, CHIP_POWER_SAVE_MODE);
 117                 if (ret < 0)
 118                         return ret;
 119
 120                 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_ELP);
 121                 if (ret < 0)
 122                         return ret;
 123                 break;
 124         case STATION_IDLE:
 125                 wl1251_debug(DEBUG_PSM, "entering idle");
 126
 127                 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_ELP);
 128                 if (ret < 0)
 129                         return ret;
 130
 131                 ret = wl1251_cmd_template_set(wl, CMD_DISCONNECT, NULL, 0);
 132                 if (ret < 0)
 133                         return ret;
 134                 break;
 135         case STATION_ACTIVE_MODE:
 136         default:
 137                 wl1251_debug(DEBUG_PSM, "leaving psm");
 138
 139                 ret = wl1251_acx_sleep_auth(wl, WL1251_PSM_CAM);
 140                 if (ret < 0)
 141                         return ret;
 142
 143                 /* disable BET */
 144                 ret = wl1251_acx_bet_enable(wl, WL1251_ACX_BET_DISABLE,
 145                                             WL1251_DEFAULT_BET_CONSECUTIVE);
 146                 if (ret < 0)
 147                         return ret;
 148
 149                 /* disable beacon filtering */
 150                 ret = wl1251_acx_beacon_filter_opt(wl, false);
 151                 if (ret < 0)
 152                         return ret;
 153
 154                 ret = wl1251_acx_wake_up_conditions(wl,
 155                                                     WAKE_UP_EVENT_DTIM_BITMAP,
 156                                                     wl->listen_int);
 157                 if (ret < 0)
 158                         return ret;
 159
 160                 ret = wl1251_cmd_ps_mode(wl, CHIP_ACTIVE_MODE);
 161                 if (ret < 0)
 162                         return ret;
 163
 164                 break;
 165         }
 166         wl->station_mode = mode;
 167
 168         return ret;
 169 }
 170