projects / deliverable / linux.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge tag 'mac80211-next-for-davem-2015-01-15' of git://git.kernel.org/pub/scm/linux...
[deliverable/linux.git] / drivers / net / wireless / iwlwifi / mvm / mac80211.c
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 *
8 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
9 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
10 *
11 * This program is free software; you can redistribute it and/or modify
12 * it under the terms of version 2 of the GNU General Public License as
13 * published by the Free Software Foundation.
14 *
15 * This program is distributed in the hope that it will be useful, but
16 * WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
18 * General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
23 * USA
24 *
25 * The full GNU General Public License is included in this distribution
26 * in the file called COPYING.
27 *
28 * Contact Information:
29 * Intel Linux Wireless <ilw@linux.intel.com>
30 * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
31 *
32 * BSD LICENSE
33 *
34 * Copyright(c) 2012 - 2014 Intel Corporation. All rights reserved.
35 * Copyright(c) 2013 - 2014 Intel Mobile Communications GmbH
36 * All rights reserved.
37 *
38 * Redistribution and use in source and binary forms, with or without
39 * modification, are permitted provided that the following conditions
40 * are met:
41 *
42 * * Redistributions of source code must retain the above copyright
43 * notice, this list of conditions and the following disclaimer.
44 * * Redistributions in binary form must reproduce the above copyright
45 * notice, this list of conditions and the following disclaimer in
46 * the documentation and/or other materials provided with the
47 * distribution.
48 * * Neither the name Intel Corporation nor the names of its
49 * contributors may be used to endorse or promote products derived
50 * from this software without specific prior written permission.
51 *
52 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
53 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
54 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
55 * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
56 * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
57 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
58 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
59 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
60 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
61 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
62 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
63 *
64 *****************************************************************************/
65 #include <linux/kernel.h>
66 #include <linux/slab.h>
67 #include <linux/skbuff.h>
68 #include <linux/netdevice.h>
69 #include <linux/etherdevice.h>
70 #include <linux/ip.h>
71 #include <linux/if_arp.h>
72 #include <linux/devcoredump.h>
73 #include <net/mac80211.h>
74 #include <net/ieee80211_radiotap.h>
75 #include <net/tcp.h>
76
77 #include "iwl-op-mode.h"
78 #include "iwl-io.h"
79 #include "mvm.h"
80 #include "sta.h"
81 #include "time-event.h"
82 #include "iwl-eeprom-parse.h"
83 #include "fw-api-scan.h"
84 #include "iwl-phy-db.h"
85 #include "testmode.h"
86 #include "iwl-fw-error-dump.h"
87 #include "iwl-prph.h"
88
89 static const struct ieee80211_iface_limit iwl_mvm_limits[] = {
90 {
91 .max = 1,
92 .types = BIT(NL80211_IFTYPE_STATION),
93 },
94 {
95 .max = 1,
96 .types = BIT(NL80211_IFTYPE_AP) |
97 BIT(NL80211_IFTYPE_P2P_CLIENT) |
98 BIT(NL80211_IFTYPE_P2P_GO),
99 },
100 {
101 .max = 1,
102 .types = BIT(NL80211_IFTYPE_P2P_DEVICE),
103 },
104 };
105
106 static const struct ieee80211_iface_combination iwl_mvm_iface_combinations[] = {
107 {
108 .num_different_channels = 1,
109 .max_interfaces = 3,
110 .limits = iwl_mvm_limits,
111 .n_limits = ARRAY_SIZE(iwl_mvm_limits),
112 },
113 };
114
115 #ifdef CONFIG_PM_SLEEP
116 static const struct nl80211_wowlan_tcp_data_token_feature
117 iwl_mvm_wowlan_tcp_token_feature = {
118 .min_len = 0,
119 .max_len = 255,
120 .bufsize = IWL_WOWLAN_REMOTE_WAKE_MAX_TOKENS,
121 };
122
123 static const struct wiphy_wowlan_tcp_support iwl_mvm_wowlan_tcp_support = {
124 .tok = &iwl_mvm_wowlan_tcp_token_feature,
125 .data_payload_max = IWL_WOWLAN_TCP_MAX_PACKET_LEN -
126 sizeof(struct ethhdr) -
127 sizeof(struct iphdr) -
128 sizeof(struct tcphdr),
129 .data_interval_max = 65535, /* __le16 in API */
130 .wake_payload_max = IWL_WOWLAN_REMOTE_WAKE_MAX_PACKET_LEN -
131 sizeof(struct ethhdr) -
132 sizeof(struct iphdr) -
133 sizeof(struct tcphdr),
134 .seq = true,
135 };
136 #endif
137
138 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
139 /*
140 * Use the reserved field to indicate magic values.
141 * these values will only be used internally by the driver,
142 * and won't make it to the fw (reserved will be 0).
143 * BC_FILTER_MAGIC_IP - configure the val of this attribute to
144 * be the vif's ip address. in case there is not a single
145 * ip address (0, or more than 1), this attribute will
146 * be skipped.
147 * BC_FILTER_MAGIC_MAC - set the val of this attribute to
148 * the LSB bytes of the vif's mac address
149 */
150 enum {
151 BC_FILTER_MAGIC_NONE = 0,
152 BC_FILTER_MAGIC_IP,
153 BC_FILTER_MAGIC_MAC,
154 };
155
156 static const struct iwl_fw_bcast_filter iwl_mvm_default_bcast_filters[] = {
157 {
158 /* arp */
159 .discard = 0,
160 .frame_type = BCAST_FILTER_FRAME_TYPE_ALL,
161 .attrs = {
162 {
163 /* frame type - arp, hw type - ethernet */
164 .offset_type =
165 BCAST_FILTER_OFFSET_PAYLOAD_START,
166 .offset = sizeof(rfc1042_header),
167 .val = cpu_to_be32(0x08060001),
168 .mask = cpu_to_be32(0xffffffff),
169 },
170 {
171 /* arp dest ip */
172 .offset_type =
173 BCAST_FILTER_OFFSET_PAYLOAD_START,
174 .offset = sizeof(rfc1042_header) + 2 +
175 sizeof(struct arphdr) +
176 ETH_ALEN + sizeof(__be32) +
177 ETH_ALEN,
178 .mask = cpu_to_be32(0xffffffff),
179 /* mark it as special field */
180 .reserved1 = cpu_to_le16(BC_FILTER_MAGIC_IP),
181 },
182 },
183 },
184 {
185 /* dhcp offer bcast */
186 .discard = 0,
187 .frame_type = BCAST_FILTER_FRAME_TYPE_IPV4,
188 .attrs = {
189 {
190 /* udp dest port - 68 (bootp client)*/
191 .offset_type = BCAST_FILTER_OFFSET_IP_END,
192 .offset = offsetof(struct udphdr, dest),
193 .val = cpu_to_be32(0x00440000),
194 .mask = cpu_to_be32(0xffff0000),
195 },
196 {
197 /* dhcp - lsb bytes of client hw address */
198 .offset_type = BCAST_FILTER_OFFSET_IP_END,
199 .offset = 38,
200 .mask = cpu_to_be32(0xffffffff),
201 /* mark it as special field */
202 .reserved1 = cpu_to_le16(BC_FILTER_MAGIC_MAC),
203 },
204 },
205 },
206 /* last filter must be empty */
207 {},
208 };
209 #endif
210
211 void iwl_mvm_ref(struct iwl_mvm *mvm, enum iwl_mvm_ref_type ref_type)
212 {
213 if (!iwl_mvm_is_d0i3_supported(mvm))
214 return;
215
216 IWL_DEBUG_RPM(mvm, "Take mvm reference - type %d\n", ref_type);
217 spin_lock_bh(&mvm->refs_lock);
218 mvm->refs[ref_type]++;
219 spin_unlock_bh(&mvm->refs_lock);
220 iwl_trans_ref(mvm->trans);
221 }
222
223 void iwl_mvm_unref(struct iwl_mvm *mvm, enum iwl_mvm_ref_type ref_type)
224 {
225 if (!iwl_mvm_is_d0i3_supported(mvm))
226 return;
227
228 IWL_DEBUG_RPM(mvm, "Leave mvm reference - type %d\n", ref_type);
229 spin_lock_bh(&mvm->refs_lock);
230 WARN_ON(!mvm->refs[ref_type]--);
231 spin_unlock_bh(&mvm->refs_lock);
232 iwl_trans_unref(mvm->trans);
233 }
234
235 static void iwl_mvm_unref_all_except(struct iwl_mvm *mvm,
236 enum iwl_mvm_ref_type except_ref)
237 {
238 int i, j;
239
240 if (!iwl_mvm_is_d0i3_supported(mvm))
241 return;
242
243 spin_lock_bh(&mvm->refs_lock);
244 for (i = 0; i < IWL_MVM_REF_COUNT; i++) {
245 if (except_ref == i || !mvm->refs[i])
246 continue;
247
248 IWL_DEBUG_RPM(mvm, "Cleanup: remove mvm ref type %d (%d)\n",
249 i, mvm->refs[i]);
250 for (j = 0; j < mvm->refs[i]; j++)
251 iwl_trans_unref(mvm->trans);
252 mvm->refs[i] = 0;
253 }
254 spin_unlock_bh(&mvm->refs_lock);
255 }
256
257 bool iwl_mvm_ref_taken(struct iwl_mvm *mvm)
258 {
259 int i;
260 bool taken = false;
261
262 if (!iwl_mvm_is_d0i3_supported(mvm))
263 return true;
264
265 spin_lock_bh(&mvm->refs_lock);
266 for (i = 0; i < IWL_MVM_REF_COUNT; i++) {
267 if (mvm->refs[i]) {
268 taken = true;
269 break;
270 }
271 }
272 spin_unlock_bh(&mvm->refs_lock);
273
274 return taken;
275 }
276
277 int iwl_mvm_ref_sync(struct iwl_mvm *mvm, enum iwl_mvm_ref_type ref_type)
278 {
279 iwl_mvm_ref(mvm, ref_type);
280
281 if (!wait_event_timeout(mvm->d0i3_exit_waitq,
282 !test_bit(IWL_MVM_STATUS_IN_D0I3, &mvm->status),
283 HZ)) {
284 WARN_ON_ONCE(1);
285 iwl_mvm_unref(mvm, ref_type);
286 return -EIO;
287 }
288
289 return 0;
290 }
291
292 static void iwl_mvm_reset_phy_ctxts(struct iwl_mvm *mvm)
293 {
294 int i;
295
296 memset(mvm->phy_ctxts, 0, sizeof(mvm->phy_ctxts));
297 for (i = 0; i < NUM_PHY_CTX; i++) {
298 mvm->phy_ctxts[i].id = i;
299 mvm->phy_ctxts[i].ref = 0;
300 }
301 }
302
303 int iwl_mvm_mac_setup_register(struct iwl_mvm *mvm)
304 {
305 struct ieee80211_hw *hw = mvm->hw;
306 int num_mac, ret, i;
307
308 /* Tell mac80211 our characteristics */
309 hw->flags = IEEE80211_HW_SIGNAL_DBM |
310 IEEE80211_HW_SPECTRUM_MGMT |
311 IEEE80211_HW_REPORTS_TX_ACK_STATUS |
312 IEEE80211_HW_QUEUE_CONTROL |
313 IEEE80211_HW_WANT_MONITOR_VIF |
314 IEEE80211_HW_SUPPORTS_PS |
315 IEEE80211_HW_SUPPORTS_DYNAMIC_PS |
316 IEEE80211_HW_AMPDU_AGGREGATION |
317 IEEE80211_HW_TIMING_BEACON_ONLY |
318 IEEE80211_HW_CONNECTION_MONITOR |
319 IEEE80211_HW_CHANCTX_STA_CSA |
320 IEEE80211_HW_SUPPORTS_CLONED_SKBS;
321
322 hw->queues = mvm->first_agg_queue;
323 hw->offchannel_tx_hw_queue = IWL_MVM_OFFCHANNEL_QUEUE;
324 hw->radiotap_mcs_details |= IEEE80211_RADIOTAP_MCS_HAVE_FEC |
325 IEEE80211_RADIOTAP_MCS_HAVE_STBC;
326 hw->radiotap_vht_details |= IEEE80211_RADIOTAP_VHT_KNOWN_STBC |
327 IEEE80211_RADIOTAP_VHT_KNOWN_BEAMFORMED;
328 hw->rate_control_algorithm = "iwl-mvm-rs";
329 hw->uapsd_queues = IWL_MVM_UAPSD_QUEUES;
330 hw->uapsd_max_sp_len = IWL_UAPSD_MAX_SP;
331
332 /*
333 * Enable 11w if advertised by firmware and software crypto
334 * is not enabled (as the firmware will interpret some mgmt
335 * packets, so enabling it with software crypto isn't safe)
336 */
337 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_MFP &&
338 !iwlwifi_mod_params.sw_crypto)
339 hw->flags |= IEEE80211_HW_MFP_CAPABLE;
340
341 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_LMAC_SCAN ||
342 mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN) {
343 hw->flags |= IEEE80211_SINGLE_HW_SCAN_ON_ALL_BANDS;
344 hw->wiphy->features |=
345 NL80211_FEATURE_SCHED_SCAN_RANDOM_MAC_ADDR |
346 NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;
347 }
348
349 hw->sta_data_size = sizeof(struct iwl_mvm_sta);
350 hw->vif_data_size = sizeof(struct iwl_mvm_vif);
351 hw->chanctx_data_size = sizeof(u16);
352
353 hw->wiphy->interface_modes = BIT(NL80211_IFTYPE_STATION) |
354 BIT(NL80211_IFTYPE_P2P_CLIENT) |
355 BIT(NL80211_IFTYPE_AP) |
356 BIT(NL80211_IFTYPE_P2P_GO) |
357 BIT(NL80211_IFTYPE_P2P_DEVICE) |
358 BIT(NL80211_IFTYPE_ADHOC);
359
360 hw->wiphy->flags |= WIPHY_FLAG_IBSS_RSN;
361 hw->wiphy->regulatory_flags |= REGULATORY_CUSTOM_REG |
362 REGULATORY_DISABLE_BEACON_HINTS;
363
364 if (mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_GO_UAPSD)
365 hw->wiphy->flags |= WIPHY_FLAG_AP_UAPSD;
366
367 hw->wiphy->flags |= WIPHY_FLAG_HAS_CHANNEL_SWITCH;
368
369 hw->wiphy->iface_combinations = iwl_mvm_iface_combinations;
370 hw->wiphy->n_iface_combinations =
371 ARRAY_SIZE(iwl_mvm_iface_combinations);
372
373 hw->wiphy->max_remain_on_channel_duration = 10000;
374 hw->max_listen_interval = IWL_CONN_MAX_LISTEN_INTERVAL;
375
376 /* Extract MAC address */
377 memcpy(mvm->addresses[0].addr, mvm->nvm_data->hw_addr, ETH_ALEN);
378 hw->wiphy->addresses = mvm->addresses;
379 hw->wiphy->n_addresses = 1;
380
381 /* Extract additional MAC addresses if available */
382 num_mac = (mvm->nvm_data->n_hw_addrs > 1) ?
383 min(IWL_MVM_MAX_ADDRESSES, mvm->nvm_data->n_hw_addrs) : 1;
384
385 for (i = 1; i < num_mac; i++) {
386 memcpy(mvm->addresses[i].addr, mvm->addresses[i-1].addr,
387 ETH_ALEN);
388 mvm->addresses[i].addr[5]++;
389 hw->wiphy->n_addresses++;
390 }
391
392 iwl_mvm_reset_phy_ctxts(mvm);
393
394 hw->wiphy->max_scan_ie_len = iwl_mvm_max_scan_ie_len(mvm, false);
395
396 hw->wiphy->max_scan_ssids = PROBE_OPTION_MAX;
397
398 if (mvm->nvm_data->bands[IEEE80211_BAND_2GHZ].n_channels)
399 hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
400 &mvm->nvm_data->bands[IEEE80211_BAND_2GHZ];
401 if (mvm->nvm_data->bands[IEEE80211_BAND_5GHZ].n_channels)
402 hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
403 &mvm->nvm_data->bands[IEEE80211_BAND_5GHZ];
404
405 hw->wiphy->hw_version = mvm->trans->hw_id;
406
407 if (iwlmvm_mod_params.power_scheme != IWL_POWER_SCHEME_CAM)
408 hw->wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
409 else
410 hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
411
412 if (IWL_UCODE_API(mvm->fw->ucode_ver) >= 10) {
413 hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN;
414 hw->wiphy->max_sched_scan_ssids = PROBE_OPTION_MAX;
415 hw->wiphy->max_match_sets = IWL_SCAN_MAX_PROFILES;
416 /* we create the 802.11 header and zero length SSID IE. */
417 hw->wiphy->max_sched_scan_ie_len =
418 SCAN_OFFLOAD_PROBE_REQ_SIZE - 24 - 2;
419 }
420
421 hw->wiphy->features |= NL80211_FEATURE_P2P_GO_CTWIN |
422 NL80211_FEATURE_LOW_PRIORITY_SCAN |
423 NL80211_FEATURE_P2P_GO_OPPPS |
424 NL80211_FEATURE_DYNAMIC_SMPS |
425 NL80211_FEATURE_STATIC_SMPS |
426 NL80211_FEATURE_SUPPORTS_WMM_ADMISSION;
427
428 if (mvm->fw->ucode_capa.capa[0] &
429 IWL_UCODE_TLV_CAPA_TXPOWER_INSERTION_SUPPORT)
430 hw->wiphy->features |= NL80211_FEATURE_TX_POWER_INSERTION;
431 if (mvm->fw->ucode_capa.capa[0] &
432 IWL_UCODE_TLV_CAPA_QUIET_PERIOD_SUPPORT)
433 hw->wiphy->features |= NL80211_FEATURE_QUIET;
434
435 if (mvm->fw->ucode_capa.capa[0] &
436 IWL_UCODE_TLV_CAPA_DS_PARAM_SET_IE_SUPPORT)
437 hw->wiphy->features |=
438 NL80211_FEATURE_DS_PARAM_SET_IE_IN_PROBES;
439
440 if (mvm->fw->ucode_capa.capa[0] &
441 IWL_UCODE_TLV_CAPA_WFA_TPC_REP_IE_SUPPORT)
442 hw->wiphy->features |= NL80211_FEATURE_WFA_TPC_IE_IN_PROBES;
443
444 mvm->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
445
446 /* currently FW API supports only one optional cipher scheme */
447 if (mvm->fw->cs[0].cipher) {
448 mvm->hw->n_cipher_schemes = 1;
449 mvm->hw->cipher_schemes = &mvm->fw->cs[0];
450 }
451
452 #ifdef CONFIG_PM_SLEEP
453 if (iwl_mvm_is_d0i3_supported(mvm) &&
454 device_can_wakeup(mvm->trans->dev)) {
455 mvm->wowlan.flags = WIPHY_WOWLAN_ANY;
456 hw->wiphy->wowlan = &mvm->wowlan;
457 } else if (mvm->fw->img[IWL_UCODE_WOWLAN].sec[0].len &&
458 mvm->trans->ops->d3_suspend &&
459 mvm->trans->ops->d3_resume &&
460 device_can_wakeup(mvm->trans->dev)) {
461 mvm->wowlan.flags = WIPHY_WOWLAN_MAGIC_PKT |
462 WIPHY_WOWLAN_DISCONNECT |
463 WIPHY_WOWLAN_EAP_IDENTITY_REQ |
464 WIPHY_WOWLAN_RFKILL_RELEASE |
465 WIPHY_WOWLAN_NET_DETECT;
466 if (!iwlwifi_mod_params.sw_crypto)
467 mvm->wowlan.flags |= WIPHY_WOWLAN_SUPPORTS_GTK_REKEY |
468 WIPHY_WOWLAN_GTK_REKEY_FAILURE |
469 WIPHY_WOWLAN_4WAY_HANDSHAKE;
470
471 mvm->wowlan.n_patterns = IWL_WOWLAN_MAX_PATTERNS;
472 mvm->wowlan.pattern_min_len = IWL_WOWLAN_MIN_PATTERN_LEN;
473 mvm->wowlan.pattern_max_len = IWL_WOWLAN_MAX_PATTERN_LEN;
474 mvm->wowlan.max_nd_match_sets = IWL_SCAN_MAX_PROFILES;
475 mvm->wowlan.tcp = &iwl_mvm_wowlan_tcp_support;
476 hw->wiphy->wowlan = &mvm->wowlan;
477 }
478 #endif
479
480 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
481 /* assign default bcast filtering configuration */
482 mvm->bcast_filters = iwl_mvm_default_bcast_filters;
483 #endif
484
485 ret = iwl_mvm_leds_init(mvm);
486 if (ret)
487 return ret;
488
489 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_TDLS_SUPPORT) {
490 IWL_DEBUG_TDLS(mvm, "TDLS supported\n");
491 hw->wiphy->flags |= WIPHY_FLAG_SUPPORTS_TDLS;
492 }
493
494 if (mvm->fw->ucode_capa.capa[0] &
495 IWL_UCODE_TLV_CAPA_TDLS_CHANNEL_SWITCH) {
496 IWL_DEBUG_TDLS(mvm, "TDLS channel switch supported\n");
497 hw->wiphy->features |= NL80211_FEATURE_TDLS_CHANNEL_SWITCH;
498 }
499
500 ret = ieee80211_register_hw(mvm->hw);
501 if (ret)
502 iwl_mvm_leds_exit(mvm);
503
504 return ret;
505 }
506
507 static bool iwl_mvm_defer_tx(struct iwl_mvm *mvm,
508 struct ieee80211_sta *sta,
509 struct sk_buff *skb)
510 {
511 struct iwl_mvm_sta *mvmsta;
512 bool defer = false;
513
514 /*
515 * double check the IN_D0I3 flag both before and after
516 * taking the spinlock, in order to prevent taking
517 * the spinlock when not needed.
518 */
519 if (likely(!test_bit(IWL_MVM_STATUS_IN_D0I3, &mvm->status)))
520 return false;
521
522 spin_lock(&mvm->d0i3_tx_lock);
523 /*
524 * testing the flag again ensures the skb dequeue
525 * loop (on d0i3 exit) hasn't run yet.
526 */
527 if (!test_bit(IWL_MVM_STATUS_IN_D0I3, &mvm->status))
528 goto out;
529
530 mvmsta = iwl_mvm_sta_from_mac80211(sta);
531 if (mvmsta->sta_id == IWL_MVM_STATION_COUNT ||
532 mvmsta->sta_id != mvm->d0i3_ap_sta_id)
533 goto out;
534
535 __skb_queue_tail(&mvm->d0i3_tx, skb);
536 ieee80211_stop_queues(mvm->hw);
537
538 /* trigger wakeup */
539 iwl_mvm_ref(mvm, IWL_MVM_REF_TX);
540 iwl_mvm_unref(mvm, IWL_MVM_REF_TX);
541
542 defer = true;
543 out:
544 spin_unlock(&mvm->d0i3_tx_lock);
545 return defer;
546 }
547
548 static void iwl_mvm_mac_tx(struct ieee80211_hw *hw,
549 struct ieee80211_tx_control *control,
550 struct sk_buff *skb)
551 {
552 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
553 struct ieee80211_sta *sta = control->sta;
554 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
555 struct ieee80211_hdr *hdr = (void *)skb->data;
556
557 if (iwl_mvm_is_radio_killed(mvm)) {
558 IWL_DEBUG_DROP(mvm, "Dropping - RF/CT KILL\n");
559 goto drop;
560 }
561
562 if (IEEE80211_SKB_CB(skb)->hw_queue == IWL_MVM_OFFCHANNEL_QUEUE &&
563 !test_bit(IWL_MVM_STATUS_ROC_RUNNING, &mvm->status) &&
564 !test_bit(IWL_MVM_STATUS_ROC_AUX_RUNNING, &mvm->status))
565 goto drop;
566
567 /* treat non-bufferable MMPDUs as broadcast if sta is sleeping */
568 if (unlikely(info->flags & IEEE80211_TX_CTL_NO_PS_BUFFER &&
569 ieee80211_is_mgmt(hdr->frame_control) &&
570 !ieee80211_is_deauth(hdr->frame_control) &&
571 !ieee80211_is_disassoc(hdr->frame_control) &&
572 !ieee80211_is_action(hdr->frame_control)))
573 sta = NULL;
574
575 if (sta) {
576 if (iwl_mvm_defer_tx(mvm, sta, skb))
577 return;
578 if (iwl_mvm_tx_skb(mvm, skb, sta))
579 goto drop;
580 return;
581 }
582
583 if (iwl_mvm_tx_skb_non_sta(mvm, skb))
584 goto drop;
585 return;
586 drop:
587 ieee80211_free_txskb(hw, skb);
588 }
589
590 static inline bool iwl_enable_rx_ampdu(const struct iwl_cfg *cfg)
591 {
592 if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_RXAGG)
593 return false;
594 return true;
595 }
596
597 static inline bool iwl_enable_tx_ampdu(const struct iwl_cfg *cfg)
598 {
599 if (iwlwifi_mod_params.disable_11n & IWL_DISABLE_HT_TXAGG)
600 return false;
601 if (iwlwifi_mod_params.disable_11n & IWL_ENABLE_HT_TXAGG)
602 return true;
603
604 /* enabled by default */
605 return true;
606 }
607
608 static int iwl_mvm_mac_ampdu_action(struct ieee80211_hw *hw,
609 struct ieee80211_vif *vif,
610 enum ieee80211_ampdu_mlme_action action,
611 struct ieee80211_sta *sta, u16 tid,
612 u16 *ssn, u8 buf_size)
613 {
614 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
615 int ret;
616 bool tx_agg_ref = false;
617
618 IWL_DEBUG_HT(mvm, "A-MPDU action on addr %pM tid %d: action %d\n",
619 sta->addr, tid, action);
620
621 if (!(mvm->nvm_data->sku_cap_11n_enable))
622 return -EACCES;
623
624 /* return from D0i3 before starting a new Tx aggregation */
625 switch (action) {
626 case IEEE80211_AMPDU_TX_START:
627 case IEEE80211_AMPDU_TX_STOP_CONT:
628 case IEEE80211_AMPDU_TX_STOP_FLUSH:
629 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
630 case IEEE80211_AMPDU_TX_OPERATIONAL:
631 /*
632 * for tx start, wait synchronously until D0i3 exit to
633 * get the correct sequence number for the tid.
634 * additionally, some other ampdu actions use direct
635 * target access, which is not handled automatically
636 * by the trans layer (unlike commands), so wait for
637 * d0i3 exit in these cases as well.
638 */
639 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_TX_AGG);
640 if (ret)
641 return ret;
642
643 tx_agg_ref = true;
644 break;
645 default:
646 break;
647 }
648
649 mutex_lock(&mvm->mutex);
650
651 switch (action) {
652 case IEEE80211_AMPDU_RX_START:
653 if (!iwl_enable_rx_ampdu(mvm->cfg)) {
654 ret = -EINVAL;
655 break;
656 }
657 ret = iwl_mvm_sta_rx_agg(mvm, sta, tid, *ssn, true);
658 break;
659 case IEEE80211_AMPDU_RX_STOP:
660 ret = iwl_mvm_sta_rx_agg(mvm, sta, tid, 0, false);
661 break;
662 case IEEE80211_AMPDU_TX_START:
663 if (!iwl_enable_tx_ampdu(mvm->cfg)) {
664 ret = -EINVAL;
665 break;
666 }
667 ret = iwl_mvm_sta_tx_agg_start(mvm, vif, sta, tid, ssn);
668 break;
669 case IEEE80211_AMPDU_TX_STOP_CONT:
670 ret = iwl_mvm_sta_tx_agg_stop(mvm, vif, sta, tid);
671 break;
672 case IEEE80211_AMPDU_TX_STOP_FLUSH:
673 case IEEE80211_AMPDU_TX_STOP_FLUSH_CONT:
674 ret = iwl_mvm_sta_tx_agg_flush(mvm, vif, sta, tid);
675 break;
676 case IEEE80211_AMPDU_TX_OPERATIONAL:
677 ret = iwl_mvm_sta_tx_agg_oper(mvm, vif, sta, tid, buf_size);
678 break;
679 default:
680 WARN_ON_ONCE(1);
681 ret = -EINVAL;
682 break;
683 }
684 mutex_unlock(&mvm->mutex);
685
686 /*
687 * If the tid is marked as started, we won't use it for offloaded
688 * traffic on the next D0i3 entry. It's safe to unref.
689 */
690 if (tx_agg_ref)
691 iwl_mvm_unref(mvm, IWL_MVM_REF_TX_AGG);
692
693 return ret;
694 }
695
696 static void iwl_mvm_cleanup_iterator(void *data, u8 *mac,
697 struct ieee80211_vif *vif)
698 {
699 struct iwl_mvm *mvm = data;
700 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
701
702 mvmvif->uploaded = false;
703 mvmvif->ap_sta_id = IWL_MVM_STATION_COUNT;
704
705 /* does this make sense at all? */
706 mvmvif->color++;
707
708 spin_lock_bh(&mvm->time_event_lock);
709 iwl_mvm_te_clear_data(mvm, &mvmvif->time_event_data);
710 spin_unlock_bh(&mvm->time_event_lock);
711
712 mvmvif->phy_ctxt = NULL;
713 memset(&mvmvif->bf_data, 0, sizeof(mvmvif->bf_data));
714 }
715
716 static ssize_t iwl_mvm_read_coredump(char *buffer, loff_t offset, size_t count,
717 const void *data, size_t datalen)
718 {
719 const struct iwl_mvm_dump_ptrs *dump_ptrs = data;
720 ssize_t bytes_read;
721 ssize_t bytes_read_trans;
722
723 if (offset < dump_ptrs->op_mode_len) {
724 bytes_read = min_t(ssize_t, count,
725 dump_ptrs->op_mode_len - offset);
726 memcpy(buffer, (u8 *)dump_ptrs->op_mode_ptr + offset,
727 bytes_read);
728 offset += bytes_read;
729 count -= bytes_read;
730
731 if (count == 0)
732 return bytes_read;
733 } else {
734 bytes_read = 0;
735 }
736
737 if (!dump_ptrs->trans_ptr)
738 return bytes_read;
739
740 offset -= dump_ptrs->op_mode_len;
741 bytes_read_trans = min_t(ssize_t, count,
742 dump_ptrs->trans_ptr->len - offset);
743 memcpy(buffer + bytes_read,
744 (u8 *)dump_ptrs->trans_ptr->data + offset,
745 bytes_read_trans);
746
747 return bytes_read + bytes_read_trans;
748 }
749
750 static void iwl_mvm_free_coredump(const void *data)
751 {
752 const struct iwl_mvm_dump_ptrs *fw_error_dump = data;
753
754 vfree(fw_error_dump->op_mode_ptr);
755 vfree(fw_error_dump->trans_ptr);
756 kfree(fw_error_dump);
757 }
758
759 void iwl_mvm_fw_error_dump(struct iwl_mvm *mvm)
760 {
761 struct iwl_fw_error_dump_file *dump_file;
762 struct iwl_fw_error_dump_data *dump_data;
763 struct iwl_fw_error_dump_info *dump_info;
764 struct iwl_mvm_dump_ptrs *fw_error_dump;
765 const struct fw_img *img;
766 u32 sram_len, sram_ofs;
767 u32 file_len, rxf_len;
768 unsigned long flags;
769 int reg_val;
770
771 lockdep_assert_held(&mvm->mutex);
772
773 fw_error_dump = kzalloc(sizeof(*fw_error_dump), GFP_KERNEL);
774 if (!fw_error_dump)
775 return;
776
777 img = &mvm->fw->img[mvm->cur_ucode];
778 sram_ofs = img->sec[IWL_UCODE_SECTION_DATA].offset;
779 sram_len = img->sec[IWL_UCODE_SECTION_DATA].len;
780
781 /* reading buffer size */
782 reg_val = iwl_trans_read_prph(mvm->trans, RXF_SIZE_ADDR);
783 rxf_len = (reg_val & RXF_SIZE_BYTE_CNT_MSK) >> RXF_SIZE_BYTE_CND_POS;
784
785 /* the register holds the value divided by 128 */
786 rxf_len = rxf_len << 7;
787
788 file_len = sizeof(*dump_file) +
789 sizeof(*dump_data) * 3 +
790 sram_len +
791 rxf_len +
792 sizeof(*dump_info);
793
794 dump_file = vzalloc(file_len);
795 if (!dump_file) {
796 kfree(fw_error_dump);
797 return;
798 }
799
800 fw_error_dump->op_mode_ptr = dump_file;
801
802 dump_file->barker = cpu_to_le32(IWL_FW_ERROR_DUMP_BARKER);
803 dump_data = (void *)dump_file->data;
804
805 dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_DEV_FW_INFO);
806 dump_data->len = cpu_to_le32(sizeof(*dump_info));
807 dump_info = (void *) dump_data->data;
808 dump_info->device_family =
809 mvm->cfg->device_family == IWL_DEVICE_FAMILY_7000 ?
810 cpu_to_le32(IWL_FW_ERROR_DUMP_FAMILY_7) :
811 cpu_to_le32(IWL_FW_ERROR_DUMP_FAMILY_8);
812 memcpy(dump_info->fw_human_readable, mvm->fw->human_readable,
813 sizeof(dump_info->fw_human_readable));
814 strncpy(dump_info->dev_human_readable, mvm->cfg->name,
815 sizeof(dump_info->dev_human_readable));
816 strncpy(dump_info->bus_human_readable, mvm->dev->bus->name,
817 sizeof(dump_info->bus_human_readable));
818
819 dump_data = iwl_fw_error_next_data(dump_data);
820 dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_RXF);
821 dump_data->len = cpu_to_le32(rxf_len);
822
823 if (iwl_trans_grab_nic_access(mvm->trans, false, &flags)) {
824 u32 *rxf = (void *)dump_data->data;
825 int i;
826
827 for (i = 0; i < (rxf_len / sizeof(u32)); i++) {
828 iwl_trans_write_prph(mvm->trans,
829 RXF_LD_FENCE_OFFSET_ADDR,
830 i * sizeof(u32));
831 rxf[i] = iwl_trans_read_prph(mvm->trans,
832 RXF_FIFO_RD_FENCE_ADDR);
833 }
834 iwl_trans_release_nic_access(mvm->trans, &flags);
835 }
836
837 dump_data = iwl_fw_error_next_data(dump_data);
838 dump_data->type = cpu_to_le32(IWL_FW_ERROR_DUMP_SRAM);
839 dump_data->len = cpu_to_le32(sram_len);
840 iwl_trans_read_mem_bytes(mvm->trans, sram_ofs, dump_data->data,
841 sram_len);
842
843 fw_error_dump->trans_ptr = iwl_trans_dump_data(mvm->trans);
844 fw_error_dump->op_mode_len = file_len;
845 if (fw_error_dump->trans_ptr)
846 file_len += fw_error_dump->trans_ptr->len;
847 dump_file->file_len = cpu_to_le32(file_len);
848
849 dev_coredumpm(mvm->trans->dev, THIS_MODULE, fw_error_dump, 0,
850 GFP_KERNEL, iwl_mvm_read_coredump, iwl_mvm_free_coredump);
851 }
852
853 static void iwl_mvm_restart_cleanup(struct iwl_mvm *mvm)
854 {
855 /* clear the D3 reconfig, we only need it to avoid dumping a
856 * firmware coredump on reconfiguration, we shouldn't do that
857 * on D3->D0 transition
858 */
859 if (!test_and_clear_bit(IWL_MVM_STATUS_D3_RECONFIG, &mvm->status))
860 iwl_mvm_fw_error_dump(mvm);
861
862 iwl_trans_stop_device(mvm->trans);
863
864 mvm->scan_status = IWL_MVM_SCAN_NONE;
865 mvm->ps_disabled = false;
866 mvm->calibrating = false;
867
868 /* just in case one was running */
869 ieee80211_remain_on_channel_expired(mvm->hw);
870
871 ieee80211_iterate_active_interfaces_atomic(
872 mvm->hw, IEEE80211_IFACE_ITER_RESUME_ALL,
873 iwl_mvm_cleanup_iterator, mvm);
874
875 mvm->p2p_device_vif = NULL;
876 mvm->d0i3_ap_sta_id = IWL_MVM_STATION_COUNT;
877
878 iwl_mvm_reset_phy_ctxts(mvm);
879 memset(mvm->fw_key_table, 0, sizeof(mvm->fw_key_table));
880 memset(mvm->sta_drained, 0, sizeof(mvm->sta_drained));
881 memset(mvm->tfd_drained, 0, sizeof(mvm->tfd_drained));
882 memset(&mvm->last_bt_notif, 0, sizeof(mvm->last_bt_notif));
883 memset(&mvm->last_bt_notif_old, 0, sizeof(mvm->last_bt_notif_old));
884 memset(&mvm->last_bt_ci_cmd, 0, sizeof(mvm->last_bt_ci_cmd));
885 memset(&mvm->last_bt_ci_cmd_old, 0, sizeof(mvm->last_bt_ci_cmd_old));
886 memset(&mvm->bt_ack_kill_msk, 0, sizeof(mvm->bt_ack_kill_msk));
887 memset(&mvm->bt_cts_kill_msk, 0, sizeof(mvm->bt_cts_kill_msk));
888
889 ieee80211_wake_queues(mvm->hw);
890
891 /* cleanup all stale references (scan, roc), but keep the
892 * ucode_down ref until reconfig is complete */
893 iwl_mvm_unref_all_except(mvm, IWL_MVM_REF_UCODE_DOWN);
894
895 /* clear any stale d0i3 state */
896 clear_bit(IWL_MVM_STATUS_IN_D0I3, &mvm->status);
897
898 mvm->vif_count = 0;
899 mvm->rx_ba_sessions = 0;
900 }
901
902 int __iwl_mvm_mac_start(struct iwl_mvm *mvm)
903 {
904 int ret;
905
906 lockdep_assert_held(&mvm->mutex);
907
908 /* Clean up some internal and mac80211 state on restart */
909 if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status))
910 iwl_mvm_restart_cleanup(mvm);
911
912 ret = iwl_mvm_up(mvm);
913
914 if (ret && test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status)) {
915 /* Something went wrong - we need to finish some cleanup
916 * that normally iwl_mvm_mac_restart_complete() below
917 * would do.
918 */
919 clear_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status);
920 iwl_mvm_d0i3_enable_tx(mvm, NULL);
921 }
922
923 return ret;
924 }
925
926 static int iwl_mvm_mac_start(struct ieee80211_hw *hw)
927 {
928 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
929 int ret;
930
931 mutex_lock(&mvm->mutex);
932 ret = __iwl_mvm_mac_start(mvm);
933 mutex_unlock(&mvm->mutex);
934
935 return ret;
936 }
937
938 static void iwl_mvm_restart_complete(struct iwl_mvm *mvm)
939 {
940 int ret;
941
942 mutex_lock(&mvm->mutex);
943
944 clear_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status);
945 iwl_mvm_d0i3_enable_tx(mvm, NULL);
946 ret = iwl_mvm_update_quotas(mvm, NULL);
947 if (ret)
948 IWL_ERR(mvm, "Failed to update quotas after restart (%d)\n",
949 ret);
950
951 /* allow transport/FW low power modes */
952 iwl_mvm_unref(mvm, IWL_MVM_REF_UCODE_DOWN);
953
954 /*
955 * If we have TDLS peers, remove them. We don't know the last seqno/PN
956 * of packets the FW sent out, so we must reconnect.
957 */
958 iwl_mvm_teardown_tdls_peers(mvm);
959
960 mutex_unlock(&mvm->mutex);
961 }
962
963 static void iwl_mvm_resume_complete(struct iwl_mvm *mvm)
964 {
965 bool exit_now;
966
967 if (!iwl_mvm_is_d0i3_supported(mvm))
968 return;
969
970 mutex_lock(&mvm->d0i3_suspend_mutex);
971 __clear_bit(D0I3_DEFER_WAKEUP, &mvm->d0i3_suspend_flags);
972 exit_now = __test_and_clear_bit(D0I3_PENDING_WAKEUP,
973 &mvm->d0i3_suspend_flags);
974 mutex_unlock(&mvm->d0i3_suspend_mutex);
975
976 if (exit_now) {
977 IWL_DEBUG_RPM(mvm, "Run deferred d0i3 exit\n");
978 _iwl_mvm_exit_d0i3(mvm);
979 }
980 }
981
982 static void
983 iwl_mvm_mac_reconfig_complete(struct ieee80211_hw *hw,
984 enum ieee80211_reconfig_type reconfig_type)
985 {
986 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
987
988 switch (reconfig_type) {
989 case IEEE80211_RECONFIG_TYPE_RESTART:
990 iwl_mvm_restart_complete(mvm);
991 break;
992 case IEEE80211_RECONFIG_TYPE_SUSPEND:
993 iwl_mvm_resume_complete(mvm);
994 break;
995 }
996 }
997
998 void __iwl_mvm_mac_stop(struct iwl_mvm *mvm)
999 {
1000 lockdep_assert_held(&mvm->mutex);
1001
1002 /*
1003 * Disallow low power states when the FW is down by taking
1004 * the UCODE_DOWN ref. in case of ongoing hw restart the
1005 * ref is already taken, so don't take it again.
1006 */
1007 if (!test_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status))
1008 iwl_mvm_ref(mvm, IWL_MVM_REF_UCODE_DOWN);
1009
1010 /* async_handlers_wk is now blocked */
1011
1012 /*
1013 * The work item could be running or queued if the
1014 * ROC time event stops just as we get here.
1015 */
1016 cancel_work_sync(&mvm->roc_done_wk);
1017
1018 iwl_trans_stop_device(mvm->trans);
1019
1020 iwl_mvm_async_handlers_purge(mvm);
1021 /* async_handlers_list is empty and will stay empty: HW is stopped */
1022
1023 /* the fw is stopped, the aux sta is dead: clean up driver state */
1024 iwl_mvm_del_aux_sta(mvm);
1025
1026 /*
1027 * Clear IN_HW_RESTART flag when stopping the hw (as restart_complete()
1028 * won't be called in this case).
1029 */
1030 clear_bit(IWL_MVM_STATUS_IN_HW_RESTART, &mvm->status);
1031
1032 mvm->ucode_loaded = false;
1033 }
1034
1035 static void iwl_mvm_mac_stop(struct ieee80211_hw *hw)
1036 {
1037 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1038
1039 flush_work(&mvm->d0i3_exit_work);
1040 flush_work(&mvm->async_handlers_wk);
1041 flush_work(&mvm->fw_error_dump_wk);
1042
1043 mutex_lock(&mvm->mutex);
1044 __iwl_mvm_mac_stop(mvm);
1045 mutex_unlock(&mvm->mutex);
1046
1047 /*
1048 * The worker might have been waiting for the mutex, let it run and
1049 * discover that its list is now empty.
1050 */
1051 cancel_work_sync(&mvm->async_handlers_wk);
1052 }
1053
1054 static struct iwl_mvm_phy_ctxt *iwl_mvm_get_free_phy_ctxt(struct iwl_mvm *mvm)
1055 {
1056 u16 i;
1057
1058 lockdep_assert_held(&mvm->mutex);
1059
1060 for (i = 0; i < NUM_PHY_CTX; i++)
1061 if (!mvm->phy_ctxts[i].ref)
1062 return &mvm->phy_ctxts[i];
1063
1064 IWL_ERR(mvm, "No available PHY context\n");
1065 return NULL;
1066 }
1067
1068 static int iwl_mvm_set_tx_power(struct iwl_mvm *mvm, struct ieee80211_vif *vif,
1069 s8 tx_power)
1070 {
1071 /* FW is in charge of regulatory enforcement */
1072 struct iwl_reduce_tx_power_cmd reduce_txpwr_cmd = {
1073 .mac_context_id = iwl_mvm_vif_from_mac80211(vif)->id,
1074 .pwr_restriction = cpu_to_le16(tx_power),
1075 };
1076
1077 return iwl_mvm_send_cmd_pdu(mvm, REDUCE_TX_POWER_CMD, 0,
1078 sizeof(reduce_txpwr_cmd),
1079 &reduce_txpwr_cmd);
1080 }
1081
1082 static int iwl_mvm_mac_add_interface(struct ieee80211_hw *hw,
1083 struct ieee80211_vif *vif)
1084 {
1085 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1086 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1087 int ret;
1088
1089 /*
1090 * make sure D0i3 exit is completed, otherwise a target access
1091 * during tx queue configuration could be done when still in
1092 * D0i3 state.
1093 */
1094 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_ADD_IF);
1095 if (ret)
1096 return ret;
1097
1098 /*
1099 * Not much to do here. The stack will not allow interface
1100 * types or combinations that we didn't advertise, so we
1101 * don't really have to check the types.
1102 */
1103
1104 mutex_lock(&mvm->mutex);
1105
1106 /* Allocate resources for the MAC context, and add it to the fw */
1107 ret = iwl_mvm_mac_ctxt_init(mvm, vif);
1108 if (ret)
1109 goto out_unlock;
1110
1111 /* Counting number of interfaces is needed for legacy PM */
1112 if (vif->type != NL80211_IFTYPE_P2P_DEVICE)
1113 mvm->vif_count++;
1114
1115 /*
1116 * The AP binding flow can be done only after the beacon
1117 * template is configured (which happens only in the mac80211
1118 * start_ap() flow), and adding the broadcast station can happen
1119 * only after the binding.
1120 * In addition, since modifying the MAC before adding a bcast
1121 * station is not allowed by the FW, delay the adding of MAC context to
1122 * the point where we can also add the bcast station.
1123 * In short: there's not much we can do at this point, other than
1124 * allocating resources :)
1125 */
1126 if (vif->type == NL80211_IFTYPE_AP ||
1127 vif->type == NL80211_IFTYPE_ADHOC) {
1128 ret = iwl_mvm_alloc_bcast_sta(mvm, vif);
1129 if (ret) {
1130 IWL_ERR(mvm, "Failed to allocate bcast sta\n");
1131 goto out_release;
1132 }
1133
1134 iwl_mvm_vif_dbgfs_register(mvm, vif);
1135 goto out_unlock;
1136 }
1137
1138 ret = iwl_mvm_mac_ctxt_add(mvm, vif);
1139 if (ret)
1140 goto out_release;
1141
1142 ret = iwl_mvm_power_update_mac(mvm);
1143 if (ret)
1144 goto out_release;
1145
1146 /* beacon filtering */
1147 ret = iwl_mvm_disable_beacon_filter(mvm, vif, 0);
1148 if (ret)
1149 goto out_remove_mac;
1150
1151 if (!mvm->bf_allowed_vif &&
1152 vif->type == NL80211_IFTYPE_STATION && !vif->p2p) {
1153 mvm->bf_allowed_vif = mvmvif;
1154 vif->driver_flags |= IEEE80211_VIF_BEACON_FILTER |
1155 IEEE80211_VIF_SUPPORTS_CQM_RSSI;
1156 if (mvm->fw->ucode_capa.flags &
1157 IWL_UCODE_TLV_FLAGS_UAPSD_SUPPORT &&
1158 !iwlwifi_mod_params.uapsd_disable)
1159 vif->driver_flags |= IEEE80211_VIF_SUPPORTS_UAPSD;
1160 }
1161
1162 /*
1163 * P2P_DEVICE interface does not have a channel context assigned to it,
1164 * so a dedicated PHY context is allocated to it and the corresponding
1165 * MAC context is bound to it at this stage.
1166 */
1167 if (vif->type == NL80211_IFTYPE_P2P_DEVICE) {
1168
1169 mvmvif->phy_ctxt = iwl_mvm_get_free_phy_ctxt(mvm);
1170 if (!mvmvif->phy_ctxt) {
1171 ret = -ENOSPC;
1172 goto out_free_bf;
1173 }
1174
1175 iwl_mvm_phy_ctxt_ref(mvm, mvmvif->phy_ctxt);
1176 ret = iwl_mvm_binding_add_vif(mvm, vif);
1177 if (ret)
1178 goto out_unref_phy;
1179
1180 ret = iwl_mvm_add_bcast_sta(mvm, vif);
1181 if (ret)
1182 goto out_unbind;
1183
1184 /* Save a pointer to p2p device vif, so it can later be used to
1185 * update the p2p device MAC when a GO is started/stopped */
1186 mvm->p2p_device_vif = vif;
1187 }
1188
1189 iwl_mvm_vif_dbgfs_register(mvm, vif);
1190 goto out_unlock;
1191
1192 out_unbind:
1193 iwl_mvm_binding_remove_vif(mvm, vif);
1194 out_unref_phy:
1195 iwl_mvm_phy_ctxt_unref(mvm, mvmvif->phy_ctxt);
1196 out_free_bf:
1197 if (mvm->bf_allowed_vif == mvmvif) {
1198 mvm->bf_allowed_vif = NULL;
1199 vif->driver_flags &= ~(IEEE80211_VIF_BEACON_FILTER |
1200 IEEE80211_VIF_SUPPORTS_CQM_RSSI);
1201 }
1202 out_remove_mac:
1203 mvmvif->phy_ctxt = NULL;
1204 iwl_mvm_mac_ctxt_remove(mvm, vif);
1205 out_release:
1206 if (vif->type != NL80211_IFTYPE_P2P_DEVICE)
1207 mvm->vif_count--;
1208
1209 iwl_mvm_mac_ctxt_release(mvm, vif);
1210 out_unlock:
1211 mutex_unlock(&mvm->mutex);
1212
1213 iwl_mvm_unref(mvm, IWL_MVM_REF_ADD_IF);
1214
1215 return ret;
1216 }
1217
1218 static void iwl_mvm_prepare_mac_removal(struct iwl_mvm *mvm,
1219 struct ieee80211_vif *vif)
1220 {
1221 u32 tfd_msk = iwl_mvm_mac_get_queues_mask(vif);
1222
1223 if (tfd_msk) {
1224 mutex_lock(&mvm->mutex);
1225 iwl_mvm_flush_tx_path(mvm, tfd_msk, true);
1226 mutex_unlock(&mvm->mutex);
1227 }
1228
1229 if (vif->type == NL80211_IFTYPE_P2P_DEVICE) {
1230 /*
1231 * Flush the ROC worker which will flush the OFFCHANNEL queue.
1232 * We assume here that all the packets sent to the OFFCHANNEL
1233 * queue are sent in ROC session.
1234 */
1235 flush_work(&mvm->roc_done_wk);
1236 } else {
1237 /*
1238 * By now, all the AC queues are empty. The AGG queues are
1239 * empty too. We already got all the Tx responses for all the
1240 * packets in the queues. The drain work can have been
1241 * triggered. Flush it.
1242 */
1243 flush_work(&mvm->sta_drained_wk);
1244 }
1245 }
1246
1247 static void iwl_mvm_mac_remove_interface(struct ieee80211_hw *hw,
1248 struct ieee80211_vif *vif)
1249 {
1250 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1251 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1252
1253 iwl_mvm_prepare_mac_removal(mvm, vif);
1254
1255 mutex_lock(&mvm->mutex);
1256
1257 if (mvm->bf_allowed_vif == mvmvif) {
1258 mvm->bf_allowed_vif = NULL;
1259 vif->driver_flags &= ~(IEEE80211_VIF_BEACON_FILTER |
1260 IEEE80211_VIF_SUPPORTS_CQM_RSSI);
1261 }
1262
1263 iwl_mvm_vif_dbgfs_clean(mvm, vif);
1264
1265 /*
1266 * For AP/GO interface, the tear down of the resources allocated to the
1267 * interface is be handled as part of the stop_ap flow.
1268 */
1269 if (vif->type == NL80211_IFTYPE_AP ||
1270 vif->type == NL80211_IFTYPE_ADHOC) {
1271 #ifdef CONFIG_NL80211_TESTMODE
1272 if (vif == mvm->noa_vif) {
1273 mvm->noa_vif = NULL;
1274 mvm->noa_duration = 0;
1275 }
1276 #endif
1277 iwl_mvm_dealloc_bcast_sta(mvm, vif);
1278 goto out_release;
1279 }
1280
1281 if (vif->type == NL80211_IFTYPE_P2P_DEVICE) {
1282 mvm->p2p_device_vif = NULL;
1283 iwl_mvm_rm_bcast_sta(mvm, vif);
1284 iwl_mvm_binding_remove_vif(mvm, vif);
1285 iwl_mvm_phy_ctxt_unref(mvm, mvmvif->phy_ctxt);
1286 mvmvif->phy_ctxt = NULL;
1287 }
1288
1289 if (mvm->vif_count && vif->type != NL80211_IFTYPE_P2P_DEVICE)
1290 mvm->vif_count--;
1291
1292 iwl_mvm_power_update_mac(mvm);
1293 iwl_mvm_mac_ctxt_remove(mvm, vif);
1294
1295 out_release:
1296 iwl_mvm_mac_ctxt_release(mvm, vif);
1297 mutex_unlock(&mvm->mutex);
1298 }
1299
1300 static int iwl_mvm_mac_config(struct ieee80211_hw *hw, u32 changed)
1301 {
1302 return 0;
1303 }
1304
1305 struct iwl_mvm_mc_iter_data {
1306 struct iwl_mvm *mvm;
1307 int port_id;
1308 };
1309
1310 static void iwl_mvm_mc_iface_iterator(void *_data, u8 *mac,
1311 struct ieee80211_vif *vif)
1312 {
1313 struct iwl_mvm_mc_iter_data *data = _data;
1314 struct iwl_mvm *mvm = data->mvm;
1315 struct iwl_mcast_filter_cmd *cmd = mvm->mcast_filter_cmd;
1316 int ret, len;
1317
1318 /* if we don't have free ports, mcast frames will be dropped */
1319 if (WARN_ON_ONCE(data->port_id >= MAX_PORT_ID_NUM))
1320 return;
1321
1322 if (vif->type != NL80211_IFTYPE_STATION ||
1323 !vif->bss_conf.assoc)
1324 return;
1325
1326 cmd->port_id = data->port_id++;
1327 memcpy(cmd->bssid, vif->bss_conf.bssid, ETH_ALEN);
1328 len = roundup(sizeof(*cmd) + cmd->count * ETH_ALEN, 4);
1329
1330 ret = iwl_mvm_send_cmd_pdu(mvm, MCAST_FILTER_CMD, CMD_ASYNC, len, cmd);
1331 if (ret)
1332 IWL_ERR(mvm, "mcast filter cmd error. ret=%d\n", ret);
1333 }
1334
1335 static void iwl_mvm_recalc_multicast(struct iwl_mvm *mvm)
1336 {
1337 struct iwl_mvm_mc_iter_data iter_data = {
1338 .mvm = mvm,
1339 };
1340
1341 lockdep_assert_held(&mvm->mutex);
1342
1343 if (WARN_ON_ONCE(!mvm->mcast_filter_cmd))
1344 return;
1345
1346 ieee80211_iterate_active_interfaces_atomic(
1347 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
1348 iwl_mvm_mc_iface_iterator, &iter_data);
1349 }
1350
1351 static u64 iwl_mvm_prepare_multicast(struct ieee80211_hw *hw,
1352 struct netdev_hw_addr_list *mc_list)
1353 {
1354 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1355 struct iwl_mcast_filter_cmd *cmd;
1356 struct netdev_hw_addr *addr;
1357 int addr_count;
1358 bool pass_all;
1359 int len;
1360
1361 addr_count = netdev_hw_addr_list_count(mc_list);
1362 pass_all = addr_count > MAX_MCAST_FILTERING_ADDRESSES ||
1363 IWL_MVM_FW_MCAST_FILTER_PASS_ALL;
1364 if (pass_all)
1365 addr_count = 0;
1366
1367 len = roundup(sizeof(*cmd) + addr_count * ETH_ALEN, 4);
1368 cmd = kzalloc(len, GFP_ATOMIC);
1369 if (!cmd)
1370 return 0;
1371
1372 if (pass_all) {
1373 cmd->pass_all = 1;
1374 return (u64)(unsigned long)cmd;
1375 }
1376
1377 netdev_hw_addr_list_for_each(addr, mc_list) {
1378 IWL_DEBUG_MAC80211(mvm, "mcast addr (%d): %pM\n",
1379 cmd->count, addr->addr);
1380 memcpy(&cmd->addr_list[cmd->count * ETH_ALEN],
1381 addr->addr, ETH_ALEN);
1382 cmd->count++;
1383 }
1384
1385 return (u64)(unsigned long)cmd;
1386 }
1387
1388 static void iwl_mvm_configure_filter(struct ieee80211_hw *hw,
1389 unsigned int changed_flags,
1390 unsigned int *total_flags,
1391 u64 multicast)
1392 {
1393 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1394 struct iwl_mcast_filter_cmd *cmd = (void *)(unsigned long)multicast;
1395
1396 mutex_lock(&mvm->mutex);
1397
1398 /* replace previous configuration */
1399 kfree(mvm->mcast_filter_cmd);
1400 mvm->mcast_filter_cmd = cmd;
1401
1402 if (!cmd)
1403 goto out;
1404
1405 iwl_mvm_recalc_multicast(mvm);
1406 out:
1407 mutex_unlock(&mvm->mutex);
1408 *total_flags = 0;
1409 }
1410
1411 #ifdef CONFIG_IWLWIFI_BCAST_FILTERING
1412 struct iwl_bcast_iter_data {
1413 struct iwl_mvm *mvm;
1414 struct iwl_bcast_filter_cmd *cmd;
1415 u8 current_filter;
1416 };
1417
1418 static void
1419 iwl_mvm_set_bcast_filter(struct ieee80211_vif *vif,
1420 const struct iwl_fw_bcast_filter *in_filter,
1421 struct iwl_fw_bcast_filter *out_filter)
1422 {
1423 struct iwl_fw_bcast_filter_attr *attr;
1424 int i;
1425
1426 memcpy(out_filter, in_filter, sizeof(*out_filter));
1427
1428 for (i = 0; i < ARRAY_SIZE(out_filter->attrs); i++) {
1429 attr = &out_filter->attrs[i];
1430
1431 if (!attr->mask)
1432 break;
1433
1434 switch (attr->reserved1) {
1435 case cpu_to_le16(BC_FILTER_MAGIC_IP):
1436 if (vif->bss_conf.arp_addr_cnt != 1) {
1437 attr->mask = 0;
1438 continue;
1439 }
1440
1441 attr->val = vif->bss_conf.arp_addr_list[0];
1442 break;
1443 case cpu_to_le16(BC_FILTER_MAGIC_MAC):
1444 attr->val = *(__be32 *)&vif->addr[2];
1445 break;
1446 default:
1447 break;
1448 }
1449 attr->reserved1 = 0;
1450 out_filter->num_attrs++;
1451 }
1452 }
1453
1454 static void iwl_mvm_bcast_filter_iterator(void *_data, u8 *mac,
1455 struct ieee80211_vif *vif)
1456 {
1457 struct iwl_bcast_iter_data *data = _data;
1458 struct iwl_mvm *mvm = data->mvm;
1459 struct iwl_bcast_filter_cmd *cmd = data->cmd;
1460 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1461 struct iwl_fw_bcast_mac *bcast_mac;
1462 int i;
1463
1464 if (WARN_ON(mvmvif->id >= ARRAY_SIZE(cmd->macs)))
1465 return;
1466
1467 bcast_mac = &cmd->macs[mvmvif->id];
1468
1469 /*
1470 * enable filtering only for associated stations, but not for P2P
1471 * Clients
1472 */
1473 if (vif->type != NL80211_IFTYPE_STATION || vif->p2p ||
1474 !vif->bss_conf.assoc)
1475 return;
1476
1477 bcast_mac->default_discard = 1;
1478
1479 /* copy all configured filters */
1480 for (i = 0; mvm->bcast_filters[i].attrs[0].mask; i++) {
1481 /*
1482 * Make sure we don't exceed our filters limit.
1483 * if there is still a valid filter to be configured,
1484 * be on the safe side and just allow bcast for this mac.
1485 */
1486 if (WARN_ON_ONCE(data->current_filter >=
1487 ARRAY_SIZE(cmd->filters))) {
1488 bcast_mac->default_discard = 0;
1489 bcast_mac->attached_filters = 0;
1490 break;
1491 }
1492
1493 iwl_mvm_set_bcast_filter(vif,
1494 &mvm->bcast_filters[i],
1495 &cmd->filters[data->current_filter]);
1496
1497 /* skip current filter if it contains no attributes */
1498 if (!cmd->filters[data->current_filter].num_attrs)
1499 continue;
1500
1501 /* attach the filter to current mac */
1502 bcast_mac->attached_filters |=
1503 cpu_to_le16(BIT(data->current_filter));
1504
1505 data->current_filter++;
1506 }
1507 }
1508
1509 bool iwl_mvm_bcast_filter_build_cmd(struct iwl_mvm *mvm,
1510 struct iwl_bcast_filter_cmd *cmd)
1511 {
1512 struct iwl_bcast_iter_data iter_data = {
1513 .mvm = mvm,
1514 .cmd = cmd,
1515 };
1516
1517 if (IWL_MVM_FW_BCAST_FILTER_PASS_ALL)
1518 return false;
1519
1520 memset(cmd, 0, sizeof(*cmd));
1521 cmd->max_bcast_filters = ARRAY_SIZE(cmd->filters);
1522 cmd->max_macs = ARRAY_SIZE(cmd->macs);
1523
1524 #ifdef CONFIG_IWLWIFI_DEBUGFS
1525 /* use debugfs filters/macs if override is configured */
1526 if (mvm->dbgfs_bcast_filtering.override) {
1527 memcpy(cmd->filters, &mvm->dbgfs_bcast_filtering.cmd.filters,
1528 sizeof(cmd->filters));
1529 memcpy(cmd->macs, &mvm->dbgfs_bcast_filtering.cmd.macs,
1530 sizeof(cmd->macs));
1531 return true;
1532 }
1533 #endif
1534
1535 /* if no filters are configured, do nothing */
1536 if (!mvm->bcast_filters)
1537 return false;
1538
1539 /* configure and attach these filters for each associated sta vif */
1540 ieee80211_iterate_active_interfaces(
1541 mvm->hw, IEEE80211_IFACE_ITER_NORMAL,
1542 iwl_mvm_bcast_filter_iterator, &iter_data);
1543
1544 return true;
1545 }
1546 static int iwl_mvm_configure_bcast_filter(struct iwl_mvm *mvm,
1547 struct ieee80211_vif *vif)
1548 {
1549 struct iwl_bcast_filter_cmd cmd;
1550
1551 if (!(mvm->fw->ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BCAST_FILTERING))
1552 return 0;
1553
1554 if (!iwl_mvm_bcast_filter_build_cmd(mvm, &cmd))
1555 return 0;
1556
1557 return iwl_mvm_send_cmd_pdu(mvm, BCAST_FILTER_CMD, 0,
1558 sizeof(cmd), &cmd);
1559 }
1560 #else
1561 static inline int iwl_mvm_configure_bcast_filter(struct iwl_mvm *mvm,
1562 struct ieee80211_vif *vif)
1563 {
1564 return 0;
1565 }
1566 #endif
1567
1568 static void iwl_mvm_bss_info_changed_station(struct iwl_mvm *mvm,
1569 struct ieee80211_vif *vif,
1570 struct ieee80211_bss_conf *bss_conf,
1571 u32 changes)
1572 {
1573 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1574 int ret;
1575
1576 /*
1577 * Re-calculate the tsf id, as the master-slave relations depend on the
1578 * beacon interval, which was not known when the station interface was
1579 * added.
1580 */
1581 if (changes & BSS_CHANGED_ASSOC && bss_conf->assoc)
1582 iwl_mvm_mac_ctxt_recalc_tsf_id(mvm, vif);
1583
1584 /*
1585 * If we're not associated yet, take the (new) BSSID before associating
1586 * so the firmware knows. If we're already associated, then use the old
1587 * BSSID here, and we'll send a cleared one later in the CHANGED_ASSOC
1588 * branch for disassociation below.
1589 */
1590 if (changes & BSS_CHANGED_BSSID && !mvmvif->associated)
1591 memcpy(mvmvif->bssid, bss_conf->bssid, ETH_ALEN);
1592
1593 ret = iwl_mvm_mac_ctxt_changed(mvm, vif, false, mvmvif->bssid);
1594 if (ret)
1595 IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr);
1596
1597 /* after sending it once, adopt mac80211 data */
1598 memcpy(mvmvif->bssid, bss_conf->bssid, ETH_ALEN);
1599 mvmvif->associated = bss_conf->assoc;
1600
1601 if (changes & BSS_CHANGED_ASSOC) {
1602 if (bss_conf->assoc) {
1603 /* add quota for this interface */
1604 ret = iwl_mvm_update_quotas(mvm, NULL);
1605 if (ret) {
1606 IWL_ERR(mvm, "failed to update quotas\n");
1607 return;
1608 }
1609
1610 if (test_bit(IWL_MVM_STATUS_IN_HW_RESTART,
1611 &mvm->status)) {
1612 /*
1613 * If we're restarting then the firmware will
1614 * obviously have lost synchronisation with
1615 * the AP. It will attempt to synchronise by
1616 * itself, but we can make it more reliable by
1617 * scheduling a session protection time event.
1618 *
1619 * The firmware needs to receive a beacon to
1620 * catch up with synchronisation, use 110% of
1621 * the beacon interval.
1622 *
1623 * Set a large maximum delay to allow for more
1624 * than a single interface.
1625 */
1626 u32 dur = (11 * vif->bss_conf.beacon_int) / 10;
1627 iwl_mvm_protect_session(mvm, vif, dur, dur,
1628 5 * dur, false);
1629 }
1630
1631 iwl_mvm_sf_update(mvm, vif, false);
1632 iwl_mvm_power_vif_assoc(mvm, vif);
1633 if (vif->p2p) {
1634 iwl_mvm_ref(mvm, IWL_MVM_REF_P2P_CLIENT);
1635 iwl_mvm_update_smps(mvm, vif,
1636 IWL_MVM_SMPS_REQ_PROT,
1637 IEEE80211_SMPS_DYNAMIC);
1638 }
1639 } else if (mvmvif->ap_sta_id != IWL_MVM_STATION_COUNT) {
1640 /*
1641 * If update fails - SF might be running in associated
1642 * mode while disassociated - which is forbidden.
1643 */
1644 WARN_ONCE(iwl_mvm_sf_update(mvm, vif, false),
1645 "Failed to update SF upon disassociation\n");
1646
1647 /* remove AP station now that the MAC is unassoc */
1648 ret = iwl_mvm_rm_sta_id(mvm, vif, mvmvif->ap_sta_id);
1649 if (ret)
1650 IWL_ERR(mvm, "failed to remove AP station\n");
1651
1652 if (mvm->d0i3_ap_sta_id == mvmvif->ap_sta_id)
1653 mvm->d0i3_ap_sta_id = IWL_MVM_STATION_COUNT;
1654 mvmvif->ap_sta_id = IWL_MVM_STATION_COUNT;
1655 /* remove quota for this interface */
1656 ret = iwl_mvm_update_quotas(mvm, NULL);
1657 if (ret)
1658 IWL_ERR(mvm, "failed to update quotas\n");
1659
1660 if (vif->p2p)
1661 iwl_mvm_unref(mvm, IWL_MVM_REF_P2P_CLIENT);
1662
1663 /* this will take the cleared BSSID from bss_conf */
1664 ret = iwl_mvm_mac_ctxt_changed(mvm, vif, false, NULL);
1665 if (ret)
1666 IWL_ERR(mvm,
1667 "failed to update MAC %pM (clear after unassoc)\n",
1668 vif->addr);
1669 }
1670
1671 iwl_mvm_recalc_multicast(mvm);
1672 iwl_mvm_configure_bcast_filter(mvm, vif);
1673
1674 /* reset rssi values */
1675 mvmvif->bf_data.ave_beacon_signal = 0;
1676
1677 iwl_mvm_bt_coex_vif_change(mvm);
1678 iwl_mvm_update_smps(mvm, vif, IWL_MVM_SMPS_REQ_TT,
1679 IEEE80211_SMPS_AUTOMATIC);
1680 } else if (changes & BSS_CHANGED_BEACON_INFO) {
1681 /*
1682 * We received a beacon _after_ association so
1683 * remove the session protection.
1684 */
1685 iwl_mvm_remove_time_event(mvm, mvmvif,
1686 &mvmvif->time_event_data);
1687 }
1688
1689 if (changes & BSS_CHANGED_BEACON_INFO) {
1690 iwl_mvm_sf_update(mvm, vif, false);
1691 WARN_ON(iwl_mvm_enable_beacon_filter(mvm, vif, 0));
1692 }
1693
1694 if (changes & (BSS_CHANGED_PS | BSS_CHANGED_P2P_PS | BSS_CHANGED_QOS)) {
1695 ret = iwl_mvm_power_update_mac(mvm);
1696 if (ret)
1697 IWL_ERR(mvm, "failed to update power mode\n");
1698 }
1699
1700 if (changes & BSS_CHANGED_TXPOWER) {
1701 IWL_DEBUG_CALIB(mvm, "Changing TX Power to %d\n",
1702 bss_conf->txpower);
1703 iwl_mvm_set_tx_power(mvm, vif, bss_conf->txpower);
1704 }
1705
1706 if (changes & BSS_CHANGED_CQM) {
1707 IWL_DEBUG_MAC80211(mvm, "cqm info_changed\n");
1708 /* reset cqm events tracking */
1709 mvmvif->bf_data.last_cqm_event = 0;
1710 if (mvmvif->bf_data.bf_enabled) {
1711 ret = iwl_mvm_enable_beacon_filter(mvm, vif, 0);
1712 if (ret)
1713 IWL_ERR(mvm,
1714 "failed to update CQM thresholds\n");
1715 }
1716 }
1717
1718 if (changes & BSS_CHANGED_ARP_FILTER) {
1719 IWL_DEBUG_MAC80211(mvm, "arp filter changed\n");
1720 iwl_mvm_configure_bcast_filter(mvm, vif);
1721 }
1722 }
1723
1724 static int iwl_mvm_start_ap_ibss(struct ieee80211_hw *hw,
1725 struct ieee80211_vif *vif)
1726 {
1727 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1728 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1729 int ret;
1730
1731 /*
1732 * iwl_mvm_mac_ctxt_add() might read directly from the device
1733 * (the system time), so make sure it is available.
1734 */
1735 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_START_AP);
1736 if (ret)
1737 return ret;
1738
1739 mutex_lock(&mvm->mutex);
1740
1741 /* Send the beacon template */
1742 ret = iwl_mvm_mac_ctxt_beacon_changed(mvm, vif);
1743 if (ret)
1744 goto out_unlock;
1745
1746 /*
1747 * Re-calculate the tsf id, as the master-slave relations depend on the
1748 * beacon interval, which was not known when the AP interface was added.
1749 */
1750 if (vif->type == NL80211_IFTYPE_AP)
1751 iwl_mvm_mac_ctxt_recalc_tsf_id(mvm, vif);
1752
1753 /* Add the mac context */
1754 ret = iwl_mvm_mac_ctxt_add(mvm, vif);
1755 if (ret)
1756 goto out_unlock;
1757
1758 /* Perform the binding */
1759 ret = iwl_mvm_binding_add_vif(mvm, vif);
1760 if (ret)
1761 goto out_remove;
1762
1763 /* Send the bcast station. At this stage the TBTT and DTIM time events
1764 * are added and applied to the scheduler */
1765 ret = iwl_mvm_send_add_bcast_sta(mvm, vif);
1766 if (ret)
1767 goto out_unbind;
1768
1769 /* must be set before quota calculations */
1770 mvmvif->ap_ibss_active = true;
1771
1772 /* power updated needs to be done before quotas */
1773 iwl_mvm_power_update_mac(mvm);
1774
1775 ret = iwl_mvm_update_quotas(mvm, NULL);
1776 if (ret)
1777 goto out_quota_failed;
1778
1779 /* Need to update the P2P Device MAC (only GO, IBSS is single vif) */
1780 if (vif->p2p && mvm->p2p_device_vif)
1781 iwl_mvm_mac_ctxt_changed(mvm, mvm->p2p_device_vif, false, NULL);
1782
1783 iwl_mvm_ref(mvm, IWL_MVM_REF_AP_IBSS);
1784
1785 iwl_mvm_bt_coex_vif_change(mvm);
1786
1787 /* we don't support TDLS during DCM */
1788 if (iwl_mvm_phy_ctx_count(mvm) > 1)
1789 iwl_mvm_teardown_tdls_peers(mvm);
1790
1791 mutex_unlock(&mvm->mutex);
1792 return 0;
1793
1794 out_quota_failed:
1795 iwl_mvm_power_update_mac(mvm);
1796 mvmvif->ap_ibss_active = false;
1797 iwl_mvm_send_rm_bcast_sta(mvm, vif);
1798 out_unbind:
1799 iwl_mvm_binding_remove_vif(mvm, vif);
1800 out_remove:
1801 iwl_mvm_mac_ctxt_remove(mvm, vif);
1802 out_unlock:
1803 mutex_unlock(&mvm->mutex);
1804 iwl_mvm_unref(mvm, IWL_MVM_REF_START_AP);
1805 return ret;
1806 }
1807
1808 static void iwl_mvm_stop_ap_ibss(struct ieee80211_hw *hw,
1809 struct ieee80211_vif *vif)
1810 {
1811 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1812 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1813
1814 iwl_mvm_prepare_mac_removal(mvm, vif);
1815
1816 mutex_lock(&mvm->mutex);
1817
1818 /* Handle AP stop while in CSA */
1819 if (rcu_access_pointer(mvm->csa_vif) == vif) {
1820 iwl_mvm_remove_time_event(mvm, mvmvif,
1821 &mvmvif->time_event_data);
1822 RCU_INIT_POINTER(mvm->csa_vif, NULL);
1823 }
1824
1825 if (rcu_access_pointer(mvm->csa_tx_blocked_vif) == vif) {
1826 RCU_INIT_POINTER(mvm->csa_tx_blocked_vif, NULL);
1827 mvm->csa_tx_block_bcn_timeout = 0;
1828 }
1829
1830 mvmvif->ap_ibss_active = false;
1831 mvm->ap_last_beacon_gp2 = 0;
1832
1833 iwl_mvm_bt_coex_vif_change(mvm);
1834
1835 iwl_mvm_unref(mvm, IWL_MVM_REF_AP_IBSS);
1836
1837 /* Need to update the P2P Device MAC (only GO, IBSS is single vif) */
1838 if (vif->p2p && mvm->p2p_device_vif)
1839 iwl_mvm_mac_ctxt_changed(mvm, mvm->p2p_device_vif, false, NULL);
1840
1841 iwl_mvm_update_quotas(mvm, NULL);
1842 iwl_mvm_send_rm_bcast_sta(mvm, vif);
1843 iwl_mvm_binding_remove_vif(mvm, vif);
1844
1845 iwl_mvm_power_update_mac(mvm);
1846
1847 iwl_mvm_mac_ctxt_remove(mvm, vif);
1848
1849 mutex_unlock(&mvm->mutex);
1850 }
1851
1852 static void
1853 iwl_mvm_bss_info_changed_ap_ibss(struct iwl_mvm *mvm,
1854 struct ieee80211_vif *vif,
1855 struct ieee80211_bss_conf *bss_conf,
1856 u32 changes)
1857 {
1858 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
1859
1860 /* Changes will be applied when the AP/IBSS is started */
1861 if (!mvmvif->ap_ibss_active)
1862 return;
1863
1864 if (changes & (BSS_CHANGED_ERP_CTS_PROT | BSS_CHANGED_HT |
1865 BSS_CHANGED_BANDWIDTH | BSS_CHANGED_QOS) &&
1866 iwl_mvm_mac_ctxt_changed(mvm, vif, false, NULL))
1867 IWL_ERR(mvm, "failed to update MAC %pM\n", vif->addr);
1868
1869 /* Need to send a new beacon template to the FW */
1870 if (changes & BSS_CHANGED_BEACON &&
1871 iwl_mvm_mac_ctxt_beacon_changed(mvm, vif))
1872 IWL_WARN(mvm, "Failed updating beacon data\n");
1873
1874 if (changes & BSS_CHANGED_TXPOWER) {
1875 IWL_DEBUG_CALIB(mvm, "Changing TX Power to %d\n",
1876 bss_conf->txpower);
1877 iwl_mvm_set_tx_power(mvm, vif, bss_conf->txpower);
1878 }
1879
1880 }
1881
1882 static void iwl_mvm_bss_info_changed(struct ieee80211_hw *hw,
1883 struct ieee80211_vif *vif,
1884 struct ieee80211_bss_conf *bss_conf,
1885 u32 changes)
1886 {
1887 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1888
1889 /*
1890 * iwl_mvm_bss_info_changed_station() might call
1891 * iwl_mvm_protect_session(), which reads directly from
1892 * the device (the system time), so make sure it is available.
1893 */
1894 if (iwl_mvm_ref_sync(mvm, IWL_MVM_REF_BSS_CHANGED))
1895 return;
1896
1897 mutex_lock(&mvm->mutex);
1898
1899 if (changes & BSS_CHANGED_IDLE && !bss_conf->idle)
1900 iwl_mvm_scan_offload_stop(mvm, true);
1901
1902 switch (vif->type) {
1903 case NL80211_IFTYPE_STATION:
1904 iwl_mvm_bss_info_changed_station(mvm, vif, bss_conf, changes);
1905 break;
1906 case NL80211_IFTYPE_AP:
1907 case NL80211_IFTYPE_ADHOC:
1908 iwl_mvm_bss_info_changed_ap_ibss(mvm, vif, bss_conf, changes);
1909 break;
1910 default:
1911 /* shouldn't happen */
1912 WARN_ON_ONCE(1);
1913 }
1914
1915 mutex_unlock(&mvm->mutex);
1916 iwl_mvm_unref(mvm, IWL_MVM_REF_BSS_CHANGED);
1917 }
1918
1919 static int iwl_mvm_cancel_scan_wait_notif(struct iwl_mvm *mvm,
1920 enum iwl_scan_status scan_type)
1921 {
1922 int ret;
1923 bool wait_for_handlers = false;
1924
1925 mutex_lock(&mvm->mutex);
1926
1927 if (mvm->scan_status != scan_type) {
1928 ret = 0;
1929 /* make sure there are no pending notifications */
1930 wait_for_handlers = true;
1931 goto out;
1932 }
1933
1934 switch (scan_type) {
1935 case IWL_MVM_SCAN_SCHED:
1936 ret = iwl_mvm_scan_offload_stop(mvm, true);
1937 break;
1938 case IWL_MVM_SCAN_OS:
1939 ret = iwl_mvm_cancel_scan(mvm);
1940 break;
1941 case IWL_MVM_SCAN_NONE:
1942 default:
1943 WARN_ON_ONCE(1);
1944 ret = -EINVAL;
1945 break;
1946 }
1947 if (ret)
1948 goto out;
1949
1950 wait_for_handlers = true;
1951 out:
1952 mutex_unlock(&mvm->mutex);
1953
1954 /* make sure we consume the completion notification */
1955 if (wait_for_handlers)
1956 iwl_mvm_wait_for_async_handlers(mvm);
1957
1958 return ret;
1959 }
1960 static int iwl_mvm_mac_hw_scan(struct ieee80211_hw *hw,
1961 struct ieee80211_vif *vif,
1962 struct ieee80211_scan_request *hw_req)
1963 {
1964 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
1965 struct cfg80211_scan_request *req = &hw_req->req;
1966 int ret;
1967
1968 if (req->n_channels == 0 ||
1969 req->n_channels > mvm->fw->ucode_capa.n_scan_channels)
1970 return -EINVAL;
1971
1972 if (!(mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)) {
1973 ret = iwl_mvm_cancel_scan_wait_notif(mvm, IWL_MVM_SCAN_SCHED);
1974 if (ret)
1975 return ret;
1976 }
1977
1978 mutex_lock(&mvm->mutex);
1979
1980 if (mvm->scan_status != IWL_MVM_SCAN_NONE) {
1981 ret = -EBUSY;
1982 goto out;
1983 }
1984
1985 iwl_mvm_ref(mvm, IWL_MVM_REF_SCAN);
1986
1987 if (mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)
1988 ret = iwl_mvm_scan_umac(mvm, vif, hw_req);
1989 else if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_LMAC_SCAN)
1990 ret = iwl_mvm_unified_scan_lmac(mvm, vif, hw_req);
1991 else
1992 ret = iwl_mvm_scan_request(mvm, vif, req);
1993
1994 if (ret)
1995 iwl_mvm_unref(mvm, IWL_MVM_REF_SCAN);
1996 out:
1997 mutex_unlock(&mvm->mutex);
1998 return ret;
1999 }
2000
2001 static void iwl_mvm_mac_cancel_hw_scan(struct ieee80211_hw *hw,
2002 struct ieee80211_vif *vif)
2003 {
2004 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2005
2006 mutex_lock(&mvm->mutex);
2007
2008 iwl_mvm_cancel_scan(mvm);
2009
2010 mutex_unlock(&mvm->mutex);
2011 }
2012
2013 static void
2014 iwl_mvm_mac_allow_buffered_frames(struct ieee80211_hw *hw,
2015 struct ieee80211_sta *sta, u16 tids,
2016 int num_frames,
2017 enum ieee80211_frame_release_type reason,
2018 bool more_data)
2019 {
2020 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2021
2022 /* Called when we need to transmit (a) frame(s) from mac80211 */
2023
2024 iwl_mvm_sta_modify_sleep_tx_count(mvm, sta, reason, num_frames,
2025 tids, more_data, false);
2026 }
2027
2028 static void
2029 iwl_mvm_mac_release_buffered_frames(struct ieee80211_hw *hw,
2030 struct ieee80211_sta *sta, u16 tids,
2031 int num_frames,
2032 enum ieee80211_frame_release_type reason,
2033 bool more_data)
2034 {
2035 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2036
2037 /* Called when we need to transmit (a) frame(s) from agg queue */
2038
2039 iwl_mvm_sta_modify_sleep_tx_count(mvm, sta, reason, num_frames,
2040 tids, more_data, true);
2041 }
2042
2043 static void iwl_mvm_mac_sta_notify(struct ieee80211_hw *hw,
2044 struct ieee80211_vif *vif,
2045 enum sta_notify_cmd cmd,
2046 struct ieee80211_sta *sta)
2047 {
2048 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2049 struct iwl_mvm_sta *mvmsta = iwl_mvm_sta_from_mac80211(sta);
2050 int tid;
2051
2052 switch (cmd) {
2053 case STA_NOTIFY_SLEEP:
2054 if (atomic_read(&mvm->pending_frames[mvmsta->sta_id]) > 0)
2055 ieee80211_sta_block_awake(hw, sta, true);
2056 spin_lock_bh(&mvmsta->lock);
2057 for (tid = 0; tid < IWL_MAX_TID_COUNT; tid++) {
2058 struct iwl_mvm_tid_data *tid_data;
2059
2060 tid_data = &mvmsta->tid_data[tid];
2061 if (tid_data->state != IWL_AGG_ON &&
2062 tid_data->state != IWL_EMPTYING_HW_QUEUE_DELBA)
2063 continue;
2064 if (iwl_mvm_tid_queued(tid_data) == 0)
2065 continue;
2066 ieee80211_sta_set_buffered(sta, tid, true);
2067 }
2068 spin_unlock_bh(&mvmsta->lock);
2069 /*
2070 * The fw updates the STA to be asleep. Tx packets on the Tx
2071 * queues to this station will not be transmitted. The fw will
2072 * send a Tx response with TX_STATUS_FAIL_DEST_PS.
2073 */
2074 break;
2075 case STA_NOTIFY_AWAKE:
2076 if (WARN_ON(mvmsta->sta_id == IWL_MVM_STATION_COUNT))
2077 break;
2078 iwl_mvm_sta_modify_ps_wake(mvm, sta);
2079 break;
2080 default:
2081 break;
2082 }
2083 }
2084
2085 static void iwl_mvm_sta_pre_rcu_remove(struct ieee80211_hw *hw,
2086 struct ieee80211_vif *vif,
2087 struct ieee80211_sta *sta)
2088 {
2089 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2090 struct iwl_mvm_sta *mvm_sta = (void *)sta->drv_priv;
2091
2092 /*
2093 * This is called before mac80211 does RCU synchronisation,
2094 * so here we already invalidate our internal RCU-protected
2095 * station pointer. The rest of the code will thus no longer
2096 * be able to find the station this way, and we don't rely
2097 * on further RCU synchronisation after the sta_state()
2098 * callback deleted the station.
2099 */
2100 mutex_lock(&mvm->mutex);
2101 if (sta == rcu_access_pointer(mvm->fw_id_to_mac_id[mvm_sta->sta_id]))
2102 rcu_assign_pointer(mvm->fw_id_to_mac_id[mvm_sta->sta_id],
2103 ERR_PTR(-ENOENT));
2104 mutex_unlock(&mvm->mutex);
2105 }
2106
2107 static int iwl_mvm_mac_sta_state(struct ieee80211_hw *hw,
2108 struct ieee80211_vif *vif,
2109 struct ieee80211_sta *sta,
2110 enum ieee80211_sta_state old_state,
2111 enum ieee80211_sta_state new_state)
2112 {
2113 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2114 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2115 int ret;
2116
2117 IWL_DEBUG_MAC80211(mvm, "station %pM state change %d->%d\n",
2118 sta->addr, old_state, new_state);
2119
2120 /* this would be a mac80211 bug ... but don't crash */
2121 if (WARN_ON_ONCE(!mvmvif->phy_ctxt))
2122 return -EINVAL;
2123
2124 /* if a STA is being removed, reuse its ID */
2125 flush_work(&mvm->sta_drained_wk);
2126
2127 mutex_lock(&mvm->mutex);
2128 if (old_state == IEEE80211_STA_NOTEXIST &&
2129 new_state == IEEE80211_STA_NONE) {
2130 /*
2131 * Firmware bug - it'll crash if the beacon interval is less
2132 * than 16. We can't avoid connecting at all, so refuse the
2133 * station state change, this will cause mac80211 to abandon
2134 * attempts to connect to this AP, and eventually wpa_s will
2135 * blacklist the AP...
2136 */
2137 if (vif->type == NL80211_IFTYPE_STATION &&
2138 vif->bss_conf.beacon_int < 16) {
2139 IWL_ERR(mvm,
2140 "AP %pM beacon interval is %d, refusing due to firmware bug!\n",
2141 sta->addr, vif->bss_conf.beacon_int);
2142 ret = -EINVAL;
2143 goto out_unlock;
2144 }
2145
2146 if (sta->tdls &&
2147 (vif->p2p ||
2148 iwl_mvm_tdls_sta_count(mvm, NULL) ==
2149 IWL_MVM_TDLS_STA_COUNT ||
2150 iwl_mvm_phy_ctx_count(mvm) > 1)) {
2151 IWL_DEBUG_MAC80211(mvm, "refusing TDLS sta\n");
2152 ret = -EBUSY;
2153 goto out_unlock;
2154 }
2155
2156 ret = iwl_mvm_add_sta(mvm, vif, sta);
2157 if (sta->tdls && ret == 0)
2158 iwl_mvm_recalc_tdls_state(mvm, vif, true);
2159 } else if (old_state == IEEE80211_STA_NONE &&
2160 new_state == IEEE80211_STA_AUTH) {
2161 /*
2162 * EBS may be disabled due to previous failures reported by FW.
2163 * Reset EBS status here assuming environment has been changed.
2164 */
2165 mvm->last_ebs_successful = true;
2166 ret = 0;
2167 } else if (old_state == IEEE80211_STA_AUTH &&
2168 new_state == IEEE80211_STA_ASSOC) {
2169 ret = iwl_mvm_update_sta(mvm, vif, sta);
2170 if (ret == 0)
2171 iwl_mvm_rs_rate_init(mvm, sta,
2172 mvmvif->phy_ctxt->channel->band,
2173 true);
2174 } else if (old_state == IEEE80211_STA_ASSOC &&
2175 new_state == IEEE80211_STA_AUTHORIZED) {
2176
2177 /* we don't support TDLS during DCM */
2178 if (iwl_mvm_phy_ctx_count(mvm) > 1)
2179 iwl_mvm_teardown_tdls_peers(mvm);
2180
2181 /* enable beacon filtering */
2182 WARN_ON(iwl_mvm_enable_beacon_filter(mvm, vif, 0));
2183 ret = 0;
2184 } else if (old_state == IEEE80211_STA_AUTHORIZED &&
2185 new_state == IEEE80211_STA_ASSOC) {
2186 /* disable beacon filtering */
2187 WARN_ON(iwl_mvm_disable_beacon_filter(mvm, vif, 0));
2188 ret = 0;
2189 } else if (old_state == IEEE80211_STA_ASSOC &&
2190 new_state == IEEE80211_STA_AUTH) {
2191 ret = 0;
2192 } else if (old_state == IEEE80211_STA_AUTH &&
2193 new_state == IEEE80211_STA_NONE) {
2194 ret = 0;
2195 } else if (old_state == IEEE80211_STA_NONE &&
2196 new_state == IEEE80211_STA_NOTEXIST) {
2197 ret = iwl_mvm_rm_sta(mvm, vif, sta);
2198 if (sta->tdls)
2199 iwl_mvm_recalc_tdls_state(mvm, vif, false);
2200 } else {
2201 ret = -EIO;
2202 }
2203 out_unlock:
2204 mutex_unlock(&mvm->mutex);
2205
2206 if (sta->tdls && ret == 0) {
2207 if (old_state == IEEE80211_STA_NOTEXIST &&
2208 new_state == IEEE80211_STA_NONE)
2209 ieee80211_reserve_tid(sta, IWL_MVM_TDLS_FW_TID);
2210 else if (old_state == IEEE80211_STA_NONE &&
2211 new_state == IEEE80211_STA_NOTEXIST)
2212 ieee80211_unreserve_tid(sta, IWL_MVM_TDLS_FW_TID);
2213 }
2214
2215 return ret;
2216 }
2217
2218 static int iwl_mvm_mac_set_rts_threshold(struct ieee80211_hw *hw, u32 value)
2219 {
2220 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2221
2222 mvm->rts_threshold = value;
2223
2224 return 0;
2225 }
2226
2227 static void iwl_mvm_sta_rc_update(struct ieee80211_hw *hw,
2228 struct ieee80211_vif *vif,
2229 struct ieee80211_sta *sta, u32 changed)
2230 {
2231 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2232
2233 if (vif->type == NL80211_IFTYPE_STATION &&
2234 changed & IEEE80211_RC_NSS_CHANGED)
2235 iwl_mvm_sf_update(mvm, vif, false);
2236 }
2237
2238 static int iwl_mvm_mac_conf_tx(struct ieee80211_hw *hw,
2239 struct ieee80211_vif *vif, u16 ac,
2240 const struct ieee80211_tx_queue_params *params)
2241 {
2242 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2243 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2244
2245 mvmvif->queue_params[ac] = *params;
2246
2247 /*
2248 * No need to update right away, we'll get BSS_CHANGED_QOS
2249 * The exception is P2P_DEVICE interface which needs immediate update.
2250 */
2251 if (vif->type == NL80211_IFTYPE_P2P_DEVICE) {
2252 int ret;
2253
2254 mutex_lock(&mvm->mutex);
2255 ret = iwl_mvm_mac_ctxt_changed(mvm, vif, false, NULL);
2256 mutex_unlock(&mvm->mutex);
2257 return ret;
2258 }
2259 return 0;
2260 }
2261
2262 static void iwl_mvm_mac_mgd_prepare_tx(struct ieee80211_hw *hw,
2263 struct ieee80211_vif *vif)
2264 {
2265 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2266 u32 duration = min(IWL_MVM_TE_SESSION_PROTECTION_MAX_TIME_MS,
2267 200 + vif->bss_conf.beacon_int);
2268 u32 min_duration = min(IWL_MVM_TE_SESSION_PROTECTION_MIN_TIME_MS,
2269 100 + vif->bss_conf.beacon_int);
2270
2271 if (WARN_ON_ONCE(vif->bss_conf.assoc))
2272 return;
2273
2274 /*
2275 * iwl_mvm_protect_session() reads directly from the device
2276 * (the system time), so make sure it is available.
2277 */
2278 if (iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PREPARE_TX))
2279 return;
2280
2281 mutex_lock(&mvm->mutex);
2282 /* Try really hard to protect the session and hear a beacon */
2283 iwl_mvm_protect_session(mvm, vif, duration, min_duration, 500, false);
2284 mutex_unlock(&mvm->mutex);
2285
2286 iwl_mvm_unref(mvm, IWL_MVM_REF_PREPARE_TX);
2287 }
2288
2289 static int iwl_mvm_mac_sched_scan_start(struct ieee80211_hw *hw,
2290 struct ieee80211_vif *vif,
2291 struct cfg80211_sched_scan_request *req,
2292 struct ieee80211_scan_ies *ies)
2293 {
2294 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2295 int ret;
2296
2297 if (!(mvm->fw->ucode_capa.capa[0] & IWL_UCODE_TLV_CAPA_UMAC_SCAN)) {
2298 ret = iwl_mvm_cancel_scan_wait_notif(mvm, IWL_MVM_SCAN_OS);
2299 if (ret)
2300 return ret;
2301 }
2302
2303 mutex_lock(&mvm->mutex);
2304
2305 /* Newest FW fixes sched scan while connected on another interface */
2306 if (mvm->fw->ucode_capa.api[0] & IWL_UCODE_TLV_API_LMAC_SCAN) {
2307 if (!vif->bss_conf.idle) {
2308 ret = -EBUSY;
2309 goto out;
2310 }
2311 } else if (!iwl_mvm_is_idle(mvm)) {
2312 ret = -EBUSY;
2313 goto out;
2314 }
2315
2316 if (mvm->scan_status != IWL_MVM_SCAN_NONE) {
2317 ret = -EBUSY;
2318 goto out;
2319 }
2320
2321 ret = iwl_mvm_scan_offload_start(mvm, vif, req, ies);
2322 if (ret)
2323 mvm->scan_status = IWL_MVM_SCAN_NONE;
2324
2325 out:
2326 mutex_unlock(&mvm->mutex);
2327 return ret;
2328 }
2329
2330 static int iwl_mvm_mac_sched_scan_stop(struct ieee80211_hw *hw,
2331 struct ieee80211_vif *vif)
2332 {
2333 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2334 int ret;
2335
2336 mutex_lock(&mvm->mutex);
2337 ret = iwl_mvm_scan_offload_stop(mvm, false);
2338 mutex_unlock(&mvm->mutex);
2339 iwl_mvm_wait_for_async_handlers(mvm);
2340
2341 return ret;
2342
2343 }
2344
2345 static int iwl_mvm_mac_set_key(struct ieee80211_hw *hw,
2346 enum set_key_cmd cmd,
2347 struct ieee80211_vif *vif,
2348 struct ieee80211_sta *sta,
2349 struct ieee80211_key_conf *key)
2350 {
2351 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2352 int ret;
2353
2354 if (iwlwifi_mod_params.sw_crypto) {
2355 IWL_DEBUG_MAC80211(mvm, "leave - hwcrypto disabled\n");
2356 return -EOPNOTSUPP;
2357 }
2358
2359 switch (key->cipher) {
2360 case WLAN_CIPHER_SUITE_TKIP:
2361 key->flags |= IEEE80211_KEY_FLAG_GENERATE_MMIC;
2362 /* fall-through */
2363 case WLAN_CIPHER_SUITE_CCMP:
2364 key->flags |= IEEE80211_KEY_FLAG_GENERATE_IV;
2365 break;
2366 case WLAN_CIPHER_SUITE_AES_CMAC:
2367 WARN_ON_ONCE(!(hw->flags & IEEE80211_HW_MFP_CAPABLE));
2368 break;
2369 case WLAN_CIPHER_SUITE_WEP40:
2370 case WLAN_CIPHER_SUITE_WEP104:
2371 /* For non-client mode, only use WEP keys for TX as we probably
2372 * don't have a station yet anyway and would then have to keep
2373 * track of the keys, linking them to each of the clients/peers
2374 * as they appear. For now, don't do that, for performance WEP
2375 * offload doesn't really matter much, but we need it for some
2376 * other offload features in client mode.
2377 */
2378 if (vif->type != NL80211_IFTYPE_STATION)
2379 return 0;
2380 break;
2381 default:
2382 /* currently FW supports only one optional cipher scheme */
2383 if (hw->n_cipher_schemes &&
2384 hw->cipher_schemes->cipher == key->cipher)
2385 key->flags |= IEEE80211_KEY_FLAG_PUT_IV_SPACE;
2386 else
2387 return -EOPNOTSUPP;
2388 }
2389
2390 mutex_lock(&mvm->mutex);
2391
2392 switch (cmd) {
2393 case SET_KEY:
2394 if ((vif->type == NL80211_IFTYPE_ADHOC ||
2395 vif->type == NL80211_IFTYPE_AP) && !sta) {
2396 /*
2397 * GTK on AP interface is a TX-only key, return 0;
2398 * on IBSS they're per-station and because we're lazy
2399 * we don't support them for RX, so do the same.
2400 */
2401 ret = 0;
2402 key->hw_key_idx = STA_KEY_IDX_INVALID;
2403 break;
2404 }
2405
2406 IWL_DEBUG_MAC80211(mvm, "set hwcrypto key\n");
2407 ret = iwl_mvm_set_sta_key(mvm, vif, sta, key, false);
2408 if (ret) {
2409 IWL_WARN(mvm, "set key failed\n");
2410 /*
2411 * can't add key for RX, but we don't need it
2412 * in the device for TX so still return 0
2413 */
2414 key->hw_key_idx = STA_KEY_IDX_INVALID;
2415 ret = 0;
2416 }
2417
2418 break;
2419 case DISABLE_KEY:
2420 if (key->hw_key_idx == STA_KEY_IDX_INVALID) {
2421 ret = 0;
2422 break;
2423 }
2424
2425 IWL_DEBUG_MAC80211(mvm, "disable hwcrypto key\n");
2426 ret = iwl_mvm_remove_sta_key(mvm, vif, sta, key);
2427 break;
2428 default:
2429 ret = -EINVAL;
2430 }
2431
2432 mutex_unlock(&mvm->mutex);
2433 return ret;
2434 }
2435
2436 static void iwl_mvm_mac_update_tkip_key(struct ieee80211_hw *hw,
2437 struct ieee80211_vif *vif,
2438 struct ieee80211_key_conf *keyconf,
2439 struct ieee80211_sta *sta,
2440 u32 iv32, u16 *phase1key)
2441 {
2442 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2443
2444 if (keyconf->hw_key_idx == STA_KEY_IDX_INVALID)
2445 return;
2446
2447 iwl_mvm_update_tkip_key(mvm, vif, keyconf, sta, iv32, phase1key);
2448 }
2449
2450
2451 static bool iwl_mvm_rx_aux_roc(struct iwl_notif_wait_data *notif_wait,
2452 struct iwl_rx_packet *pkt, void *data)
2453 {
2454 struct iwl_mvm *mvm =
2455 container_of(notif_wait, struct iwl_mvm, notif_wait);
2456 struct iwl_hs20_roc_res *resp;
2457 int resp_len = iwl_rx_packet_payload_len(pkt);
2458 struct iwl_mvm_time_event_data *te_data = data;
2459
2460 if (WARN_ON(pkt->hdr.cmd != HOT_SPOT_CMD))
2461 return true;
2462
2463 if (WARN_ON_ONCE(resp_len != sizeof(*resp))) {
2464 IWL_ERR(mvm, "Invalid HOT_SPOT_CMD response\n");
2465 return true;
2466 }
2467
2468 resp = (void *)pkt->data;
2469
2470 IWL_DEBUG_TE(mvm,
2471 "Aux ROC: Recieved response from ucode: status=%d uid=%d\n",
2472 resp->status, resp->event_unique_id);
2473
2474 te_data->uid = le32_to_cpu(resp->event_unique_id);
2475 IWL_DEBUG_TE(mvm, "TIME_EVENT_CMD response - UID = 0x%x\n",
2476 te_data->uid);
2477
2478 spin_lock_bh(&mvm->time_event_lock);
2479 list_add_tail(&te_data->list, &mvm->aux_roc_te_list);
2480 spin_unlock_bh(&mvm->time_event_lock);
2481
2482 return true;
2483 }
2484
2485 #define AUX_ROC_MAX_DELAY_ON_CHANNEL 5000
2486 static int iwl_mvm_send_aux_roc_cmd(struct iwl_mvm *mvm,
2487 struct ieee80211_channel *channel,
2488 struct ieee80211_vif *vif,
2489 int duration)
2490 {
2491 int res, time_reg = DEVICE_SYSTEM_TIME_REG;
2492 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2493 struct iwl_mvm_time_event_data *te_data = &mvmvif->hs_time_event_data;
2494 static const u8 time_event_response[] = { HOT_SPOT_CMD };
2495 struct iwl_notification_wait wait_time_event;
2496 struct iwl_hs20_roc_req aux_roc_req = {
2497 .action = cpu_to_le32(FW_CTXT_ACTION_ADD),
2498 .id_and_color =
2499 cpu_to_le32(FW_CMD_ID_AND_COLOR(MAC_INDEX_AUX, 0)),
2500 .sta_id_and_color = cpu_to_le32(mvm->aux_sta.sta_id),
2501 /* Set the channel info data */
2502 .channel_info.band = (channel->band == IEEE80211_BAND_2GHZ) ?
2503 PHY_BAND_24 : PHY_BAND_5,
2504 .channel_info.channel = channel->hw_value,
2505 .channel_info.width = PHY_VHT_CHANNEL_MODE20,
2506 /* Set the time and duration */
2507 .apply_time = cpu_to_le32(iwl_read_prph(mvm->trans, time_reg)),
2508 .apply_time_max_delay =
2509 cpu_to_le32(MSEC_TO_TU(AUX_ROC_MAX_DELAY_ON_CHANNEL)),
2510 .duration = cpu_to_le32(MSEC_TO_TU(duration)),
2511 };
2512
2513 /* Set the node address */
2514 memcpy(aux_roc_req.node_addr, vif->addr, ETH_ALEN);
2515
2516 lockdep_assert_held(&mvm->mutex);
2517
2518 spin_lock_bh(&mvm->time_event_lock);
2519
2520 if (WARN_ON(te_data->id == HOT_SPOT_CMD)) {
2521 spin_unlock_bh(&mvm->time_event_lock);
2522 return -EIO;
2523 }
2524
2525 te_data->vif = vif;
2526 te_data->duration = duration;
2527 te_data->id = HOT_SPOT_CMD;
2528
2529 spin_unlock_bh(&mvm->time_event_lock);
2530
2531 /*
2532 * Use a notification wait, which really just processes the
2533 * command response and doesn't wait for anything, in order
2534 * to be able to process the response and get the UID inside
2535 * the RX path. Using CMD_WANT_SKB doesn't work because it
2536 * stores the buffer and then wakes up this thread, by which
2537 * time another notification (that the time event started)
2538 * might already be processed unsuccessfully.
2539 */
2540 iwl_init_notification_wait(&mvm->notif_wait, &wait_time_event,
2541 time_event_response,
2542 ARRAY_SIZE(time_event_response),
2543 iwl_mvm_rx_aux_roc, te_data);
2544
2545 res = iwl_mvm_send_cmd_pdu(mvm, HOT_SPOT_CMD, 0, sizeof(aux_roc_req),
2546 &aux_roc_req);
2547
2548 if (res) {
2549 IWL_ERR(mvm, "Couldn't send HOT_SPOT_CMD: %d\n", res);
2550 iwl_remove_notification(&mvm->notif_wait, &wait_time_event);
2551 goto out_clear_te;
2552 }
2553
2554 /* No need to wait for anything, so just pass 1 (0 isn't valid) */
2555 res = iwl_wait_notification(&mvm->notif_wait, &wait_time_event, 1);
2556 /* should never fail */
2557 WARN_ON_ONCE(res);
2558
2559 if (res) {
2560 out_clear_te:
2561 spin_lock_bh(&mvm->time_event_lock);
2562 iwl_mvm_te_clear_data(mvm, te_data);
2563 spin_unlock_bh(&mvm->time_event_lock);
2564 }
2565
2566 return res;
2567 }
2568
2569 static int iwl_mvm_roc(struct ieee80211_hw *hw,
2570 struct ieee80211_vif *vif,
2571 struct ieee80211_channel *channel,
2572 int duration,
2573 enum ieee80211_roc_type type)
2574 {
2575 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2576 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2577 struct cfg80211_chan_def chandef;
2578 struct iwl_mvm_phy_ctxt *phy_ctxt;
2579 int ret, i;
2580
2581 IWL_DEBUG_MAC80211(mvm, "enter (%d, %d, %d)\n", channel->hw_value,
2582 duration, type);
2583
2584 mutex_lock(&mvm->mutex);
2585
2586 switch (vif->type) {
2587 case NL80211_IFTYPE_STATION:
2588 if (mvm->fw->ucode_capa.capa[0] &
2589 IWL_UCODE_TLV_CAPA_HOTSPOT_SUPPORT) {
2590 /* Use aux roc framework (HS20) */
2591 ret = iwl_mvm_send_aux_roc_cmd(mvm, channel,
2592 vif, duration);
2593 goto out_unlock;
2594 }
2595 IWL_ERR(mvm, "hotspot not supported\n");
2596 ret = -EINVAL;
2597 goto out_unlock;
2598 case NL80211_IFTYPE_P2P_DEVICE:
2599 /* handle below */
2600 break;
2601 default:
2602 IWL_ERR(mvm, "vif isn't P2P_DEVICE: %d\n", vif->type);
2603 ret = -EINVAL;
2604 goto out_unlock;
2605 }
2606
2607 for (i = 0; i < NUM_PHY_CTX; i++) {
2608 phy_ctxt = &mvm->phy_ctxts[i];
2609 if (phy_ctxt->ref == 0 || mvmvif->phy_ctxt == phy_ctxt)
2610 continue;
2611
2612 if (phy_ctxt->ref && channel == phy_ctxt->channel) {
2613 /*
2614 * Unbind the P2P_DEVICE from the current PHY context,
2615 * and if the PHY context is not used remove it.
2616 */
2617 ret = iwl_mvm_binding_remove_vif(mvm, vif);
2618 if (WARN(ret, "Failed unbinding P2P_DEVICE\n"))
2619 goto out_unlock;
2620
2621 iwl_mvm_phy_ctxt_unref(mvm, mvmvif->phy_ctxt);
2622
2623 /* Bind the P2P_DEVICE to the current PHY Context */
2624 mvmvif->phy_ctxt = phy_ctxt;
2625
2626 ret = iwl_mvm_binding_add_vif(mvm, vif);
2627 if (WARN(ret, "Failed binding P2P_DEVICE\n"))
2628 goto out_unlock;
2629
2630 iwl_mvm_phy_ctxt_ref(mvm, mvmvif->phy_ctxt);
2631 goto schedule_time_event;
2632 }
2633 }
2634
2635 /* Need to update the PHY context only if the ROC channel changed */
2636 if (channel == mvmvif->phy_ctxt->channel)
2637 goto schedule_time_event;
2638
2639 cfg80211_chandef_create(&chandef, channel, NL80211_CHAN_NO_HT);
2640
2641 /*
2642 * Change the PHY context configuration as it is currently referenced
2643 * only by the P2P Device MAC
2644 */
2645 if (mvmvif->phy_ctxt->ref == 1) {
2646 ret = iwl_mvm_phy_ctxt_changed(mvm, mvmvif->phy_ctxt,
2647 &chandef, 1, 1);
2648 if (ret)
2649 goto out_unlock;
2650 } else {
2651 /*
2652 * The PHY context is shared with other MACs. Need to remove the
2653 * P2P Device from the binding, allocate an new PHY context and
2654 * create a new binding
2655 */
2656 phy_ctxt = iwl_mvm_get_free_phy_ctxt(mvm);
2657 if (!phy_ctxt) {
2658 ret = -ENOSPC;
2659 goto out_unlock;
2660 }
2661
2662 ret = iwl_mvm_phy_ctxt_changed(mvm, phy_ctxt, &chandef,
2663 1, 1);
2664 if (ret) {
2665 IWL_ERR(mvm, "Failed to change PHY context\n");
2666 goto out_unlock;
2667 }
2668
2669 /* Unbind the P2P_DEVICE from the current PHY context */
2670 ret = iwl_mvm_binding_remove_vif(mvm, vif);
2671 if (WARN(ret, "Failed unbinding P2P_DEVICE\n"))
2672 goto out_unlock;
2673
2674 iwl_mvm_phy_ctxt_unref(mvm, mvmvif->phy_ctxt);
2675
2676 /* Bind the P2P_DEVICE to the new allocated PHY context */
2677 mvmvif->phy_ctxt = phy_ctxt;
2678
2679 ret = iwl_mvm_binding_add_vif(mvm, vif);
2680 if (WARN(ret, "Failed binding P2P_DEVICE\n"))
2681 goto out_unlock;
2682
2683 iwl_mvm_phy_ctxt_ref(mvm, mvmvif->phy_ctxt);
2684 }
2685
2686 schedule_time_event:
2687 /* Schedule the time events */
2688 ret = iwl_mvm_start_p2p_roc(mvm, vif, duration, type);
2689
2690 out_unlock:
2691 mutex_unlock(&mvm->mutex);
2692 IWL_DEBUG_MAC80211(mvm, "leave\n");
2693 return ret;
2694 }
2695
2696 static int iwl_mvm_cancel_roc(struct ieee80211_hw *hw)
2697 {
2698 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2699
2700 IWL_DEBUG_MAC80211(mvm, "enter\n");
2701
2702 mutex_lock(&mvm->mutex);
2703 iwl_mvm_stop_roc(mvm);
2704 mutex_unlock(&mvm->mutex);
2705
2706 IWL_DEBUG_MAC80211(mvm, "leave\n");
2707 return 0;
2708 }
2709
2710 static int __iwl_mvm_add_chanctx(struct iwl_mvm *mvm,
2711 struct ieee80211_chanctx_conf *ctx)
2712 {
2713 u16 *phy_ctxt_id = (u16 *)ctx->drv_priv;
2714 struct iwl_mvm_phy_ctxt *phy_ctxt;
2715 int ret;
2716
2717 lockdep_assert_held(&mvm->mutex);
2718
2719 IWL_DEBUG_MAC80211(mvm, "Add channel context\n");
2720
2721 phy_ctxt = iwl_mvm_get_free_phy_ctxt(mvm);
2722 if (!phy_ctxt) {
2723 ret = -ENOSPC;
2724 goto out;
2725 }
2726
2727 ret = iwl_mvm_phy_ctxt_changed(mvm, phy_ctxt, &ctx->min_def,
2728 ctx->rx_chains_static,
2729 ctx->rx_chains_dynamic);
2730 if (ret) {
2731 IWL_ERR(mvm, "Failed to add PHY context\n");
2732 goto out;
2733 }
2734
2735 iwl_mvm_phy_ctxt_ref(mvm, phy_ctxt);
2736 *phy_ctxt_id = phy_ctxt->id;
2737 out:
2738 return ret;
2739 }
2740
2741 static int iwl_mvm_add_chanctx(struct ieee80211_hw *hw,
2742 struct ieee80211_chanctx_conf *ctx)
2743 {
2744 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2745 int ret;
2746
2747 mutex_lock(&mvm->mutex);
2748 ret = __iwl_mvm_add_chanctx(mvm, ctx);
2749 mutex_unlock(&mvm->mutex);
2750
2751 return ret;
2752 }
2753
2754 static void __iwl_mvm_remove_chanctx(struct iwl_mvm *mvm,
2755 struct ieee80211_chanctx_conf *ctx)
2756 {
2757 u16 *phy_ctxt_id = (u16 *)ctx->drv_priv;
2758 struct iwl_mvm_phy_ctxt *phy_ctxt = &mvm->phy_ctxts[*phy_ctxt_id];
2759
2760 lockdep_assert_held(&mvm->mutex);
2761
2762 iwl_mvm_phy_ctxt_unref(mvm, phy_ctxt);
2763 }
2764
2765 static void iwl_mvm_remove_chanctx(struct ieee80211_hw *hw,
2766 struct ieee80211_chanctx_conf *ctx)
2767 {
2768 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2769
2770 mutex_lock(&mvm->mutex);
2771 __iwl_mvm_remove_chanctx(mvm, ctx);
2772 mutex_unlock(&mvm->mutex);
2773 }
2774
2775 static void iwl_mvm_change_chanctx(struct ieee80211_hw *hw,
2776 struct ieee80211_chanctx_conf *ctx,
2777 u32 changed)
2778 {
2779 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2780 u16 *phy_ctxt_id = (u16 *)ctx->drv_priv;
2781 struct iwl_mvm_phy_ctxt *phy_ctxt = &mvm->phy_ctxts[*phy_ctxt_id];
2782
2783 if (WARN_ONCE((phy_ctxt->ref > 1) &&
2784 (changed & ~(IEEE80211_CHANCTX_CHANGE_WIDTH |
2785 IEEE80211_CHANCTX_CHANGE_RX_CHAINS |
2786 IEEE80211_CHANCTX_CHANGE_RADAR |
2787 IEEE80211_CHANCTX_CHANGE_MIN_WIDTH)),
2788 "Cannot change PHY. Ref=%d, changed=0x%X\n",
2789 phy_ctxt->ref, changed))
2790 return;
2791
2792 mutex_lock(&mvm->mutex);
2793 iwl_mvm_bt_coex_vif_change(mvm);
2794 iwl_mvm_phy_ctxt_changed(mvm, phy_ctxt, &ctx->min_def,
2795 ctx->rx_chains_static,
2796 ctx->rx_chains_dynamic);
2797 mutex_unlock(&mvm->mutex);
2798 }
2799
2800 static int __iwl_mvm_assign_vif_chanctx(struct iwl_mvm *mvm,
2801 struct ieee80211_vif *vif,
2802 struct ieee80211_chanctx_conf *ctx,
2803 bool switching_chanctx)
2804 {
2805 u16 *phy_ctxt_id = (u16 *)ctx->drv_priv;
2806 struct iwl_mvm_phy_ctxt *phy_ctxt = &mvm->phy_ctxts[*phy_ctxt_id];
2807 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2808 int ret;
2809
2810 lockdep_assert_held(&mvm->mutex);
2811
2812 mvmvif->phy_ctxt = phy_ctxt;
2813
2814 switch (vif->type) {
2815 case NL80211_IFTYPE_AP:
2816 /* only needed if we're switching chanctx (i.e. during CSA) */
2817 if (switching_chanctx) {
2818 mvmvif->ap_ibss_active = true;
2819 break;
2820 }
2821 case NL80211_IFTYPE_ADHOC:
2822 /*
2823 * The AP binding flow is handled as part of the start_ap flow
2824 * (in bss_info_changed), similarly for IBSS.
2825 */
2826 ret = 0;
2827 goto out;
2828 case NL80211_IFTYPE_STATION:
2829 break;
2830 case NL80211_IFTYPE_MONITOR:
2831 /* always disable PS when a monitor interface is active */
2832 mvmvif->ps_disabled = true;
2833 break;
2834 default:
2835 ret = -EINVAL;
2836 goto out;
2837 }
2838
2839 ret = iwl_mvm_binding_add_vif(mvm, vif);
2840 if (ret)
2841 goto out;
2842
2843 /*
2844 * Power state must be updated before quotas,
2845 * otherwise fw will complain.
2846 */
2847 iwl_mvm_power_update_mac(mvm);
2848
2849 /* Setting the quota at this stage is only required for monitor
2850 * interfaces. For the other types, the bss_info changed flow
2851 * will handle quota settings.
2852 */
2853 if (vif->type == NL80211_IFTYPE_MONITOR) {
2854 mvmvif->monitor_active = true;
2855 ret = iwl_mvm_update_quotas(mvm, NULL);
2856 if (ret)
2857 goto out_remove_binding;
2858 }
2859
2860 /* Handle binding during CSA */
2861 if (vif->type == NL80211_IFTYPE_AP) {
2862 iwl_mvm_update_quotas(mvm, NULL);
2863 iwl_mvm_mac_ctxt_changed(mvm, vif, false, NULL);
2864 }
2865
2866 if (switching_chanctx && vif->type == NL80211_IFTYPE_STATION) {
2867 u32 duration = 2 * vif->bss_conf.beacon_int;
2868
2869 /* iwl_mvm_protect_session() reads directly from the
2870 * device (the system time), so make sure it is
2871 * available.
2872 */
2873 ret = iwl_mvm_ref_sync(mvm, IWL_MVM_REF_PROTECT_CSA);
2874 if (ret)
2875 goto out_remove_binding;
2876
2877 /* Protect the session to make sure we hear the first
2878 * beacon on the new channel.
2879 */
2880 iwl_mvm_protect_session(mvm, vif, duration, duration,
2881 vif->bss_conf.beacon_int / 2,
2882 true);
2883
2884 iwl_mvm_unref(mvm, IWL_MVM_REF_PROTECT_CSA);
2885
2886 iwl_mvm_update_quotas(mvm, NULL);
2887 }
2888
2889 goto out;
2890
2891 out_remove_binding:
2892 iwl_mvm_binding_remove_vif(mvm, vif);
2893 iwl_mvm_power_update_mac(mvm);
2894 out:
2895 if (ret)
2896 mvmvif->phy_ctxt = NULL;
2897 return ret;
2898 }
2899 static int iwl_mvm_assign_vif_chanctx(struct ieee80211_hw *hw,
2900 struct ieee80211_vif *vif,
2901 struct ieee80211_chanctx_conf *ctx)
2902 {
2903 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2904 int ret;
2905
2906 mutex_lock(&mvm->mutex);
2907 ret = __iwl_mvm_assign_vif_chanctx(mvm, vif, ctx, false);
2908 mutex_unlock(&mvm->mutex);
2909
2910 return ret;
2911 }
2912
2913 static void __iwl_mvm_unassign_vif_chanctx(struct iwl_mvm *mvm,
2914 struct ieee80211_vif *vif,
2915 struct ieee80211_chanctx_conf *ctx,
2916 bool switching_chanctx)
2917 {
2918 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
2919 struct ieee80211_vif *disabled_vif = NULL;
2920
2921 lockdep_assert_held(&mvm->mutex);
2922
2923 iwl_mvm_remove_time_event(mvm, mvmvif, &mvmvif->time_event_data);
2924
2925 switch (vif->type) {
2926 case NL80211_IFTYPE_ADHOC:
2927 goto out;
2928 case NL80211_IFTYPE_MONITOR:
2929 mvmvif->monitor_active = false;
2930 mvmvif->ps_disabled = false;
2931 break;
2932 case NL80211_IFTYPE_AP:
2933 /* This part is triggered only during CSA */
2934 if (!switching_chanctx || !mvmvif->ap_ibss_active)
2935 goto out;
2936
2937 mvmvif->csa_countdown = false;
2938
2939 /* Set CS bit on all the stations */
2940 iwl_mvm_modify_all_sta_disable_tx(mvm, mvmvif, true);
2941
2942 /* Save blocked iface, the timeout is set on the next beacon */
2943 rcu_assign_pointer(mvm->csa_tx_blocked_vif, vif);
2944
2945 mvmvif->ap_ibss_active = false;
2946 break;
2947 case NL80211_IFTYPE_STATION:
2948 if (!switching_chanctx)
2949 break;
2950
2951 disabled_vif = vif;
2952
2953 iwl_mvm_mac_ctxt_changed(mvm, vif, true, NULL);
2954 break;
2955 default:
2956 break;
2957 }
2958
2959 iwl_mvm_update_quotas(mvm, disabled_vif);
2960 iwl_mvm_binding_remove_vif(mvm, vif);
2961
2962 out:
2963 mvmvif->phy_ctxt = NULL;
2964 iwl_mvm_power_update_mac(mvm);
2965 }
2966
2967 static void iwl_mvm_unassign_vif_chanctx(struct ieee80211_hw *hw,
2968 struct ieee80211_vif *vif,
2969 struct ieee80211_chanctx_conf *ctx)
2970 {
2971 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
2972
2973 mutex_lock(&mvm->mutex);
2974 __iwl_mvm_unassign_vif_chanctx(mvm, vif, ctx, false);
2975 mutex_unlock(&mvm->mutex);
2976 }
2977
2978 static int
2979 iwl_mvm_switch_vif_chanctx_swap(struct iwl_mvm *mvm,
2980 struct ieee80211_vif_chanctx_switch *vifs)
2981 {
2982 int ret;
2983
2984 mutex_lock(&mvm->mutex);
2985 __iwl_mvm_unassign_vif_chanctx(mvm, vifs[0].vif, vifs[0].old_ctx, true);
2986 __iwl_mvm_remove_chanctx(mvm, vifs[0].old_ctx);
2987
2988 ret = __iwl_mvm_add_chanctx(mvm, vifs[0].new_ctx);
2989 if (ret) {
2990 IWL_ERR(mvm, "failed to add new_ctx during channel switch\n");
2991 goto out_reassign;
2992 }
2993
2994 ret = __iwl_mvm_assign_vif_chanctx(mvm, vifs[0].vif, vifs[0].new_ctx,
2995 true);
2996 if (ret) {
2997 IWL_ERR(mvm,
2998 "failed to assign new_ctx during channel switch\n");
2999 goto out_remove;
3000 }
3001
3002 /* we don't support TDLS during DCM - can be caused by channel switch */
3003 if (iwl_mvm_phy_ctx_count(mvm) > 1)
3004 iwl_mvm_teardown_tdls_peers(mvm);
3005
3006 goto out;
3007
3008 out_remove:
3009 __iwl_mvm_remove_chanctx(mvm, vifs[0].new_ctx);
3010
3011 out_reassign:
3012 if (__iwl_mvm_add_chanctx(mvm, vifs[0].old_ctx)) {
3013 IWL_ERR(mvm, "failed to add old_ctx back after failure.\n");
3014 goto out_restart;
3015 }
3016
3017 if (__iwl_mvm_assign_vif_chanctx(mvm, vifs[0].vif, vifs[0].old_ctx,
3018 true)) {
3019 IWL_ERR(mvm, "failed to reassign old_ctx after failure.\n");
3020 goto out_restart;
3021 }
3022
3023 goto out;
3024
3025 out_restart:
3026 /* things keep failing, better restart the hw */
3027 iwl_mvm_nic_restart(mvm, false);
3028
3029 out:
3030 mutex_unlock(&mvm->mutex);
3031
3032 return ret;
3033 }
3034
3035 static int
3036 iwl_mvm_switch_vif_chanctx_reassign(struct iwl_mvm *mvm,
3037 struct ieee80211_vif_chanctx_switch *vifs)
3038 {
3039 int ret;
3040
3041 mutex_lock(&mvm->mutex);
3042 __iwl_mvm_unassign_vif_chanctx(mvm, vifs[0].vif, vifs[0].old_ctx, true);
3043
3044 ret = __iwl_mvm_assign_vif_chanctx(mvm, vifs[0].vif, vifs[0].new_ctx,
3045 true);
3046 if (ret) {
3047 IWL_ERR(mvm,
3048 "failed to assign new_ctx during channel switch\n");
3049 goto out_reassign;
3050 }
3051
3052 goto out;
3053
3054 out_reassign:
3055 if (__iwl_mvm_assign_vif_chanctx(mvm, vifs[0].vif, vifs[0].old_ctx,
3056 true)) {
3057 IWL_ERR(mvm, "failed to reassign old_ctx after failure.\n");
3058 goto out_restart;
3059 }
3060
3061 goto out;
3062
3063 out_restart:
3064 /* things keep failing, better restart the hw */
3065 iwl_mvm_nic_restart(mvm, false);
3066
3067 out:
3068 mutex_unlock(&mvm->mutex);
3069
3070 return ret;
3071 }
3072
3073 static int iwl_mvm_switch_vif_chanctx(struct ieee80211_hw *hw,
3074 struct ieee80211_vif_chanctx_switch *vifs,
3075 int n_vifs,
3076 enum ieee80211_chanctx_switch_mode mode)
3077 {
3078 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3079 int ret;
3080
3081 /* we only support a single-vif right now */
3082 if (n_vifs > 1)
3083 return -EOPNOTSUPP;
3084
3085 switch (mode) {
3086 case CHANCTX_SWMODE_SWAP_CONTEXTS:
3087 ret = iwl_mvm_switch_vif_chanctx_swap(mvm, vifs);
3088 break;
3089 case CHANCTX_SWMODE_REASSIGN_VIF:
3090 ret = iwl_mvm_switch_vif_chanctx_reassign(mvm, vifs);
3091 break;
3092 default:
3093 ret = -EOPNOTSUPP;
3094 break;
3095 }
3096
3097 return ret;
3098 }
3099
3100 static int iwl_mvm_set_tim(struct ieee80211_hw *hw,
3101 struct ieee80211_sta *sta,
3102 bool set)
3103 {
3104 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3105 struct iwl_mvm_sta *mvm_sta = (void *)sta->drv_priv;
3106
3107 if (!mvm_sta || !mvm_sta->vif) {
3108 IWL_ERR(mvm, "Station is not associated to a vif\n");
3109 return -EINVAL;
3110 }
3111
3112 return iwl_mvm_mac_ctxt_beacon_changed(mvm, mvm_sta->vif);
3113 }
3114
3115 #ifdef CONFIG_NL80211_TESTMODE
3116 static const struct nla_policy iwl_mvm_tm_policy[IWL_MVM_TM_ATTR_MAX + 1] = {
3117 [IWL_MVM_TM_ATTR_CMD] = { .type = NLA_U32 },
3118 [IWL_MVM_TM_ATTR_NOA_DURATION] = { .type = NLA_U32 },
3119 [IWL_MVM_TM_ATTR_BEACON_FILTER_STATE] = { .type = NLA_U32 },
3120 };
3121
3122 static int __iwl_mvm_mac_testmode_cmd(struct iwl_mvm *mvm,
3123 struct ieee80211_vif *vif,
3124 void *data, int len)
3125 {
3126 struct nlattr *tb[IWL_MVM_TM_ATTR_MAX + 1];
3127 int err;
3128 u32 noa_duration;
3129
3130 err = nla_parse(tb, IWL_MVM_TM_ATTR_MAX, data, len, iwl_mvm_tm_policy);
3131 if (err)
3132 return err;
3133
3134 if (!tb[IWL_MVM_TM_ATTR_CMD])
3135 return -EINVAL;
3136
3137 switch (nla_get_u32(tb[IWL_MVM_TM_ATTR_CMD])) {
3138 case IWL_MVM_TM_CMD_SET_NOA:
3139 if (!vif || vif->type != NL80211_IFTYPE_AP || !vif->p2p ||
3140 !vif->bss_conf.enable_beacon ||
3141 !tb[IWL_MVM_TM_ATTR_NOA_DURATION])
3142 return -EINVAL;
3143
3144 noa_duration = nla_get_u32(tb[IWL_MVM_TM_ATTR_NOA_DURATION]);
3145 if (noa_duration >= vif->bss_conf.beacon_int)
3146 return -EINVAL;
3147
3148 mvm->noa_duration = noa_duration;
3149 mvm->noa_vif = vif;
3150
3151 return iwl_mvm_update_quotas(mvm, NULL);
3152 case IWL_MVM_TM_CMD_SET_BEACON_FILTER:
3153 /* must be associated client vif - ignore authorized */
3154 if (!vif || vif->type != NL80211_IFTYPE_STATION ||
3155 !vif->bss_conf.assoc || !vif->bss_conf.dtim_period ||
3156 !tb[IWL_MVM_TM_ATTR_BEACON_FILTER_STATE])
3157 return -EINVAL;
3158
3159 if (nla_get_u32(tb[IWL_MVM_TM_ATTR_BEACON_FILTER_STATE]))
3160 return iwl_mvm_enable_beacon_filter(mvm, vif, 0);
3161 return iwl_mvm_disable_beacon_filter(mvm, vif, 0);
3162 }
3163
3164 return -EOPNOTSUPP;
3165 }
3166
3167 static int iwl_mvm_mac_testmode_cmd(struct ieee80211_hw *hw,
3168 struct ieee80211_vif *vif,
3169 void *data, int len)
3170 {
3171 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3172 int err;
3173
3174 mutex_lock(&mvm->mutex);
3175 err = __iwl_mvm_mac_testmode_cmd(mvm, vif, data, len);
3176 mutex_unlock(&mvm->mutex);
3177
3178 return err;
3179 }
3180 #endif
3181
3182 static void iwl_mvm_channel_switch(struct ieee80211_hw *hw,
3183 struct ieee80211_vif *vif,
3184 struct ieee80211_channel_switch *chsw)
3185 {
3186 /* By implementing this operation, we prevent mac80211 from
3187 * starting its own channel switch timer, so that we can call
3188 * ieee80211_chswitch_done() ourselves at the right time
3189 * (which is when the absence time event starts).
3190 */
3191
3192 IWL_DEBUG_MAC80211(IWL_MAC80211_GET_MVM(hw),
3193 "dummy channel switch op\n");
3194 }
3195
3196 static int iwl_mvm_pre_channel_switch(struct ieee80211_hw *hw,
3197 struct ieee80211_vif *vif,
3198 struct ieee80211_channel_switch *chsw)
3199 {
3200 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3201 struct ieee80211_vif *csa_vif;
3202 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
3203 u32 apply_time;
3204 int ret;
3205
3206 mutex_lock(&mvm->mutex);
3207
3208 IWL_DEBUG_MAC80211(mvm, "pre CSA to freq %d\n",
3209 chsw->chandef.center_freq1);
3210
3211 switch (vif->type) {
3212 case NL80211_IFTYPE_AP:
3213 csa_vif =
3214 rcu_dereference_protected(mvm->csa_vif,
3215 lockdep_is_held(&mvm->mutex));
3216 if (WARN_ONCE(csa_vif && csa_vif->csa_active,
3217 "Another CSA is already in progress")) {
3218 ret = -EBUSY;
3219 goto out_unlock;
3220 }
3221
3222 rcu_assign_pointer(mvm->csa_vif, vif);
3223
3224 if (WARN_ONCE(mvmvif->csa_countdown,
3225 "Previous CSA countdown didn't complete")) {
3226 ret = -EBUSY;
3227 goto out_unlock;
3228 }
3229
3230 break;
3231 case NL80211_IFTYPE_STATION:
3232 /* Schedule the time event to a bit before beacon 1,
3233 * to make sure we're in the new channel when the
3234 * GO/AP arrives.
3235 */
3236 apply_time = chsw->device_timestamp +
3237 ((vif->bss_conf.beacon_int * (chsw->count - 1) -
3238 IWL_MVM_CHANNEL_SWITCH_TIME_CLIENT) * 1024);
3239
3240 if (chsw->block_tx)
3241 iwl_mvm_csa_client_absent(mvm, vif);
3242
3243 iwl_mvm_schedule_csa_period(mvm, vif, vif->bss_conf.beacon_int,
3244 apply_time);
3245 if (mvmvif->bf_data.bf_enabled) {
3246 ret = iwl_mvm_disable_beacon_filter(mvm, vif, 0);
3247 if (ret)
3248 goto out_unlock;
3249 }
3250
3251 break;
3252 default:
3253 break;
3254 }
3255
3256 mvmvif->ps_disabled = true;
3257
3258 ret = iwl_mvm_power_update_ps(mvm);
3259 if (ret)
3260 goto out_unlock;
3261
3262 /* we won't be on this channel any longer */
3263 iwl_mvm_teardown_tdls_peers(mvm);
3264
3265 out_unlock:
3266 mutex_unlock(&mvm->mutex);
3267
3268 return ret;
3269 }
3270
3271 static int iwl_mvm_post_channel_switch(struct ieee80211_hw *hw,
3272 struct ieee80211_vif *vif)
3273 {
3274 struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
3275 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3276 int ret;
3277
3278 mutex_lock(&mvm->mutex);
3279
3280 if (vif->type == NL80211_IFTYPE_STATION) {
3281 struct iwl_mvm_sta *mvmsta;
3282
3283 mvmsta = iwl_mvm_sta_from_staid_protected(mvm,
3284 mvmvif->ap_sta_id);
3285
3286 if (WARN_ON(!mvmsta)) {
3287 ret = -EIO;
3288 goto out_unlock;
3289 }
3290
3291 iwl_mvm_sta_modify_disable_tx(mvm, mvmsta, false);
3292
3293 iwl_mvm_mac_ctxt_changed(mvm, vif, false, NULL);
3294
3295 ret = iwl_mvm_enable_beacon_filter(mvm, vif, 0);
3296 if (ret)
3297 goto out_unlock;
3298
3299 iwl_mvm_stop_session_protection(mvm, vif);
3300 }
3301
3302 mvmvif->ps_disabled = false;
3303
3304 ret = iwl_mvm_power_update_ps(mvm);
3305
3306 out_unlock:
3307 mutex_unlock(&mvm->mutex);
3308
3309 return ret;
3310 }
3311
3312 static void iwl_mvm_mac_flush(struct ieee80211_hw *hw,
3313 struct ieee80211_vif *vif, u32 queues, bool drop)
3314 {
3315 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
3316 struct iwl_mvm_vif *mvmvif;
3317 struct iwl_mvm_sta *mvmsta;
3318 struct ieee80211_sta *sta;
3319 int i;
3320 u32 msk = 0;
3321
3322 if (!vif || vif->type != NL80211_IFTYPE_STATION)
3323 return;
3324
3325 mutex_lock(&mvm->mutex);
3326 mvmvif = iwl_mvm_vif_from_mac80211(vif);
3327
3328 /* flush the AP-station and all TDLS peers */
3329 for (i = 0; i < IWL_MVM_STATION_COUNT; i++) {
3330 sta = rcu_dereference_protected(mvm->fw_id_to_mac_id[i],
3331 lockdep_is_held(&mvm->mutex));
3332 if (IS_ERR_OR_NULL(sta))
3333 continue;
3334
3335 mvmsta = iwl_mvm_sta_from_mac80211(sta);
3336 if (mvmsta->vif != vif)
3337 continue;
3338
3339 /* make sure only TDLS peers or the AP are flushed */
3340 WARN_ON(i != mvmvif->ap_sta_id && !sta->tdls);
3341
3342 msk |= mvmsta->tfd_queue_msk;
3343 }
3344
3345 if (drop) {
3346 if (iwl_mvm_flush_tx_path(mvm, msk, true))
3347 IWL_ERR(mvm, "flush request fail\n");
3348 mutex_unlock(&mvm->mutex);
3349 } else {
3350 mutex_unlock(&mvm->mutex);
3351
3352 /* this can take a while, and we may need/want other operations
3353 * to succeed while doing this, so do it without the mutex held
3354 */
3355 iwl_trans_wait_tx_queue_empty(mvm->trans, msk);
3356 }
3357 }
3358
3359 const struct ieee80211_ops iwl_mvm_hw_ops = {
3360 .tx = iwl_mvm_mac_tx,
3361 .ampdu_action = iwl_mvm_mac_ampdu_action,
3362 .start = iwl_mvm_mac_start,
3363 .reconfig_complete = iwl_mvm_mac_reconfig_complete,
3364 .stop = iwl_mvm_mac_stop,
3365 .add_interface = iwl_mvm_mac_add_interface,
3366 .remove_interface = iwl_mvm_mac_remove_interface,
3367 .config = iwl_mvm_mac_config,
3368 .prepare_multicast = iwl_mvm_prepare_multicast,
3369 .configure_filter = iwl_mvm_configure_filter,
3370 .bss_info_changed = iwl_mvm_bss_info_changed,
3371 .hw_scan = iwl_mvm_mac_hw_scan,
3372 .cancel_hw_scan = iwl_mvm_mac_cancel_hw_scan,
3373 .sta_pre_rcu_remove = iwl_mvm_sta_pre_rcu_remove,
3374 .sta_state = iwl_mvm_mac_sta_state,
3375 .sta_notify = iwl_mvm_mac_sta_notify,
3376 .allow_buffered_frames = iwl_mvm_mac_allow_buffered_frames,
3377 .release_buffered_frames = iwl_mvm_mac_release_buffered_frames,
3378 .set_rts_threshold = iwl_mvm_mac_set_rts_threshold,
3379 .sta_rc_update = iwl_mvm_sta_rc_update,
3380 .conf_tx = iwl_mvm_mac_conf_tx,
3381 .mgd_prepare_tx = iwl_mvm_mac_mgd_prepare_tx,
3382 .mgd_protect_tdls_discover = iwl_mvm_mac_mgd_protect_tdls_discover,
3383 .flush = iwl_mvm_mac_flush,
3384 .sched_scan_start = iwl_mvm_mac_sched_scan_start,
3385 .sched_scan_stop = iwl_mvm_mac_sched_scan_stop,
3386 .set_key = iwl_mvm_mac_set_key,
3387 .update_tkip_key = iwl_mvm_mac_update_tkip_key,
3388 .remain_on_channel = iwl_mvm_roc,
3389 .cancel_remain_on_channel = iwl_mvm_cancel_roc,
3390 .add_chanctx = iwl_mvm_add_chanctx,
3391 .remove_chanctx = iwl_mvm_remove_chanctx,
3392 .change_chanctx = iwl_mvm_change_chanctx,
3393 .assign_vif_chanctx = iwl_mvm_assign_vif_chanctx,
3394 .unassign_vif_chanctx = iwl_mvm_unassign_vif_chanctx,
3395 .switch_vif_chanctx = iwl_mvm_switch_vif_chanctx,
3396
3397 .start_ap = iwl_mvm_start_ap_ibss,
3398 .stop_ap = iwl_mvm_stop_ap_ibss,
3399 .join_ibss = iwl_mvm_start_ap_ibss,
3400 .leave_ibss = iwl_mvm_stop_ap_ibss,
3401
3402 .set_tim = iwl_mvm_set_tim,
3403
3404 .channel_switch = iwl_mvm_channel_switch,
3405 .pre_channel_switch = iwl_mvm_pre_channel_switch,
3406 .post_channel_switch = iwl_mvm_post_channel_switch,
3407
3408 .tdls_channel_switch = iwl_mvm_tdls_channel_switch,
3409 .tdls_cancel_channel_switch = iwl_mvm_tdls_cancel_channel_switch,
3410 .tdls_recv_channel_switch = iwl_mvm_tdls_recv_channel_switch,
3411
3412 CFG80211_TESTMODE_CMD(iwl_mvm_mac_testmode_cmd)
3413
3414 #ifdef CONFIG_PM_SLEEP
3415 /* look at d3.c */
3416 .suspend = iwl_mvm_suspend,
3417 .resume = iwl_mvm_resume,
3418 .set_wakeup = iwl_mvm_set_wakeup,
3419 .set_rekey_data = iwl_mvm_set_rekey_data,
3420 #if IS_ENABLED(CONFIG_IPV6)
3421 .ipv6_addr_change = iwl_mvm_ipv6_addr_change,
3422 #endif
3423 .set_default_unicast_key = iwl_mvm_set_default_unicast_key,
3424 #endif
3425 };
Linux kernel - Deliverables
This page took 0.104402 seconds and 5 git commands to generate.