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         return "INVALID_STATE";
  40 }
  41
  42 static inline void rsi_modify_ps_state(struct rsi_hw *adapter,
  43                                        enum ps_state nstate)
  44 {
  45         rsi_dbg(INFO_ZONE, "PS state changed %s => %s\n",
  46                 str_psstate(adapter->ps_state),
  47                 str_psstate(nstate));
  48
  49         adapter->ps_state = nstate;
  50 }
  51
  52 void rsi_default_ps_params(struct rsi_hw *adapter)
  53 {
  54         struct rsi_ps_info *ps_info = &adapter->ps_info;
  55
  56         ps_info->enabled = true;
  57         ps_info->sleep_type = RSI_SLEEP_TYPE_LP;
  58         ps_info->tx_threshold = 0;
  59         ps_info->rx_threshold = 0;
  60         ps_info->tx_hysterisis = 0;
  61         ps_info->rx_hysterisis = 0;
  62         ps_info->monitor_interval = 0;
  63         ps_info->listen_interval = RSI_DEF_LISTEN_INTERVAL;
  64         ps_info->num_bcns_per_lis_int = 0;
  65         ps_info->dtim_interval_duration = 0;
  66         ps_info->num_dtims_per_sleep = 0;
  67         ps_info->deep_sleep_wakeup_period = RSI_DEF_DS_WAKEUP_PERIOD;
  68 }
  69
  70 void rsi_enable_ps(struct rsi_hw *adapter)
  71 {
  72         if (adapter->ps_state != PS_NONE) {
  73                 rsi_dbg(ERR_ZONE,
  74                         "%s: Cannot accept enable PS in %s state\n",
  75                         __func__, str_psstate(adapter->ps_state));
  76                 return;
  77         }
  78
  79         if (rsi_send_ps_request(adapter, true)) {
  80                 rsi_dbg(ERR_ZONE,
  81                         "%s: Failed to send PS request to device\n",
  82                         __func__);
  83                 return;
  84         }
  85
  86         rsi_modify_ps_state(adapter, PS_ENABLE_REQ_SENT);
  87 }
  88
  89 void rsi_disable_ps(struct rsi_hw *adapter)
  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)) {
  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)
 109 {
 110         int ret;
 111
 112         if (adapter->ps_state != PS_ENABLED)
 113                 return;
 114
 115         ret = rsi_send_ps_request(adapter, false);
 116         if (!ret)
 117                 ret = rsi_send_ps_request(adapter, true);
 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