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 
147