]>
Commit | Line | Data |
---|---|---|
8ca151b5 JB |
1 | /****************************************************************************** |
2 | * | |
3 | * This file is provided under a dual BSD/GPLv2 license. When using or | |
4 | * redistributing this file, you may do so under either license. | |
5 | * | |
6 | * GPL LICENSE SUMMARY | |
7 | * | |
51368bf7 | 8 | * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. |
8b4139dc | 9 | * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH |
0db056d3 | 10 | * Copyright(c) 2015 - 2016 Intel Deutschland GmbH |
8ca151b5 JB |
11 | * |
12 | * This program is free software; you can redistribute it and/or modify | |
13 | * it under the terms of version 2 of the GNU General Public License as | |
14 | * published by the Free Software Foundation. | |
15 | * | |
16 | * This program is distributed in the hope that it will be useful, but | |
17 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
18 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
19 | * General Public License for more details. | |
20 | * | |
21 | * You should have received a copy of the GNU General Public License | |
22 | * along with this program; if not, write to the Free Software | |
23 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, | |
24 | * USA | |
25 | * | |
26 | * The full GNU General Public License is included in this distribution | |
410dc5aa | 27 | * in the file called COPYING. |
8ca151b5 JB |
28 | * |
29 | * Contact Information: | |
cb2f8277 | 30 | * Intel Linux Wireless <linuxwifi@intel.com> |
8ca151b5 JB |
31 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
32 | * | |
33 | * BSD LICENSE | |
34 | * | |
51368bf7 | 35 | * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved. |
8b4139dc | 36 | * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH |
0db056d3 | 37 | * Copyright(c) 2015 - 2016 Intel Deutschland GmbH |
8ca151b5 JB |
38 | * All rights reserved. |
39 | * | |
40 | * Redistribution and use in source and binary forms, with or without | |
41 | * modification, are permitted provided that the following conditions | |
42 | * are met: | |
43 | * | |
44 | * * Redistributions of source code must retain the above copyright | |
45 | * notice, this list of conditions and the following disclaimer. | |
46 | * * Redistributions in binary form must reproduce the above copyright | |
47 | * notice, this list of conditions and the following disclaimer in | |
48 | * the documentation and/or other materials provided with the | |
49 | * distribution. | |
50 | * * Neither the name Intel Corporation nor the names of its | |
51 | * contributors may be used to endorse or promote products derived | |
52 | * from this software without specific prior written permission. | |
53 | * | |
54 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
55 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
56 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
57 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
58 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
59 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
60 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
61 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
62 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
63 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
64 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
65 | * | |
66 | *****************************************************************************/ | |
67 | ||
68 | #include <linux/kernel.h> | |
69 | #include <linux/module.h> | |
70 | #include <linux/slab.h> | |
93803b33 | 71 | #include <linux/etherdevice.h> |
8ca151b5 JB |
72 | |
73 | #include <net/mac80211.h> | |
74 | ||
75 | #include "iwl-debug.h" | |
76 | #include "mvm.h" | |
77 | #include "iwl-modparams.h" | |
78 | #include "fw-api-power.h" | |
79 | ||
80 | #define POWER_KEEP_ALIVE_PERIOD_SEC 25 | |
81 | ||
d623d24a | 82 | static |
e811ada7 | 83 | int iwl_mvm_beacon_filter_send_cmd(struct iwl_mvm *mvm, |
3dd37d05 EP |
84 | struct iwl_beacon_filter_cmd *cmd, |
85 | u32 flags) | |
071d4990 | 86 | { |
d623d24a EG |
87 | IWL_DEBUG_POWER(mvm, "ba_enable_beacon_abort is: %d\n", |
88 | le32_to_cpu(cmd->ba_enable_beacon_abort)); | |
89 | IWL_DEBUG_POWER(mvm, "ba_escape_timer is: %d\n", | |
90 | le32_to_cpu(cmd->ba_escape_timer)); | |
91 | IWL_DEBUG_POWER(mvm, "bf_debug_flag is: %d\n", | |
92 | le32_to_cpu(cmd->bf_debug_flag)); | |
93 | IWL_DEBUG_POWER(mvm, "bf_enable_beacon_filter is: %d\n", | |
94 | le32_to_cpu(cmd->bf_enable_beacon_filter)); | |
95 | IWL_DEBUG_POWER(mvm, "bf_energy_delta is: %d\n", | |
96 | le32_to_cpu(cmd->bf_energy_delta)); | |
97 | IWL_DEBUG_POWER(mvm, "bf_escape_timer is: %d\n", | |
98 | le32_to_cpu(cmd->bf_escape_timer)); | |
99 | IWL_DEBUG_POWER(mvm, "bf_roaming_energy_delta is: %d\n", | |
100 | le32_to_cpu(cmd->bf_roaming_energy_delta)); | |
101 | IWL_DEBUG_POWER(mvm, "bf_roaming_state is: %d\n", | |
102 | le32_to_cpu(cmd->bf_roaming_state)); | |
103 | IWL_DEBUG_POWER(mvm, "bf_temp_threshold is: %d\n", | |
104 | le32_to_cpu(cmd->bf_temp_threshold)); | |
105 | IWL_DEBUG_POWER(mvm, "bf_temp_fast_filter is: %d\n", | |
106 | le32_to_cpu(cmd->bf_temp_fast_filter)); | |
107 | IWL_DEBUG_POWER(mvm, "bf_temp_slow_filter is: %d\n", | |
108 | le32_to_cpu(cmd->bf_temp_slow_filter)); | |
109 | ||
110 | return iwl_mvm_send_cmd_pdu(mvm, REPLY_BEACON_FILTERING_CMD, flags, | |
111 | sizeof(struct iwl_beacon_filter_cmd), cmd); | |
071d4990 AB |
112 | } |
113 | ||
a20fd398 AO |
114 | static |
115 | void iwl_mvm_beacon_filter_set_cqm_params(struct iwl_mvm *mvm, | |
116 | struct ieee80211_vif *vif, | |
cdc306b2 GG |
117 | struct iwl_beacon_filter_cmd *cmd, |
118 | bool d0i3) | |
a20fd398 AO |
119 | { |
120 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
121 | ||
cdc306b2 | 122 | if (vif->bss_conf.cqm_rssi_thold && !d0i3) { |
a20fd398 AO |
123 | cmd->bf_energy_delta = |
124 | cpu_to_le32(vif->bss_conf.cqm_rssi_hyst); | |
125 | /* fw uses an absolute value for this */ | |
126 | cmd->bf_roaming_state = | |
127 | cpu_to_le32(-vif->bss_conf.cqm_rssi_thold); | |
128 | } | |
129 | cmd->ba_enable_beacon_abort = cpu_to_le32(mvmvif->bf_data.ba_enabled); | |
130 | } | |
131 | ||
3f0b2b3e | 132 | static void iwl_mvm_power_log(struct iwl_mvm *mvm, |
e811ada7 | 133 | struct iwl_mac_power_cmd *cmd) |
3f0b2b3e AB |
134 | { |
135 | IWL_DEBUG_POWER(mvm, | |
e811ada7 AB |
136 | "Sending power table command on mac id 0x%X for power level %d, flags = 0x%X\n", |
137 | cmd->id_and_color, iwlmvm_mod_params.power_scheme, | |
3f0b2b3e | 138 | le16_to_cpu(cmd->flags)); |
e811ada7 AB |
139 | IWL_DEBUG_POWER(mvm, "Keep alive = %u sec\n", |
140 | le16_to_cpu(cmd->keep_alive_seconds)); | |
3f0b2b3e | 141 | |
e3c588ec AB |
142 | if (!(cmd->flags & cpu_to_le16(POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK))) { |
143 | IWL_DEBUG_POWER(mvm, "Disable power management\n"); | |
144 | return; | |
145 | } | |
146 | ||
147 | IWL_DEBUG_POWER(mvm, "Rx timeout = %u usec\n", | |
148 | le32_to_cpu(cmd->rx_data_timeout)); | |
149 | IWL_DEBUG_POWER(mvm, "Tx timeout = %u usec\n", | |
150 | le32_to_cpu(cmd->tx_data_timeout)); | |
151 | if (cmd->flags & cpu_to_le16(POWER_FLAGS_SKIP_OVER_DTIM_MSK)) | |
152 | IWL_DEBUG_POWER(mvm, "DTIM periods to skip = %u\n", | |
153 | cmd->skip_dtim_periods); | |
154 | if (cmd->flags & cpu_to_le16(POWER_FLAGS_LPRX_ENA_MSK)) | |
155 | IWL_DEBUG_POWER(mvm, "LP RX RSSI threshold = %u\n", | |
156 | cmd->lprx_rssi_threshold); | |
157 | if (cmd->flags & cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK)) { | |
158 | IWL_DEBUG_POWER(mvm, "uAPSD enabled\n"); | |
159 | IWL_DEBUG_POWER(mvm, "Rx timeout (uAPSD) = %u usec\n", | |
160 | le32_to_cpu(cmd->rx_data_timeout_uapsd)); | |
161 | IWL_DEBUG_POWER(mvm, "Tx timeout (uAPSD) = %u usec\n", | |
162 | le32_to_cpu(cmd->tx_data_timeout_uapsd)); | |
163 | IWL_DEBUG_POWER(mvm, "QNDP TID = %d\n", cmd->qndp_tid); | |
164 | IWL_DEBUG_POWER(mvm, "ACs flags = 0x%x\n", cmd->uapsd_ac_flags); | |
165 | IWL_DEBUG_POWER(mvm, "Max SP = %d\n", cmd->uapsd_max_sp); | |
3f0b2b3e AB |
166 | } |
167 | } | |
168 | ||
175a70b7 AB |
169 | static void iwl_mvm_power_configure_uapsd(struct iwl_mvm *mvm, |
170 | struct ieee80211_vif *vif, | |
171 | struct iwl_mac_power_cmd *cmd) | |
172 | { | |
173 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
174 | enum ieee80211_ac_numbers ac; | |
175 | bool tid_found = false; | |
176 | ||
177 | for (ac = IEEE80211_AC_VO; ac <= IEEE80211_AC_BK; ac++) { | |
178 | if (!mvmvif->queue_params[ac].uapsd) | |
179 | continue; | |
180 | ||
181 | if (mvm->cur_ucode != IWL_UCODE_WOWLAN) | |
182 | cmd->flags |= | |
183 | cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK); | |
184 | ||
185 | cmd->uapsd_ac_flags |= BIT(ac); | |
186 | ||
187 | /* QNDP TID - the highest TID with no admission control */ | |
188 | if (!tid_found && !mvmvif->queue_params[ac].acm) { | |
189 | tid_found = true; | |
190 | switch (ac) { | |
191 | case IEEE80211_AC_VO: | |
192 | cmd->qndp_tid = 6; | |
193 | break; | |
194 | case IEEE80211_AC_VI: | |
195 | cmd->qndp_tid = 5; | |
196 | break; | |
197 | case IEEE80211_AC_BE: | |
198 | cmd->qndp_tid = 0; | |
199 | break; | |
200 | case IEEE80211_AC_BK: | |
201 | cmd->qndp_tid = 1; | |
202 | break; | |
203 | } | |
204 | } | |
205 | } | |
206 | ||
84fd7608 EP |
207 | if (!(cmd->flags & cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK))) { |
208 | #ifdef CONFIG_IWLWIFI_DEBUGFS | |
209 | /* set advanced pm flag with no uapsd ACs to enable ps-poll */ | |
210 | if (mvmvif->dbgfs_pm.use_ps_poll) | |
211 | cmd->flags |= | |
212 | cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK); | |
213 | #endif | |
175a70b7 | 214 | return; |
84fd7608 | 215 | } |
175a70b7 AB |
216 | |
217 | cmd->flags |= cpu_to_le16(POWER_FLAGS_UAPSD_MISBEHAVING_ENA_MSK); | |
218 | ||
219 | if (cmd->uapsd_ac_flags == (BIT(IEEE80211_AC_VO) | | |
220 | BIT(IEEE80211_AC_VI) | | |
221 | BIT(IEEE80211_AC_BE) | | |
222 | BIT(IEEE80211_AC_BK))) { | |
223 | cmd->flags |= cpu_to_le16(POWER_FLAGS_SNOOZE_ENA_MSK); | |
224 | cmd->snooze_interval = cpu_to_le16(IWL_MVM_PS_SNOOZE_INTERVAL); | |
225 | cmd->snooze_window = (mvm->cur_ucode == IWL_UCODE_WOWLAN) ? | |
226 | cpu_to_le16(IWL_MVM_WOWLAN_PS_SNOOZE_WINDOW) : | |
227 | cpu_to_le16(IWL_MVM_PS_SNOOZE_WINDOW); | |
228 | } | |
229 | ||
6e2611f3 | 230 | cmd->uapsd_max_sp = mvm->hw->uapsd_max_sp_len; |
175a70b7 AB |
231 | |
232 | if (mvm->cur_ucode == IWL_UCODE_WOWLAN || cmd->flags & | |
233 | cpu_to_le16(POWER_FLAGS_SNOOZE_ENA_MSK)) { | |
234 | cmd->rx_data_timeout_uapsd = | |
235 | cpu_to_le32(IWL_MVM_WOWLAN_PS_RX_DATA_TIMEOUT); | |
236 | cmd->tx_data_timeout_uapsd = | |
237 | cpu_to_le32(IWL_MVM_WOWLAN_PS_TX_DATA_TIMEOUT); | |
238 | } else { | |
239 | cmd->rx_data_timeout_uapsd = | |
240 | cpu_to_le32(IWL_MVM_UAPSD_RX_DATA_TIMEOUT); | |
241 | cmd->tx_data_timeout_uapsd = | |
242 | cpu_to_le32(IWL_MVM_UAPSD_TX_DATA_TIMEOUT); | |
243 | } | |
244 | ||
245 | if (cmd->flags & cpu_to_le16(POWER_FLAGS_SNOOZE_ENA_MSK)) { | |
246 | cmd->heavy_tx_thld_packets = | |
247 | IWL_MVM_PS_SNOOZE_HEAVY_TX_THLD_PACKETS; | |
248 | cmd->heavy_rx_thld_packets = | |
249 | IWL_MVM_PS_SNOOZE_HEAVY_RX_THLD_PACKETS; | |
250 | } else { | |
251 | cmd->heavy_tx_thld_packets = | |
252 | IWL_MVM_PS_HEAVY_TX_THLD_PACKETS; | |
253 | cmd->heavy_rx_thld_packets = | |
254 | IWL_MVM_PS_HEAVY_RX_THLD_PACKETS; | |
255 | } | |
256 | cmd->heavy_tx_thld_percentage = | |
257 | IWL_MVM_PS_HEAVY_TX_THLD_PERCENT; | |
258 | cmd->heavy_rx_thld_percentage = | |
259 | IWL_MVM_PS_HEAVY_RX_THLD_PERCENT; | |
260 | } | |
261 | ||
ee95ed37 AA |
262 | static void iwl_mvm_p2p_standalone_iterator(void *_data, u8 *mac, |
263 | struct ieee80211_vif *vif) | |
264 | { | |
265 | bool *is_p2p_standalone = _data; | |
266 | ||
267 | switch (ieee80211_vif_type_p2p(vif)) { | |
268 | case NL80211_IFTYPE_P2P_GO: | |
269 | case NL80211_IFTYPE_AP: | |
270 | *is_p2p_standalone = false; | |
271 | break; | |
272 | case NL80211_IFTYPE_STATION: | |
273 | if (vif->bss_conf.assoc) | |
274 | *is_p2p_standalone = false; | |
275 | break; | |
276 | ||
277 | default: | |
278 | break; | |
279 | } | |
280 | } | |
281 | ||
c6e37a68 AA |
282 | static bool iwl_mvm_power_allow_uapsd(struct iwl_mvm *mvm, |
283 | struct ieee80211_vif *vif) | |
284 | { | |
285 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
286 | ||
287 | if (!memcmp(mvmvif->uapsd_misbehaving_bssid, vif->bss_conf.bssid, | |
288 | ETH_ALEN)) | |
289 | return false; | |
290 | ||
c6e37a68 AA |
291 | /* |
292 | * Avoid using uAPSD if P2P client is associated to GO that uses | |
293 | * opportunistic power save. This is due to current FW limitation. | |
294 | */ | |
295 | if (vif->p2p && | |
296 | (vif->bss_conf.p2p_noa_attr.oppps_ctwindow & | |
297 | IEEE80211_P2P_OPPPS_ENABLE_BIT)) | |
298 | return false; | |
299 | ||
0534528e AA |
300 | /* |
301 | * Avoid using uAPSD if client is in DCM - | |
302 | * low latency issue in Miracast | |
303 | */ | |
cf7b491d | 304 | if (iwl_mvm_phy_ctx_count(mvm) >= 2) |
0534528e AA |
305 | return false; |
306 | ||
ee95ed37 AA |
307 | if (vif->p2p) { |
308 | /* Allow U-APSD only if p2p is stand alone */ | |
309 | bool is_p2p_standalone = true; | |
310 | ||
c5241b0c | 311 | if (!iwl_mvm_is_p2p_scm_uapsd_supported(mvm)) |
ee95ed37 AA |
312 | return false; |
313 | ||
314 | ieee80211_iterate_active_interfaces_atomic(mvm->hw, | |
315 | IEEE80211_IFACE_ITER_NORMAL, | |
316 | iwl_mvm_p2p_standalone_iterator, | |
317 | &is_p2p_standalone); | |
318 | ||
319 | if (!is_p2p_standalone) | |
320 | return false; | |
321 | } | |
322 | ||
c6e37a68 AA |
323 | return true; |
324 | } | |
325 | ||
49c6d802 AA |
326 | static bool iwl_mvm_power_is_radar(struct ieee80211_vif *vif) |
327 | { | |
328 | struct ieee80211_chanctx_conf *chanctx_conf; | |
329 | struct ieee80211_channel *chan; | |
330 | bool radar_detect = false; | |
331 | ||
332 | rcu_read_lock(); | |
333 | chanctx_conf = rcu_dereference(vif->chanctx_conf); | |
334 | WARN_ON(!chanctx_conf); | |
335 | if (chanctx_conf) { | |
336 | chan = chanctx_conf->def.chan; | |
337 | radar_detect = chan->flags & IEEE80211_CHAN_RADAR; | |
338 | } | |
339 | rcu_read_unlock(); | |
340 | ||
341 | return radar_detect; | |
342 | } | |
343 | ||
a6449126 JB |
344 | static void iwl_mvm_power_config_skip_dtim(struct iwl_mvm *mvm, |
345 | struct ieee80211_vif *vif, | |
346 | struct iwl_mac_power_cmd *cmd, | |
347 | bool host_awake) | |
348 | { | |
349 | int dtimper = vif->bss_conf.dtim_period ?: 1; | |
350 | int skip; | |
351 | ||
352 | /* disable, in case we're supposed to override */ | |
353 | cmd->skip_dtim_periods = 0; | |
354 | cmd->flags &= ~cpu_to_le16(POWER_FLAGS_SKIP_OVER_DTIM_MSK); | |
355 | ||
356 | if (iwl_mvm_power_is_radar(vif)) | |
357 | return; | |
358 | ||
359 | if (dtimper >= 10) | |
360 | return; | |
361 | ||
362 | /* TODO: check that multicast wake lock is off */ | |
363 | ||
364 | if (host_awake) { | |
365 | if (iwlmvm_mod_params.power_scheme != IWL_POWER_SCHEME_LP) | |
366 | return; | |
367 | skip = 2; | |
368 | } else { | |
369 | int dtimper_tu = dtimper * vif->bss_conf.beacon_int; | |
370 | ||
371 | if (WARN_ON(!dtimper_tu)) | |
372 | return; | |
373 | /* configure skip over dtim up to 306TU - 314 msec */ | |
374 | skip = max_t(u8, 1, 306 / dtimper_tu); | |
375 | } | |
376 | ||
377 | /* the firmware really expects "look at every X DTIMs", so add 1 */ | |
378 | cmd->skip_dtim_periods = 1 + skip; | |
379 | cmd->flags |= cpu_to_le16(POWER_FLAGS_SKIP_OVER_DTIM_MSK); | |
380 | } | |
381 | ||
e811ada7 AB |
382 | static void iwl_mvm_power_build_cmd(struct iwl_mvm *mvm, |
383 | struct ieee80211_vif *vif, | |
9645edb6 JB |
384 | struct iwl_mac_power_cmd *cmd, |
385 | bool host_awake) | |
8ca151b5 | 386 | { |
5387b348 | 387 | int dtimper, bi; |
8ca151b5 | 388 | int keep_alive; |
b571a697 AB |
389 | struct iwl_mvm_vif *mvmvif __maybe_unused = |
390 | iwl_mvm_vif_from_mac80211(vif); | |
8ca151b5 | 391 | |
e811ada7 AB |
392 | cmd->id_and_color = cpu_to_le32(FW_CMD_ID_AND_COLOR(mvmvif->id, |
393 | mvmvif->color)); | |
717e2390 | 394 | dtimper = vif->bss_conf.dtim_period; |
886ca9f5 | 395 | bi = vif->bss_conf.beacon_int; |
e811ada7 | 396 | |
e16cf7ec AB |
397 | /* |
398 | * Regardless of power management state the driver must set | |
399 | * keep alive period. FW will use it for sending keep alive NDPs | |
e811ada7 AB |
400 | * immediately after association. Check that keep alive period |
401 | * is at least 3 * DTIM | |
e16cf7ec | 402 | */ |
5387b348 AA |
403 | keep_alive = DIV_ROUND_UP(ieee80211_tu_to_usec(3 * dtimper * bi), |
404 | USEC_PER_SEC); | |
405 | keep_alive = max(keep_alive, POWER_KEEP_ALIVE_PERIOD_SEC); | |
e811ada7 | 406 | cmd->keep_alive_seconds = cpu_to_le16(keep_alive); |
e16cf7ec | 407 | |
e5e7aa8e | 408 | if (mvm->ps_disabled) |
8ca151b5 JB |
409 | return; |
410 | ||
9a613048 AB |
411 | cmd->flags |= cpu_to_le16(POWER_FLAGS_POWER_SAVE_ENA_MSK); |
412 | ||
b08dbed7 JB |
413 | if (!vif->bss_conf.ps || !mvmvif->pm_enabled) |
414 | return; | |
415 | ||
416 | if (iwl_mvm_vif_low_latency(mvmvif) && vif->p2p && | |
417 | (!fw_has_capa(&mvm->fw->ucode_capa, | |
418 | IWL_UCODE_TLV_CAPA_SHORT_PM_TIMEOUTS) || | |
419 | !IWL_MVM_P2P_LOWLATENCY_PS_ENABLE)) | |
9a613048 AB |
420 | return; |
421 | ||
422 | cmd->flags |= cpu_to_le16(POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK); | |
8ca151b5 | 423 | |
bd4ace2a AB |
424 | if (vif->bss_conf.beacon_rate && |
425 | (vif->bss_conf.beacon_rate->bitrate == 10 || | |
426 | vif->bss_conf.beacon_rate->bitrate == 60)) { | |
427 | cmd->flags |= cpu_to_le16(POWER_FLAGS_LPRX_ENA_MSK); | |
e811ada7 | 428 | cmd->lprx_rssi_threshold = POWER_LPRX_RSSI_THRESHOLD; |
bd4ace2a AB |
429 | } |
430 | ||
9645edb6 | 431 | iwl_mvm_power_config_skip_dtim(mvm, vif, cmd, host_awake); |
8ca151b5 | 432 | |
b08dbed7 | 433 | if (!host_awake) { |
99545924 | 434 | cmd->rx_data_timeout = |
b08dbed7 | 435 | cpu_to_le32(IWL_MVM_WOWLAN_PS_RX_DATA_TIMEOUT); |
99545924 | 436 | cmd->tx_data_timeout = |
b08dbed7 JB |
437 | cpu_to_le32(IWL_MVM_WOWLAN_PS_TX_DATA_TIMEOUT); |
438 | } else if (iwl_mvm_vif_low_latency(mvmvif) && vif->p2p && | |
439 | fw_has_capa(&mvm->fw->ucode_capa, | |
440 | IWL_UCODE_TLV_CAPA_SHORT_PM_TIMEOUTS)) { | |
441 | cmd->tx_data_timeout = | |
442 | cpu_to_le32(IWL_MVM_SHORT_PS_TX_DATA_TIMEOUT); | |
443 | cmd->rx_data_timeout = | |
444 | cpu_to_le32(IWL_MVM_SHORT_PS_RX_DATA_TIMEOUT); | |
ee1e8422 | 445 | } else { |
99545924 | 446 | cmd->rx_data_timeout = |
b08dbed7 | 447 | cpu_to_le32(IWL_MVM_DEFAULT_PS_RX_DATA_TIMEOUT); |
99545924 | 448 | cmd->tx_data_timeout = |
b08dbed7 | 449 | cpu_to_le32(IWL_MVM_DEFAULT_PS_TX_DATA_TIMEOUT); |
ee1e8422 | 450 | } |
b571a697 | 451 | |
c6e37a68 | 452 | if (iwl_mvm_power_allow_uapsd(mvm, vif)) |
175a70b7 | 453 | iwl_mvm_power_configure_uapsd(mvm, vif, cmd); |
e3c588ec | 454 | |
b571a697 AB |
455 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
456 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_KEEP_ALIVE) | |
e811ada7 AB |
457 | cmd->keep_alive_seconds = |
458 | cpu_to_le16(mvmvif->dbgfs_pm.keep_alive_seconds); | |
b571a697 AB |
459 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_SKIP_OVER_DTIM) { |
460 | if (mvmvif->dbgfs_pm.skip_over_dtim) | |
461 | cmd->flags |= | |
462 | cpu_to_le16(POWER_FLAGS_SKIP_OVER_DTIM_MSK); | |
463 | else | |
464 | cmd->flags &= | |
465 | cpu_to_le16(~POWER_FLAGS_SKIP_OVER_DTIM_MSK); | |
466 | } | |
467 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_RX_DATA_TIMEOUT) | |
468 | cmd->rx_data_timeout = | |
469 | cpu_to_le32(mvmvif->dbgfs_pm.rx_data_timeout); | |
470 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_TX_DATA_TIMEOUT) | |
471 | cmd->tx_data_timeout = | |
472 | cpu_to_le32(mvmvif->dbgfs_pm.tx_data_timeout); | |
473 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_SKIP_DTIM_PERIODS) | |
e811ada7 | 474 | cmd->skip_dtim_periods = mvmvif->dbgfs_pm.skip_dtim_periods; |
bd4ace2a AB |
475 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_LPRX_ENA) { |
476 | if (mvmvif->dbgfs_pm.lprx_ena) | |
477 | cmd->flags |= cpu_to_le16(POWER_FLAGS_LPRX_ENA_MSK); | |
478 | else | |
479 | cmd->flags &= cpu_to_le16(~POWER_FLAGS_LPRX_ENA_MSK); | |
480 | } | |
481 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_LPRX_RSSI_THRESHOLD) | |
e811ada7 | 482 | cmd->lprx_rssi_threshold = mvmvif->dbgfs_pm.lprx_rssi_threshold; |
89716344 AB |
483 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_SNOOZE_ENABLE) { |
484 | if (mvmvif->dbgfs_pm.snooze_ena) | |
485 | cmd->flags |= | |
486 | cpu_to_le16(POWER_FLAGS_SNOOZE_ENA_MSK); | |
487 | else | |
488 | cmd->flags &= | |
489 | cpu_to_le16(~POWER_FLAGS_SNOOZE_ENA_MSK); | |
490 | } | |
e45a941d AB |
491 | if (mvmvif->dbgfs_pm.mask & MVM_DEBUGFS_PM_UAPSD_MISBEHAVING) { |
492 | u16 flag = POWER_FLAGS_UAPSD_MISBEHAVING_ENA_MSK; | |
493 | if (mvmvif->dbgfs_pm.uapsd_misbehaving) | |
494 | cmd->flags |= cpu_to_le16(flag); | |
495 | else | |
496 | cmd->flags &= cpu_to_le16(flag); | |
497 | } | |
b571a697 | 498 | #endif /* CONFIG_IWLWIFI_DEBUGFS */ |
8ca151b5 JB |
499 | } |
500 | ||
e5e7aa8e | 501 | static int iwl_mvm_power_send_cmd(struct iwl_mvm *mvm, |
e811ada7 | 502 | struct ieee80211_vif *vif) |
8ca151b5 | 503 | { |
e811ada7 | 504 | struct iwl_mac_power_cmd cmd = {}; |
8ca151b5 | 505 | |
9645edb6 JB |
506 | iwl_mvm_power_build_cmd(mvm, vif, &cmd, |
507 | mvm->cur_ucode != IWL_UCODE_WOWLAN); | |
3f0b2b3e | 508 | iwl_mvm_power_log(mvm, &cmd); |
474b50c3 EG |
509 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
510 | memcpy(&iwl_mvm_vif_from_mac80211(vif)->mac_pwr_cmd, &cmd, sizeof(cmd)); | |
511 | #endif | |
8ca151b5 | 512 | |
a1022927 | 513 | return iwl_mvm_send_cmd_pdu(mvm, MAC_PM_POWER_TABLE, 0, |
06280a2b EG |
514 | sizeof(cmd), &cmd); |
515 | } | |
516 | ||
e5e7aa8e | 517 | int iwl_mvm_power_update_device(struct iwl_mvm *mvm) |
64b928c4 AB |
518 | { |
519 | struct iwl_device_power_cmd cmd = { | |
ceef91c8 | 520 | .flags = 0, |
64b928c4 AB |
521 | }; |
522 | ||
e5e7aa8e EG |
523 | if (iwlmvm_mod_params.power_scheme == IWL_POWER_SCHEME_CAM) |
524 | mvm->ps_disabled = true; | |
525 | ||
ceef91c8 JB |
526 | if (!mvm->ps_disabled) |
527 | cmd.flags |= cpu_to_le16(DEVICE_POWER_FLAGS_POWER_SAVE_ENA_MSK); | |
64b928c4 AB |
528 | |
529 | #ifdef CONFIG_IWLWIFI_DEBUGFS | |
530 | if ((mvm->cur_ucode == IWL_UCODE_WOWLAN) ? mvm->disable_power_off_d3 : | |
531 | mvm->disable_power_off) | |
532 | cmd.flags &= | |
533 | cpu_to_le16(~DEVICE_POWER_FLAGS_POWER_SAVE_ENA_MSK); | |
534 | #endif | |
535 | IWL_DEBUG_POWER(mvm, | |
536 | "Sending device power command with flags = 0x%X\n", | |
537 | cmd.flags); | |
538 | ||
a1022927 | 539 | return iwl_mvm_send_cmd_pdu(mvm, POWER_TABLE_CMD, 0, sizeof(cmd), |
64b928c4 AB |
540 | &cmd); |
541 | } | |
542 | ||
175a70b7 AB |
543 | void iwl_mvm_power_vif_assoc(struct iwl_mvm *mvm, struct ieee80211_vif *vif) |
544 | { | |
545 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
546 | ||
547 | if (memcmp(vif->bss_conf.bssid, mvmvif->uapsd_misbehaving_bssid, | |
548 | ETH_ALEN)) | |
93803b33 | 549 | eth_zero_addr(mvmvif->uapsd_misbehaving_bssid); |
175a70b7 AB |
550 | } |
551 | ||
552 | static void iwl_mvm_power_uapsd_misbehav_ap_iterator(void *_data, u8 *mac, | |
553 | struct ieee80211_vif *vif) | |
554 | { | |
555 | u8 *ap_sta_id = _data; | |
556 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
557 | ||
558 | /* The ap_sta_id is not expected to change during current association | |
559 | * so no explicit protection is needed | |
560 | */ | |
561 | if (mvmvif->ap_sta_id == *ap_sta_id) | |
562 | memcpy(mvmvif->uapsd_misbehaving_bssid, vif->bss_conf.bssid, | |
563 | ETH_ALEN); | |
564 | } | |
565 | ||
0416841d JB |
566 | void iwl_mvm_power_uapsd_misbehaving_ap_notif(struct iwl_mvm *mvm, |
567 | struct iwl_rx_cmd_buffer *rxb) | |
175a70b7 AB |
568 | { |
569 | struct iwl_rx_packet *pkt = rxb_addr(rxb); | |
570 | struct iwl_uapsd_misbehaving_ap_notif *notif = (void *)pkt->data; | |
571 | u8 ap_sta_id = le32_to_cpu(notif->sta_id); | |
572 | ||
573 | ieee80211_iterate_active_interfaces_atomic( | |
574 | mvm->hw, IEEE80211_IFACE_ITER_NORMAL, | |
575 | iwl_mvm_power_uapsd_misbehav_ap_iterator, &ap_sta_id); | |
175a70b7 AB |
576 | } |
577 | ||
19889025 | 578 | struct iwl_power_vifs { |
fa3d07e4 | 579 | struct iwl_mvm *mvm; |
e5e7aa8e | 580 | struct ieee80211_vif *bss_vif; |
8ea0c68f | 581 | struct ieee80211_vif *p2p_vif; |
19889025 AA |
582 | struct ieee80211_vif *ap_vif; |
583 | struct ieee80211_vif *monitor_vif; | |
584 | bool p2p_active; | |
585 | bool bss_active; | |
586 | bool ap_active; | |
587 | bool monitor_active; | |
06280a2b EG |
588 | }; |
589 | ||
128aa948 LC |
590 | static void iwl_mvm_power_disable_pm_iterator(void *_data, u8* mac, |
591 | struct ieee80211_vif *vif) | |
1c2abf72 | 592 | { |
06280a2b | 593 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); |
e5e7aa8e | 594 | |
19889025 | 595 | mvmvif->pm_enabled = false; |
128aa948 LC |
596 | } |
597 | ||
2533edce LC |
598 | static void iwl_mvm_power_ps_disabled_iterator(void *_data, u8* mac, |
599 | struct ieee80211_vif *vif) | |
600 | { | |
601 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
602 | bool *disable_ps = _data; | |
603 | ||
604 | if (mvmvif->phy_ctxt) | |
605 | if (mvmvif->phy_ctxt->id < MAX_PHYS) | |
606 | *disable_ps |= mvmvif->ps_disabled; | |
607 | } | |
608 | ||
128aa948 LC |
609 | static void iwl_mvm_power_get_vifs_iterator(void *_data, u8 *mac, |
610 | struct ieee80211_vif *vif) | |
611 | { | |
612 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
613 | struct iwl_power_vifs *power_iterator = _data; | |
614 | ||
e5e7aa8e EG |
615 | switch (ieee80211_vif_type_p2p(vif)) { |
616 | case NL80211_IFTYPE_P2P_DEVICE: | |
617 | break; | |
618 | ||
619 | case NL80211_IFTYPE_P2P_GO: | |
620 | case NL80211_IFTYPE_AP: | |
19889025 AA |
621 | /* only a single MAC of the same type */ |
622 | WARN_ON(power_iterator->ap_vif); | |
623 | power_iterator->ap_vif = vif; | |
624 | if (mvmvif->phy_ctxt) | |
625 | if (mvmvif->phy_ctxt->id < MAX_PHYS) | |
626 | power_iterator->ap_active = true; | |
e5e7aa8e EG |
627 | break; |
628 | ||
629 | case NL80211_IFTYPE_MONITOR: | |
19889025 AA |
630 | /* only a single MAC of the same type */ |
631 | WARN_ON(power_iterator->monitor_vif); | |
632 | power_iterator->monitor_vif = vif; | |
633 | if (mvmvif->phy_ctxt) | |
634 | if (mvmvif->phy_ctxt->id < MAX_PHYS) | |
635 | power_iterator->monitor_active = true; | |
e5e7aa8e EG |
636 | break; |
637 | ||
638 | case NL80211_IFTYPE_P2P_CLIENT: | |
19889025 | 639 | /* only a single MAC of the same type */ |
8ea0c68f AA |
640 | WARN_ON(power_iterator->p2p_vif); |
641 | power_iterator->p2p_vif = vif; | |
19889025 AA |
642 | if (mvmvif->phy_ctxt) |
643 | if (mvmvif->phy_ctxt->id < MAX_PHYS) | |
644 | power_iterator->p2p_active = true; | |
e5e7aa8e EG |
645 | break; |
646 | ||
647 | case NL80211_IFTYPE_STATION: | |
e5e7aa8e | 648 | power_iterator->bss_vif = vif; |
19889025 AA |
649 | if (mvmvif->phy_ctxt) |
650 | if (mvmvif->phy_ctxt->id < MAX_PHYS) | |
651 | power_iterator->bss_active = true; | |
e5e7aa8e EG |
652 | break; |
653 | ||
654 | default: | |
655 | break; | |
656 | } | |
657 | } | |
1c2abf72 | 658 | |
b1873300 LC |
659 | static void iwl_mvm_power_set_pm(struct iwl_mvm *mvm, |
660 | struct iwl_power_vifs *vifs) | |
e5e7aa8e | 661 | { |
19889025 AA |
662 | struct iwl_mvm_vif *bss_mvmvif = NULL; |
663 | struct iwl_mvm_vif *p2p_mvmvif = NULL; | |
664 | struct iwl_mvm_vif *ap_mvmvif = NULL; | |
665 | bool client_same_channel = false; | |
666 | bool ap_same_channel = false; | |
e5e7aa8e | 667 | |
19889025 | 668 | lockdep_assert_held(&mvm->mutex); |
06280a2b | 669 | |
128aa948 | 670 | /* set pm_enable to false */ |
e5e7aa8e | 671 | ieee80211_iterate_active_interfaces_atomic(mvm->hw, |
128aa948 LC |
672 | IEEE80211_IFACE_ITER_NORMAL, |
673 | iwl_mvm_power_disable_pm_iterator, | |
674 | NULL); | |
19889025 AA |
675 | |
676 | if (vifs->bss_vif) | |
677 | bss_mvmvif = iwl_mvm_vif_from_mac80211(vifs->bss_vif); | |
678 | ||
679 | if (vifs->p2p_vif) | |
680 | p2p_mvmvif = iwl_mvm_vif_from_mac80211(vifs->p2p_vif); | |
681 | ||
682 | if (vifs->ap_vif) | |
683 | ap_mvmvif = iwl_mvm_vif_from_mac80211(vifs->ap_vif); | |
684 | ||
fcf23352 AN |
685 | /* don't allow PM if any TDLS stations exist */ |
686 | if (iwl_mvm_tdls_sta_count(mvm, NULL)) | |
687 | return; | |
688 | ||
19889025 | 689 | /* enable PM on bss if bss stand alone */ |
9474d444 | 690 | if (vifs->bss_active && !vifs->p2p_active && !vifs->ap_active) { |
19889025 AA |
691 | bss_mvmvif->pm_enabled = true; |
692 | return; | |
693 | } | |
694 | ||
695 | /* enable PM on p2p if p2p stand alone */ | |
9474d444 | 696 | if (vifs->p2p_active && !vifs->bss_active && !vifs->ap_active) { |
19889025 AA |
697 | if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_P2P_PM) |
698 | p2p_mvmvif->pm_enabled = true; | |
699 | return; | |
700 | } | |
701 | ||
702 | if (vifs->bss_active && vifs->p2p_active) | |
703 | client_same_channel = (bss_mvmvif->phy_ctxt->id == | |
704 | p2p_mvmvif->phy_ctxt->id); | |
705 | if (vifs->bss_active && vifs->ap_active) | |
706 | ap_same_channel = (bss_mvmvif->phy_ctxt->id == | |
707 | ap_mvmvif->phy_ctxt->id); | |
708 | ||
63ef81cf AA |
709 | /* clients are not stand alone: enable PM if DCM */ |
710 | if (!(client_same_channel || ap_same_channel) && | |
19889025 | 711 | (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BSS_P2P_PS_DCM)) { |
63ef81cf | 712 | if (vifs->bss_active) |
19889025 | 713 | bss_mvmvif->pm_enabled = true; |
63ef81cf AA |
714 | if (vifs->p2p_active && |
715 | (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_P2P_PM)) | |
716 | p2p_mvmvif->pm_enabled = true; | |
717 | return; | |
19889025 AA |
718 | } |
719 | ||
720 | /* | |
721 | * There is only one channel in the system and there are only | |
722 | * bss and p2p clients that share it | |
723 | */ | |
724 | if (client_same_channel && !vifs->ap_active && | |
725 | (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BSS_P2P_PS_SCM)) { | |
726 | /* share same channel*/ | |
727 | bss_mvmvif->pm_enabled = true; | |
728 | if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_P2P_PM) | |
729 | p2p_mvmvif->pm_enabled = true; | |
730 | } | |
1c2abf72 AB |
731 | } |
732 | ||
b571a697 | 733 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
c1cb92fc EG |
734 | int iwl_mvm_power_mac_dbgfs_read(struct iwl_mvm *mvm, |
735 | struct ieee80211_vif *vif, char *buf, | |
736 | int bufsz) | |
e811ada7 | 737 | { |
474b50c3 | 738 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); |
e811ada7 AB |
739 | struct iwl_mac_power_cmd cmd = {}; |
740 | int pos = 0; | |
741 | ||
474b50c3 EG |
742 | mutex_lock(&mvm->mutex); |
743 | memcpy(&cmd, &mvmvif->mac_pwr_cmd, sizeof(cmd)); | |
744 | mutex_unlock(&mvm->mutex); | |
e811ada7 | 745 | |
e811ada7 AB |
746 | pos += scnprintf(buf+pos, bufsz-pos, "power_scheme = %d\n", |
747 | iwlmvm_mod_params.power_scheme); | |
748 | pos += scnprintf(buf+pos, bufsz-pos, "flags = 0x%x\n", | |
749 | le16_to_cpu(cmd.flags)); | |
750 | pos += scnprintf(buf+pos, bufsz-pos, "keep_alive = %d\n", | |
751 | le16_to_cpu(cmd.keep_alive_seconds)); | |
752 | ||
175a70b7 AB |
753 | if (!(cmd.flags & cpu_to_le16(POWER_FLAGS_POWER_MANAGEMENT_ENA_MSK))) |
754 | return pos; | |
755 | ||
756 | pos += scnprintf(buf+pos, bufsz-pos, "skip_over_dtim = %d\n", | |
757 | (cmd.flags & | |
758 | cpu_to_le16(POWER_FLAGS_SKIP_OVER_DTIM_MSK)) ? 1 : 0); | |
759 | pos += scnprintf(buf+pos, bufsz-pos, "skip_dtim_periods = %d\n", | |
760 | cmd.skip_dtim_periods); | |
761 | if (!(cmd.flags & cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK))) { | |
762 | pos += scnprintf(buf+pos, bufsz-pos, "rx_data_timeout = %d\n", | |
763 | le32_to_cpu(cmd.rx_data_timeout)); | |
764 | pos += scnprintf(buf+pos, bufsz-pos, "tx_data_timeout = %d\n", | |
765 | le32_to_cpu(cmd.tx_data_timeout)); | |
e811ada7 | 766 | } |
175a70b7 AB |
767 | if (cmd.flags & cpu_to_le16(POWER_FLAGS_LPRX_ENA_MSK)) |
768 | pos += scnprintf(buf+pos, bufsz-pos, | |
769 | "lprx_rssi_threshold = %d\n", | |
770 | cmd.lprx_rssi_threshold); | |
771 | ||
772 | if (!(cmd.flags & cpu_to_le16(POWER_FLAGS_ADVANCE_PM_ENA_MSK))) | |
773 | return pos; | |
774 | ||
775 | pos += scnprintf(buf+pos, bufsz-pos, "rx_data_timeout_uapsd = %d\n", | |
776 | le32_to_cpu(cmd.rx_data_timeout_uapsd)); | |
777 | pos += scnprintf(buf+pos, bufsz-pos, "tx_data_timeout_uapsd = %d\n", | |
778 | le32_to_cpu(cmd.tx_data_timeout_uapsd)); | |
779 | pos += scnprintf(buf+pos, bufsz-pos, "qndp_tid = %d\n", cmd.qndp_tid); | |
780 | pos += scnprintf(buf+pos, bufsz-pos, "uapsd_ac_flags = 0x%x\n", | |
781 | cmd.uapsd_ac_flags); | |
782 | pos += scnprintf(buf+pos, bufsz-pos, "uapsd_max_sp = %d\n", | |
783 | cmd.uapsd_max_sp); | |
784 | pos += scnprintf(buf+pos, bufsz-pos, "heavy_tx_thld_packets = %d\n", | |
785 | cmd.heavy_tx_thld_packets); | |
786 | pos += scnprintf(buf+pos, bufsz-pos, "heavy_rx_thld_packets = %d\n", | |
787 | cmd.heavy_rx_thld_packets); | |
788 | pos += scnprintf(buf+pos, bufsz-pos, "heavy_tx_thld_percentage = %d\n", | |
789 | cmd.heavy_tx_thld_percentage); | |
790 | pos += scnprintf(buf+pos, bufsz-pos, "heavy_rx_thld_percentage = %d\n", | |
791 | cmd.heavy_rx_thld_percentage); | |
792 | pos += scnprintf(buf+pos, bufsz-pos, "uapsd_misbehaving_enable = %d\n", | |
793 | (cmd.flags & | |
794 | cpu_to_le16(POWER_FLAGS_UAPSD_MISBEHAVING_ENA_MSK)) ? | |
795 | 1 : 0); | |
796 | ||
797 | if (!(cmd.flags & cpu_to_le16(POWER_FLAGS_SNOOZE_ENA_MSK))) | |
798 | return pos; | |
799 | ||
800 | pos += scnprintf(buf+pos, bufsz-pos, "snooze_interval = %d\n", | |
801 | cmd.snooze_interval); | |
802 | pos += scnprintf(buf+pos, bufsz-pos, "snooze_window = %d\n", | |
803 | cmd.snooze_window); | |
804 | ||
e811ada7 AB |
805 | return pos; |
806 | } | |
807 | ||
b571a697 AB |
808 | void |
809 | iwl_mvm_beacon_filter_debugfs_parameters(struct ieee80211_vif *vif, | |
810 | struct iwl_beacon_filter_cmd *cmd) | |
811 | { | |
812 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
813 | struct iwl_dbgfs_bf *dbgfs_bf = &mvmvif->dbgfs_bf; | |
814 | ||
815 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_ENERGY_DELTA) | |
5dca7c24 | 816 | cmd->bf_energy_delta = cpu_to_le32(dbgfs_bf->bf_energy_delta); |
b571a697 AB |
817 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_ROAMING_ENERGY_DELTA) |
818 | cmd->bf_roaming_energy_delta = | |
5dca7c24 | 819 | cpu_to_le32(dbgfs_bf->bf_roaming_energy_delta); |
b571a697 | 820 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_ROAMING_STATE) |
5dca7c24 HG |
821 | cmd->bf_roaming_state = cpu_to_le32(dbgfs_bf->bf_roaming_state); |
822 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_TEMP_THRESHOLD) | |
823 | cmd->bf_temp_threshold = | |
824 | cpu_to_le32(dbgfs_bf->bf_temp_threshold); | |
825 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_TEMP_FAST_FILTER) | |
826 | cmd->bf_temp_fast_filter = | |
827 | cpu_to_le32(dbgfs_bf->bf_temp_fast_filter); | |
828 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_TEMP_SLOW_FILTER) | |
829 | cmd->bf_temp_slow_filter = | |
830 | cpu_to_le32(dbgfs_bf->bf_temp_slow_filter); | |
b571a697 | 831 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_DEBUG_FLAG) |
5dca7c24 | 832 | cmd->bf_debug_flag = cpu_to_le32(dbgfs_bf->bf_debug_flag); |
b571a697 AB |
833 | if (dbgfs_bf->mask & MVM_DEBUGFS_BF_ESCAPE_TIMER) |
834 | cmd->bf_escape_timer = cpu_to_le32(dbgfs_bf->bf_escape_timer); | |
835 | if (dbgfs_bf->mask & MVM_DEBUGFS_BA_ESCAPE_TIMER) | |
836 | cmd->ba_escape_timer = cpu_to_le32(dbgfs_bf->ba_escape_timer); | |
837 | if (dbgfs_bf->mask & MVM_DEBUGFS_BA_ENABLE_BEACON_ABORT) | |
5dca7c24 HG |
838 | cmd->ba_enable_beacon_abort = |
839 | cpu_to_le32(dbgfs_bf->ba_enable_beacon_abort); | |
b571a697 AB |
840 | } |
841 | #endif | |
842 | ||
3dd37d05 EP |
843 | static int _iwl_mvm_enable_beacon_filter(struct iwl_mvm *mvm, |
844 | struct ieee80211_vif *vif, | |
845 | struct iwl_beacon_filter_cmd *cmd, | |
846 | u32 cmd_flags, | |
847 | bool d0i3) | |
7df15b1e HG |
848 | { |
849 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
071d4990 | 850 | int ret; |
7df15b1e | 851 | |
fa7b2e7f | 852 | if (mvmvif != mvm->bf_allowed_vif || !vif->bss_conf.dtim_period || |
7df15b1e HG |
853 | vif->type != NL80211_IFTYPE_STATION || vif->p2p) |
854 | return 0; | |
855 | ||
cdc306b2 | 856 | iwl_mvm_beacon_filter_set_cqm_params(mvm, vif, cmd, d0i3); |
3dd37d05 EP |
857 | if (!d0i3) |
858 | iwl_mvm_beacon_filter_debugfs_parameters(vif, cmd); | |
859 | ret = iwl_mvm_beacon_filter_send_cmd(mvm, cmd, cmd_flags); | |
071d4990 | 860 | |
3dd37d05 EP |
861 | /* don't change bf_enabled in case of temporary d0i3 configuration */ |
862 | if (!ret && !d0i3) | |
a20fd398 | 863 | mvmvif->bf_data.bf_enabled = true; |
071d4990 AB |
864 | |
865 | return ret; | |
7df15b1e HG |
866 | } |
867 | ||
3dd37d05 EP |
868 | int iwl_mvm_enable_beacon_filter(struct iwl_mvm *mvm, |
869 | struct ieee80211_vif *vif, | |
870 | u32 flags) | |
871 | { | |
872 | struct iwl_beacon_filter_cmd cmd = { | |
873 | IWL_BF_CMD_CONFIG_DEFAULTS, | |
874 | .bf_enable_beacon_filter = cpu_to_le32(1), | |
875 | }; | |
876 | ||
877 | return _iwl_mvm_enable_beacon_filter(mvm, vif, &cmd, flags, false); | |
878 | } | |
879 | ||
0db056d3 SS |
880 | static int _iwl_mvm_disable_beacon_filter(struct iwl_mvm *mvm, |
881 | struct ieee80211_vif *vif, | |
882 | u32 flags, bool d0i3) | |
7df15b1e | 883 | { |
071d4990 AB |
884 | struct iwl_beacon_filter_cmd cmd = {}; |
885 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
886 | int ret; | |
7df15b1e | 887 | |
73e5f2c5 | 888 | if (vif->type != NL80211_IFTYPE_STATION || vif->p2p) |
7df15b1e HG |
889 | return 0; |
890 | ||
3dd37d05 | 891 | ret = iwl_mvm_beacon_filter_send_cmd(mvm, &cmd, flags); |
071d4990 | 892 | |
0db056d3 SS |
893 | /* don't change bf_enabled in case of temporary d0i3 configuration */ |
894 | if (!ret && !d0i3) | |
a20fd398 | 895 | mvmvif->bf_data.bf_enabled = false; |
071d4990 AB |
896 | |
897 | return ret; | |
7df15b1e | 898 | } |
e811ada7 | 899 | |
0db056d3 SS |
900 | int iwl_mvm_disable_beacon_filter(struct iwl_mvm *mvm, |
901 | struct ieee80211_vif *vif, | |
902 | u32 flags) | |
903 | { | |
904 | return _iwl_mvm_disable_beacon_filter(mvm, vif, flags, false); | |
905 | } | |
906 | ||
2533edce | 907 | static int iwl_mvm_power_set_ps(struct iwl_mvm *mvm) |
13b72322 | 908 | { |
128aa948 | 909 | bool disable_ps; |
13b72322 EG |
910 | int ret; |
911 | ||
13b72322 | 912 | /* disable PS if CAM */ |
b1873300 | 913 | disable_ps = (iwlmvm_mod_params.power_scheme == IWL_POWER_SCHEME_CAM); |
2533edce LC |
914 | /* ...or if any of the vifs require PS to be off */ |
915 | ieee80211_iterate_active_interfaces_atomic(mvm->hw, | |
916 | IEEE80211_IFACE_ITER_NORMAL, | |
917 | iwl_mvm_power_ps_disabled_iterator, | |
918 | &disable_ps); | |
b1873300 LC |
919 | |
920 | /* update device power state if it has changed */ | |
921 | if (mvm->ps_disabled != disable_ps) { | |
922 | bool old_ps_disabled = mvm->ps_disabled; | |
923 | ||
924 | mvm->ps_disabled = disable_ps; | |
925 | ret = iwl_mvm_power_update_device(mvm); | |
926 | if (ret) { | |
927 | mvm->ps_disabled = old_ps_disabled; | |
928 | return ret; | |
13b72322 EG |
929 | } |
930 | } | |
931 | ||
128aa948 LC |
932 | return 0; |
933 | } | |
934 | ||
ef9203d2 | 935 | static int iwl_mvm_power_set_ba(struct iwl_mvm *mvm, |
8812182e | 936 | struct ieee80211_vif *vif) |
128aa948 | 937 | { |
8812182e | 938 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); |
416ec4f3 AA |
939 | struct iwl_beacon_filter_cmd cmd = { |
940 | IWL_BF_CMD_CONFIG_DEFAULTS, | |
941 | .bf_enable_beacon_filter = cpu_to_le32(1), | |
942 | }; | |
ef9203d2 | 943 | |
8812182e | 944 | if (!mvmvif->bf_data.bf_enabled) |
ef9203d2 LC |
945 | return 0; |
946 | ||
416ec4f3 AA |
947 | if (mvm->cur_ucode == IWL_UCODE_WOWLAN) |
948 | cmd.ba_escape_timer = cpu_to_le32(IWL_BA_ESCAPE_TIMER_D3); | |
949 | ||
950 | mvmvif->bf_data.ba_enabled = !(!mvmvif->pm_enabled || | |
951 | mvm->ps_disabled || | |
952 | !vif->bss_conf.ps || | |
953 | iwl_mvm_vif_low_latency(mvmvif)); | |
ef9203d2 | 954 | |
416ec4f3 | 955 | return _iwl_mvm_enable_beacon_filter(mvm, vif, &cmd, 0, false); |
ef9203d2 LC |
956 | } |
957 | ||
958 | int iwl_mvm_power_update_ps(struct iwl_mvm *mvm) | |
959 | { | |
960 | struct iwl_power_vifs vifs = { | |
961 | .mvm = mvm, | |
962 | }; | |
963 | int ret; | |
964 | ||
965 | lockdep_assert_held(&mvm->mutex); | |
966 | ||
967 | /* get vifs info */ | |
968 | ieee80211_iterate_active_interfaces_atomic(mvm->hw, | |
969 | IEEE80211_IFACE_ITER_NORMAL, | |
970 | iwl_mvm_power_get_vifs_iterator, &vifs); | |
971 | ||
2533edce | 972 | ret = iwl_mvm_power_set_ps(mvm); |
ef9203d2 LC |
973 | if (ret) |
974 | return ret; | |
975 | ||
8812182e AA |
976 | if (vifs.bss_vif) |
977 | return iwl_mvm_power_set_ba(mvm, vifs.bss_vif); | |
978 | ||
979 | return 0; | |
ef9203d2 LC |
980 | } |
981 | ||
982 | int iwl_mvm_power_update_mac(struct iwl_mvm *mvm) | |
983 | { | |
128aa948 LC |
984 | struct iwl_power_vifs vifs = { |
985 | .mvm = mvm, | |
986 | }; | |
128aa948 LC |
987 | int ret; |
988 | ||
989 | lockdep_assert_held(&mvm->mutex); | |
990 | ||
991 | /* get vifs info */ | |
992 | ieee80211_iterate_active_interfaces_atomic(mvm->hw, | |
993 | IEEE80211_IFACE_ITER_NORMAL, | |
994 | iwl_mvm_power_get_vifs_iterator, &vifs); | |
995 | ||
996 | iwl_mvm_power_set_pm(mvm, &vifs); | |
997 | ||
2533edce | 998 | ret = iwl_mvm_power_set_ps(mvm); |
128aa948 LC |
999 | if (ret) |
1000 | return ret; | |
1001 | ||
13b72322 EG |
1002 | if (vifs.bss_vif) { |
1003 | ret = iwl_mvm_power_send_cmd(mvm, vifs.bss_vif); | |
1004 | if (ret) | |
1005 | return ret; | |
1006 | } | |
1007 | ||
1008 | if (vifs.p2p_vif) { | |
1009 | ret = iwl_mvm_power_send_cmd(mvm, vifs.p2p_vif); | |
1010 | if (ret) | |
1011 | return ret; | |
1012 | } | |
1013 | ||
8812182e AA |
1014 | if (vifs.bss_vif) |
1015 | return iwl_mvm_power_set_ba(mvm, vifs.bss_vif); | |
1016 | ||
1017 | return 0; | |
13b72322 EG |
1018 | } |
1019 | ||
3dd37d05 EP |
1020 | int iwl_mvm_update_d0i3_power_mode(struct iwl_mvm *mvm, |
1021 | struct ieee80211_vif *vif, | |
1022 | bool enable, u32 flags) | |
1023 | { | |
1024 | int ret; | |
1025 | struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif); | |
1026 | struct iwl_mac_power_cmd cmd = {}; | |
1027 | ||
1028 | if (vif->type != NL80211_IFTYPE_STATION || vif->p2p) | |
1029 | return 0; | |
1030 | ||
1031 | if (!vif->bss_conf.assoc) | |
1032 | return 0; | |
1033 | ||
9645edb6 | 1034 | iwl_mvm_power_build_cmd(mvm, vif, &cmd, !enable); |
a6449126 | 1035 | |
3dd37d05 | 1036 | iwl_mvm_power_log(mvm, &cmd); |
474b50c3 EG |
1037 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
1038 | memcpy(&mvmvif->mac_pwr_cmd, &cmd, sizeof(cmd)); | |
1039 | #endif | |
3dd37d05 EP |
1040 | ret = iwl_mvm_send_cmd_pdu(mvm, MAC_PM_POWER_TABLE, flags, |
1041 | sizeof(cmd), &cmd); | |
1042 | if (ret) | |
1043 | return ret; | |
1044 | ||
1045 | /* configure beacon filtering */ | |
1046 | if (mvmvif != mvm->bf_allowed_vif) | |
1047 | return 0; | |
1048 | ||
1049 | if (enable) { | |
1050 | struct iwl_beacon_filter_cmd cmd_bf = { | |
1051 | IWL_BF_CMD_CONFIG_D0I3, | |
1052 | .bf_enable_beacon_filter = cpu_to_le32(1), | |
1053 | }; | |
0db056d3 SS |
1054 | /* |
1055 | * When beacon storing is supported - disable beacon filtering | |
1056 | * altogether - the latest beacon will be sent when exiting d0i3 | |
1057 | */ | |
1058 | if (fw_has_capa(&mvm->fw->ucode_capa, | |
1059 | IWL_UCODE_TLV_CAPA_BEACON_STORING)) | |
1060 | ret = _iwl_mvm_disable_beacon_filter(mvm, vif, flags, | |
1061 | true); | |
1062 | else | |
1063 | ret = _iwl_mvm_enable_beacon_filter(mvm, vif, &cmd_bf, | |
1064 | flags, true); | |
3dd37d05 EP |
1065 | } else { |
1066 | if (mvmvif->bf_data.bf_enabled) | |
1067 | ret = iwl_mvm_enable_beacon_filter(mvm, vif, flags); | |
1068 | else | |
1069 | ret = iwl_mvm_disable_beacon_filter(mvm, vif, flags); | |
1070 | } | |
1071 | ||
1072 | return ret; | |
1073 | } |