projects / deliverable / linux.git / blob
? search:


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