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 "rsi_debugfs.h" 20 #include "rsi_mgmt.h" 21 #include "rsi_common.h" 22 #include "rsi_ps.h" 23 24 char *str_psstate(enum ps_state state) 25 { 26 switch (state) { 27 case PS_NONE: 28 return "PS_NONE"; 29 case PS_DISABLE_REQ_SENT: 30 return "PS_DISABLE_REQ_SENT"; 31 case PS_ENABLE_REQ_SENT: 32 return "PS_ENABLE_REQ_SENT"; 33 case PS_ENABLED: 34 return "PS_ENABLED"; 35 default: 36 return "INVALID_STATE"; 37 } 38 } 39 40 static inline void rsi_modify_ps_state(struct rsi_hw *adapter, 41 enum ps_state nstate) 42 { 43 rsi_dbg(INFO_ZONE, "PS state changed %s => %s\n", 44 str_psstate(adapter->ps_state), 45 str_psstate(nstate)); 46 47 adapter->ps_state = nstate; 48 } 49 50 void rsi_default_ps_params(struct rsi_hw *adapter) 51 { 52 struct rsi_ps_info *ps_info = &adapter->ps_info; 53 54 ps_info->enabled = true; 55 ps_info->sleep_type = RSI_SLEEP_TYPE_LP; 56 ps_info->tx_threshold = 0; 57 ps_info->rx_threshold = 0; 58 ps_info->tx_hysterisis = 0; 59 ps_info->rx_hysterisis = 0; 60 ps_info->monitor_interval = 0; 61 ps_info->listen_interval = RSI_DEF_LISTEN_INTERVAL; 62 ps_info->num_bcns_per_lis_int = 0; 63 ps_info->dtim_interval_duration = 0; 64 ps_info->num_dtims_per_sleep = 0; 65 ps_info->deep_sleep_wakeup_period = RSI_DEF_DS_WAKEUP_PERIOD; 66 } 67 68 void rsi_enable_ps(struct rsi_hw *adapter, struct ieee80211_vif *vif) 69 { 70 if (adapter->ps_state != PS_NONE) { 71 rsi_dbg(ERR_ZONE, 72 "%s: Cannot accept enable PS in %s state\n", 73 __func__, str_psstate(adapter->ps_state)); 74 return; 75 } 76 77 if (rsi_send_ps_request(adapter, true, vif)) { 78 rsi_dbg(ERR_ZONE, 79 "%s: Failed to send PS request to device\n", 80 __func__); 81 return; 82 } 83 84 rsi_modify_ps_state(adapter, PS_ENABLE_REQ_SENT); 85 } 86 87 /* This function is used to disable power save */ 88 void rsi_disable_ps(struct rsi_hw *adapter, struct ieee80211_vif *vif) 89 { 90 if (adapter->ps_state != PS_ENABLED) { 91 rsi_dbg(ERR_ZONE, 92 "%s: Cannot accept disable PS in %s state\n", 93 __func__, str_psstate(adapter->ps_state)); 94 return; 95 } 96 97 if (rsi_send_ps_request(adapter, false, vif)) { 98 rsi_dbg(ERR_ZONE, 99 "%s: Failed to send PS request to device\n", 100 __func__); 101 return; 102 } 103 104 rsi_modify_ps_state(adapter, PS_DISABLE_REQ_SENT); 105 } 106 107 void rsi_conf_uapsd(struct rsi_hw *adapter, struct ieee80211_vif *vif) 108 { 109 int ret; 110 111 if (adapter->ps_state != PS_ENABLED) 112 return; 113 114 ret = rsi_send_ps_request(adapter, false, vif); 115 if (!ret) 116 ret = rsi_send_ps_request(adapter, true, vif); 117 if (ret) 118 rsi_dbg(ERR_ZONE, 119 "%s: Failed to send PS request to device\n", 120 __func__); 121 } 122 123 int rsi_handle_ps_confirm(struct rsi_hw *adapter, u8 *msg) 124 { 125 u16 cfm_type = get_unaligned_le16(msg + PS_CONFIRM_INDEX); 126 127 switch (cfm_type) { 128 case RSI_SLEEP_REQUEST: 129 if (adapter->ps_state == PS_ENABLE_REQ_SENT) 130 rsi_modify_ps_state(adapter, PS_ENABLED); 131 break; 132 case RSI_WAKEUP_REQUEST: 133 if (adapter->ps_state == PS_DISABLE_REQ_SENT) 134 rsi_modify_ps_state(adapter, PS_NONE); 135 break; 136 default: 137 rsi_dbg(ERR_ZONE, 138 "Invalid PS confirm type %x in state %s\n", 139 cfm_type, str_psstate(adapter->ps_state)); 140 return -1; 141 } 142 143 return 0; 144 } 145 146