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
str_psstate(enum ps_state state)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
rsi_modify_ps_state(struct rsi_hw * adapter,enum ps_state nstate)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
rsi_default_ps_params(struct rsi_hw * adapter)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
rsi_enable_ps(struct rsi_hw * adapter)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
rsi_disable_ps(struct rsi_hw * adapter)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
rsi_conf_uapsd(struct rsi_hw * adapter)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
rsi_handle_ps_confirm(struct rsi_hw * adapter,u8 * msg)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
147