drivers/net/wireless/rsi/rsi_91x_ps.c

   1 /*
   2  * Copyright (c) 2014 Redpine Signals Inc.
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include <linux/etherdevice.h>
  18 #include <linux/if.h>
  19 #include <linux/version.h>
  20 #include "rsi_debugfs.h"
  21 #include "rsi_mgmt.h"
  22 #include "rsi_common.h"
  23 #include "rsi_ps.h"
  24
  25 char *str_psstate(enum ps_state state)
  26 {
  27         switch (state) {
  28         case PS_NONE:
  29                 return "PS_NONE";
  30         case PS_DISABLE_REQ_SENT:
  31                 return "PS_DISABLE_REQ_SENT";
  32         case PS_ENABLE_REQ_SENT:
  33                 return "PS_ENABLE_REQ_SENT";
  34         case PS_ENABLED:
  35                 return "PS_ENABLED";
  36         default:
  37                 return "INVALID_STATE";
  38         }
  39 }
  40
  41 static inline void rsi_modify_ps_state(struct rsi_hw *adapter,
  42                                        enum ps_state nstate)
  43 {
  44         rsi_dbg(INFO_ZONE, "PS state changed %s => %s\n",
  45                 str_psstate(adapter->ps_state),
  46                 str_psstate(nstate));
  47
  48         adapter->ps_state = nstate;
  49 }
  50
  51 void rsi_default_ps_params(struct rsi_hw *adapter)
  52 {
  53         struct rsi_ps_info *ps_info = &adapter->ps_info;
  54
  55         ps_info->enabled = true;
  56         ps_info->sleep_type = RSI_SLEEP_TYPE_LP;
  57         ps_info->tx_threshold = 0;
  58         ps_info->rx_threshold = 0;
  59         ps_info->tx_hysterisis = 0;
  60         ps_info->rx_hysterisis = 0;
  61         ps_info->monitor_interval = 0;
  62         ps_info->listen_interval = RSI_DEF_LISTEN_INTERVAL;
  63         ps_info->num_bcns_per_lis_int = 0;
  64         ps_info->dtim_interval_duration = 0;
  65         ps_info->num_dtims_per_sleep = 0;
  66         ps_info->deep_sleep_wakeup_period = RSI_DEF_DS_WAKEUP_PERIOD;
  67 }
  68
  69 void rsi_enable_ps(struct rsi_hw *adapter, struct ieee80211_vif *vif)
  70 {
  71         if (adapter->ps_state != PS_NONE) {
  72                 rsi_dbg(ERR_ZONE,
  73                         "%s: Cannot accept enable PS in %s state\n",
  74                         __func__, str_psstate(adapter->ps_state));
  75                 return;
  76         }
  77
  78         if (rsi_send_ps_request(adapter, true, vif)) {
  79                 rsi_dbg(ERR_ZONE,
  80                         "%s: Failed to send PS request to device\n",
  81                         __func__);
  82                 return;
  83         }
  84
  85         rsi_modify_ps_state(adapter, PS_ENABLE_REQ_SENT);
  86 }
  87
  88 /* This function is used to disable power save */
  89 void rsi_disable_ps(struct rsi_hw *adapter, struct ieee80211_vif *vif)
  90 {
  91         if (adapter->ps_state != PS_ENABLED) {
  92                 rsi_dbg(ERR_ZONE,
  93                         "%s: Cannot accept disable PS in %s state\n",
  94                         __func__, str_psstate(adapter->ps_state));
  95                 return;
  96         }
  97
  98         if (rsi_send_ps_request(adapter, false, vif)) {
  99                 rsi_dbg(ERR_ZONE,
 100                         "%s: Failed to send PS request to device\n",
 101                         __func__);
 102                 return;
 103         }
 104
 105         rsi_modify_ps_state(adapter, PS_DISABLE_REQ_SENT);
 106 }
 107
 108 void rsi_conf_uapsd(struct rsi_hw *adapter, struct ieee80211_vif *vif)
 109 {
 110         int ret;
 111
 112         if (adapter->ps_state != PS_ENABLED)
 113                 return;
 114
 115         ret = rsi_send_ps_request(adapter, false, vif);
 116         if (!ret)
 117                 ret = rsi_send_ps_request(adapter, true, vif);
 118         if (ret)
 119                 rsi_dbg(ERR_ZONE,
 120                         "%s: Failed to send PS request to device\n",
 121                         __func__);
 122 }
 123
 124 int rsi_handle_ps_confirm(struct rsi_hw *adapter, u8 *msg)
 125 {
 126         u16 cfm_type = get_unaligned_le16(msg + PS_CONFIRM_INDEX);
 127
 128         switch (cfm_type) {
 129         case RSI_SLEEP_REQUEST:
 130                 if (adapter->ps_state == PS_ENABLE_REQ_SENT)
 131                         rsi_modify_ps_state(adapter, PS_ENABLED);
 132                 break;
 133         case RSI_WAKEUP_REQUEST:
 134                 if (adapter->ps_state == PS_DISABLE_REQ_SENT)
 135                         rsi_modify_ps_state(adapter, PS_NONE);
 136                 break;
 137         default:
 138                 rsi_dbg(ERR_ZONE,
 139                         "Invalid PS confirm type %x in state %s\n",
 140                         cfm_type, str_psstate(adapter->ps_state));
 141                 return -1;
 142         }
 143
 144         return 0;
 145 }
 146