Merge branch 'i2c/for-5.3' of git://git.kernel.org/pub/scm/linux/kernel/git/wsa/linux
[linux-2.6-microblaze.git] / net / mac80211 / cfg.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * mac80211 configuration hooks for cfg80211
4  *
5  * Copyright 2006-2010  Johannes Berg <johannes@sipsolutions.net>
6  * Copyright 2013-2015  Intel Mobile Communications GmbH
7  * Copyright (C) 2015-2017 Intel Deutschland GmbH
8  * Copyright (C) 2018-2019 Intel Corporation
9  * Copyright (C) 2018 Intel Corporation
10  */
11
12 #include <linux/ieee80211.h>
13 #include <linux/nl80211.h>
14 #include <linux/rtnetlink.h>
15 #include <linux/slab.h>
16 #include <net/net_namespace.h>
17 #include <linux/rcupdate.h>
18 #include <linux/fips.h>
19 #include <linux/if_ether.h>
20 #include <net/cfg80211.h>
21 #include "ieee80211_i.h"
22 #include "driver-ops.h"
23 #include "rate.h"
24 #include "mesh.h"
25 #include "wme.h"
26
27 static void ieee80211_set_mu_mimo_follow(struct ieee80211_sub_if_data *sdata,
28                                          struct vif_params *params)
29 {
30         bool mu_mimo_groups = false;
31         bool mu_mimo_follow = false;
32
33         if (params->vht_mumimo_groups) {
34                 u64 membership;
35
36                 BUILD_BUG_ON(sizeof(membership) != WLAN_MEMBERSHIP_LEN);
37
38                 memcpy(sdata->vif.bss_conf.mu_group.membership,
39                        params->vht_mumimo_groups, WLAN_MEMBERSHIP_LEN);
40                 memcpy(sdata->vif.bss_conf.mu_group.position,
41                        params->vht_mumimo_groups + WLAN_MEMBERSHIP_LEN,
42                        WLAN_USER_POSITION_LEN);
43                 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_MU_GROUPS);
44                 /* don't care about endianness - just check for 0 */
45                 memcpy(&membership, params->vht_mumimo_groups,
46                        WLAN_MEMBERSHIP_LEN);
47                 mu_mimo_groups = membership != 0;
48         }
49
50         if (params->vht_mumimo_follow_addr) {
51                 mu_mimo_follow =
52                         is_valid_ether_addr(params->vht_mumimo_follow_addr);
53                 ether_addr_copy(sdata->u.mntr.mu_follow_addr,
54                                 params->vht_mumimo_follow_addr);
55         }
56
57         sdata->vif.mu_mimo_owner = mu_mimo_groups || mu_mimo_follow;
58 }
59
60 static int ieee80211_set_mon_options(struct ieee80211_sub_if_data *sdata,
61                                      struct vif_params *params)
62 {
63         struct ieee80211_local *local = sdata->local;
64         struct ieee80211_sub_if_data *monitor_sdata;
65
66         /* check flags first */
67         if (params->flags && ieee80211_sdata_running(sdata)) {
68                 u32 mask = MONITOR_FLAG_COOK_FRAMES | MONITOR_FLAG_ACTIVE;
69
70                 /*
71                  * Prohibit MONITOR_FLAG_COOK_FRAMES and
72                  * MONITOR_FLAG_ACTIVE to be changed while the
73                  * interface is up.
74                  * Else we would need to add a lot of cruft
75                  * to update everything:
76                  *      cooked_mntrs, monitor and all fif_* counters
77                  *      reconfigure hardware
78                  */
79                 if ((params->flags & mask) != (sdata->u.mntr.flags & mask))
80                         return -EBUSY;
81         }
82
83         /* also validate MU-MIMO change */
84         monitor_sdata = rtnl_dereference(local->monitor_sdata);
85
86         if (!monitor_sdata &&
87             (params->vht_mumimo_groups || params->vht_mumimo_follow_addr))
88                 return -EOPNOTSUPP;
89
90         /* apply all changes now - no failures allowed */
91
92         if (monitor_sdata)
93                 ieee80211_set_mu_mimo_follow(monitor_sdata, params);
94
95         if (params->flags) {
96                 if (ieee80211_sdata_running(sdata)) {
97                         ieee80211_adjust_monitor_flags(sdata, -1);
98                         sdata->u.mntr.flags = params->flags;
99                         ieee80211_adjust_monitor_flags(sdata, 1);
100
101                         ieee80211_configure_filter(local);
102                 } else {
103                         /*
104                          * Because the interface is down, ieee80211_do_stop
105                          * and ieee80211_do_open take care of "everything"
106                          * mentioned in the comment above.
107                          */
108                         sdata->u.mntr.flags = params->flags;
109                 }
110         }
111
112         return 0;
113 }
114
115 static struct wireless_dev *ieee80211_add_iface(struct wiphy *wiphy,
116                                                 const char *name,
117                                                 unsigned char name_assign_type,
118                                                 enum nl80211_iftype type,
119                                                 struct vif_params *params)
120 {
121         struct ieee80211_local *local = wiphy_priv(wiphy);
122         struct wireless_dev *wdev;
123         struct ieee80211_sub_if_data *sdata;
124         int err;
125
126         err = ieee80211_if_add(local, name, name_assign_type, &wdev, type, params);
127         if (err)
128                 return ERR_PTR(err);
129
130         sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
131
132         if (type == NL80211_IFTYPE_MONITOR) {
133                 err = ieee80211_set_mon_options(sdata, params);
134                 if (err) {
135                         ieee80211_if_remove(sdata);
136                         return NULL;
137                 }
138         }
139
140         return wdev;
141 }
142
143 static int ieee80211_del_iface(struct wiphy *wiphy, struct wireless_dev *wdev)
144 {
145         ieee80211_if_remove(IEEE80211_WDEV_TO_SUB_IF(wdev));
146
147         return 0;
148 }
149
150 static int ieee80211_change_iface(struct wiphy *wiphy,
151                                   struct net_device *dev,
152                                   enum nl80211_iftype type,
153                                   struct vif_params *params)
154 {
155         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
156         int ret;
157
158         ret = ieee80211_if_change_type(sdata, type);
159         if (ret)
160                 return ret;
161
162         if (type == NL80211_IFTYPE_AP_VLAN && params->use_4addr == 0) {
163                 RCU_INIT_POINTER(sdata->u.vlan.sta, NULL);
164                 ieee80211_check_fast_rx_iface(sdata);
165         } else if (type == NL80211_IFTYPE_STATION && params->use_4addr >= 0) {
166                 sdata->u.mgd.use_4addr = params->use_4addr;
167         }
168
169         if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
170                 ret = ieee80211_set_mon_options(sdata, params);
171                 if (ret)
172                         return ret;
173         }
174
175         return 0;
176 }
177
178 static int ieee80211_start_p2p_device(struct wiphy *wiphy,
179                                       struct wireless_dev *wdev)
180 {
181         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
182         int ret;
183
184         mutex_lock(&sdata->local->chanctx_mtx);
185         ret = ieee80211_check_combinations(sdata, NULL, 0, 0);
186         mutex_unlock(&sdata->local->chanctx_mtx);
187         if (ret < 0)
188                 return ret;
189
190         return ieee80211_do_open(wdev, true);
191 }
192
193 static void ieee80211_stop_p2p_device(struct wiphy *wiphy,
194                                       struct wireless_dev *wdev)
195 {
196         ieee80211_sdata_stop(IEEE80211_WDEV_TO_SUB_IF(wdev));
197 }
198
199 static int ieee80211_start_nan(struct wiphy *wiphy,
200                                struct wireless_dev *wdev,
201                                struct cfg80211_nan_conf *conf)
202 {
203         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
204         int ret;
205
206         mutex_lock(&sdata->local->chanctx_mtx);
207         ret = ieee80211_check_combinations(sdata, NULL, 0, 0);
208         mutex_unlock(&sdata->local->chanctx_mtx);
209         if (ret < 0)
210                 return ret;
211
212         ret = ieee80211_do_open(wdev, true);
213         if (ret)
214                 return ret;
215
216         ret = drv_start_nan(sdata->local, sdata, conf);
217         if (ret)
218                 ieee80211_sdata_stop(sdata);
219
220         sdata->u.nan.conf = *conf;
221
222         return ret;
223 }
224
225 static void ieee80211_stop_nan(struct wiphy *wiphy,
226                                struct wireless_dev *wdev)
227 {
228         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
229
230         drv_stop_nan(sdata->local, sdata);
231         ieee80211_sdata_stop(sdata);
232 }
233
234 static int ieee80211_nan_change_conf(struct wiphy *wiphy,
235                                      struct wireless_dev *wdev,
236                                      struct cfg80211_nan_conf *conf,
237                                      u32 changes)
238 {
239         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
240         struct cfg80211_nan_conf new_conf;
241         int ret = 0;
242
243         if (sdata->vif.type != NL80211_IFTYPE_NAN)
244                 return -EOPNOTSUPP;
245
246         if (!ieee80211_sdata_running(sdata))
247                 return -ENETDOWN;
248
249         new_conf = sdata->u.nan.conf;
250
251         if (changes & CFG80211_NAN_CONF_CHANGED_PREF)
252                 new_conf.master_pref = conf->master_pref;
253
254         if (changes & CFG80211_NAN_CONF_CHANGED_BANDS)
255                 new_conf.bands = conf->bands;
256
257         ret = drv_nan_change_conf(sdata->local, sdata, &new_conf, changes);
258         if (!ret)
259                 sdata->u.nan.conf = new_conf;
260
261         return ret;
262 }
263
264 static int ieee80211_add_nan_func(struct wiphy *wiphy,
265                                   struct wireless_dev *wdev,
266                                   struct cfg80211_nan_func *nan_func)
267 {
268         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
269         int ret;
270
271         if (sdata->vif.type != NL80211_IFTYPE_NAN)
272                 return -EOPNOTSUPP;
273
274         if (!ieee80211_sdata_running(sdata))
275                 return -ENETDOWN;
276
277         spin_lock_bh(&sdata->u.nan.func_lock);
278
279         ret = idr_alloc(&sdata->u.nan.function_inst_ids,
280                         nan_func, 1, sdata->local->hw.max_nan_de_entries + 1,
281                         GFP_ATOMIC);
282         spin_unlock_bh(&sdata->u.nan.func_lock);
283
284         if (ret < 0)
285                 return ret;
286
287         nan_func->instance_id = ret;
288
289         WARN_ON(nan_func->instance_id == 0);
290
291         ret = drv_add_nan_func(sdata->local, sdata, nan_func);
292         if (ret) {
293                 spin_lock_bh(&sdata->u.nan.func_lock);
294                 idr_remove(&sdata->u.nan.function_inst_ids,
295                            nan_func->instance_id);
296                 spin_unlock_bh(&sdata->u.nan.func_lock);
297         }
298
299         return ret;
300 }
301
302 static struct cfg80211_nan_func *
303 ieee80211_find_nan_func_by_cookie(struct ieee80211_sub_if_data *sdata,
304                                   u64 cookie)
305 {
306         struct cfg80211_nan_func *func;
307         int id;
308
309         lockdep_assert_held(&sdata->u.nan.func_lock);
310
311         idr_for_each_entry(&sdata->u.nan.function_inst_ids, func, id) {
312                 if (func->cookie == cookie)
313                         return func;
314         }
315
316         return NULL;
317 }
318
319 static void ieee80211_del_nan_func(struct wiphy *wiphy,
320                                   struct wireless_dev *wdev, u64 cookie)
321 {
322         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
323         struct cfg80211_nan_func *func;
324         u8 instance_id = 0;
325
326         if (sdata->vif.type != NL80211_IFTYPE_NAN ||
327             !ieee80211_sdata_running(sdata))
328                 return;
329
330         spin_lock_bh(&sdata->u.nan.func_lock);
331
332         func = ieee80211_find_nan_func_by_cookie(sdata, cookie);
333         if (func)
334                 instance_id = func->instance_id;
335
336         spin_unlock_bh(&sdata->u.nan.func_lock);
337
338         if (instance_id)
339                 drv_del_nan_func(sdata->local, sdata, instance_id);
340 }
341
342 static int ieee80211_set_noack_map(struct wiphy *wiphy,
343                                   struct net_device *dev,
344                                   u16 noack_map)
345 {
346         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
347
348         sdata->noack_map = noack_map;
349
350         ieee80211_check_fast_xmit_iface(sdata);
351
352         return 0;
353 }
354
355 static int ieee80211_set_tx(struct ieee80211_sub_if_data *sdata,
356                             const u8 *mac_addr, u8 key_idx)
357 {
358         struct ieee80211_local *local = sdata->local;
359         struct ieee80211_key *key;
360         struct sta_info *sta;
361         int ret = -EINVAL;
362
363         if (!wiphy_ext_feature_isset(local->hw.wiphy,
364                                      NL80211_EXT_FEATURE_EXT_KEY_ID))
365                 return -EINVAL;
366
367         sta = sta_info_get_bss(sdata, mac_addr);
368
369         if (!sta)
370                 return -EINVAL;
371
372         if (sta->ptk_idx == key_idx)
373                 return 0;
374
375         mutex_lock(&local->key_mtx);
376         key = key_mtx_dereference(local, sta->ptk[key_idx]);
377
378         if (key && key->conf.flags & IEEE80211_KEY_FLAG_NO_AUTO_TX)
379                 ret = ieee80211_set_tx_key(key);
380
381         mutex_unlock(&local->key_mtx);
382         return ret;
383 }
384
385 static int ieee80211_add_key(struct wiphy *wiphy, struct net_device *dev,
386                              u8 key_idx, bool pairwise, const u8 *mac_addr,
387                              struct key_params *params)
388 {
389         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
390         struct ieee80211_local *local = sdata->local;
391         struct sta_info *sta = NULL;
392         const struct ieee80211_cipher_scheme *cs = NULL;
393         struct ieee80211_key *key;
394         int err;
395
396         if (!ieee80211_sdata_running(sdata))
397                 return -ENETDOWN;
398
399         if (pairwise && params->mode == NL80211_KEY_SET_TX)
400                 return ieee80211_set_tx(sdata, mac_addr, key_idx);
401
402         /* reject WEP and TKIP keys if WEP failed to initialize */
403         switch (params->cipher) {
404         case WLAN_CIPHER_SUITE_WEP40:
405         case WLAN_CIPHER_SUITE_TKIP:
406         case WLAN_CIPHER_SUITE_WEP104:
407                 if (WARN_ON_ONCE(fips_enabled))
408                         return -EINVAL;
409         case WLAN_CIPHER_SUITE_CCMP:
410         case WLAN_CIPHER_SUITE_CCMP_256:
411         case WLAN_CIPHER_SUITE_AES_CMAC:
412         case WLAN_CIPHER_SUITE_BIP_CMAC_256:
413         case WLAN_CIPHER_SUITE_BIP_GMAC_128:
414         case WLAN_CIPHER_SUITE_BIP_GMAC_256:
415         case WLAN_CIPHER_SUITE_GCMP:
416         case WLAN_CIPHER_SUITE_GCMP_256:
417                 break;
418         default:
419                 cs = ieee80211_cs_get(local, params->cipher, sdata->vif.type);
420                 break;
421         }
422
423         key = ieee80211_key_alloc(params->cipher, key_idx, params->key_len,
424                                   params->key, params->seq_len, params->seq,
425                                   cs);
426         if (IS_ERR(key))
427                 return PTR_ERR(key);
428
429         if (pairwise)
430                 key->conf.flags |= IEEE80211_KEY_FLAG_PAIRWISE;
431
432         if (params->mode == NL80211_KEY_NO_TX)
433                 key->conf.flags |= IEEE80211_KEY_FLAG_NO_AUTO_TX;
434
435         mutex_lock(&local->sta_mtx);
436
437         if (mac_addr) {
438                 sta = sta_info_get_bss(sdata, mac_addr);
439                 /*
440                  * The ASSOC test makes sure the driver is ready to
441                  * receive the key. When wpa_supplicant has roamed
442                  * using FT, it attempts to set the key before
443                  * association has completed, this rejects that attempt
444                  * so it will set the key again after association.
445                  *
446                  * TODO: accept the key if we have a station entry and
447                  *       add it to the device after the station.
448                  */
449                 if (!sta || !test_sta_flag(sta, WLAN_STA_ASSOC)) {
450                         ieee80211_key_free_unused(key);
451                         err = -ENOENT;
452                         goto out_unlock;
453                 }
454         }
455
456         switch (sdata->vif.type) {
457         case NL80211_IFTYPE_STATION:
458                 if (sdata->u.mgd.mfp != IEEE80211_MFP_DISABLED)
459                         key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
460                 break;
461         case NL80211_IFTYPE_AP:
462         case NL80211_IFTYPE_AP_VLAN:
463                 /* Keys without a station are used for TX only */
464                 if (sta && test_sta_flag(sta, WLAN_STA_MFP))
465                         key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
466                 break;
467         case NL80211_IFTYPE_ADHOC:
468                 /* no MFP (yet) */
469                 break;
470         case NL80211_IFTYPE_MESH_POINT:
471 #ifdef CONFIG_MAC80211_MESH
472                 if (sdata->u.mesh.security != IEEE80211_MESH_SEC_NONE)
473                         key->conf.flags |= IEEE80211_KEY_FLAG_RX_MGMT;
474                 break;
475 #endif
476         case NL80211_IFTYPE_WDS:
477         case NL80211_IFTYPE_MONITOR:
478         case NL80211_IFTYPE_P2P_DEVICE:
479         case NL80211_IFTYPE_NAN:
480         case NL80211_IFTYPE_UNSPECIFIED:
481         case NUM_NL80211_IFTYPES:
482         case NL80211_IFTYPE_P2P_CLIENT:
483         case NL80211_IFTYPE_P2P_GO:
484         case NL80211_IFTYPE_OCB:
485                 /* shouldn't happen */
486                 WARN_ON_ONCE(1);
487                 break;
488         }
489
490         if (sta)
491                 sta->cipher_scheme = cs;
492
493         err = ieee80211_key_link(key, sdata, sta);
494
495  out_unlock:
496         mutex_unlock(&local->sta_mtx);
497
498         return err;
499 }
500
501 static int ieee80211_del_key(struct wiphy *wiphy, struct net_device *dev,
502                              u8 key_idx, bool pairwise, const u8 *mac_addr)
503 {
504         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
505         struct ieee80211_local *local = sdata->local;
506         struct sta_info *sta;
507         struct ieee80211_key *key = NULL;
508         int ret;
509
510         mutex_lock(&local->sta_mtx);
511         mutex_lock(&local->key_mtx);
512
513         if (mac_addr) {
514                 ret = -ENOENT;
515
516                 sta = sta_info_get_bss(sdata, mac_addr);
517                 if (!sta)
518                         goto out_unlock;
519
520                 if (pairwise)
521                         key = key_mtx_dereference(local, sta->ptk[key_idx]);
522                 else
523                         key = key_mtx_dereference(local, sta->gtk[key_idx]);
524         } else
525                 key = key_mtx_dereference(local, sdata->keys[key_idx]);
526
527         if (!key) {
528                 ret = -ENOENT;
529                 goto out_unlock;
530         }
531
532         ieee80211_key_free(key, sdata->vif.type == NL80211_IFTYPE_STATION);
533
534         ret = 0;
535  out_unlock:
536         mutex_unlock(&local->key_mtx);
537         mutex_unlock(&local->sta_mtx);
538
539         return ret;
540 }
541
542 static int ieee80211_get_key(struct wiphy *wiphy, struct net_device *dev,
543                              u8 key_idx, bool pairwise, const u8 *mac_addr,
544                              void *cookie,
545                              void (*callback)(void *cookie,
546                                               struct key_params *params))
547 {
548         struct ieee80211_sub_if_data *sdata;
549         struct sta_info *sta = NULL;
550         u8 seq[6] = {0};
551         struct key_params params;
552         struct ieee80211_key *key = NULL;
553         u64 pn64;
554         u32 iv32;
555         u16 iv16;
556         int err = -ENOENT;
557         struct ieee80211_key_seq kseq = {};
558
559         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
560
561         rcu_read_lock();
562
563         if (mac_addr) {
564                 sta = sta_info_get_bss(sdata, mac_addr);
565                 if (!sta)
566                         goto out;
567
568                 if (pairwise && key_idx < NUM_DEFAULT_KEYS)
569                         key = rcu_dereference(sta->ptk[key_idx]);
570                 else if (!pairwise &&
571                          key_idx < NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
572                         key = rcu_dereference(sta->gtk[key_idx]);
573         } else
574                 key = rcu_dereference(sdata->keys[key_idx]);
575
576         if (!key)
577                 goto out;
578
579         memset(&params, 0, sizeof(params));
580
581         params.cipher = key->conf.cipher;
582
583         switch (key->conf.cipher) {
584         case WLAN_CIPHER_SUITE_TKIP:
585                 pn64 = atomic64_read(&key->conf.tx_pn);
586                 iv32 = TKIP_PN_TO_IV32(pn64);
587                 iv16 = TKIP_PN_TO_IV16(pn64);
588
589                 if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
590                     !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
591                         drv_get_key_seq(sdata->local, key, &kseq);
592                         iv32 = kseq.tkip.iv32;
593                         iv16 = kseq.tkip.iv16;
594                 }
595
596                 seq[0] = iv16 & 0xff;
597                 seq[1] = (iv16 >> 8) & 0xff;
598                 seq[2] = iv32 & 0xff;
599                 seq[3] = (iv32 >> 8) & 0xff;
600                 seq[4] = (iv32 >> 16) & 0xff;
601                 seq[5] = (iv32 >> 24) & 0xff;
602                 params.seq = seq;
603                 params.seq_len = 6;
604                 break;
605         case WLAN_CIPHER_SUITE_CCMP:
606         case WLAN_CIPHER_SUITE_CCMP_256:
607         case WLAN_CIPHER_SUITE_AES_CMAC:
608         case WLAN_CIPHER_SUITE_BIP_CMAC_256:
609                 BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
610                              offsetof(typeof(kseq), aes_cmac));
611                 /* fall through */
612         case WLAN_CIPHER_SUITE_BIP_GMAC_128:
613         case WLAN_CIPHER_SUITE_BIP_GMAC_256:
614                 BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
615                              offsetof(typeof(kseq), aes_gmac));
616                 /* fall through */
617         case WLAN_CIPHER_SUITE_GCMP:
618         case WLAN_CIPHER_SUITE_GCMP_256:
619                 BUILD_BUG_ON(offsetof(typeof(kseq), ccmp) !=
620                              offsetof(typeof(kseq), gcmp));
621
622                 if (key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE &&
623                     !(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV)) {
624                         drv_get_key_seq(sdata->local, key, &kseq);
625                         memcpy(seq, kseq.ccmp.pn, 6);
626                 } else {
627                         pn64 = atomic64_read(&key->conf.tx_pn);
628                         seq[0] = pn64;
629                         seq[1] = pn64 >> 8;
630                         seq[2] = pn64 >> 16;
631                         seq[3] = pn64 >> 24;
632                         seq[4] = pn64 >> 32;
633                         seq[5] = pn64 >> 40;
634                 }
635                 params.seq = seq;
636                 params.seq_len = 6;
637                 break;
638         default:
639                 if (!(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE))
640                         break;
641                 if (WARN_ON(key->conf.flags & IEEE80211_KEY_FLAG_GENERATE_IV))
642                         break;
643                 drv_get_key_seq(sdata->local, key, &kseq);
644                 params.seq = kseq.hw.seq;
645                 params.seq_len = kseq.hw.seq_len;
646                 break;
647         }
648
649         params.key = key->conf.key;
650         params.key_len = key->conf.keylen;
651
652         callback(cookie, &params);
653         err = 0;
654
655  out:
656         rcu_read_unlock();
657         return err;
658 }
659
660 static int ieee80211_config_default_key(struct wiphy *wiphy,
661                                         struct net_device *dev,
662                                         u8 key_idx, bool uni,
663                                         bool multi)
664 {
665         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
666
667         ieee80211_set_default_key(sdata, key_idx, uni, multi);
668
669         return 0;
670 }
671
672 static int ieee80211_config_default_mgmt_key(struct wiphy *wiphy,
673                                              struct net_device *dev,
674                                              u8 key_idx)
675 {
676         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
677
678         ieee80211_set_default_mgmt_key(sdata, key_idx);
679
680         return 0;
681 }
682
683 void sta_set_rate_info_tx(struct sta_info *sta,
684                           const struct ieee80211_tx_rate *rate,
685                           struct rate_info *rinfo)
686 {
687         rinfo->flags = 0;
688         if (rate->flags & IEEE80211_TX_RC_MCS) {
689                 rinfo->flags |= RATE_INFO_FLAGS_MCS;
690                 rinfo->mcs = rate->idx;
691         } else if (rate->flags & IEEE80211_TX_RC_VHT_MCS) {
692                 rinfo->flags |= RATE_INFO_FLAGS_VHT_MCS;
693                 rinfo->mcs = ieee80211_rate_get_vht_mcs(rate);
694                 rinfo->nss = ieee80211_rate_get_vht_nss(rate);
695         } else {
696                 struct ieee80211_supported_band *sband;
697                 int shift = ieee80211_vif_get_shift(&sta->sdata->vif);
698                 u16 brate;
699
700                 sband = ieee80211_get_sband(sta->sdata);
701                 if (sband) {
702                         brate = sband->bitrates[rate->idx].bitrate;
703                         rinfo->legacy = DIV_ROUND_UP(brate, 1 << shift);
704                 }
705         }
706         if (rate->flags & IEEE80211_TX_RC_40_MHZ_WIDTH)
707                 rinfo->bw = RATE_INFO_BW_40;
708         else if (rate->flags & IEEE80211_TX_RC_80_MHZ_WIDTH)
709                 rinfo->bw = RATE_INFO_BW_80;
710         else if (rate->flags & IEEE80211_TX_RC_160_MHZ_WIDTH)
711                 rinfo->bw = RATE_INFO_BW_160;
712         else
713                 rinfo->bw = RATE_INFO_BW_20;
714         if (rate->flags & IEEE80211_TX_RC_SHORT_GI)
715                 rinfo->flags |= RATE_INFO_FLAGS_SHORT_GI;
716 }
717
718 static int ieee80211_dump_station(struct wiphy *wiphy, struct net_device *dev,
719                                   int idx, u8 *mac, struct station_info *sinfo)
720 {
721         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
722         struct ieee80211_local *local = sdata->local;
723         struct sta_info *sta;
724         int ret = -ENOENT;
725
726         mutex_lock(&local->sta_mtx);
727
728         sta = sta_info_get_by_idx(sdata, idx);
729         if (sta) {
730                 ret = 0;
731                 memcpy(mac, sta->sta.addr, ETH_ALEN);
732                 sta_set_sinfo(sta, sinfo, true);
733         }
734
735         mutex_unlock(&local->sta_mtx);
736
737         return ret;
738 }
739
740 static int ieee80211_dump_survey(struct wiphy *wiphy, struct net_device *dev,
741                                  int idx, struct survey_info *survey)
742 {
743         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
744
745         return drv_get_survey(local, idx, survey);
746 }
747
748 static int ieee80211_get_station(struct wiphy *wiphy, struct net_device *dev,
749                                  const u8 *mac, struct station_info *sinfo)
750 {
751         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
752         struct ieee80211_local *local = sdata->local;
753         struct sta_info *sta;
754         int ret = -ENOENT;
755
756         mutex_lock(&local->sta_mtx);
757
758         sta = sta_info_get_bss(sdata, mac);
759         if (sta) {
760                 ret = 0;
761                 sta_set_sinfo(sta, sinfo, true);
762         }
763
764         mutex_unlock(&local->sta_mtx);
765
766         return ret;
767 }
768
769 static int ieee80211_set_monitor_channel(struct wiphy *wiphy,
770                                          struct cfg80211_chan_def *chandef)
771 {
772         struct ieee80211_local *local = wiphy_priv(wiphy);
773         struct ieee80211_sub_if_data *sdata;
774         int ret = 0;
775
776         if (cfg80211_chandef_identical(&local->monitor_chandef, chandef))
777                 return 0;
778
779         mutex_lock(&local->mtx);
780         if (local->use_chanctx) {
781                 sdata = rtnl_dereference(local->monitor_sdata);
782                 if (sdata) {
783                         ieee80211_vif_release_channel(sdata);
784                         ret = ieee80211_vif_use_channel(sdata, chandef,
785                                         IEEE80211_CHANCTX_EXCLUSIVE);
786                 }
787         } else if (local->open_count == local->monitors) {
788                 local->_oper_chandef = *chandef;
789                 ieee80211_hw_config(local, 0);
790         }
791
792         if (ret == 0)
793                 local->monitor_chandef = *chandef;
794         mutex_unlock(&local->mtx);
795
796         return ret;
797 }
798
799 static int ieee80211_set_probe_resp(struct ieee80211_sub_if_data *sdata,
800                                     const u8 *resp, size_t resp_len,
801                                     const struct ieee80211_csa_settings *csa)
802 {
803         struct probe_resp *new, *old;
804
805         if (!resp || !resp_len)
806                 return 1;
807
808         old = sdata_dereference(sdata->u.ap.probe_resp, sdata);
809
810         new = kzalloc(sizeof(struct probe_resp) + resp_len, GFP_KERNEL);
811         if (!new)
812                 return -ENOMEM;
813
814         new->len = resp_len;
815         memcpy(new->data, resp, resp_len);
816
817         if (csa)
818                 memcpy(new->csa_counter_offsets, csa->counter_offsets_presp,
819                        csa->n_counter_offsets_presp *
820                        sizeof(new->csa_counter_offsets[0]));
821
822         rcu_assign_pointer(sdata->u.ap.probe_resp, new);
823         if (old)
824                 kfree_rcu(old, rcu_head);
825
826         return 0;
827 }
828
829 static int ieee80211_set_ftm_responder_params(
830                                 struct ieee80211_sub_if_data *sdata,
831                                 const u8 *lci, size_t lci_len,
832                                 const u8 *civicloc, size_t civicloc_len)
833 {
834         struct ieee80211_ftm_responder_params *new, *old;
835         struct ieee80211_bss_conf *bss_conf;
836         u8 *pos;
837         int len;
838
839         if (!lci_len && !civicloc_len)
840                 return 0;
841
842         bss_conf = &sdata->vif.bss_conf;
843         old = bss_conf->ftmr_params;
844         len = lci_len + civicloc_len;
845
846         new = kzalloc(sizeof(*new) + len, GFP_KERNEL);
847         if (!new)
848                 return -ENOMEM;
849
850         pos = (u8 *)(new + 1);
851         if (lci_len) {
852                 new->lci_len = lci_len;
853                 new->lci = pos;
854                 memcpy(pos, lci, lci_len);
855                 pos += lci_len;
856         }
857
858         if (civicloc_len) {
859                 new->civicloc_len = civicloc_len;
860                 new->civicloc = pos;
861                 memcpy(pos, civicloc, civicloc_len);
862                 pos += civicloc_len;
863         }
864
865         bss_conf->ftmr_params = new;
866         kfree(old);
867
868         return 0;
869 }
870
871 static int ieee80211_assign_beacon(struct ieee80211_sub_if_data *sdata,
872                                    struct cfg80211_beacon_data *params,
873                                    const struct ieee80211_csa_settings *csa)
874 {
875         struct beacon_data *new, *old;
876         int new_head_len, new_tail_len;
877         int size, err;
878         u32 changed = BSS_CHANGED_BEACON;
879
880         old = sdata_dereference(sdata->u.ap.beacon, sdata);
881
882
883         /* Need to have a beacon head if we don't have one yet */
884         if (!params->head && !old)
885                 return -EINVAL;
886
887         /* new or old head? */
888         if (params->head)
889                 new_head_len = params->head_len;
890         else
891                 new_head_len = old->head_len;
892
893         /* new or old tail? */
894         if (params->tail || !old)
895                 /* params->tail_len will be zero for !params->tail */
896                 new_tail_len = params->tail_len;
897         else
898                 new_tail_len = old->tail_len;
899
900         size = sizeof(*new) + new_head_len + new_tail_len;
901
902         new = kzalloc(size, GFP_KERNEL);
903         if (!new)
904                 return -ENOMEM;
905
906         /* start filling the new info now */
907
908         /*
909          * pointers go into the block we allocated,
910          * memory is | beacon_data | head | tail |
911          */
912         new->head = ((u8 *) new) + sizeof(*new);
913         new->tail = new->head + new_head_len;
914         new->head_len = new_head_len;
915         new->tail_len = new_tail_len;
916
917         if (csa) {
918                 new->csa_current_counter = csa->count;
919                 memcpy(new->csa_counter_offsets, csa->counter_offsets_beacon,
920                        csa->n_counter_offsets_beacon *
921                        sizeof(new->csa_counter_offsets[0]));
922         }
923
924         /* copy in head */
925         if (params->head)
926                 memcpy(new->head, params->head, new_head_len);
927         else
928                 memcpy(new->head, old->head, new_head_len);
929
930         /* copy in optional tail */
931         if (params->tail)
932                 memcpy(new->tail, params->tail, new_tail_len);
933         else
934                 if (old)
935                         memcpy(new->tail, old->tail, new_tail_len);
936
937         err = ieee80211_set_probe_resp(sdata, params->probe_resp,
938                                        params->probe_resp_len, csa);
939         if (err < 0)
940                 return err;
941         if (err == 0)
942                 changed |= BSS_CHANGED_AP_PROBE_RESP;
943
944         if (params->ftm_responder != -1) {
945                 sdata->vif.bss_conf.ftm_responder = params->ftm_responder;
946                 err = ieee80211_set_ftm_responder_params(sdata,
947                                                          params->lci,
948                                                          params->lci_len,
949                                                          params->civicloc,
950                                                          params->civicloc_len);
951
952                 if (err < 0)
953                         return err;
954
955                 changed |= BSS_CHANGED_FTM_RESPONDER;
956         }
957
958         rcu_assign_pointer(sdata->u.ap.beacon, new);
959
960         if (old)
961                 kfree_rcu(old, rcu_head);
962
963         return changed;
964 }
965
966 static int ieee80211_start_ap(struct wiphy *wiphy, struct net_device *dev,
967                               struct cfg80211_ap_settings *params)
968 {
969         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
970         struct ieee80211_local *local = sdata->local;
971         struct beacon_data *old;
972         struct ieee80211_sub_if_data *vlan;
973         u32 changed = BSS_CHANGED_BEACON_INT |
974                       BSS_CHANGED_BEACON_ENABLED |
975                       BSS_CHANGED_BEACON |
976                       BSS_CHANGED_SSID |
977                       BSS_CHANGED_P2P_PS |
978                       BSS_CHANGED_TXPOWER |
979                       BSS_CHANGED_TWT;
980         int err;
981         int prev_beacon_int;
982
983         old = sdata_dereference(sdata->u.ap.beacon, sdata);
984         if (old)
985                 return -EALREADY;
986
987         switch (params->smps_mode) {
988         case NL80211_SMPS_OFF:
989                 sdata->smps_mode = IEEE80211_SMPS_OFF;
990                 break;
991         case NL80211_SMPS_STATIC:
992                 sdata->smps_mode = IEEE80211_SMPS_STATIC;
993                 break;
994         case NL80211_SMPS_DYNAMIC:
995                 sdata->smps_mode = IEEE80211_SMPS_DYNAMIC;
996                 break;
997         default:
998                 return -EINVAL;
999         }
1000         sdata->u.ap.req_smps = sdata->smps_mode;
1001
1002         sdata->needed_rx_chains = sdata->local->rx_chains;
1003
1004         prev_beacon_int = sdata->vif.bss_conf.beacon_int;
1005         sdata->vif.bss_conf.beacon_int = params->beacon_interval;
1006
1007         if (params->he_cap)
1008                 sdata->vif.bss_conf.he_support = true;
1009
1010         mutex_lock(&local->mtx);
1011         err = ieee80211_vif_use_channel(sdata, &params->chandef,
1012                                         IEEE80211_CHANCTX_SHARED);
1013         if (!err)
1014                 ieee80211_vif_copy_chanctx_to_vlans(sdata, false);
1015         mutex_unlock(&local->mtx);
1016         if (err) {
1017                 sdata->vif.bss_conf.beacon_int = prev_beacon_int;
1018                 return err;
1019         }
1020
1021         /*
1022          * Apply control port protocol, this allows us to
1023          * not encrypt dynamic WEP control frames.
1024          */
1025         sdata->control_port_protocol = params->crypto.control_port_ethertype;
1026         sdata->control_port_no_encrypt = params->crypto.control_port_no_encrypt;
1027         sdata->control_port_over_nl80211 =
1028                                 params->crypto.control_port_over_nl80211;
1029         sdata->encrypt_headroom = ieee80211_cs_headroom(sdata->local,
1030                                                         &params->crypto,
1031                                                         sdata->vif.type);
1032
1033         list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list) {
1034                 vlan->control_port_protocol =
1035                         params->crypto.control_port_ethertype;
1036                 vlan->control_port_no_encrypt =
1037                         params->crypto.control_port_no_encrypt;
1038                 vlan->control_port_over_nl80211 =
1039                         params->crypto.control_port_over_nl80211;
1040                 vlan->encrypt_headroom =
1041                         ieee80211_cs_headroom(sdata->local,
1042                                               &params->crypto,
1043                                               vlan->vif.type);
1044         }
1045
1046         sdata->vif.bss_conf.dtim_period = params->dtim_period;
1047         sdata->vif.bss_conf.enable_beacon = true;
1048         sdata->vif.bss_conf.allow_p2p_go_ps = sdata->vif.p2p;
1049         sdata->vif.bss_conf.twt_responder = params->twt_responder;
1050
1051         sdata->vif.bss_conf.ssid_len = params->ssid_len;
1052         if (params->ssid_len)
1053                 memcpy(sdata->vif.bss_conf.ssid, params->ssid,
1054                        params->ssid_len);
1055         sdata->vif.bss_conf.hidden_ssid =
1056                 (params->hidden_ssid != NL80211_HIDDEN_SSID_NOT_IN_USE);
1057
1058         memset(&sdata->vif.bss_conf.p2p_noa_attr, 0,
1059                sizeof(sdata->vif.bss_conf.p2p_noa_attr));
1060         sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow =
1061                 params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
1062         if (params->p2p_opp_ps)
1063                 sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
1064                                         IEEE80211_P2P_OPPPS_ENABLE_BIT;
1065
1066         err = ieee80211_assign_beacon(sdata, &params->beacon, NULL);
1067         if (err < 0) {
1068                 ieee80211_vif_release_channel(sdata);
1069                 return err;
1070         }
1071         changed |= err;
1072
1073         err = drv_start_ap(sdata->local, sdata);
1074         if (err) {
1075                 old = sdata_dereference(sdata->u.ap.beacon, sdata);
1076
1077                 if (old)
1078                         kfree_rcu(old, rcu_head);
1079                 RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
1080                 ieee80211_vif_release_channel(sdata);
1081                 return err;
1082         }
1083
1084         ieee80211_recalc_dtim(local, sdata);
1085         ieee80211_bss_info_change_notify(sdata, changed);
1086
1087         netif_carrier_on(dev);
1088         list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
1089                 netif_carrier_on(vlan->dev);
1090
1091         return 0;
1092 }
1093
1094 static int ieee80211_change_beacon(struct wiphy *wiphy, struct net_device *dev,
1095                                    struct cfg80211_beacon_data *params)
1096 {
1097         struct ieee80211_sub_if_data *sdata;
1098         struct beacon_data *old;
1099         int err;
1100
1101         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1102         sdata_assert_lock(sdata);
1103
1104         /* don't allow changing the beacon while CSA is in place - offset
1105          * of channel switch counter may change
1106          */
1107         if (sdata->vif.csa_active)
1108                 return -EBUSY;
1109
1110         old = sdata_dereference(sdata->u.ap.beacon, sdata);
1111         if (!old)
1112                 return -ENOENT;
1113
1114         err = ieee80211_assign_beacon(sdata, params, NULL);
1115         if (err < 0)
1116                 return err;
1117         ieee80211_bss_info_change_notify(sdata, err);
1118         return 0;
1119 }
1120
1121 static int ieee80211_stop_ap(struct wiphy *wiphy, struct net_device *dev)
1122 {
1123         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1124         struct ieee80211_sub_if_data *vlan;
1125         struct ieee80211_local *local = sdata->local;
1126         struct beacon_data *old_beacon;
1127         struct probe_resp *old_probe_resp;
1128         struct cfg80211_chan_def chandef;
1129
1130         sdata_assert_lock(sdata);
1131
1132         old_beacon = sdata_dereference(sdata->u.ap.beacon, sdata);
1133         if (!old_beacon)
1134                 return -ENOENT;
1135         old_probe_resp = sdata_dereference(sdata->u.ap.probe_resp, sdata);
1136
1137         /* abort any running channel switch */
1138         mutex_lock(&local->mtx);
1139         sdata->vif.csa_active = false;
1140         if (sdata->csa_block_tx) {
1141                 ieee80211_wake_vif_queues(local, sdata,
1142                                           IEEE80211_QUEUE_STOP_REASON_CSA);
1143                 sdata->csa_block_tx = false;
1144         }
1145
1146         mutex_unlock(&local->mtx);
1147
1148         kfree(sdata->u.ap.next_beacon);
1149         sdata->u.ap.next_beacon = NULL;
1150
1151         /* turn off carrier for this interface and dependent VLANs */
1152         list_for_each_entry(vlan, &sdata->u.ap.vlans, u.vlan.list)
1153                 netif_carrier_off(vlan->dev);
1154         netif_carrier_off(dev);
1155
1156         /* remove beacon and probe response */
1157         RCU_INIT_POINTER(sdata->u.ap.beacon, NULL);
1158         RCU_INIT_POINTER(sdata->u.ap.probe_resp, NULL);
1159         kfree_rcu(old_beacon, rcu_head);
1160         if (old_probe_resp)
1161                 kfree_rcu(old_probe_resp, rcu_head);
1162         sdata->u.ap.driver_smps_mode = IEEE80211_SMPS_OFF;
1163
1164         kfree(sdata->vif.bss_conf.ftmr_params);
1165         sdata->vif.bss_conf.ftmr_params = NULL;
1166
1167         __sta_info_flush(sdata, true);
1168         ieee80211_free_keys(sdata, true);
1169
1170         sdata->vif.bss_conf.enable_beacon = false;
1171         sdata->vif.bss_conf.ssid_len = 0;
1172         clear_bit(SDATA_STATE_OFFCHANNEL_BEACON_STOPPED, &sdata->state);
1173         ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_BEACON_ENABLED);
1174
1175         if (sdata->wdev.cac_started) {
1176                 chandef = sdata->vif.bss_conf.chandef;
1177                 cancel_delayed_work_sync(&sdata->dfs_cac_timer_work);
1178                 cfg80211_cac_event(sdata->dev, &chandef,
1179                                    NL80211_RADAR_CAC_ABORTED,
1180                                    GFP_KERNEL);
1181         }
1182
1183         drv_stop_ap(sdata->local, sdata);
1184
1185         /* free all potentially still buffered bcast frames */
1186         local->total_ps_buffered -= skb_queue_len(&sdata->u.ap.ps.bc_buf);
1187         ieee80211_purge_tx_queue(&local->hw, &sdata->u.ap.ps.bc_buf);
1188
1189         mutex_lock(&local->mtx);
1190         ieee80211_vif_copy_chanctx_to_vlans(sdata, true);
1191         ieee80211_vif_release_channel(sdata);
1192         mutex_unlock(&local->mtx);
1193
1194         return 0;
1195 }
1196
1197 static int sta_apply_auth_flags(struct ieee80211_local *local,
1198                                 struct sta_info *sta,
1199                                 u32 mask, u32 set)
1200 {
1201         int ret;
1202
1203         if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
1204             set & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
1205             !test_sta_flag(sta, WLAN_STA_AUTH)) {
1206                 ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
1207                 if (ret)
1208                         return ret;
1209         }
1210
1211         if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
1212             set & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
1213             !test_sta_flag(sta, WLAN_STA_ASSOC)) {
1214                 /*
1215                  * When peer becomes associated, init rate control as
1216                  * well. Some drivers require rate control initialized
1217                  * before drv_sta_state() is called.
1218                  */
1219                 if (!test_sta_flag(sta, WLAN_STA_RATE_CONTROL))
1220                         rate_control_rate_init(sta);
1221
1222                 ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
1223                 if (ret)
1224                         return ret;
1225         }
1226
1227         if (mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
1228                 if (set & BIT(NL80211_STA_FLAG_AUTHORIZED))
1229                         ret = sta_info_move_state(sta, IEEE80211_STA_AUTHORIZED);
1230                 else if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
1231                         ret = sta_info_move_state(sta, IEEE80211_STA_ASSOC);
1232                 else
1233                         ret = 0;
1234                 if (ret)
1235                         return ret;
1236         }
1237
1238         if (mask & BIT(NL80211_STA_FLAG_ASSOCIATED) &&
1239             !(set & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
1240             test_sta_flag(sta, WLAN_STA_ASSOC)) {
1241                 ret = sta_info_move_state(sta, IEEE80211_STA_AUTH);
1242                 if (ret)
1243                         return ret;
1244         }
1245
1246         if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED) &&
1247             !(set & BIT(NL80211_STA_FLAG_AUTHENTICATED)) &&
1248             test_sta_flag(sta, WLAN_STA_AUTH)) {
1249                 ret = sta_info_move_state(sta, IEEE80211_STA_NONE);
1250                 if (ret)
1251                         return ret;
1252         }
1253
1254         return 0;
1255 }
1256
1257 static void sta_apply_mesh_params(struct ieee80211_local *local,
1258                                   struct sta_info *sta,
1259                                   struct station_parameters *params)
1260 {
1261 #ifdef CONFIG_MAC80211_MESH
1262         struct ieee80211_sub_if_data *sdata = sta->sdata;
1263         u32 changed = 0;
1264
1265         if (params->sta_modify_mask & STATION_PARAM_APPLY_PLINK_STATE) {
1266                 switch (params->plink_state) {
1267                 case NL80211_PLINK_ESTAB:
1268                         if (sta->mesh->plink_state != NL80211_PLINK_ESTAB)
1269                                 changed = mesh_plink_inc_estab_count(sdata);
1270                         sta->mesh->plink_state = params->plink_state;
1271                         sta->mesh->aid = params->peer_aid;
1272
1273                         ieee80211_mps_sta_status_update(sta);
1274                         changed |= ieee80211_mps_set_sta_local_pm(sta,
1275                                       sdata->u.mesh.mshcfg.power_mode);
1276
1277                         ewma_mesh_tx_rate_avg_init(&sta->mesh->tx_rate_avg);
1278                         /* init at low value */
1279                         ewma_mesh_tx_rate_avg_add(&sta->mesh->tx_rate_avg, 10);
1280
1281                         break;
1282                 case NL80211_PLINK_LISTEN:
1283                 case NL80211_PLINK_BLOCKED:
1284                 case NL80211_PLINK_OPN_SNT:
1285                 case NL80211_PLINK_OPN_RCVD:
1286                 case NL80211_PLINK_CNF_RCVD:
1287                 case NL80211_PLINK_HOLDING:
1288                         if (sta->mesh->plink_state == NL80211_PLINK_ESTAB)
1289                                 changed = mesh_plink_dec_estab_count(sdata);
1290                         sta->mesh->plink_state = params->plink_state;
1291
1292                         ieee80211_mps_sta_status_update(sta);
1293                         changed |= ieee80211_mps_set_sta_local_pm(sta,
1294                                         NL80211_MESH_POWER_UNKNOWN);
1295                         break;
1296                 default:
1297                         /*  nothing  */
1298                         break;
1299                 }
1300         }
1301
1302         switch (params->plink_action) {
1303         case NL80211_PLINK_ACTION_NO_ACTION:
1304                 /* nothing */
1305                 break;
1306         case NL80211_PLINK_ACTION_OPEN:
1307                 changed |= mesh_plink_open(sta);
1308                 break;
1309         case NL80211_PLINK_ACTION_BLOCK:
1310                 changed |= mesh_plink_block(sta);
1311                 break;
1312         }
1313
1314         if (params->local_pm)
1315                 changed |= ieee80211_mps_set_sta_local_pm(sta,
1316                                                           params->local_pm);
1317
1318         ieee80211_mbss_info_change_notify(sdata, changed);
1319 #endif
1320 }
1321
1322 static int sta_apply_parameters(struct ieee80211_local *local,
1323                                 struct sta_info *sta,
1324                                 struct station_parameters *params)
1325 {
1326         int ret = 0;
1327         struct ieee80211_supported_band *sband;
1328         struct ieee80211_sub_if_data *sdata = sta->sdata;
1329         u32 mask, set;
1330
1331         sband = ieee80211_get_sband(sdata);
1332         if (!sband)
1333                 return -EINVAL;
1334
1335         mask = params->sta_flags_mask;
1336         set = params->sta_flags_set;
1337
1338         if (ieee80211_vif_is_mesh(&sdata->vif)) {
1339                 /*
1340                  * In mesh mode, ASSOCIATED isn't part of the nl80211
1341                  * API but must follow AUTHENTICATED for driver state.
1342                  */
1343                 if (mask & BIT(NL80211_STA_FLAG_AUTHENTICATED))
1344                         mask |= BIT(NL80211_STA_FLAG_ASSOCIATED);
1345                 if (set & BIT(NL80211_STA_FLAG_AUTHENTICATED))
1346                         set |= BIT(NL80211_STA_FLAG_ASSOCIATED);
1347         } else if (test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
1348                 /*
1349                  * TDLS -- everything follows authorized, but
1350                  * only becoming authorized is possible, not
1351                  * going back
1352                  */
1353                 if (set & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
1354                         set |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
1355                                BIT(NL80211_STA_FLAG_ASSOCIATED);
1356                         mask |= BIT(NL80211_STA_FLAG_AUTHENTICATED) |
1357                                 BIT(NL80211_STA_FLAG_ASSOCIATED);
1358                 }
1359         }
1360
1361         if (mask & BIT(NL80211_STA_FLAG_WME) &&
1362             local->hw.queues >= IEEE80211_NUM_ACS)
1363                 sta->sta.wme = set & BIT(NL80211_STA_FLAG_WME);
1364
1365         /* auth flags will be set later for TDLS,
1366          * and for unassociated stations that move to assocaited */
1367         if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
1368             !((mask & BIT(NL80211_STA_FLAG_ASSOCIATED)) &&
1369               (set & BIT(NL80211_STA_FLAG_ASSOCIATED)))) {
1370                 ret = sta_apply_auth_flags(local, sta, mask, set);
1371                 if (ret)
1372                         return ret;
1373         }
1374
1375         if (mask & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE)) {
1376                 if (set & BIT(NL80211_STA_FLAG_SHORT_PREAMBLE))
1377                         set_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
1378                 else
1379                         clear_sta_flag(sta, WLAN_STA_SHORT_PREAMBLE);
1380         }
1381
1382         if (mask & BIT(NL80211_STA_FLAG_MFP)) {
1383                 sta->sta.mfp = !!(set & BIT(NL80211_STA_FLAG_MFP));
1384                 if (set & BIT(NL80211_STA_FLAG_MFP))
1385                         set_sta_flag(sta, WLAN_STA_MFP);
1386                 else
1387                         clear_sta_flag(sta, WLAN_STA_MFP);
1388         }
1389
1390         if (mask & BIT(NL80211_STA_FLAG_TDLS_PEER)) {
1391                 if (set & BIT(NL80211_STA_FLAG_TDLS_PEER))
1392                         set_sta_flag(sta, WLAN_STA_TDLS_PEER);
1393                 else
1394                         clear_sta_flag(sta, WLAN_STA_TDLS_PEER);
1395         }
1396
1397         /* mark TDLS channel switch support, if the AP allows it */
1398         if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
1399             !sdata->u.mgd.tdls_chan_switch_prohibited &&
1400             params->ext_capab_len >= 4 &&
1401             params->ext_capab[3] & WLAN_EXT_CAPA4_TDLS_CHAN_SWITCH)
1402                 set_sta_flag(sta, WLAN_STA_TDLS_CHAN_SWITCH);
1403
1404         if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
1405             !sdata->u.mgd.tdls_wider_bw_prohibited &&
1406             ieee80211_hw_check(&local->hw, TDLS_WIDER_BW) &&
1407             params->ext_capab_len >= 8 &&
1408             params->ext_capab[7] & WLAN_EXT_CAPA8_TDLS_WIDE_BW_ENABLED)
1409                 set_sta_flag(sta, WLAN_STA_TDLS_WIDER_BW);
1410
1411         if (params->sta_modify_mask & STATION_PARAM_APPLY_UAPSD) {
1412                 sta->sta.uapsd_queues = params->uapsd_queues;
1413                 sta->sta.max_sp = params->max_sp;
1414         }
1415
1416         /* The sender might not have sent the last bit, consider it to be 0 */
1417         if (params->ext_capab_len >= 8) {
1418                 u8 val = (params->ext_capab[7] &
1419                           WLAN_EXT_CAPA8_MAX_MSDU_IN_AMSDU_LSB) >> 7;
1420
1421                 /* we did get all the bits, take the MSB as well */
1422                 if (params->ext_capab_len >= 9) {
1423                         u8 val_msb = params->ext_capab[8] &
1424                                 WLAN_EXT_CAPA9_MAX_MSDU_IN_AMSDU_MSB;
1425                         val_msb <<= 1;
1426                         val |= val_msb;
1427                 }
1428
1429                 switch (val) {
1430                 case 1:
1431                         sta->sta.max_amsdu_subframes = 32;
1432                         break;
1433                 case 2:
1434                         sta->sta.max_amsdu_subframes = 16;
1435                         break;
1436                 case 3:
1437                         sta->sta.max_amsdu_subframes = 8;
1438                         break;
1439                 default:
1440                         sta->sta.max_amsdu_subframes = 0;
1441                 }
1442         }
1443
1444         /*
1445          * cfg80211 validates this (1-2007) and allows setting the AID
1446          * only when creating a new station entry
1447          */
1448         if (params->aid)
1449                 sta->sta.aid = params->aid;
1450
1451         /*
1452          * Some of the following updates would be racy if called on an
1453          * existing station, via ieee80211_change_station(). However,
1454          * all such changes are rejected by cfg80211 except for updates
1455          * changing the supported rates on an existing but not yet used
1456          * TDLS peer.
1457          */
1458
1459         if (params->listen_interval >= 0)
1460                 sta->listen_interval = params->listen_interval;
1461
1462         if (params->sta_modify_mask & STATION_PARAM_APPLY_STA_TXPOWER) {
1463                 sta->sta.txpwr.type = params->txpwr.type;
1464                 if (params->txpwr.type == NL80211_TX_POWER_LIMITED)
1465                         sta->sta.txpwr.power = params->txpwr.power;
1466                 ret = drv_sta_set_txpwr(local, sdata, sta);
1467                 if (ret)
1468                         return ret;
1469         }
1470
1471         if (params->supported_rates && params->supported_rates_len) {
1472                 ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
1473                                          sband, params->supported_rates,
1474                                          params->supported_rates_len,
1475                                          &sta->sta.supp_rates[sband->band]);
1476         }
1477
1478         if (params->ht_capa)
1479                 ieee80211_ht_cap_ie_to_sta_ht_cap(sdata, sband,
1480                                                   params->ht_capa, sta);
1481
1482         /* VHT can override some HT caps such as the A-MSDU max length */
1483         if (params->vht_capa)
1484                 ieee80211_vht_cap_ie_to_sta_vht_cap(sdata, sband,
1485                                                     params->vht_capa, sta);
1486
1487         if (params->he_capa)
1488                 ieee80211_he_cap_ie_to_sta_he_cap(sdata, sband,
1489                                                   (void *)params->he_capa,
1490                                                   params->he_capa_len, sta);
1491
1492         if (params->opmode_notif_used) {
1493                 /* returned value is only needed for rc update, but the
1494                  * rc isn't initialized here yet, so ignore it
1495                  */
1496                 __ieee80211_vht_handle_opmode(sdata, sta, params->opmode_notif,
1497                                               sband->band);
1498         }
1499
1500         if (params->support_p2p_ps >= 0)
1501                 sta->sta.support_p2p_ps = params->support_p2p_ps;
1502
1503         if (ieee80211_vif_is_mesh(&sdata->vif))
1504                 sta_apply_mesh_params(local, sta, params);
1505
1506         if (params->airtime_weight)
1507                 sta->airtime_weight = params->airtime_weight;
1508
1509         /* set the STA state after all sta info from usermode has been set */
1510         if (test_sta_flag(sta, WLAN_STA_TDLS_PEER) ||
1511             set & BIT(NL80211_STA_FLAG_ASSOCIATED)) {
1512                 ret = sta_apply_auth_flags(local, sta, mask, set);
1513                 if (ret)
1514                         return ret;
1515         }
1516
1517         return 0;
1518 }
1519
1520 static int ieee80211_add_station(struct wiphy *wiphy, struct net_device *dev,
1521                                  const u8 *mac,
1522                                  struct station_parameters *params)
1523 {
1524         struct ieee80211_local *local = wiphy_priv(wiphy);
1525         struct sta_info *sta;
1526         struct ieee80211_sub_if_data *sdata;
1527         int err;
1528         int layer2_update;
1529
1530         if (params->vlan) {
1531                 sdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
1532
1533                 if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
1534                     sdata->vif.type != NL80211_IFTYPE_AP)
1535                         return -EINVAL;
1536         } else
1537                 sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1538
1539         if (ether_addr_equal(mac, sdata->vif.addr))
1540                 return -EINVAL;
1541
1542         if (is_multicast_ether_addr(mac))
1543                 return -EINVAL;
1544
1545         sta = sta_info_alloc(sdata, mac, GFP_KERNEL);
1546         if (!sta)
1547                 return -ENOMEM;
1548
1549         if (params->sta_flags_set & BIT(NL80211_STA_FLAG_TDLS_PEER))
1550                 sta->sta.tdls = true;
1551
1552         if (sta->sta.tdls && sdata->vif.type == NL80211_IFTYPE_STATION &&
1553             !sdata->u.mgd.associated)
1554                 return -EINVAL;
1555
1556         err = sta_apply_parameters(local, sta, params);
1557         if (err) {
1558                 sta_info_free(local, sta);
1559                 return err;
1560         }
1561
1562         /*
1563          * for TDLS and for unassociated station, rate control should be
1564          * initialized only when rates are known and station is marked
1565          * authorized/associated
1566          */
1567         if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER) &&
1568             test_sta_flag(sta, WLAN_STA_ASSOC))
1569                 rate_control_rate_init(sta);
1570
1571         layer2_update = sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
1572                 sdata->vif.type == NL80211_IFTYPE_AP;
1573
1574         err = sta_info_insert_rcu(sta);
1575         if (err) {
1576                 rcu_read_unlock();
1577                 return err;
1578         }
1579
1580         if (layer2_update)
1581                 cfg80211_send_layer2_update(sta->sdata->dev, sta->sta.addr);
1582
1583         rcu_read_unlock();
1584
1585         return 0;
1586 }
1587
1588 static int ieee80211_del_station(struct wiphy *wiphy, struct net_device *dev,
1589                                  struct station_del_parameters *params)
1590 {
1591         struct ieee80211_sub_if_data *sdata;
1592
1593         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1594
1595         if (params->mac)
1596                 return sta_info_destroy_addr_bss(sdata, params->mac);
1597
1598         sta_info_flush(sdata);
1599         return 0;
1600 }
1601
1602 static int ieee80211_change_station(struct wiphy *wiphy,
1603                                     struct net_device *dev, const u8 *mac,
1604                                     struct station_parameters *params)
1605 {
1606         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1607         struct ieee80211_local *local = wiphy_priv(wiphy);
1608         struct sta_info *sta;
1609         struct ieee80211_sub_if_data *vlansdata;
1610         enum cfg80211_station_type statype;
1611         int err;
1612
1613         mutex_lock(&local->sta_mtx);
1614
1615         sta = sta_info_get_bss(sdata, mac);
1616         if (!sta) {
1617                 err = -ENOENT;
1618                 goto out_err;
1619         }
1620
1621         switch (sdata->vif.type) {
1622         case NL80211_IFTYPE_MESH_POINT:
1623                 if (sdata->u.mesh.user_mpm)
1624                         statype = CFG80211_STA_MESH_PEER_USER;
1625                 else
1626                         statype = CFG80211_STA_MESH_PEER_KERNEL;
1627                 break;
1628         case NL80211_IFTYPE_ADHOC:
1629                 statype = CFG80211_STA_IBSS;
1630                 break;
1631         case NL80211_IFTYPE_STATION:
1632                 if (!test_sta_flag(sta, WLAN_STA_TDLS_PEER)) {
1633                         statype = CFG80211_STA_AP_STA;
1634                         break;
1635                 }
1636                 if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
1637                         statype = CFG80211_STA_TDLS_PEER_ACTIVE;
1638                 else
1639                         statype = CFG80211_STA_TDLS_PEER_SETUP;
1640                 break;
1641         case NL80211_IFTYPE_AP:
1642         case NL80211_IFTYPE_AP_VLAN:
1643                 if (test_sta_flag(sta, WLAN_STA_ASSOC))
1644                         statype = CFG80211_STA_AP_CLIENT;
1645                 else
1646                         statype = CFG80211_STA_AP_CLIENT_UNASSOC;
1647                 break;
1648         default:
1649                 err = -EOPNOTSUPP;
1650                 goto out_err;
1651         }
1652
1653         err = cfg80211_check_station_change(wiphy, params, statype);
1654         if (err)
1655                 goto out_err;
1656
1657         if (params->vlan && params->vlan != sta->sdata->dev) {
1658                 vlansdata = IEEE80211_DEV_TO_SUB_IF(params->vlan);
1659
1660                 if (params->vlan->ieee80211_ptr->use_4addr) {
1661                         if (vlansdata->u.vlan.sta) {
1662                                 err = -EBUSY;
1663                                 goto out_err;
1664                         }
1665
1666                         rcu_assign_pointer(vlansdata->u.vlan.sta, sta);
1667                         __ieee80211_check_fast_rx_iface(vlansdata);
1668                 }
1669
1670                 if (sta->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
1671                     sta->sdata->u.vlan.sta)
1672                         RCU_INIT_POINTER(sta->sdata->u.vlan.sta, NULL);
1673
1674                 if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
1675                         ieee80211_vif_dec_num_mcast(sta->sdata);
1676
1677                 sta->sdata = vlansdata;
1678                 ieee80211_check_fast_xmit(sta);
1679
1680                 if (test_sta_flag(sta, WLAN_STA_AUTHORIZED))
1681                         ieee80211_vif_inc_num_mcast(sta->sdata);
1682
1683                 cfg80211_send_layer2_update(sta->sdata->dev, sta->sta.addr);
1684         }
1685
1686         err = sta_apply_parameters(local, sta, params);
1687         if (err)
1688                 goto out_err;
1689
1690         mutex_unlock(&local->sta_mtx);
1691
1692         if ((sdata->vif.type == NL80211_IFTYPE_AP ||
1693              sdata->vif.type == NL80211_IFTYPE_AP_VLAN) &&
1694             sta->known_smps_mode != sta->sdata->bss->req_smps &&
1695             test_sta_flag(sta, WLAN_STA_AUTHORIZED) &&
1696             sta_info_tx_streams(sta) != 1) {
1697                 ht_dbg(sta->sdata,
1698                        "%pM just authorized and MIMO capable - update SMPS\n",
1699                        sta->sta.addr);
1700                 ieee80211_send_smps_action(sta->sdata,
1701                         sta->sdata->bss->req_smps,
1702                         sta->sta.addr,
1703                         sta->sdata->vif.bss_conf.bssid);
1704         }
1705
1706         if (sdata->vif.type == NL80211_IFTYPE_STATION &&
1707             params->sta_flags_mask & BIT(NL80211_STA_FLAG_AUTHORIZED)) {
1708                 ieee80211_recalc_ps(local);
1709                 ieee80211_recalc_ps_vif(sdata);
1710         }
1711
1712         return 0;
1713 out_err:
1714         mutex_unlock(&local->sta_mtx);
1715         return err;
1716 }
1717
1718 #ifdef CONFIG_MAC80211_MESH
1719 static int ieee80211_add_mpath(struct wiphy *wiphy, struct net_device *dev,
1720                                const u8 *dst, const u8 *next_hop)
1721 {
1722         struct ieee80211_sub_if_data *sdata;
1723         struct mesh_path *mpath;
1724         struct sta_info *sta;
1725
1726         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1727
1728         rcu_read_lock();
1729         sta = sta_info_get(sdata, next_hop);
1730         if (!sta) {
1731                 rcu_read_unlock();
1732                 return -ENOENT;
1733         }
1734
1735         mpath = mesh_path_add(sdata, dst);
1736         if (IS_ERR(mpath)) {
1737                 rcu_read_unlock();
1738                 return PTR_ERR(mpath);
1739         }
1740
1741         mesh_path_fix_nexthop(mpath, sta);
1742
1743         rcu_read_unlock();
1744         return 0;
1745 }
1746
1747 static int ieee80211_del_mpath(struct wiphy *wiphy, struct net_device *dev,
1748                                const u8 *dst)
1749 {
1750         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1751
1752         if (dst)
1753                 return mesh_path_del(sdata, dst);
1754
1755         mesh_path_flush_by_iface(sdata);
1756         return 0;
1757 }
1758
1759 static int ieee80211_change_mpath(struct wiphy *wiphy, struct net_device *dev,
1760                                   const u8 *dst, const u8 *next_hop)
1761 {
1762         struct ieee80211_sub_if_data *sdata;
1763         struct mesh_path *mpath;
1764         struct sta_info *sta;
1765
1766         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1767
1768         rcu_read_lock();
1769
1770         sta = sta_info_get(sdata, next_hop);
1771         if (!sta) {
1772                 rcu_read_unlock();
1773                 return -ENOENT;
1774         }
1775
1776         mpath = mesh_path_lookup(sdata, dst);
1777         if (!mpath) {
1778                 rcu_read_unlock();
1779                 return -ENOENT;
1780         }
1781
1782         mesh_path_fix_nexthop(mpath, sta);
1783
1784         rcu_read_unlock();
1785         return 0;
1786 }
1787
1788 static void mpath_set_pinfo(struct mesh_path *mpath, u8 *next_hop,
1789                             struct mpath_info *pinfo)
1790 {
1791         struct sta_info *next_hop_sta = rcu_dereference(mpath->next_hop);
1792
1793         if (next_hop_sta)
1794                 memcpy(next_hop, next_hop_sta->sta.addr, ETH_ALEN);
1795         else
1796                 eth_zero_addr(next_hop);
1797
1798         memset(pinfo, 0, sizeof(*pinfo));
1799
1800         pinfo->generation = mpath->sdata->u.mesh.mesh_paths_generation;
1801
1802         pinfo->filled = MPATH_INFO_FRAME_QLEN |
1803                         MPATH_INFO_SN |
1804                         MPATH_INFO_METRIC |
1805                         MPATH_INFO_EXPTIME |
1806                         MPATH_INFO_DISCOVERY_TIMEOUT |
1807                         MPATH_INFO_DISCOVERY_RETRIES |
1808                         MPATH_INFO_FLAGS |
1809                         MPATH_INFO_HOP_COUNT |
1810                         MPATH_INFO_PATH_CHANGE;
1811
1812         pinfo->frame_qlen = mpath->frame_queue.qlen;
1813         pinfo->sn = mpath->sn;
1814         pinfo->metric = mpath->metric;
1815         if (time_before(jiffies, mpath->exp_time))
1816                 pinfo->exptime = jiffies_to_msecs(mpath->exp_time - jiffies);
1817         pinfo->discovery_timeout =
1818                         jiffies_to_msecs(mpath->discovery_timeout);
1819         pinfo->discovery_retries = mpath->discovery_retries;
1820         if (mpath->flags & MESH_PATH_ACTIVE)
1821                 pinfo->flags |= NL80211_MPATH_FLAG_ACTIVE;
1822         if (mpath->flags & MESH_PATH_RESOLVING)
1823                 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVING;
1824         if (mpath->flags & MESH_PATH_SN_VALID)
1825                 pinfo->flags |= NL80211_MPATH_FLAG_SN_VALID;
1826         if (mpath->flags & MESH_PATH_FIXED)
1827                 pinfo->flags |= NL80211_MPATH_FLAG_FIXED;
1828         if (mpath->flags & MESH_PATH_RESOLVED)
1829                 pinfo->flags |= NL80211_MPATH_FLAG_RESOLVED;
1830         pinfo->hop_count = mpath->hop_count;
1831         pinfo->path_change_count = mpath->path_change_count;
1832 }
1833
1834 static int ieee80211_get_mpath(struct wiphy *wiphy, struct net_device *dev,
1835                                u8 *dst, u8 *next_hop, struct mpath_info *pinfo)
1836
1837 {
1838         struct ieee80211_sub_if_data *sdata;
1839         struct mesh_path *mpath;
1840
1841         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1842
1843         rcu_read_lock();
1844         mpath = mesh_path_lookup(sdata, dst);
1845         if (!mpath) {
1846                 rcu_read_unlock();
1847                 return -ENOENT;
1848         }
1849         memcpy(dst, mpath->dst, ETH_ALEN);
1850         mpath_set_pinfo(mpath, next_hop, pinfo);
1851         rcu_read_unlock();
1852         return 0;
1853 }
1854
1855 static int ieee80211_dump_mpath(struct wiphy *wiphy, struct net_device *dev,
1856                                 int idx, u8 *dst, u8 *next_hop,
1857                                 struct mpath_info *pinfo)
1858 {
1859         struct ieee80211_sub_if_data *sdata;
1860         struct mesh_path *mpath;
1861
1862         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1863
1864         rcu_read_lock();
1865         mpath = mesh_path_lookup_by_idx(sdata, idx);
1866         if (!mpath) {
1867                 rcu_read_unlock();
1868                 return -ENOENT;
1869         }
1870         memcpy(dst, mpath->dst, ETH_ALEN);
1871         mpath_set_pinfo(mpath, next_hop, pinfo);
1872         rcu_read_unlock();
1873         return 0;
1874 }
1875
1876 static void mpp_set_pinfo(struct mesh_path *mpath, u8 *mpp,
1877                           struct mpath_info *pinfo)
1878 {
1879         memset(pinfo, 0, sizeof(*pinfo));
1880         memcpy(mpp, mpath->mpp, ETH_ALEN);
1881
1882         pinfo->generation = mpath->sdata->u.mesh.mpp_paths_generation;
1883 }
1884
1885 static int ieee80211_get_mpp(struct wiphy *wiphy, struct net_device *dev,
1886                              u8 *dst, u8 *mpp, struct mpath_info *pinfo)
1887
1888 {
1889         struct ieee80211_sub_if_data *sdata;
1890         struct mesh_path *mpath;
1891
1892         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1893
1894         rcu_read_lock();
1895         mpath = mpp_path_lookup(sdata, dst);
1896         if (!mpath) {
1897                 rcu_read_unlock();
1898                 return -ENOENT;
1899         }
1900         memcpy(dst, mpath->dst, ETH_ALEN);
1901         mpp_set_pinfo(mpath, mpp, pinfo);
1902         rcu_read_unlock();
1903         return 0;
1904 }
1905
1906 static int ieee80211_dump_mpp(struct wiphy *wiphy, struct net_device *dev,
1907                               int idx, u8 *dst, u8 *mpp,
1908                               struct mpath_info *pinfo)
1909 {
1910         struct ieee80211_sub_if_data *sdata;
1911         struct mesh_path *mpath;
1912
1913         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1914
1915         rcu_read_lock();
1916         mpath = mpp_path_lookup_by_idx(sdata, idx);
1917         if (!mpath) {
1918                 rcu_read_unlock();
1919                 return -ENOENT;
1920         }
1921         memcpy(dst, mpath->dst, ETH_ALEN);
1922         mpp_set_pinfo(mpath, mpp, pinfo);
1923         rcu_read_unlock();
1924         return 0;
1925 }
1926
1927 static int ieee80211_get_mesh_config(struct wiphy *wiphy,
1928                                 struct net_device *dev,
1929                                 struct mesh_config *conf)
1930 {
1931         struct ieee80211_sub_if_data *sdata;
1932         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
1933
1934         memcpy(conf, &(sdata->u.mesh.mshcfg), sizeof(struct mesh_config));
1935         return 0;
1936 }
1937
1938 static inline bool _chg_mesh_attr(enum nl80211_meshconf_params parm, u32 mask)
1939 {
1940         return (mask >> (parm-1)) & 0x1;
1941 }
1942
1943 static int copy_mesh_setup(struct ieee80211_if_mesh *ifmsh,
1944                 const struct mesh_setup *setup)
1945 {
1946         u8 *new_ie;
1947         const u8 *old_ie;
1948         struct ieee80211_sub_if_data *sdata = container_of(ifmsh,
1949                                         struct ieee80211_sub_if_data, u.mesh);
1950
1951         /* allocate information elements */
1952         new_ie = NULL;
1953         old_ie = ifmsh->ie;
1954
1955         if (setup->ie_len) {
1956                 new_ie = kmemdup(setup->ie, setup->ie_len,
1957                                 GFP_KERNEL);
1958                 if (!new_ie)
1959                         return -ENOMEM;
1960         }
1961         ifmsh->ie_len = setup->ie_len;
1962         ifmsh->ie = new_ie;
1963         kfree(old_ie);
1964
1965         /* now copy the rest of the setup parameters */
1966         ifmsh->mesh_id_len = setup->mesh_id_len;
1967         memcpy(ifmsh->mesh_id, setup->mesh_id, ifmsh->mesh_id_len);
1968         ifmsh->mesh_sp_id = setup->sync_method;
1969         ifmsh->mesh_pp_id = setup->path_sel_proto;
1970         ifmsh->mesh_pm_id = setup->path_metric;
1971         ifmsh->user_mpm = setup->user_mpm;
1972         ifmsh->mesh_auth_id = setup->auth_id;
1973         ifmsh->security = IEEE80211_MESH_SEC_NONE;
1974         ifmsh->userspace_handles_dfs = setup->userspace_handles_dfs;
1975         if (setup->is_authenticated)
1976                 ifmsh->security |= IEEE80211_MESH_SEC_AUTHED;
1977         if (setup->is_secure)
1978                 ifmsh->security |= IEEE80211_MESH_SEC_SECURED;
1979
1980         /* mcast rate setting in Mesh Node */
1981         memcpy(sdata->vif.bss_conf.mcast_rate, setup->mcast_rate,
1982                                                 sizeof(setup->mcast_rate));
1983         sdata->vif.bss_conf.basic_rates = setup->basic_rates;
1984
1985         sdata->vif.bss_conf.beacon_int = setup->beacon_interval;
1986         sdata->vif.bss_conf.dtim_period = setup->dtim_period;
1987
1988         return 0;
1989 }
1990
1991 static int ieee80211_update_mesh_config(struct wiphy *wiphy,
1992                                         struct net_device *dev, u32 mask,
1993                                         const struct mesh_config *nconf)
1994 {
1995         struct mesh_config *conf;
1996         struct ieee80211_sub_if_data *sdata;
1997         struct ieee80211_if_mesh *ifmsh;
1998
1999         sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2000         ifmsh = &sdata->u.mesh;
2001
2002         /* Set the config options which we are interested in setting */
2003         conf = &(sdata->u.mesh.mshcfg);
2004         if (_chg_mesh_attr(NL80211_MESHCONF_RETRY_TIMEOUT, mask))
2005                 conf->dot11MeshRetryTimeout = nconf->dot11MeshRetryTimeout;
2006         if (_chg_mesh_attr(NL80211_MESHCONF_CONFIRM_TIMEOUT, mask))
2007                 conf->dot11MeshConfirmTimeout = nconf->dot11MeshConfirmTimeout;
2008         if (_chg_mesh_attr(NL80211_MESHCONF_HOLDING_TIMEOUT, mask))
2009                 conf->dot11MeshHoldingTimeout = nconf->dot11MeshHoldingTimeout;
2010         if (_chg_mesh_attr(NL80211_MESHCONF_MAX_PEER_LINKS, mask))
2011                 conf->dot11MeshMaxPeerLinks = nconf->dot11MeshMaxPeerLinks;
2012         if (_chg_mesh_attr(NL80211_MESHCONF_MAX_RETRIES, mask))
2013                 conf->dot11MeshMaxRetries = nconf->dot11MeshMaxRetries;
2014         if (_chg_mesh_attr(NL80211_MESHCONF_TTL, mask))
2015                 conf->dot11MeshTTL = nconf->dot11MeshTTL;
2016         if (_chg_mesh_attr(NL80211_MESHCONF_ELEMENT_TTL, mask))
2017                 conf->element_ttl = nconf->element_ttl;
2018         if (_chg_mesh_attr(NL80211_MESHCONF_AUTO_OPEN_PLINKS, mask)) {
2019                 if (ifmsh->user_mpm)
2020                         return -EBUSY;
2021                 conf->auto_open_plinks = nconf->auto_open_plinks;
2022         }
2023         if (_chg_mesh_attr(NL80211_MESHCONF_SYNC_OFFSET_MAX_NEIGHBOR, mask))
2024                 conf->dot11MeshNbrOffsetMaxNeighbor =
2025                         nconf->dot11MeshNbrOffsetMaxNeighbor;
2026         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_MAX_PREQ_RETRIES, mask))
2027                 conf->dot11MeshHWMPmaxPREQretries =
2028                         nconf->dot11MeshHWMPmaxPREQretries;
2029         if (_chg_mesh_attr(NL80211_MESHCONF_PATH_REFRESH_TIME, mask))
2030                 conf->path_refresh_time = nconf->path_refresh_time;
2031         if (_chg_mesh_attr(NL80211_MESHCONF_MIN_DISCOVERY_TIMEOUT, mask))
2032                 conf->min_discovery_timeout = nconf->min_discovery_timeout;
2033         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ACTIVE_PATH_TIMEOUT, mask))
2034                 conf->dot11MeshHWMPactivePathTimeout =
2035                         nconf->dot11MeshHWMPactivePathTimeout;
2036         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PREQ_MIN_INTERVAL, mask))
2037                 conf->dot11MeshHWMPpreqMinInterval =
2038                         nconf->dot11MeshHWMPpreqMinInterval;
2039         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PERR_MIN_INTERVAL, mask))
2040                 conf->dot11MeshHWMPperrMinInterval =
2041                         nconf->dot11MeshHWMPperrMinInterval;
2042         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_NET_DIAM_TRVS_TIME,
2043                            mask))
2044                 conf->dot11MeshHWMPnetDiameterTraversalTime =
2045                         nconf->dot11MeshHWMPnetDiameterTraversalTime;
2046         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOTMODE, mask)) {
2047                 conf->dot11MeshHWMPRootMode = nconf->dot11MeshHWMPRootMode;
2048                 ieee80211_mesh_root_setup(ifmsh);
2049         }
2050         if (_chg_mesh_attr(NL80211_MESHCONF_GATE_ANNOUNCEMENTS, mask)) {
2051                 /* our current gate announcement implementation rides on root
2052                  * announcements, so require this ifmsh to also be a root node
2053                  * */
2054                 if (nconf->dot11MeshGateAnnouncementProtocol &&
2055                     !(conf->dot11MeshHWMPRootMode > IEEE80211_ROOTMODE_ROOT)) {
2056                         conf->dot11MeshHWMPRootMode = IEEE80211_PROACTIVE_RANN;
2057                         ieee80211_mesh_root_setup(ifmsh);
2058                 }
2059                 conf->dot11MeshGateAnnouncementProtocol =
2060                         nconf->dot11MeshGateAnnouncementProtocol;
2061         }
2062         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_RANN_INTERVAL, mask))
2063                 conf->dot11MeshHWMPRannInterval =
2064                         nconf->dot11MeshHWMPRannInterval;
2065         if (_chg_mesh_attr(NL80211_MESHCONF_FORWARDING, mask))
2066                 conf->dot11MeshForwarding = nconf->dot11MeshForwarding;
2067         if (_chg_mesh_attr(NL80211_MESHCONF_RSSI_THRESHOLD, mask)) {
2068                 /* our RSSI threshold implementation is supported only for
2069                  * devices that report signal in dBm.
2070                  */
2071                 if (!ieee80211_hw_check(&sdata->local->hw, SIGNAL_DBM))
2072                         return -ENOTSUPP;
2073                 conf->rssi_threshold = nconf->rssi_threshold;
2074         }
2075         if (_chg_mesh_attr(NL80211_MESHCONF_HT_OPMODE, mask)) {
2076                 conf->ht_opmode = nconf->ht_opmode;
2077                 sdata->vif.bss_conf.ht_operation_mode = nconf->ht_opmode;
2078                 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_HT);
2079         }
2080         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_PATH_TO_ROOT_TIMEOUT, mask))
2081                 conf->dot11MeshHWMPactivePathToRootTimeout =
2082                         nconf->dot11MeshHWMPactivePathToRootTimeout;
2083         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_ROOT_INTERVAL, mask))
2084                 conf->dot11MeshHWMProotInterval =
2085                         nconf->dot11MeshHWMProotInterval;
2086         if (_chg_mesh_attr(NL80211_MESHCONF_HWMP_CONFIRMATION_INTERVAL, mask))
2087                 conf->dot11MeshHWMPconfirmationInterval =
2088                         nconf->dot11MeshHWMPconfirmationInterval;
2089         if (_chg_mesh_attr(NL80211_MESHCONF_POWER_MODE, mask)) {
2090                 conf->power_mode = nconf->power_mode;
2091                 ieee80211_mps_local_status_update(sdata);
2092         }
2093         if (_chg_mesh_attr(NL80211_MESHCONF_AWAKE_WINDOW, mask))
2094                 conf->dot11MeshAwakeWindowDuration =
2095                         nconf->dot11MeshAwakeWindowDuration;
2096         if (_chg_mesh_attr(NL80211_MESHCONF_PLINK_TIMEOUT, mask))
2097                 conf->plink_timeout = nconf->plink_timeout;
2098         if (_chg_mesh_attr(NL80211_MESHCONF_CONNECTED_TO_GATE, mask))
2099                 conf->dot11MeshConnectedToMeshGate =
2100                         nconf->dot11MeshConnectedToMeshGate;
2101         ieee80211_mbss_info_change_notify(sdata, BSS_CHANGED_BEACON);
2102         return 0;
2103 }
2104
2105 static int ieee80211_join_mesh(struct wiphy *wiphy, struct net_device *dev,
2106                                const struct mesh_config *conf,
2107                                const struct mesh_setup *setup)
2108 {
2109         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2110         struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
2111         int err;
2112
2113         memcpy(&ifmsh->mshcfg, conf, sizeof(struct mesh_config));
2114         err = copy_mesh_setup(ifmsh, setup);
2115         if (err)
2116                 return err;
2117
2118         sdata->control_port_over_nl80211 = setup->control_port_over_nl80211;
2119
2120         /* can mesh use other SMPS modes? */
2121         sdata->smps_mode = IEEE80211_SMPS_OFF;
2122         sdata->needed_rx_chains = sdata->local->rx_chains;
2123
2124         mutex_lock(&sdata->local->mtx);
2125         err = ieee80211_vif_use_channel(sdata, &setup->chandef,
2126                                         IEEE80211_CHANCTX_SHARED);
2127         mutex_unlock(&sdata->local->mtx);
2128         if (err)
2129                 return err;
2130
2131         return ieee80211_start_mesh(sdata);
2132 }
2133
2134 static int ieee80211_leave_mesh(struct wiphy *wiphy, struct net_device *dev)
2135 {
2136         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2137
2138         ieee80211_stop_mesh(sdata);
2139         mutex_lock(&sdata->local->mtx);
2140         ieee80211_vif_release_channel(sdata);
2141         mutex_unlock(&sdata->local->mtx);
2142
2143         return 0;
2144 }
2145 #endif
2146
2147 static int ieee80211_change_bss(struct wiphy *wiphy,
2148                                 struct net_device *dev,
2149                                 struct bss_parameters *params)
2150 {
2151         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2152         struct ieee80211_supported_band *sband;
2153         u32 changed = 0;
2154
2155         if (!sdata_dereference(sdata->u.ap.beacon, sdata))
2156                 return -ENOENT;
2157
2158         sband = ieee80211_get_sband(sdata);
2159         if (!sband)
2160                 return -EINVAL;
2161
2162         if (params->use_cts_prot >= 0) {
2163                 sdata->vif.bss_conf.use_cts_prot = params->use_cts_prot;
2164                 changed |= BSS_CHANGED_ERP_CTS_PROT;
2165         }
2166         if (params->use_short_preamble >= 0) {
2167                 sdata->vif.bss_conf.use_short_preamble =
2168                         params->use_short_preamble;
2169                 changed |= BSS_CHANGED_ERP_PREAMBLE;
2170         }
2171
2172         if (!sdata->vif.bss_conf.use_short_slot &&
2173             sband->band == NL80211_BAND_5GHZ) {
2174                 sdata->vif.bss_conf.use_short_slot = true;
2175                 changed |= BSS_CHANGED_ERP_SLOT;
2176         }
2177
2178         if (params->use_short_slot_time >= 0) {
2179                 sdata->vif.bss_conf.use_short_slot =
2180                         params->use_short_slot_time;
2181                 changed |= BSS_CHANGED_ERP_SLOT;
2182         }
2183
2184         if (params->basic_rates) {
2185                 ieee80211_parse_bitrates(&sdata->vif.bss_conf.chandef,
2186                                          wiphy->bands[sband->band],
2187                                          params->basic_rates,
2188                                          params->basic_rates_len,
2189                                          &sdata->vif.bss_conf.basic_rates);
2190                 changed |= BSS_CHANGED_BASIC_RATES;
2191                 ieee80211_check_rate_mask(sdata);
2192         }
2193
2194         if (params->ap_isolate >= 0) {
2195                 if (params->ap_isolate)
2196                         sdata->flags |= IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
2197                 else
2198                         sdata->flags &= ~IEEE80211_SDATA_DONT_BRIDGE_PACKETS;
2199                 ieee80211_check_fast_rx_iface(sdata);
2200         }
2201
2202         if (params->ht_opmode >= 0) {
2203                 sdata->vif.bss_conf.ht_operation_mode =
2204                         (u16) params->ht_opmode;
2205                 changed |= BSS_CHANGED_HT;
2206         }
2207
2208         if (params->p2p_ctwindow >= 0) {
2209                 sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
2210                                         ~IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
2211                 sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
2212                         params->p2p_ctwindow & IEEE80211_P2P_OPPPS_CTWINDOW_MASK;
2213                 changed |= BSS_CHANGED_P2P_PS;
2214         }
2215
2216         if (params->p2p_opp_ps > 0) {
2217                 sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow |=
2218                                         IEEE80211_P2P_OPPPS_ENABLE_BIT;
2219                 changed |= BSS_CHANGED_P2P_PS;
2220         } else if (params->p2p_opp_ps == 0) {
2221                 sdata->vif.bss_conf.p2p_noa_attr.oppps_ctwindow &=
2222                                         ~IEEE80211_P2P_OPPPS_ENABLE_BIT;
2223                 changed |= BSS_CHANGED_P2P_PS;
2224         }
2225
2226         ieee80211_bss_info_change_notify(sdata, changed);
2227
2228         return 0;
2229 }
2230
2231 static int ieee80211_set_txq_params(struct wiphy *wiphy,
2232                                     struct net_device *dev,
2233                                     struct ieee80211_txq_params *params)
2234 {
2235         struct ieee80211_local *local = wiphy_priv(wiphy);
2236         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2237         struct ieee80211_tx_queue_params p;
2238
2239         if (!local->ops->conf_tx)
2240                 return -EOPNOTSUPP;
2241
2242         if (local->hw.queues < IEEE80211_NUM_ACS)
2243                 return -EOPNOTSUPP;
2244
2245         memset(&p, 0, sizeof(p));
2246         p.aifs = params->aifs;
2247         p.cw_max = params->cwmax;
2248         p.cw_min = params->cwmin;
2249         p.txop = params->txop;
2250
2251         /*
2252          * Setting tx queue params disables u-apsd because it's only
2253          * called in master mode.
2254          */
2255         p.uapsd = false;
2256
2257         ieee80211_regulatory_limit_wmm_params(sdata, &p, params->ac);
2258
2259         sdata->tx_conf[params->ac] = p;
2260         if (drv_conf_tx(local, sdata, params->ac, &p)) {
2261                 wiphy_debug(local->hw.wiphy,
2262                             "failed to set TX queue parameters for AC %d\n",
2263                             params->ac);
2264                 return -EINVAL;
2265         }
2266
2267         ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS);
2268
2269         return 0;
2270 }
2271
2272 #ifdef CONFIG_PM
2273 static int ieee80211_suspend(struct wiphy *wiphy,
2274                              struct cfg80211_wowlan *wowlan)
2275 {
2276         return __ieee80211_suspend(wiphy_priv(wiphy), wowlan);
2277 }
2278
2279 static int ieee80211_resume(struct wiphy *wiphy)
2280 {
2281         return __ieee80211_resume(wiphy_priv(wiphy));
2282 }
2283 #else
2284 #define ieee80211_suspend NULL
2285 #define ieee80211_resume NULL
2286 #endif
2287
2288 static int ieee80211_scan(struct wiphy *wiphy,
2289                           struct cfg80211_scan_request *req)
2290 {
2291         struct ieee80211_sub_if_data *sdata;
2292
2293         sdata = IEEE80211_WDEV_TO_SUB_IF(req->wdev);
2294
2295         switch (ieee80211_vif_type_p2p(&sdata->vif)) {
2296         case NL80211_IFTYPE_STATION:
2297         case NL80211_IFTYPE_ADHOC:
2298         case NL80211_IFTYPE_MESH_POINT:
2299         case NL80211_IFTYPE_P2P_CLIENT:
2300         case NL80211_IFTYPE_P2P_DEVICE:
2301                 break;
2302         case NL80211_IFTYPE_P2P_GO:
2303                 if (sdata->local->ops->hw_scan)
2304                         break;
2305                 /*
2306                  * FIXME: implement NoA while scanning in software,
2307                  * for now fall through to allow scanning only when
2308                  * beaconing hasn't been configured yet
2309                  */
2310                 /* fall through */
2311         case NL80211_IFTYPE_AP:
2312                 /*
2313                  * If the scan has been forced (and the driver supports
2314                  * forcing), don't care about being beaconing already.
2315                  * This will create problems to the attached stations (e.g. all
2316                  * the  frames sent while scanning on other channel will be
2317                  * lost)
2318                  */
2319                 if (sdata->u.ap.beacon &&
2320                     (!(wiphy->features & NL80211_FEATURE_AP_SCAN) ||
2321                      !(req->flags & NL80211_SCAN_FLAG_AP)))
2322                         return -EOPNOTSUPP;
2323                 break;
2324         case NL80211_IFTYPE_NAN:
2325         default:
2326                 return -EOPNOTSUPP;
2327         }
2328
2329         return ieee80211_request_scan(sdata, req);
2330 }
2331
2332 static void ieee80211_abort_scan(struct wiphy *wiphy, struct wireless_dev *wdev)
2333 {
2334         ieee80211_scan_cancel(wiphy_priv(wiphy));
2335 }
2336
2337 static int
2338 ieee80211_sched_scan_start(struct wiphy *wiphy,
2339                            struct net_device *dev,
2340                            struct cfg80211_sched_scan_request *req)
2341 {
2342         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2343
2344         if (!sdata->local->ops->sched_scan_start)
2345                 return -EOPNOTSUPP;
2346
2347         return ieee80211_request_sched_scan_start(sdata, req);
2348 }
2349
2350 static int
2351 ieee80211_sched_scan_stop(struct wiphy *wiphy, struct net_device *dev,
2352                           u64 reqid)
2353 {
2354         struct ieee80211_local *local = wiphy_priv(wiphy);
2355
2356         if (!local->ops->sched_scan_stop)
2357                 return -EOPNOTSUPP;
2358
2359         return ieee80211_request_sched_scan_stop(local);
2360 }
2361
2362 static int ieee80211_auth(struct wiphy *wiphy, struct net_device *dev,
2363                           struct cfg80211_auth_request *req)
2364 {
2365         return ieee80211_mgd_auth(IEEE80211_DEV_TO_SUB_IF(dev), req);
2366 }
2367
2368 static int ieee80211_assoc(struct wiphy *wiphy, struct net_device *dev,
2369                            struct cfg80211_assoc_request *req)
2370 {
2371         return ieee80211_mgd_assoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
2372 }
2373
2374 static int ieee80211_deauth(struct wiphy *wiphy, struct net_device *dev,
2375                             struct cfg80211_deauth_request *req)
2376 {
2377         return ieee80211_mgd_deauth(IEEE80211_DEV_TO_SUB_IF(dev), req);
2378 }
2379
2380 static int ieee80211_disassoc(struct wiphy *wiphy, struct net_device *dev,
2381                               struct cfg80211_disassoc_request *req)
2382 {
2383         return ieee80211_mgd_disassoc(IEEE80211_DEV_TO_SUB_IF(dev), req);
2384 }
2385
2386 static int ieee80211_join_ibss(struct wiphy *wiphy, struct net_device *dev,
2387                                struct cfg80211_ibss_params *params)
2388 {
2389         return ieee80211_ibss_join(IEEE80211_DEV_TO_SUB_IF(dev), params);
2390 }
2391
2392 static int ieee80211_leave_ibss(struct wiphy *wiphy, struct net_device *dev)
2393 {
2394         return ieee80211_ibss_leave(IEEE80211_DEV_TO_SUB_IF(dev));
2395 }
2396
2397 static int ieee80211_join_ocb(struct wiphy *wiphy, struct net_device *dev,
2398                               struct ocb_setup *setup)
2399 {
2400         return ieee80211_ocb_join(IEEE80211_DEV_TO_SUB_IF(dev), setup);
2401 }
2402
2403 static int ieee80211_leave_ocb(struct wiphy *wiphy, struct net_device *dev)
2404 {
2405         return ieee80211_ocb_leave(IEEE80211_DEV_TO_SUB_IF(dev));
2406 }
2407
2408 static int ieee80211_set_mcast_rate(struct wiphy *wiphy, struct net_device *dev,
2409                                     int rate[NUM_NL80211_BANDS])
2410 {
2411         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2412
2413         memcpy(sdata->vif.bss_conf.mcast_rate, rate,
2414                sizeof(int) * NUM_NL80211_BANDS);
2415
2416         ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_MCAST_RATE);
2417
2418         return 0;
2419 }
2420
2421 static int ieee80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
2422 {
2423         struct ieee80211_local *local = wiphy_priv(wiphy);
2424         int err;
2425
2426         if (changed & WIPHY_PARAM_FRAG_THRESHOLD) {
2427                 ieee80211_check_fast_xmit_all(local);
2428
2429                 err = drv_set_frag_threshold(local, wiphy->frag_threshold);
2430
2431                 if (err) {
2432                         ieee80211_check_fast_xmit_all(local);
2433                         return err;
2434                 }
2435         }
2436
2437         if ((changed & WIPHY_PARAM_COVERAGE_CLASS) ||
2438             (changed & WIPHY_PARAM_DYN_ACK)) {
2439                 s16 coverage_class;
2440
2441                 coverage_class = changed & WIPHY_PARAM_COVERAGE_CLASS ?
2442                                         wiphy->coverage_class : -1;
2443                 err = drv_set_coverage_class(local, coverage_class);
2444
2445                 if (err)
2446                         return err;
2447         }
2448
2449         if (changed & WIPHY_PARAM_RTS_THRESHOLD) {
2450                 err = drv_set_rts_threshold(local, wiphy->rts_threshold);
2451
2452                 if (err)
2453                         return err;
2454         }
2455
2456         if (changed & WIPHY_PARAM_RETRY_SHORT) {
2457                 if (wiphy->retry_short > IEEE80211_MAX_TX_RETRY)
2458                         return -EINVAL;
2459                 local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
2460         }
2461         if (changed & WIPHY_PARAM_RETRY_LONG) {
2462                 if (wiphy->retry_long > IEEE80211_MAX_TX_RETRY)
2463                         return -EINVAL;
2464                 local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
2465         }
2466         if (changed &
2467             (WIPHY_PARAM_RETRY_SHORT | WIPHY_PARAM_RETRY_LONG))
2468                 ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_RETRY_LIMITS);
2469
2470         if (changed & (WIPHY_PARAM_TXQ_LIMIT |
2471                        WIPHY_PARAM_TXQ_MEMORY_LIMIT |
2472                        WIPHY_PARAM_TXQ_QUANTUM))
2473                 ieee80211_txq_set_params(local);
2474
2475         return 0;
2476 }
2477
2478 static int ieee80211_set_tx_power(struct wiphy *wiphy,
2479                                   struct wireless_dev *wdev,
2480                                   enum nl80211_tx_power_setting type, int mbm)
2481 {
2482         struct ieee80211_local *local = wiphy_priv(wiphy);
2483         struct ieee80211_sub_if_data *sdata;
2484         enum nl80211_tx_power_setting txp_type = type;
2485         bool update_txp_type = false;
2486         bool has_monitor = false;
2487
2488         if (wdev) {
2489                 sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2490
2491                 if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
2492                         sdata = rtnl_dereference(local->monitor_sdata);
2493                         if (!sdata)
2494                                 return -EOPNOTSUPP;
2495                 }
2496
2497                 switch (type) {
2498                 case NL80211_TX_POWER_AUTOMATIC:
2499                         sdata->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
2500                         txp_type = NL80211_TX_POWER_LIMITED;
2501                         break;
2502                 case NL80211_TX_POWER_LIMITED:
2503                 case NL80211_TX_POWER_FIXED:
2504                         if (mbm < 0 || (mbm % 100))
2505                                 return -EOPNOTSUPP;
2506                         sdata->user_power_level = MBM_TO_DBM(mbm);
2507                         break;
2508                 }
2509
2510                 if (txp_type != sdata->vif.bss_conf.txpower_type) {
2511                         update_txp_type = true;
2512                         sdata->vif.bss_conf.txpower_type = txp_type;
2513                 }
2514
2515                 ieee80211_recalc_txpower(sdata, update_txp_type);
2516
2517                 return 0;
2518         }
2519
2520         switch (type) {
2521         case NL80211_TX_POWER_AUTOMATIC:
2522                 local->user_power_level = IEEE80211_UNSET_POWER_LEVEL;
2523                 txp_type = NL80211_TX_POWER_LIMITED;
2524                 break;
2525         case NL80211_TX_POWER_LIMITED:
2526         case NL80211_TX_POWER_FIXED:
2527                 if (mbm < 0 || (mbm % 100))
2528                         return -EOPNOTSUPP;
2529                 local->user_power_level = MBM_TO_DBM(mbm);
2530                 break;
2531         }
2532
2533         mutex_lock(&local->iflist_mtx);
2534         list_for_each_entry(sdata, &local->interfaces, list) {
2535                 if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
2536                         has_monitor = true;
2537                         continue;
2538                 }
2539                 sdata->user_power_level = local->user_power_level;
2540                 if (txp_type != sdata->vif.bss_conf.txpower_type)
2541                         update_txp_type = true;
2542                 sdata->vif.bss_conf.txpower_type = txp_type;
2543         }
2544         list_for_each_entry(sdata, &local->interfaces, list) {
2545                 if (sdata->vif.type == NL80211_IFTYPE_MONITOR)
2546                         continue;
2547                 ieee80211_recalc_txpower(sdata, update_txp_type);
2548         }
2549         mutex_unlock(&local->iflist_mtx);
2550
2551         if (has_monitor) {
2552                 sdata = rtnl_dereference(local->monitor_sdata);
2553                 if (sdata) {
2554                         sdata->user_power_level = local->user_power_level;
2555                         if (txp_type != sdata->vif.bss_conf.txpower_type)
2556                                 update_txp_type = true;
2557                         sdata->vif.bss_conf.txpower_type = txp_type;
2558
2559                         ieee80211_recalc_txpower(sdata, update_txp_type);
2560                 }
2561         }
2562
2563         return 0;
2564 }
2565
2566 static int ieee80211_get_tx_power(struct wiphy *wiphy,
2567                                   struct wireless_dev *wdev,
2568                                   int *dbm)
2569 {
2570         struct ieee80211_local *local = wiphy_priv(wiphy);
2571         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2572
2573         if (local->ops->get_txpower)
2574                 return drv_get_txpower(local, sdata, dbm);
2575
2576         if (!local->use_chanctx)
2577                 *dbm = local->hw.conf.power_level;
2578         else
2579                 *dbm = sdata->vif.bss_conf.txpower;
2580
2581         return 0;
2582 }
2583
2584 static int ieee80211_set_wds_peer(struct wiphy *wiphy, struct net_device *dev,
2585                                   const u8 *addr)
2586 {
2587         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2588
2589         memcpy(&sdata->u.wds.remote_addr, addr, ETH_ALEN);
2590
2591         return 0;
2592 }
2593
2594 static void ieee80211_rfkill_poll(struct wiphy *wiphy)
2595 {
2596         struct ieee80211_local *local = wiphy_priv(wiphy);
2597
2598         drv_rfkill_poll(local);
2599 }
2600
2601 #ifdef CONFIG_NL80211_TESTMODE
2602 static int ieee80211_testmode_cmd(struct wiphy *wiphy,
2603                                   struct wireless_dev *wdev,
2604                                   void *data, int len)
2605 {
2606         struct ieee80211_local *local = wiphy_priv(wiphy);
2607         struct ieee80211_vif *vif = NULL;
2608
2609         if (!local->ops->testmode_cmd)
2610                 return -EOPNOTSUPP;
2611
2612         if (wdev) {
2613                 struct ieee80211_sub_if_data *sdata;
2614
2615                 sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
2616                 if (sdata->flags & IEEE80211_SDATA_IN_DRIVER)
2617                         vif = &sdata->vif;
2618         }
2619
2620         return local->ops->testmode_cmd(&local->hw, vif, data, len);
2621 }
2622
2623 static int ieee80211_testmode_dump(struct wiphy *wiphy,
2624                                    struct sk_buff *skb,
2625                                    struct netlink_callback *cb,
2626                                    void *data, int len)
2627 {
2628         struct ieee80211_local *local = wiphy_priv(wiphy);
2629
2630         if (!local->ops->testmode_dump)
2631                 return -EOPNOTSUPP;
2632
2633         return local->ops->testmode_dump(&local->hw, skb, cb, data, len);
2634 }
2635 #endif
2636
2637 int __ieee80211_request_smps_ap(struct ieee80211_sub_if_data *sdata,
2638                                 enum ieee80211_smps_mode smps_mode)
2639 {
2640         struct sta_info *sta;
2641         enum ieee80211_smps_mode old_req;
2642
2643         if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_AP))
2644                 return -EINVAL;
2645
2646         if (sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
2647                 return 0;
2648
2649         old_req = sdata->u.ap.req_smps;
2650         sdata->u.ap.req_smps = smps_mode;
2651
2652         /* AUTOMATIC doesn't mean much for AP - don't allow it */
2653         if (old_req == smps_mode ||
2654             smps_mode == IEEE80211_SMPS_AUTOMATIC)
2655                 return 0;
2656
2657         ht_dbg(sdata,
2658                "SMPS %d requested in AP mode, sending Action frame to %d stations\n",
2659                smps_mode, atomic_read(&sdata->u.ap.num_mcast_sta));
2660
2661         mutex_lock(&sdata->local->sta_mtx);
2662         list_for_each_entry(sta, &sdata->local->sta_list, list) {
2663                 /*
2664                  * Only stations associated to our AP and
2665                  * associated VLANs
2666                  */
2667                 if (sta->sdata->bss != &sdata->u.ap)
2668                         continue;
2669
2670                 /* This station doesn't support MIMO - skip it */
2671                 if (sta_info_tx_streams(sta) == 1)
2672                         continue;
2673
2674                 /*
2675                  * Don't wake up a STA just to send the action frame
2676                  * unless we are getting more restrictive.
2677                  */
2678                 if (test_sta_flag(sta, WLAN_STA_PS_STA) &&
2679                     !ieee80211_smps_is_restrictive(sta->known_smps_mode,
2680                                                    smps_mode)) {
2681                         ht_dbg(sdata, "Won't send SMPS to sleeping STA %pM\n",
2682                                sta->sta.addr);
2683                         continue;
2684                 }
2685
2686                 /*
2687                  * If the STA is not authorized, wait until it gets
2688                  * authorized and the action frame will be sent then.
2689                  */
2690                 if (!test_sta_flag(sta, WLAN_STA_AUTHORIZED))
2691                         continue;
2692
2693                 ht_dbg(sdata, "Sending SMPS to %pM\n", sta->sta.addr);
2694                 ieee80211_send_smps_action(sdata, smps_mode, sta->sta.addr,
2695                                            sdata->vif.bss_conf.bssid);
2696         }
2697         mutex_unlock(&sdata->local->sta_mtx);
2698
2699         sdata->smps_mode = smps_mode;
2700         ieee80211_queue_work(&sdata->local->hw, &sdata->recalc_smps);
2701
2702         return 0;
2703 }
2704
2705 int __ieee80211_request_smps_mgd(struct ieee80211_sub_if_data *sdata,
2706                                  enum ieee80211_smps_mode smps_mode)
2707 {
2708         const u8 *ap;
2709         enum ieee80211_smps_mode old_req;
2710         int err;
2711         struct sta_info *sta;
2712         bool tdls_peer_found = false;
2713
2714         lockdep_assert_held(&sdata->wdev.mtx);
2715
2716         if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION))
2717                 return -EINVAL;
2718
2719         old_req = sdata->u.mgd.req_smps;
2720         sdata->u.mgd.req_smps = smps_mode;
2721
2722         if (old_req == smps_mode &&
2723             smps_mode != IEEE80211_SMPS_AUTOMATIC)
2724                 return 0;
2725
2726         /*
2727          * If not associated, or current association is not an HT
2728          * association, there's no need to do anything, just store
2729          * the new value until we associate.
2730          */
2731         if (!sdata->u.mgd.associated ||
2732             sdata->vif.bss_conf.chandef.width == NL80211_CHAN_WIDTH_20_NOHT)
2733                 return 0;
2734
2735         ap = sdata->u.mgd.associated->bssid;
2736
2737         rcu_read_lock();
2738         list_for_each_entry_rcu(sta, &sdata->local->sta_list, list) {
2739                 if (!sta->sta.tdls || sta->sdata != sdata || !sta->uploaded ||
2740                     !test_sta_flag(sta, WLAN_STA_AUTHORIZED))
2741                         continue;
2742
2743                 tdls_peer_found = true;
2744                 break;
2745         }
2746         rcu_read_unlock();
2747
2748         if (smps_mode == IEEE80211_SMPS_AUTOMATIC) {
2749                 if (tdls_peer_found || !sdata->u.mgd.powersave)
2750                         smps_mode = IEEE80211_SMPS_OFF;
2751                 else
2752                         smps_mode = IEEE80211_SMPS_DYNAMIC;
2753         }
2754
2755         /* send SM PS frame to AP */
2756         err = ieee80211_send_smps_action(sdata, smps_mode,
2757                                          ap, ap);
2758         if (err)
2759                 sdata->u.mgd.req_smps = old_req;
2760         else if (smps_mode != IEEE80211_SMPS_OFF && tdls_peer_found)
2761                 ieee80211_teardown_tdls_peers(sdata);
2762
2763         return err;
2764 }
2765
2766 static int ieee80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev,
2767                                     bool enabled, int timeout)
2768 {
2769         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2770         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2771
2772         if (sdata->vif.type != NL80211_IFTYPE_STATION)
2773                 return -EOPNOTSUPP;
2774
2775         if (!ieee80211_hw_check(&local->hw, SUPPORTS_PS))
2776                 return -EOPNOTSUPP;
2777
2778         if (enabled == sdata->u.mgd.powersave &&
2779             timeout == local->dynamic_ps_forced_timeout)
2780                 return 0;
2781
2782         sdata->u.mgd.powersave = enabled;
2783         local->dynamic_ps_forced_timeout = timeout;
2784
2785         /* no change, but if automatic follow powersave */
2786         sdata_lock(sdata);
2787         __ieee80211_request_smps_mgd(sdata, sdata->u.mgd.req_smps);
2788         sdata_unlock(sdata);
2789
2790         if (ieee80211_hw_check(&local->hw, SUPPORTS_DYNAMIC_PS))
2791                 ieee80211_hw_config(local, IEEE80211_CONF_CHANGE_PS);
2792
2793         ieee80211_recalc_ps(local);
2794         ieee80211_recalc_ps_vif(sdata);
2795         ieee80211_check_fast_rx_iface(sdata);
2796
2797         return 0;
2798 }
2799
2800 static int ieee80211_set_cqm_rssi_config(struct wiphy *wiphy,
2801                                          struct net_device *dev,
2802                                          s32 rssi_thold, u32 rssi_hyst)
2803 {
2804         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2805         struct ieee80211_vif *vif = &sdata->vif;
2806         struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
2807
2808         if (rssi_thold == bss_conf->cqm_rssi_thold &&
2809             rssi_hyst == bss_conf->cqm_rssi_hyst)
2810                 return 0;
2811
2812         if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER &&
2813             !(sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
2814                 return -EOPNOTSUPP;
2815
2816         bss_conf->cqm_rssi_thold = rssi_thold;
2817         bss_conf->cqm_rssi_hyst = rssi_hyst;
2818         bss_conf->cqm_rssi_low = 0;
2819         bss_conf->cqm_rssi_high = 0;
2820         sdata->u.mgd.last_cqm_event_signal = 0;
2821
2822         /* tell the driver upon association, unless already associated */
2823         if (sdata->u.mgd.associated &&
2824             sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
2825                 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);
2826
2827         return 0;
2828 }
2829
2830 static int ieee80211_set_cqm_rssi_range_config(struct wiphy *wiphy,
2831                                                struct net_device *dev,
2832                                                s32 rssi_low, s32 rssi_high)
2833 {
2834         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2835         struct ieee80211_vif *vif = &sdata->vif;
2836         struct ieee80211_bss_conf *bss_conf = &vif->bss_conf;
2837
2838         if (sdata->vif.driver_flags & IEEE80211_VIF_BEACON_FILTER)
2839                 return -EOPNOTSUPP;
2840
2841         bss_conf->cqm_rssi_low = rssi_low;
2842         bss_conf->cqm_rssi_high = rssi_high;
2843         bss_conf->cqm_rssi_thold = 0;
2844         bss_conf->cqm_rssi_hyst = 0;
2845         sdata->u.mgd.last_cqm_event_signal = 0;
2846
2847         /* tell the driver upon association, unless already associated */
2848         if (sdata->u.mgd.associated &&
2849             sdata->vif.driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI)
2850                 ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_CQM);
2851
2852         return 0;
2853 }
2854
2855 static int ieee80211_set_bitrate_mask(struct wiphy *wiphy,
2856                                       struct net_device *dev,
2857                                       const u8 *addr,
2858                                       const struct cfg80211_bitrate_mask *mask)
2859 {
2860         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2861         struct ieee80211_local *local = wdev_priv(dev->ieee80211_ptr);
2862         int i, ret;
2863
2864         if (!ieee80211_sdata_running(sdata))
2865                 return -ENETDOWN;
2866
2867         /*
2868          * If active validate the setting and reject it if it doesn't leave
2869          * at least one basic rate usable, since we really have to be able
2870          * to send something, and if we're an AP we have to be able to do
2871          * so at a basic rate so that all clients can receive it.
2872          */
2873         if (rcu_access_pointer(sdata->vif.chanctx_conf) &&
2874             sdata->vif.bss_conf.chandef.chan) {
2875                 u32 basic_rates = sdata->vif.bss_conf.basic_rates;
2876                 enum nl80211_band band = sdata->vif.bss_conf.chandef.chan->band;
2877
2878                 if (!(mask->control[band].legacy & basic_rates))
2879                         return -EINVAL;
2880         }
2881
2882         if (ieee80211_hw_check(&local->hw, HAS_RATE_CONTROL)) {
2883                 ret = drv_set_bitrate_mask(local, sdata, mask);
2884                 if (ret)
2885                         return ret;
2886         }
2887
2888         for (i = 0; i < NUM_NL80211_BANDS; i++) {
2889                 struct ieee80211_supported_band *sband = wiphy->bands[i];
2890                 int j;
2891
2892                 sdata->rc_rateidx_mask[i] = mask->control[i].legacy;
2893                 memcpy(sdata->rc_rateidx_mcs_mask[i], mask->control[i].ht_mcs,
2894                        sizeof(mask->control[i].ht_mcs));
2895                 memcpy(sdata->rc_rateidx_vht_mcs_mask[i],
2896                        mask->control[i].vht_mcs,
2897                        sizeof(mask->control[i].vht_mcs));
2898
2899                 sdata->rc_has_mcs_mask[i] = false;
2900                 sdata->rc_has_vht_mcs_mask[i] = false;
2901                 if (!sband)
2902                         continue;
2903
2904                 for (j = 0; j < IEEE80211_HT_MCS_MASK_LEN; j++) {
2905                         if (~sdata->rc_rateidx_mcs_mask[i][j]) {
2906                                 sdata->rc_has_mcs_mask[i] = true;
2907                                 break;
2908                         }
2909                 }
2910
2911                 for (j = 0; j < NL80211_VHT_NSS_MAX; j++) {
2912                         if (~sdata->rc_rateidx_vht_mcs_mask[i][j]) {
2913                                 sdata->rc_has_vht_mcs_mask[i] = true;
2914                                 break;
2915                         }
2916                 }
2917         }
2918
2919         return 0;
2920 }
2921
2922 static int ieee80211_start_radar_detection(struct wiphy *wiphy,
2923                                            struct net_device *dev,
2924                                            struct cfg80211_chan_def *chandef,
2925                                            u32 cac_time_ms)
2926 {
2927         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
2928         struct ieee80211_local *local = sdata->local;
2929         int err;
2930
2931         mutex_lock(&local->mtx);
2932         if (!list_empty(&local->roc_list) || local->scanning) {
2933                 err = -EBUSY;
2934                 goto out_unlock;
2935         }
2936
2937         /* whatever, but channel contexts should not complain about that one */
2938         sdata->smps_mode = IEEE80211_SMPS_OFF;
2939         sdata->needed_rx_chains = local->rx_chains;
2940
2941         err = ieee80211_vif_use_channel(sdata, chandef,
2942                                         IEEE80211_CHANCTX_SHARED);
2943         if (err)
2944                 goto out_unlock;
2945
2946         ieee80211_queue_delayed_work(&sdata->local->hw,
2947                                      &sdata->dfs_cac_timer_work,
2948                                      msecs_to_jiffies(cac_time_ms));
2949
2950  out_unlock:
2951         mutex_unlock(&local->mtx);
2952         return err;
2953 }
2954
2955 static struct cfg80211_beacon_data *
2956 cfg80211_beacon_dup(struct cfg80211_beacon_data *beacon)
2957 {
2958         struct cfg80211_beacon_data *new_beacon;
2959         u8 *pos;
2960         int len;
2961
2962         len = beacon->head_len + beacon->tail_len + beacon->beacon_ies_len +
2963               beacon->proberesp_ies_len + beacon->assocresp_ies_len +
2964               beacon->probe_resp_len + beacon->lci_len + beacon->civicloc_len;
2965
2966         new_beacon = kzalloc(sizeof(*new_beacon) + len, GFP_KERNEL);
2967         if (!new_beacon)
2968                 return NULL;
2969
2970         pos = (u8 *)(new_beacon + 1);
2971         if (beacon->head_len) {
2972                 new_beacon->head_len = beacon->head_len;
2973                 new_beacon->head = pos;
2974                 memcpy(pos, beacon->head, beacon->head_len);
2975                 pos += beacon->head_len;
2976         }
2977         if (beacon->tail_len) {
2978                 new_beacon->tail_len = beacon->tail_len;
2979                 new_beacon->tail = pos;
2980                 memcpy(pos, beacon->tail, beacon->tail_len);
2981                 pos += beacon->tail_len;
2982         }
2983         if (beacon->beacon_ies_len) {
2984                 new_beacon->beacon_ies_len = beacon->beacon_ies_len;
2985                 new_beacon->beacon_ies = pos;
2986                 memcpy(pos, beacon->beacon_ies, beacon->beacon_ies_len);
2987                 pos += beacon->beacon_ies_len;
2988         }
2989         if (beacon->proberesp_ies_len) {
2990                 new_beacon->proberesp_ies_len = beacon->proberesp_ies_len;
2991                 new_beacon->proberesp_ies = pos;
2992                 memcpy(pos, beacon->proberesp_ies, beacon->proberesp_ies_len);
2993                 pos += beacon->proberesp_ies_len;
2994         }
2995         if (beacon->assocresp_ies_len) {
2996                 new_beacon->assocresp_ies_len = beacon->assocresp_ies_len;
2997                 new_beacon->assocresp_ies = pos;
2998                 memcpy(pos, beacon->assocresp_ies, beacon->assocresp_ies_len);
2999                 pos += beacon->assocresp_ies_len;
3000         }
3001         if (beacon->probe_resp_len) {
3002                 new_beacon->probe_resp_len = beacon->probe_resp_len;
3003                 new_beacon->probe_resp = pos;
3004                 memcpy(pos, beacon->probe_resp, beacon->probe_resp_len);
3005                 pos += beacon->probe_resp_len;
3006         }
3007
3008         /* might copy -1, meaning no changes requested */
3009         new_beacon->ftm_responder = beacon->ftm_responder;
3010         if (beacon->lci) {
3011                 new_beacon->lci_len = beacon->lci_len;
3012                 new_beacon->lci = pos;
3013                 memcpy(pos, beacon->lci, beacon->lci_len);
3014                 pos += beacon->lci_len;
3015         }
3016         if (beacon->civicloc) {
3017                 new_beacon->civicloc_len = beacon->civicloc_len;
3018                 new_beacon->civicloc = pos;
3019                 memcpy(pos, beacon->civicloc, beacon->civicloc_len);
3020                 pos += beacon->civicloc_len;
3021         }
3022
3023         return new_beacon;
3024 }
3025
3026 void ieee80211_csa_finish(struct ieee80211_vif *vif)
3027 {
3028         struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
3029
3030         ieee80211_queue_work(&sdata->local->hw,
3031                              &sdata->csa_finalize_work);
3032 }
3033 EXPORT_SYMBOL(ieee80211_csa_finish);
3034
3035 static int ieee80211_set_after_csa_beacon(struct ieee80211_sub_if_data *sdata,
3036                                           u32 *changed)
3037 {
3038         int err;
3039
3040         switch (sdata->vif.type) {
3041         case NL80211_IFTYPE_AP:
3042                 err = ieee80211_assign_beacon(sdata, sdata->u.ap.next_beacon,
3043                                               NULL);
3044                 kfree(sdata->u.ap.next_beacon);
3045                 sdata->u.ap.next_beacon = NULL;
3046
3047                 if (err < 0)
3048                         return err;
3049                 *changed |= err;
3050                 break;
3051         case NL80211_IFTYPE_ADHOC:
3052                 err = ieee80211_ibss_finish_csa(sdata);
3053                 if (err < 0)
3054                         return err;
3055                 *changed |= err;
3056                 break;
3057 #ifdef CONFIG_MAC80211_MESH
3058         case NL80211_IFTYPE_MESH_POINT:
3059                 err = ieee80211_mesh_finish_csa(sdata);
3060                 if (err < 0)
3061                         return err;
3062                 *changed |= err;
3063                 break;
3064 #endif
3065         default:
3066                 WARN_ON(1);
3067                 return -EINVAL;
3068         }
3069
3070         return 0;
3071 }
3072
3073 static int __ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
3074 {
3075         struct ieee80211_local *local = sdata->local;
3076         u32 changed = 0;
3077         int err;
3078
3079         sdata_assert_lock(sdata);
3080         lockdep_assert_held(&local->mtx);
3081         lockdep_assert_held(&local->chanctx_mtx);
3082
3083         /*
3084          * using reservation isn't immediate as it may be deferred until later
3085          * with multi-vif. once reservation is complete it will re-schedule the
3086          * work with no reserved_chanctx so verify chandef to check if it
3087          * completed successfully
3088          */
3089
3090         if (sdata->reserved_chanctx) {
3091                 /*
3092                  * with multi-vif csa driver may call ieee80211_csa_finish()
3093                  * many times while waiting for other interfaces to use their
3094                  * reservations
3095                  */
3096                 if (sdata->reserved_ready)
3097                         return 0;
3098
3099                 return ieee80211_vif_use_reserved_context(sdata);
3100         }
3101
3102         if (!cfg80211_chandef_identical(&sdata->vif.bss_conf.chandef,
3103                                         &sdata->csa_chandef))
3104                 return -EINVAL;
3105
3106         sdata->vif.csa_active = false;
3107
3108         err = ieee80211_set_after_csa_beacon(sdata, &changed);
3109         if (err)
3110                 return err;
3111
3112         ieee80211_bss_info_change_notify(sdata, changed);
3113
3114         if (sdata->csa_block_tx) {
3115                 ieee80211_wake_vif_queues(local, sdata,
3116                                           IEEE80211_QUEUE_STOP_REASON_CSA);
3117                 sdata->csa_block_tx = false;
3118         }
3119
3120         err = drv_post_channel_switch(sdata);
3121         if (err)
3122                 return err;
3123
3124         cfg80211_ch_switch_notify(sdata->dev, &sdata->csa_chandef);
3125
3126         return 0;
3127 }
3128
3129 static void ieee80211_csa_finalize(struct ieee80211_sub_if_data *sdata)
3130 {
3131         if (__ieee80211_csa_finalize(sdata)) {
3132                 sdata_info(sdata, "failed to finalize CSA, disconnecting\n");
3133                 cfg80211_stop_iface(sdata->local->hw.wiphy, &sdata->wdev,
3134                                     GFP_KERNEL);
3135         }
3136 }
3137
3138 void ieee80211_csa_finalize_work(struct work_struct *work)
3139 {
3140         struct ieee80211_sub_if_data *sdata =
3141                 container_of(work, struct ieee80211_sub_if_data,
3142                              csa_finalize_work);
3143         struct ieee80211_local *local = sdata->local;
3144
3145         sdata_lock(sdata);
3146         mutex_lock(&local->mtx);
3147         mutex_lock(&local->chanctx_mtx);
3148
3149         /* AP might have been stopped while waiting for the lock. */
3150         if (!sdata->vif.csa_active)
3151                 goto unlock;
3152
3153         if (!ieee80211_sdata_running(sdata))
3154                 goto unlock;
3155
3156         ieee80211_csa_finalize(sdata);
3157
3158 unlock:
3159         mutex_unlock(&local->chanctx_mtx);
3160         mutex_unlock(&local->mtx);
3161         sdata_unlock(sdata);
3162 }
3163
3164 static int ieee80211_set_csa_beacon(struct ieee80211_sub_if_data *sdata,
3165                                     struct cfg80211_csa_settings *params,
3166                                     u32 *changed)
3167 {
3168         struct ieee80211_csa_settings csa = {};
3169         int err;
3170
3171         switch (sdata->vif.type) {
3172         case NL80211_IFTYPE_AP:
3173                 sdata->u.ap.next_beacon =
3174                         cfg80211_beacon_dup(&params->beacon_after);
3175                 if (!sdata->u.ap.next_beacon)
3176                         return -ENOMEM;
3177
3178                 /*
3179                  * With a count of 0, we don't have to wait for any
3180                  * TBTT before switching, so complete the CSA
3181                  * immediately.  In theory, with a count == 1 we
3182                  * should delay the switch until just before the next
3183                  * TBTT, but that would complicate things so we switch
3184                  * immediately too.  If we would delay the switch
3185                  * until the next TBTT, we would have to set the probe
3186                  * response here.
3187                  *
3188                  * TODO: A channel switch with count <= 1 without
3189                  * sending a CSA action frame is kind of useless,
3190                  * because the clients won't know we're changing
3191                  * channels.  The action frame must be implemented
3192                  * either here or in the userspace.
3193                  */
3194                 if (params->count <= 1)
3195                         break;
3196
3197                 if ((params->n_counter_offsets_beacon >
3198                      IEEE80211_MAX_CSA_COUNTERS_NUM) ||
3199                     (params->n_counter_offsets_presp >
3200                      IEEE80211_MAX_CSA_COUNTERS_NUM))
3201                         return -EINVAL;
3202
3203                 csa.counter_offsets_beacon = params->counter_offsets_beacon;
3204                 csa.counter_offsets_presp = params->counter_offsets_presp;
3205                 csa.n_counter_offsets_beacon = params->n_counter_offsets_beacon;
3206                 csa.n_counter_offsets_presp = params->n_counter_offsets_presp;
3207                 csa.count = params->count;
3208
3209                 err = ieee80211_assign_beacon(sdata, &params->beacon_csa, &csa);
3210                 if (err < 0) {
3211                         kfree(sdata->u.ap.next_beacon);
3212                         return err;
3213                 }
3214                 *changed |= err;
3215
3216                 break;
3217         case NL80211_IFTYPE_ADHOC:
3218                 if (!sdata->vif.bss_conf.ibss_joined)
3219                         return -EINVAL;
3220
3221                 if (params->chandef.width != sdata->u.ibss.chandef.width)
3222                         return -EINVAL;
3223
3224                 switch (params->chandef.width) {
3225                 case NL80211_CHAN_WIDTH_40:
3226                         if (cfg80211_get_chandef_type(&params->chandef) !=
3227                             cfg80211_get_chandef_type(&sdata->u.ibss.chandef))
3228                                 return -EINVAL;
3229                 case NL80211_CHAN_WIDTH_5:
3230                 case NL80211_CHAN_WIDTH_10:
3231                 case NL80211_CHAN_WIDTH_20_NOHT:
3232                 case NL80211_CHAN_WIDTH_20:
3233                         break;
3234                 default:
3235                         return -EINVAL;
3236                 }
3237
3238                 /* changes into another band are not supported */
3239                 if (sdata->u.ibss.chandef.chan->band !=
3240                     params->chandef.chan->band)
3241                         return -EINVAL;
3242
3243                 /* see comments in the NL80211_IFTYPE_AP block */
3244                 if (params->count > 1) {
3245                         err = ieee80211_ibss_csa_beacon(sdata, params);
3246                         if (err < 0)
3247                                 return err;
3248                         *changed |= err;
3249                 }
3250
3251                 ieee80211_send_action_csa(sdata, params);
3252
3253                 break;
3254 #ifdef CONFIG_MAC80211_MESH
3255         case NL80211_IFTYPE_MESH_POINT: {
3256                 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
3257
3258                 if (params->chandef.width != sdata->vif.bss_conf.chandef.width)
3259                         return -EINVAL;
3260
3261                 /* changes into another band are not supported */
3262                 if (sdata->vif.bss_conf.chandef.chan->band !=
3263                     params->chandef.chan->band)
3264                         return -EINVAL;
3265
3266                 if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_NONE) {
3267                         ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_INIT;
3268                         if (!ifmsh->pre_value)
3269                                 ifmsh->pre_value = 1;
3270                         else
3271                                 ifmsh->pre_value++;
3272                 }
3273
3274                 /* see comments in the NL80211_IFTYPE_AP block */
3275                 if (params->count > 1) {
3276                         err = ieee80211_mesh_csa_beacon(sdata, params);
3277                         if (err < 0) {
3278                                 ifmsh->csa_role = IEEE80211_MESH_CSA_ROLE_NONE;
3279                                 return err;
3280                         }
3281                         *changed |= err;
3282                 }
3283
3284                 if (ifmsh->csa_role == IEEE80211_MESH_CSA_ROLE_INIT)
3285                         ieee80211_send_action_csa(sdata, params);
3286
3287                 break;
3288                 }
3289 #endif
3290         default:
3291                 return -EOPNOTSUPP;
3292         }
3293
3294         return 0;
3295 }
3296
3297 static int
3298 __ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
3299                            struct cfg80211_csa_settings *params)
3300 {
3301         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3302         struct ieee80211_local *local = sdata->local;
3303         struct ieee80211_channel_switch ch_switch;
3304         struct ieee80211_chanctx_conf *conf;
3305         struct ieee80211_chanctx *chanctx;
3306         u32 changed = 0;
3307         int err;
3308
3309         sdata_assert_lock(sdata);
3310         lockdep_assert_held(&local->mtx);
3311
3312         if (!list_empty(&local->roc_list) || local->scanning)
3313                 return -EBUSY;
3314
3315         if (sdata->wdev.cac_started)
3316                 return -EBUSY;
3317
3318         if (cfg80211_chandef_identical(&params->chandef,
3319                                        &sdata->vif.bss_conf.chandef))
3320                 return -EINVAL;
3321
3322         /* don't allow another channel switch if one is already active. */
3323         if (sdata->vif.csa_active)
3324                 return -EBUSY;
3325
3326         mutex_lock(&local->chanctx_mtx);
3327         conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
3328                                          lockdep_is_held(&local->chanctx_mtx));
3329         if (!conf) {
3330                 err = -EBUSY;
3331                 goto out;
3332         }
3333
3334         chanctx = container_of(conf, struct ieee80211_chanctx, conf);
3335
3336         ch_switch.timestamp = 0;
3337         ch_switch.device_timestamp = 0;
3338         ch_switch.block_tx = params->block_tx;
3339         ch_switch.chandef = params->chandef;
3340         ch_switch.count = params->count;
3341
3342         err = drv_pre_channel_switch(sdata, &ch_switch);
3343         if (err)
3344                 goto out;
3345
3346         err = ieee80211_vif_reserve_chanctx(sdata, &params->chandef,
3347                                             chanctx->mode,
3348                                             params->radar_required);
3349         if (err)
3350                 goto out;
3351
3352         /* if reservation is invalid then this will fail */
3353         err = ieee80211_check_combinations(sdata, NULL, chanctx->mode, 0);
3354         if (err) {
3355                 ieee80211_vif_unreserve_chanctx(sdata);
3356                 goto out;
3357         }
3358
3359         err = ieee80211_set_csa_beacon(sdata, params, &changed);
3360         if (err) {
3361                 ieee80211_vif_unreserve_chanctx(sdata);
3362                 goto out;
3363         }
3364
3365         sdata->csa_chandef = params->chandef;
3366         sdata->csa_block_tx = params->block_tx;
3367         sdata->vif.csa_active = true;
3368
3369         if (sdata->csa_block_tx)
3370                 ieee80211_stop_vif_queues(local, sdata,
3371                                           IEEE80211_QUEUE_STOP_REASON_CSA);
3372
3373         cfg80211_ch_switch_started_notify(sdata->dev, &sdata->csa_chandef,
3374                                           params->count);
3375
3376         if (changed) {
3377                 ieee80211_bss_info_change_notify(sdata, changed);
3378                 drv_channel_switch_beacon(sdata, &params->chandef);
3379         } else {
3380                 /* if the beacon didn't change, we can finalize immediately */
3381                 ieee80211_csa_finalize(sdata);
3382         }
3383
3384 out:
3385         mutex_unlock(&local->chanctx_mtx);
3386         return err;
3387 }
3388
3389 int ieee80211_channel_switch(struct wiphy *wiphy, struct net_device *dev,
3390                              struct cfg80211_csa_settings *params)
3391 {
3392         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3393         struct ieee80211_local *local = sdata->local;
3394         int err;
3395
3396         mutex_lock(&local->mtx);
3397         err = __ieee80211_channel_switch(wiphy, dev, params);
3398         mutex_unlock(&local->mtx);
3399
3400         return err;
3401 }
3402
3403 u64 ieee80211_mgmt_tx_cookie(struct ieee80211_local *local)
3404 {
3405         lockdep_assert_held(&local->mtx);
3406
3407         local->roc_cookie_counter++;
3408
3409         /* wow, you wrapped 64 bits ... more likely a bug */
3410         if (WARN_ON(local->roc_cookie_counter == 0))
3411                 local->roc_cookie_counter++;
3412
3413         return local->roc_cookie_counter;
3414 }
3415
3416 int ieee80211_attach_ack_skb(struct ieee80211_local *local, struct sk_buff *skb,
3417                              u64 *cookie, gfp_t gfp)
3418 {
3419         unsigned long spin_flags;
3420         struct sk_buff *ack_skb;
3421         int id;
3422
3423         ack_skb = skb_copy(skb, gfp);
3424         if (!ack_skb)
3425                 return -ENOMEM;
3426
3427         spin_lock_irqsave(&local->ack_status_lock, spin_flags);
3428         id = idr_alloc(&local->ack_status_frames, ack_skb,
3429                        1, 0x10000, GFP_ATOMIC);
3430         spin_unlock_irqrestore(&local->ack_status_lock, spin_flags);
3431
3432         if (id < 0) {
3433                 kfree_skb(ack_skb);
3434                 return -ENOMEM;
3435         }
3436
3437         IEEE80211_SKB_CB(skb)->ack_frame_id = id;
3438
3439         *cookie = ieee80211_mgmt_tx_cookie(local);
3440         IEEE80211_SKB_CB(ack_skb)->ack.cookie = *cookie;
3441
3442         return 0;
3443 }
3444
3445 static void ieee80211_mgmt_frame_register(struct wiphy *wiphy,
3446                                           struct wireless_dev *wdev,
3447                                           u16 frame_type, bool reg)
3448 {
3449         struct ieee80211_local *local = wiphy_priv(wiphy);
3450         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3451
3452         switch (frame_type) {
3453         case IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_PROBE_REQ:
3454                 if (reg) {
3455                         local->probe_req_reg++;
3456                         sdata->vif.probe_req_reg++;
3457                 } else {
3458                         if (local->probe_req_reg)
3459                                 local->probe_req_reg--;
3460
3461                         if (sdata->vif.probe_req_reg)
3462                                 sdata->vif.probe_req_reg--;
3463                 }
3464
3465                 if (!local->open_count)
3466                         break;
3467
3468                 if (sdata->vif.probe_req_reg == 1)
3469                         drv_config_iface_filter(local, sdata, FIF_PROBE_REQ,
3470                                                 FIF_PROBE_REQ);
3471                 else if (sdata->vif.probe_req_reg == 0)
3472                         drv_config_iface_filter(local, sdata, 0,
3473                                                 FIF_PROBE_REQ);
3474
3475                 ieee80211_configure_filter(local);
3476                 break;
3477         default:
3478                 break;
3479         }
3480 }
3481
3482 static int ieee80211_set_antenna(struct wiphy *wiphy, u32 tx_ant, u32 rx_ant)
3483 {
3484         struct ieee80211_local *local = wiphy_priv(wiphy);
3485
3486         if (local->started)
3487                 return -EOPNOTSUPP;
3488
3489         return drv_set_antenna(local, tx_ant, rx_ant);
3490 }
3491
3492 static int ieee80211_get_antenna(struct wiphy *wiphy, u32 *tx_ant, u32 *rx_ant)
3493 {
3494         struct ieee80211_local *local = wiphy_priv(wiphy);
3495
3496         return drv_get_antenna(local, tx_ant, rx_ant);
3497 }
3498
3499 static int ieee80211_set_rekey_data(struct wiphy *wiphy,
3500                                     struct net_device *dev,
3501                                     struct cfg80211_gtk_rekey_data *data)
3502 {
3503         struct ieee80211_local *local = wiphy_priv(wiphy);
3504         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3505
3506         if (!local->ops->set_rekey_data)
3507                 return -EOPNOTSUPP;
3508
3509         drv_set_rekey_data(local, sdata, data);
3510
3511         return 0;
3512 }
3513
3514 static int ieee80211_probe_client(struct wiphy *wiphy, struct net_device *dev,
3515                                   const u8 *peer, u64 *cookie)
3516 {
3517         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3518         struct ieee80211_local *local = sdata->local;
3519         struct ieee80211_qos_hdr *nullfunc;
3520         struct sk_buff *skb;
3521         int size = sizeof(*nullfunc);
3522         __le16 fc;
3523         bool qos;
3524         struct ieee80211_tx_info *info;
3525         struct sta_info *sta;
3526         struct ieee80211_chanctx_conf *chanctx_conf;
3527         enum nl80211_band band;
3528         int ret;
3529
3530         /* the lock is needed to assign the cookie later */
3531         mutex_lock(&local->mtx);
3532
3533         rcu_read_lock();
3534         chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
3535         if (WARN_ON(!chanctx_conf)) {
3536                 ret = -EINVAL;
3537                 goto unlock;
3538         }
3539         band = chanctx_conf->def.chan->band;
3540         sta = sta_info_get_bss(sdata, peer);
3541         if (sta) {
3542                 qos = sta->sta.wme;
3543         } else {
3544                 ret = -ENOLINK;
3545                 goto unlock;
3546         }
3547
3548         if (qos) {
3549                 fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
3550                                  IEEE80211_STYPE_QOS_NULLFUNC |
3551                                  IEEE80211_FCTL_FROMDS);
3552         } else {
3553                 size -= 2;
3554                 fc = cpu_to_le16(IEEE80211_FTYPE_DATA |
3555                                  IEEE80211_STYPE_NULLFUNC |
3556                                  IEEE80211_FCTL_FROMDS);
3557         }
3558
3559         skb = dev_alloc_skb(local->hw.extra_tx_headroom + size);
3560         if (!skb) {
3561                 ret = -ENOMEM;
3562                 goto unlock;
3563         }
3564
3565         skb->dev = dev;
3566
3567         skb_reserve(skb, local->hw.extra_tx_headroom);
3568
3569         nullfunc = skb_put(skb, size);
3570         nullfunc->frame_control = fc;
3571         nullfunc->duration_id = 0;
3572         memcpy(nullfunc->addr1, sta->sta.addr, ETH_ALEN);
3573         memcpy(nullfunc->addr2, sdata->vif.addr, ETH_ALEN);
3574         memcpy(nullfunc->addr3, sdata->vif.addr, ETH_ALEN);
3575         nullfunc->seq_ctrl = 0;
3576
3577         info = IEEE80211_SKB_CB(skb);
3578
3579         info->flags |= IEEE80211_TX_CTL_REQ_TX_STATUS |
3580                        IEEE80211_TX_INTFL_NL80211_FRAME_TX;
3581         info->band = band;
3582
3583         skb_set_queue_mapping(skb, IEEE80211_AC_VO);
3584         skb->priority = 7;
3585         if (qos)
3586                 nullfunc->qos_ctrl = cpu_to_le16(7);
3587
3588         ret = ieee80211_attach_ack_skb(local, skb, cookie, GFP_ATOMIC);
3589         if (ret) {
3590                 kfree_skb(skb);
3591                 goto unlock;
3592         }
3593
3594         local_bh_disable();
3595         ieee80211_xmit(sdata, sta, skb, 0);
3596         local_bh_enable();
3597
3598         ret = 0;
3599 unlock:
3600         rcu_read_unlock();
3601         mutex_unlock(&local->mtx);
3602
3603         return ret;
3604 }
3605
3606 static int ieee80211_cfg_get_channel(struct wiphy *wiphy,
3607                                      struct wireless_dev *wdev,
3608                                      struct cfg80211_chan_def *chandef)
3609 {
3610         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3611         struct ieee80211_local *local = wiphy_priv(wiphy);
3612         struct ieee80211_chanctx_conf *chanctx_conf;
3613         int ret = -ENODATA;
3614
3615         rcu_read_lock();
3616         chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
3617         if (chanctx_conf) {
3618                 *chandef = sdata->vif.bss_conf.chandef;
3619                 ret = 0;
3620         } else if (local->open_count > 0 &&
3621                    local->open_count == local->monitors &&
3622                    sdata->vif.type == NL80211_IFTYPE_MONITOR) {
3623                 if (local->use_chanctx)
3624                         *chandef = local->monitor_chandef;
3625                 else
3626                         *chandef = local->_oper_chandef;
3627                 ret = 0;
3628         }
3629         rcu_read_unlock();
3630
3631         return ret;
3632 }
3633
3634 #ifdef CONFIG_PM
3635 static void ieee80211_set_wakeup(struct wiphy *wiphy, bool enabled)
3636 {
3637         drv_set_wakeup(wiphy_priv(wiphy), enabled);
3638 }
3639 #endif
3640
3641 static int ieee80211_set_qos_map(struct wiphy *wiphy,
3642                                  struct net_device *dev,
3643                                  struct cfg80211_qos_map *qos_map)
3644 {
3645         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3646         struct mac80211_qos_map *new_qos_map, *old_qos_map;
3647
3648         if (qos_map) {
3649                 new_qos_map = kzalloc(sizeof(*new_qos_map), GFP_KERNEL);
3650                 if (!new_qos_map)
3651                         return -ENOMEM;
3652                 memcpy(&new_qos_map->qos_map, qos_map, sizeof(*qos_map));
3653         } else {
3654                 /* A NULL qos_map was passed to disable QoS mapping */
3655                 new_qos_map = NULL;
3656         }
3657
3658         old_qos_map = sdata_dereference(sdata->qos_map, sdata);
3659         rcu_assign_pointer(sdata->qos_map, new_qos_map);
3660         if (old_qos_map)
3661                 kfree_rcu(old_qos_map, rcu_head);
3662
3663         return 0;
3664 }
3665
3666 static int ieee80211_set_ap_chanwidth(struct wiphy *wiphy,
3667                                       struct net_device *dev,
3668                                       struct cfg80211_chan_def *chandef)
3669 {
3670         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3671         int ret;
3672         u32 changed = 0;
3673
3674         ret = ieee80211_vif_change_bandwidth(sdata, chandef, &changed);
3675         if (ret == 0)
3676                 ieee80211_bss_info_change_notify(sdata, changed);
3677
3678         return ret;
3679 }
3680
3681 static int ieee80211_add_tx_ts(struct wiphy *wiphy, struct net_device *dev,
3682                                u8 tsid, const u8 *peer, u8 up,
3683                                u16 admitted_time)
3684 {
3685         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3686         struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
3687         int ac = ieee802_1d_to_ac[up];
3688
3689         if (sdata->vif.type != NL80211_IFTYPE_STATION)
3690                 return -EOPNOTSUPP;
3691
3692         if (!(sdata->wmm_acm & BIT(up)))
3693                 return -EINVAL;
3694
3695         if (ifmgd->tx_tspec[ac].admitted_time)
3696                 return -EBUSY;
3697
3698         if (admitted_time) {
3699                 ifmgd->tx_tspec[ac].admitted_time = 32 * admitted_time;
3700                 ifmgd->tx_tspec[ac].tsid = tsid;
3701                 ifmgd->tx_tspec[ac].up = up;
3702         }
3703
3704         return 0;
3705 }
3706
3707 static int ieee80211_del_tx_ts(struct wiphy *wiphy, struct net_device *dev,
3708                                u8 tsid, const u8 *peer)
3709 {
3710         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3711         struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
3712         struct ieee80211_local *local = wiphy_priv(wiphy);
3713         int ac;
3714
3715         for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
3716                 struct ieee80211_sta_tx_tspec *tx_tspec = &ifmgd->tx_tspec[ac];
3717
3718                 /* skip unused entries */
3719                 if (!tx_tspec->admitted_time)
3720                         continue;
3721
3722                 if (tx_tspec->tsid != tsid)
3723                         continue;
3724
3725                 /* due to this new packets will be reassigned to non-ACM ACs */
3726                 tx_tspec->up = -1;
3727
3728                 /* Make sure that all packets have been sent to avoid to
3729                  * restore the QoS params on packets that are still on the
3730                  * queues.
3731                  */
3732                 synchronize_net();
3733                 ieee80211_flush_queues(local, sdata, false);
3734
3735                 /* restore the normal QoS parameters
3736                  * (unconditionally to avoid races)
3737                  */
3738                 tx_tspec->action = TX_TSPEC_ACTION_STOP_DOWNGRADE;
3739                 tx_tspec->downgraded = false;
3740                 ieee80211_sta_handle_tspec_ac_params(sdata);
3741
3742                 /* finally clear all the data */
3743                 memset(tx_tspec, 0, sizeof(*tx_tspec));
3744
3745                 return 0;
3746         }
3747
3748         return -ENOENT;
3749 }
3750
3751 void ieee80211_nan_func_terminated(struct ieee80211_vif *vif,
3752                                    u8 inst_id,
3753                                    enum nl80211_nan_func_term_reason reason,
3754                                    gfp_t gfp)
3755 {
3756         struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
3757         struct cfg80211_nan_func *func;
3758         u64 cookie;
3759
3760         if (WARN_ON(vif->type != NL80211_IFTYPE_NAN))
3761                 return;
3762
3763         spin_lock_bh(&sdata->u.nan.func_lock);
3764
3765         func = idr_find(&sdata->u.nan.function_inst_ids, inst_id);
3766         if (WARN_ON(!func)) {
3767                 spin_unlock_bh(&sdata->u.nan.func_lock);
3768                 return;
3769         }
3770
3771         cookie = func->cookie;
3772         idr_remove(&sdata->u.nan.function_inst_ids, inst_id);
3773
3774         spin_unlock_bh(&sdata->u.nan.func_lock);
3775
3776         cfg80211_free_nan_func(func);
3777
3778         cfg80211_nan_func_terminated(ieee80211_vif_to_wdev(vif), inst_id,
3779                                      reason, cookie, gfp);
3780 }
3781 EXPORT_SYMBOL(ieee80211_nan_func_terminated);
3782
3783 void ieee80211_nan_func_match(struct ieee80211_vif *vif,
3784                               struct cfg80211_nan_match_params *match,
3785                               gfp_t gfp)
3786 {
3787         struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
3788         struct cfg80211_nan_func *func;
3789
3790         if (WARN_ON(vif->type != NL80211_IFTYPE_NAN))
3791                 return;
3792
3793         spin_lock_bh(&sdata->u.nan.func_lock);
3794
3795         func = idr_find(&sdata->u.nan.function_inst_ids,  match->inst_id);
3796         if (WARN_ON(!func)) {
3797                 spin_unlock_bh(&sdata->u.nan.func_lock);
3798                 return;
3799         }
3800         match->cookie = func->cookie;
3801
3802         spin_unlock_bh(&sdata->u.nan.func_lock);
3803
3804         cfg80211_nan_match(ieee80211_vif_to_wdev(vif), match, gfp);
3805 }
3806 EXPORT_SYMBOL(ieee80211_nan_func_match);
3807
3808 static int ieee80211_set_multicast_to_unicast(struct wiphy *wiphy,
3809                                               struct net_device *dev,
3810                                               const bool enabled)
3811 {
3812         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3813
3814         sdata->u.ap.multicast_to_unicast = enabled;
3815
3816         return 0;
3817 }
3818
3819 void ieee80211_fill_txq_stats(struct cfg80211_txq_stats *txqstats,
3820                               struct txq_info *txqi)
3821 {
3822         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_BACKLOG_BYTES))) {
3823                 txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_BYTES);
3824                 txqstats->backlog_bytes = txqi->tin.backlog_bytes;
3825         }
3826
3827         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS))) {
3828                 txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS);
3829                 txqstats->backlog_packets = txqi->tin.backlog_packets;
3830         }
3831
3832         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_FLOWS))) {
3833                 txqstats->filled |= BIT(NL80211_TXQ_STATS_FLOWS);
3834                 txqstats->flows = txqi->tin.flows;
3835         }
3836
3837         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_DROPS))) {
3838                 txqstats->filled |= BIT(NL80211_TXQ_STATS_DROPS);
3839                 txqstats->drops = txqi->cstats.drop_count;
3840         }
3841
3842         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_ECN_MARKS))) {
3843                 txqstats->filled |= BIT(NL80211_TXQ_STATS_ECN_MARKS);
3844                 txqstats->ecn_marks = txqi->cstats.ecn_mark;
3845         }
3846
3847         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_OVERLIMIT))) {
3848                 txqstats->filled |= BIT(NL80211_TXQ_STATS_OVERLIMIT);
3849                 txqstats->overlimit = txqi->tin.overlimit;
3850         }
3851
3852         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_COLLISIONS))) {
3853                 txqstats->filled |= BIT(NL80211_TXQ_STATS_COLLISIONS);
3854                 txqstats->collisions = txqi->tin.collisions;
3855         }
3856
3857         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_TX_BYTES))) {
3858                 txqstats->filled |= BIT(NL80211_TXQ_STATS_TX_BYTES);
3859                 txqstats->tx_bytes = txqi->tin.tx_bytes;
3860         }
3861
3862         if (!(txqstats->filled & BIT(NL80211_TXQ_STATS_TX_PACKETS))) {
3863                 txqstats->filled |= BIT(NL80211_TXQ_STATS_TX_PACKETS);
3864                 txqstats->tx_packets = txqi->tin.tx_packets;
3865         }
3866 }
3867
3868 static int ieee80211_get_txq_stats(struct wiphy *wiphy,
3869                                    struct wireless_dev *wdev,
3870                                    struct cfg80211_txq_stats *txqstats)
3871 {
3872         struct ieee80211_local *local = wiphy_priv(wiphy);
3873         struct ieee80211_sub_if_data *sdata;
3874         int ret = 0;
3875
3876         if (!local->ops->wake_tx_queue)
3877                 return 1;
3878
3879         spin_lock_bh(&local->fq.lock);
3880         rcu_read_lock();
3881
3882         if (wdev) {
3883                 sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
3884                 if (!sdata->vif.txq) {
3885                         ret = 1;
3886                         goto out;
3887                 }
3888                 ieee80211_fill_txq_stats(txqstats, to_txq_info(sdata->vif.txq));
3889         } else {
3890                 /* phy stats */
3891                 txqstats->filled |= BIT(NL80211_TXQ_STATS_BACKLOG_PACKETS) |
3892                                     BIT(NL80211_TXQ_STATS_BACKLOG_BYTES) |
3893                                     BIT(NL80211_TXQ_STATS_OVERLIMIT) |
3894                                     BIT(NL80211_TXQ_STATS_OVERMEMORY) |
3895                                     BIT(NL80211_TXQ_STATS_COLLISIONS) |
3896                                     BIT(NL80211_TXQ_STATS_MAX_FLOWS);
3897                 txqstats->backlog_packets = local->fq.backlog;
3898                 txqstats->backlog_bytes = local->fq.memory_usage;
3899                 txqstats->overlimit = local->fq.overlimit;
3900                 txqstats->overmemory = local->fq.overmemory;
3901                 txqstats->collisions = local->fq.collisions;
3902                 txqstats->max_flows = local->fq.flows_cnt;
3903         }
3904
3905 out:
3906         rcu_read_unlock();
3907         spin_unlock_bh(&local->fq.lock);
3908
3909         return ret;
3910 }
3911
3912 static int
3913 ieee80211_get_ftm_responder_stats(struct wiphy *wiphy,
3914                                   struct net_device *dev,
3915                                   struct cfg80211_ftm_responder_stats *ftm_stats)
3916 {
3917         struct ieee80211_local *local = wiphy_priv(wiphy);
3918         struct ieee80211_sub_if_data *sdata = IEEE80211_DEV_TO_SUB_IF(dev);
3919
3920         return drv_get_ftm_responder_stats(local, sdata, ftm_stats);
3921 }
3922
3923 static int
3924 ieee80211_start_pmsr(struct wiphy *wiphy, struct wireless_dev *dev,
3925                      struct cfg80211_pmsr_request *request)
3926 {
3927         struct ieee80211_local *local = wiphy_priv(wiphy);
3928         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(dev);
3929
3930         return drv_start_pmsr(local, sdata, request);
3931 }
3932
3933 static void
3934 ieee80211_abort_pmsr(struct wiphy *wiphy, struct wireless_dev *dev,
3935                      struct cfg80211_pmsr_request *request)
3936 {
3937         struct ieee80211_local *local = wiphy_priv(wiphy);
3938         struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(dev);
3939
3940         return drv_abort_pmsr(local, sdata, request);
3941 }
3942
3943 const struct cfg80211_ops mac80211_config_ops = {
3944         .add_virtual_intf = ieee80211_add_iface,
3945         .del_virtual_intf = ieee80211_del_iface,
3946         .change_virtual_intf = ieee80211_change_iface,
3947         .start_p2p_device = ieee80211_start_p2p_device,
3948         .stop_p2p_device = ieee80211_stop_p2p_device,
3949         .add_key = ieee80211_add_key,
3950         .del_key = ieee80211_del_key,
3951         .get_key = ieee80211_get_key,
3952         .set_default_key = ieee80211_config_default_key,
3953         .set_default_mgmt_key = ieee80211_config_default_mgmt_key,
3954         .start_ap = ieee80211_start_ap,
3955         .change_beacon = ieee80211_change_beacon,
3956         .stop_ap = ieee80211_stop_ap,
3957         .add_station = ieee80211_add_station,
3958         .del_station = ieee80211_del_station,
3959         .change_station = ieee80211_change_station,
3960         .get_station = ieee80211_get_station,
3961         .dump_station = ieee80211_dump_station,
3962         .dump_survey = ieee80211_dump_survey,
3963 #ifdef CONFIG_MAC80211_MESH
3964         .add_mpath = ieee80211_add_mpath,
3965         .del_mpath = ieee80211_del_mpath,
3966         .change_mpath = ieee80211_change_mpath,
3967         .get_mpath = ieee80211_get_mpath,
3968         .dump_mpath = ieee80211_dump_mpath,
3969         .get_mpp = ieee80211_get_mpp,
3970         .dump_mpp = ieee80211_dump_mpp,
3971         .update_mesh_config = ieee80211_update_mesh_config,
3972         .get_mesh_config = ieee80211_get_mesh_config,
3973         .join_mesh = ieee80211_join_mesh,
3974         .leave_mesh = ieee80211_leave_mesh,
3975 #endif
3976         .join_ocb = ieee80211_join_ocb,
3977         .leave_ocb = ieee80211_leave_ocb,
3978         .change_bss = ieee80211_change_bss,
3979         .set_txq_params = ieee80211_set_txq_params,
3980         .set_monitor_channel = ieee80211_set_monitor_channel,
3981         .suspend = ieee80211_suspend,
3982         .resume = ieee80211_resume,
3983         .scan = ieee80211_scan,
3984         .abort_scan = ieee80211_abort_scan,
3985         .sched_scan_start = ieee80211_sched_scan_start,
3986         .sched_scan_stop = ieee80211_sched_scan_stop,
3987         .auth = ieee80211_auth,
3988         .assoc = ieee80211_assoc,
3989         .deauth = ieee80211_deauth,
3990         .disassoc = ieee80211_disassoc,
3991         .join_ibss = ieee80211_join_ibss,
3992         .leave_ibss = ieee80211_leave_ibss,
3993         .set_mcast_rate = ieee80211_set_mcast_rate,
3994         .set_wiphy_params = ieee80211_set_wiphy_params,
3995         .set_tx_power = ieee80211_set_tx_power,
3996         .get_tx_power = ieee80211_get_tx_power,
3997         .set_wds_peer = ieee80211_set_wds_peer,
3998         .rfkill_poll = ieee80211_rfkill_poll,
3999         CFG80211_TESTMODE_CMD(ieee80211_testmode_cmd)
4000         CFG80211_TESTMODE_DUMP(ieee80211_testmode_dump)
4001         .set_power_mgmt = ieee80211_set_power_mgmt,
4002         .set_bitrate_mask = ieee80211_set_bitrate_mask,
4003         .remain_on_channel = ieee80211_remain_on_channel,
4004         .cancel_remain_on_channel = ieee80211_cancel_remain_on_channel,
4005         .mgmt_tx = ieee80211_mgmt_tx,
4006         .mgmt_tx_cancel_wait = ieee80211_mgmt_tx_cancel_wait,
4007         .set_cqm_rssi_config = ieee80211_set_cqm_rssi_config,
4008         .set_cqm_rssi_range_config = ieee80211_set_cqm_rssi_range_config,
4009         .mgmt_frame_register = ieee80211_mgmt_frame_register,
4010         .set_antenna = ieee80211_set_antenna,
4011         .get_antenna = ieee80211_get_antenna,
4012         .set_rekey_data = ieee80211_set_rekey_data,
4013         .tdls_oper = ieee80211_tdls_oper,
4014         .tdls_mgmt = ieee80211_tdls_mgmt,
4015         .tdls_channel_switch = ieee80211_tdls_channel_switch,
4016         .tdls_cancel_channel_switch = ieee80211_tdls_cancel_channel_switch,
4017         .probe_client = ieee80211_probe_client,
4018         .set_noack_map = ieee80211_set_noack_map,
4019 #ifdef CONFIG_PM
4020         .set_wakeup = ieee80211_set_wakeup,
4021 #endif
4022         .get_channel = ieee80211_cfg_get_channel,
4023         .start_radar_detection = ieee80211_start_radar_detection,
4024         .channel_switch = ieee80211_channel_switch,
4025         .set_qos_map = ieee80211_set_qos_map,
4026         .set_ap_chanwidth = ieee80211_set_ap_chanwidth,
4027         .add_tx_ts = ieee80211_add_tx_ts,
4028         .del_tx_ts = ieee80211_del_tx_ts,
4029         .start_nan = ieee80211_start_nan,
4030         .stop_nan = ieee80211_stop_nan,
4031         .nan_change_conf = ieee80211_nan_change_conf,
4032         .add_nan_func = ieee80211_add_nan_func,
4033         .del_nan_func = ieee80211_del_nan_func,
4034         .set_multicast_to_unicast = ieee80211_set_multicast_to_unicast,
4035         .tx_control_port = ieee80211_tx_control_port,
4036         .get_txq_stats = ieee80211_get_txq_stats,
4037         .get_ftm_responder_stats = ieee80211_get_ftm_responder_stats,
4038         .start_pmsr = ieee80211_start_pmsr,
4039         .abort_pmsr = ieee80211_abort_pmsr,
4040         .probe_mesh_link = ieee80211_probe_mesh_link,
4041 };