Merge tag 'memblock-v6.1-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/rppt...
[platform/kernel/linux-starfive.git] / net / wireless / core.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * This is the linux wireless configuration interface.
4  *
5  * Copyright 2006-2010          Johannes Berg <johannes@sipsolutions.net>
6  * Copyright 2013-2014  Intel Mobile Communications GmbH
7  * Copyright 2015-2017  Intel Deutschland GmbH
8  * Copyright (C) 2018-2022 Intel Corporation
9  */
10
11 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
12
13 #include <linux/if.h>
14 #include <linux/module.h>
15 #include <linux/err.h>
16 #include <linux/list.h>
17 #include <linux/slab.h>
18 #include <linux/nl80211.h>
19 #include <linux/debugfs.h>
20 #include <linux/notifier.h>
21 #include <linux/device.h>
22 #include <linux/etherdevice.h>
23 #include <linux/rtnetlink.h>
24 #include <linux/sched.h>
25 #include <net/genetlink.h>
26 #include <net/cfg80211.h>
27 #include "nl80211.h"
28 #include "core.h"
29 #include "sysfs.h"
30 #include "debugfs.h"
31 #include "wext-compat.h"
32 #include "rdev-ops.h"
33
34 /* name for sysfs, %d is appended */
35 #define PHY_NAME "phy"
36
37 MODULE_AUTHOR("Johannes Berg");
38 MODULE_LICENSE("GPL");
39 MODULE_DESCRIPTION("wireless configuration support");
40 MODULE_ALIAS_GENL_FAMILY(NL80211_GENL_NAME);
41
42 /* RCU-protected (and RTNL for writers) */
43 LIST_HEAD(cfg80211_rdev_list);
44 int cfg80211_rdev_list_generation;
45
46 /* for debugfs */
47 static struct dentry *ieee80211_debugfs_dir;
48
49 /* for the cleanup, scan and event works */
50 struct workqueue_struct *cfg80211_wq;
51
52 static bool cfg80211_disable_40mhz_24ghz;
53 module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
54 MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
55                  "Disable 40MHz support in the 2.4GHz band");
56
57 struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
58 {
59         struct cfg80211_registered_device *result = NULL, *rdev;
60
61         ASSERT_RTNL();
62
63         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
64                 if (rdev->wiphy_idx == wiphy_idx) {
65                         result = rdev;
66                         break;
67                 }
68         }
69
70         return result;
71 }
72
73 int get_wiphy_idx(struct wiphy *wiphy)
74 {
75         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
76
77         return rdev->wiphy_idx;
78 }
79
80 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
81 {
82         struct cfg80211_registered_device *rdev;
83
84         ASSERT_RTNL();
85
86         rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
87         if (!rdev)
88                 return NULL;
89         return &rdev->wiphy;
90 }
91
92 static int cfg80211_dev_check_name(struct cfg80211_registered_device *rdev,
93                                    const char *newname)
94 {
95         struct cfg80211_registered_device *rdev2;
96         int wiphy_idx, taken = -1, digits;
97
98         ASSERT_RTNL();
99
100         if (strlen(newname) > NL80211_WIPHY_NAME_MAXLEN)
101                 return -EINVAL;
102
103         /* prohibit calling the thing phy%d when %d is not its number */
104         sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
105         if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
106                 /* count number of places needed to print wiphy_idx */
107                 digits = 1;
108                 while (wiphy_idx /= 10)
109                         digits++;
110                 /*
111                  * deny the name if it is phy<idx> where <idx> is printed
112                  * without leading zeroes. taken == strlen(newname) here
113                  */
114                 if (taken == strlen(PHY_NAME) + digits)
115                         return -EINVAL;
116         }
117
118         /* Ensure another device does not already have this name. */
119         list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
120                 if (strcmp(newname, wiphy_name(&rdev2->wiphy)) == 0)
121                         return -EINVAL;
122
123         return 0;
124 }
125
126 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
127                         char *newname)
128 {
129         int result;
130
131         ASSERT_RTNL();
132
133         /* Ignore nop renames */
134         if (strcmp(newname, wiphy_name(&rdev->wiphy)) == 0)
135                 return 0;
136
137         result = cfg80211_dev_check_name(rdev, newname);
138         if (result < 0)
139                 return result;
140
141         result = device_rename(&rdev->wiphy.dev, newname);
142         if (result)
143                 return result;
144
145         if (!IS_ERR_OR_NULL(rdev->wiphy.debugfsdir))
146                 debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
147                                rdev->wiphy.debugfsdir,
148                                rdev->wiphy.debugfsdir->d_parent, newname);
149
150         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
151
152         return 0;
153 }
154
155 int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
156                           struct net *net)
157 {
158         struct wireless_dev *wdev;
159         int err = 0;
160
161         if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
162                 return -EOPNOTSUPP;
163
164         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
165                 if (!wdev->netdev)
166                         continue;
167                 wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
168                 err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
169                 if (err)
170                         break;
171                 wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
172         }
173
174         if (err) {
175                 /* failed -- clean up to old netns */
176                 net = wiphy_net(&rdev->wiphy);
177
178                 list_for_each_entry_continue_reverse(wdev,
179                                                      &rdev->wiphy.wdev_list,
180                                                      list) {
181                         if (!wdev->netdev)
182                                 continue;
183                         wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
184                         err = dev_change_net_namespace(wdev->netdev, net,
185                                                         "wlan%d");
186                         WARN_ON(err);
187                         wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
188                 }
189
190                 return err;
191         }
192
193         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
194                 if (!wdev->netdev)
195                         continue;
196                 nl80211_notify_iface(rdev, wdev, NL80211_CMD_DEL_INTERFACE);
197         }
198         nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
199
200         wiphy_net_set(&rdev->wiphy, net);
201
202         err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
203         WARN_ON(err);
204
205         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
206         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
207                 if (!wdev->netdev)
208                         continue;
209                 nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
210         }
211
212         return 0;
213 }
214
215 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
216 {
217         struct cfg80211_registered_device *rdev = data;
218
219         rdev_rfkill_poll(rdev);
220 }
221
222 void cfg80211_stop_p2p_device(struct cfg80211_registered_device *rdev,
223                               struct wireless_dev *wdev)
224 {
225         lockdep_assert_held(&rdev->wiphy.mtx);
226
227         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_P2P_DEVICE))
228                 return;
229
230         if (!wdev_running(wdev))
231                 return;
232
233         rdev_stop_p2p_device(rdev, wdev);
234         wdev->is_running = false;
235
236         rdev->opencount--;
237
238         if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
239                 if (WARN_ON(!rdev->scan_req->notified &&
240                             (!rdev->int_scan_req ||
241                              !rdev->int_scan_req->notified)))
242                         rdev->scan_req->info.aborted = true;
243                 ___cfg80211_scan_done(rdev, false);
244         }
245 }
246
247 void cfg80211_stop_nan(struct cfg80211_registered_device *rdev,
248                        struct wireless_dev *wdev)
249 {
250         lockdep_assert_held(&rdev->wiphy.mtx);
251
252         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_NAN))
253                 return;
254
255         if (!wdev_running(wdev))
256                 return;
257
258         rdev_stop_nan(rdev, wdev);
259         wdev->is_running = false;
260
261         rdev->opencount--;
262 }
263
264 void cfg80211_shutdown_all_interfaces(struct wiphy *wiphy)
265 {
266         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
267         struct wireless_dev *wdev;
268
269         ASSERT_RTNL();
270
271         list_for_each_entry(wdev, &rdev->wiphy.wdev_list, list) {
272                 if (wdev->netdev) {
273                         dev_close(wdev->netdev);
274                         continue;
275                 }
276
277                 /* otherwise, check iftype */
278
279                 wiphy_lock(wiphy);
280
281                 switch (wdev->iftype) {
282                 case NL80211_IFTYPE_P2P_DEVICE:
283                         cfg80211_stop_p2p_device(rdev, wdev);
284                         break;
285                 case NL80211_IFTYPE_NAN:
286                         cfg80211_stop_nan(rdev, wdev);
287                         break;
288                 default:
289                         break;
290                 }
291
292                 wiphy_unlock(wiphy);
293         }
294 }
295 EXPORT_SYMBOL_GPL(cfg80211_shutdown_all_interfaces);
296
297 static int cfg80211_rfkill_set_block(void *data, bool blocked)
298 {
299         struct cfg80211_registered_device *rdev = data;
300
301         if (!blocked)
302                 return 0;
303
304         rtnl_lock();
305         cfg80211_shutdown_all_interfaces(&rdev->wiphy);
306         rtnl_unlock();
307
308         return 0;
309 }
310
311 static void cfg80211_rfkill_block_work(struct work_struct *work)
312 {
313         struct cfg80211_registered_device *rdev;
314
315         rdev = container_of(work, struct cfg80211_registered_device,
316                             rfkill_block);
317         cfg80211_rfkill_set_block(rdev, true);
318 }
319
320 static void cfg80211_event_work(struct work_struct *work)
321 {
322         struct cfg80211_registered_device *rdev;
323
324         rdev = container_of(work, struct cfg80211_registered_device,
325                             event_work);
326
327         wiphy_lock(&rdev->wiphy);
328         cfg80211_process_rdev_events(rdev);
329         wiphy_unlock(&rdev->wiphy);
330 }
331
332 void cfg80211_destroy_ifaces(struct cfg80211_registered_device *rdev)
333 {
334         struct wireless_dev *wdev, *tmp;
335
336         ASSERT_RTNL();
337
338         list_for_each_entry_safe(wdev, tmp, &rdev->wiphy.wdev_list, list) {
339                 if (wdev->nl_owner_dead) {
340                         if (wdev->netdev)
341                                 dev_close(wdev->netdev);
342
343                         wiphy_lock(&rdev->wiphy);
344                         cfg80211_leave(rdev, wdev);
345                         cfg80211_remove_virtual_intf(rdev, wdev);
346                         wiphy_unlock(&rdev->wiphy);
347                 }
348         }
349 }
350
351 static void cfg80211_destroy_iface_wk(struct work_struct *work)
352 {
353         struct cfg80211_registered_device *rdev;
354
355         rdev = container_of(work, struct cfg80211_registered_device,
356                             destroy_work);
357
358         rtnl_lock();
359         cfg80211_destroy_ifaces(rdev);
360         rtnl_unlock();
361 }
362
363 static void cfg80211_sched_scan_stop_wk(struct work_struct *work)
364 {
365         struct cfg80211_registered_device *rdev;
366         struct cfg80211_sched_scan_request *req, *tmp;
367
368         rdev = container_of(work, struct cfg80211_registered_device,
369                            sched_scan_stop_wk);
370
371         rtnl_lock();
372         list_for_each_entry_safe(req, tmp, &rdev->sched_scan_req_list, list) {
373                 if (req->nl_owner_dead)
374                         cfg80211_stop_sched_scan_req(rdev, req, false);
375         }
376         rtnl_unlock();
377 }
378
379 static void cfg80211_propagate_radar_detect_wk(struct work_struct *work)
380 {
381         struct cfg80211_registered_device *rdev;
382
383         rdev = container_of(work, struct cfg80211_registered_device,
384                             propagate_radar_detect_wk);
385
386         rtnl_lock();
387
388         regulatory_propagate_dfs_state(&rdev->wiphy, &rdev->radar_chandef,
389                                        NL80211_DFS_UNAVAILABLE,
390                                        NL80211_RADAR_DETECTED);
391
392         rtnl_unlock();
393 }
394
395 static void cfg80211_propagate_cac_done_wk(struct work_struct *work)
396 {
397         struct cfg80211_registered_device *rdev;
398
399         rdev = container_of(work, struct cfg80211_registered_device,
400                             propagate_cac_done_wk);
401
402         rtnl_lock();
403
404         regulatory_propagate_dfs_state(&rdev->wiphy, &rdev->cac_done_chandef,
405                                        NL80211_DFS_AVAILABLE,
406                                        NL80211_RADAR_CAC_FINISHED);
407
408         rtnl_unlock();
409 }
410
411 /* exported functions */
412
413 struct wiphy *wiphy_new_nm(const struct cfg80211_ops *ops, int sizeof_priv,
414                            const char *requested_name)
415 {
416         static atomic_t wiphy_counter = ATOMIC_INIT(0);
417
418         struct cfg80211_registered_device *rdev;
419         int alloc_size;
420
421         WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
422         WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
423         WARN_ON(ops->connect && !ops->disconnect);
424         WARN_ON(ops->join_ibss && !ops->leave_ibss);
425         WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
426         WARN_ON(ops->add_station && !ops->del_station);
427         WARN_ON(ops->add_mpath && !ops->del_mpath);
428         WARN_ON(ops->join_mesh && !ops->leave_mesh);
429         WARN_ON(ops->start_p2p_device && !ops->stop_p2p_device);
430         WARN_ON(ops->start_ap && !ops->stop_ap);
431         WARN_ON(ops->join_ocb && !ops->leave_ocb);
432         WARN_ON(ops->suspend && !ops->resume);
433         WARN_ON(ops->sched_scan_start && !ops->sched_scan_stop);
434         WARN_ON(ops->remain_on_channel && !ops->cancel_remain_on_channel);
435         WARN_ON(ops->tdls_channel_switch && !ops->tdls_cancel_channel_switch);
436         WARN_ON(ops->add_tx_ts && !ops->del_tx_ts);
437
438         alloc_size = sizeof(*rdev) + sizeof_priv;
439
440         rdev = kzalloc(alloc_size, GFP_KERNEL);
441         if (!rdev)
442                 return NULL;
443
444         rdev->ops = ops;
445
446         rdev->wiphy_idx = atomic_inc_return(&wiphy_counter);
447
448         if (unlikely(rdev->wiphy_idx < 0)) {
449                 /* ugh, wrapped! */
450                 atomic_dec(&wiphy_counter);
451                 kfree(rdev);
452                 return NULL;
453         }
454
455         /* atomic_inc_return makes it start at 1, make it start at 0 */
456         rdev->wiphy_idx--;
457
458         /* give it a proper name */
459         if (requested_name && requested_name[0]) {
460                 int rv;
461
462                 rtnl_lock();
463                 rv = cfg80211_dev_check_name(rdev, requested_name);
464
465                 if (rv < 0) {
466                         rtnl_unlock();
467                         goto use_default_name;
468                 }
469
470                 rv = dev_set_name(&rdev->wiphy.dev, "%s", requested_name);
471                 rtnl_unlock();
472                 if (rv)
473                         goto use_default_name;
474         } else {
475                 int rv;
476
477 use_default_name:
478                 /* NOTE:  This is *probably* safe w/out holding rtnl because of
479                  * the restrictions on phy names.  Probably this call could
480                  * fail if some other part of the kernel (re)named a device
481                  * phyX.  But, might should add some locking and check return
482                  * value, and use a different name if this one exists?
483                  */
484                 rv = dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
485                 if (rv < 0) {
486                         kfree(rdev);
487                         return NULL;
488                 }
489         }
490
491         mutex_init(&rdev->wiphy.mtx);
492         INIT_LIST_HEAD(&rdev->wiphy.wdev_list);
493         INIT_LIST_HEAD(&rdev->beacon_registrations);
494         spin_lock_init(&rdev->beacon_registrations_lock);
495         spin_lock_init(&rdev->bss_lock);
496         INIT_LIST_HEAD(&rdev->bss_list);
497         INIT_LIST_HEAD(&rdev->sched_scan_req_list);
498         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
499         INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
500                           cfg80211_dfs_channels_update_work);
501 #ifdef CONFIG_CFG80211_WEXT
502         rdev->wiphy.wext = &cfg80211_wext_handler;
503 #endif
504
505         device_initialize(&rdev->wiphy.dev);
506         rdev->wiphy.dev.class = &ieee80211_class;
507         rdev->wiphy.dev.platform_data = rdev;
508         device_enable_async_suspend(&rdev->wiphy.dev);
509
510         INIT_WORK(&rdev->destroy_work, cfg80211_destroy_iface_wk);
511         INIT_WORK(&rdev->sched_scan_stop_wk, cfg80211_sched_scan_stop_wk);
512         INIT_WORK(&rdev->sched_scan_res_wk, cfg80211_sched_scan_results_wk);
513         INIT_WORK(&rdev->propagate_radar_detect_wk,
514                   cfg80211_propagate_radar_detect_wk);
515         INIT_WORK(&rdev->propagate_cac_done_wk, cfg80211_propagate_cac_done_wk);
516         INIT_WORK(&rdev->mgmt_registrations_update_wk,
517                   cfg80211_mgmt_registrations_update_wk);
518         spin_lock_init(&rdev->mgmt_registrations_lock);
519
520 #ifdef CONFIG_CFG80211_DEFAULT_PS
521         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
522 #endif
523
524         wiphy_net_set(&rdev->wiphy, &init_net);
525
526         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
527         rdev->wiphy.rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
528                                           &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
529                                           &rdev->rfkill_ops, rdev);
530
531         if (!rdev->wiphy.rfkill) {
532                 wiphy_free(&rdev->wiphy);
533                 return NULL;
534         }
535
536         INIT_WORK(&rdev->rfkill_block, cfg80211_rfkill_block_work);
537         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
538         INIT_WORK(&rdev->event_work, cfg80211_event_work);
539         INIT_WORK(&rdev->background_cac_abort_wk,
540                   cfg80211_background_cac_abort_wk);
541         INIT_DELAYED_WORK(&rdev->background_cac_done_wk,
542                           cfg80211_background_cac_done_wk);
543
544         init_waitqueue_head(&rdev->dev_wait);
545
546         /*
547          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
548          * Fragmentation and RTS threshold are disabled by default with the
549          * special -1 value.
550          */
551         rdev->wiphy.retry_short = 7;
552         rdev->wiphy.retry_long = 4;
553         rdev->wiphy.frag_threshold = (u32) -1;
554         rdev->wiphy.rts_threshold = (u32) -1;
555         rdev->wiphy.coverage_class = 0;
556
557         rdev->wiphy.max_num_csa_counters = 1;
558
559         rdev->wiphy.max_sched_scan_plans = 1;
560         rdev->wiphy.max_sched_scan_plan_interval = U32_MAX;
561
562         return &rdev->wiphy;
563 }
564 EXPORT_SYMBOL(wiphy_new_nm);
565
566 static int wiphy_verify_combinations(struct wiphy *wiphy)
567 {
568         const struct ieee80211_iface_combination *c;
569         int i, j;
570
571         for (i = 0; i < wiphy->n_iface_combinations; i++) {
572                 u32 cnt = 0;
573                 u16 all_iftypes = 0;
574
575                 c = &wiphy->iface_combinations[i];
576
577                 /*
578                  * Combinations with just one interface aren't real,
579                  * however we make an exception for DFS.
580                  */
581                 if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
582                         return -EINVAL;
583
584                 /* Need at least one channel */
585                 if (WARN_ON(!c->num_different_channels))
586                         return -EINVAL;
587
588                 /* DFS only works on one channel. */
589                 if (WARN_ON(c->radar_detect_widths &&
590                             (c->num_different_channels > 1)))
591                         return -EINVAL;
592
593                 if (WARN_ON(!c->n_limits))
594                         return -EINVAL;
595
596                 for (j = 0; j < c->n_limits; j++) {
597                         u16 types = c->limits[j].types;
598
599                         /* interface types shouldn't overlap */
600                         if (WARN_ON(types & all_iftypes))
601                                 return -EINVAL;
602                         all_iftypes |= types;
603
604                         if (WARN_ON(!c->limits[j].max))
605                                 return -EINVAL;
606
607                         /* Shouldn't list software iftypes in combinations! */
608                         if (WARN_ON(wiphy->software_iftypes & types))
609                                 return -EINVAL;
610
611                         /* Only a single P2P_DEVICE can be allowed */
612                         if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
613                                     c->limits[j].max > 1))
614                                 return -EINVAL;
615
616                         /* Only a single NAN can be allowed */
617                         if (WARN_ON(types & BIT(NL80211_IFTYPE_NAN) &&
618                                     c->limits[j].max > 1))
619                                 return -EINVAL;
620
621                         /*
622                          * This isn't well-defined right now. If you have an
623                          * IBSS interface, then its beacon interval may change
624                          * by joining other networks, and nothing prevents it
625                          * from doing that.
626                          * So technically we probably shouldn't even allow AP
627                          * and IBSS in the same interface, but it seems that
628                          * some drivers support that, possibly only with fixed
629                          * beacon intervals for IBSS.
630                          */
631                         if (WARN_ON(types & BIT(NL80211_IFTYPE_ADHOC) &&
632                                     c->beacon_int_min_gcd)) {
633                                 return -EINVAL;
634                         }
635
636                         cnt += c->limits[j].max;
637                         /*
638                          * Don't advertise an unsupported type
639                          * in a combination.
640                          */
641                         if (WARN_ON((wiphy->interface_modes & types) != types))
642                                 return -EINVAL;
643                 }
644
645                 if (WARN_ON(all_iftypes & BIT(NL80211_IFTYPE_WDS)))
646                         return -EINVAL;
647
648                 /* You can't even choose that many! */
649                 if (WARN_ON(cnt < c->max_interfaces))
650                         return -EINVAL;
651         }
652
653         return 0;
654 }
655
656 int wiphy_register(struct wiphy *wiphy)
657 {
658         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
659         int res;
660         enum nl80211_band band;
661         struct ieee80211_supported_band *sband;
662         bool have_band = false;
663         int i;
664         u16 ifmodes = wiphy->interface_modes;
665
666 #ifdef CONFIG_PM
667         if (WARN_ON(wiphy->wowlan &&
668                     (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
669                     !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
670                 return -EINVAL;
671         if (WARN_ON(wiphy->wowlan &&
672                     !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
673                     !wiphy->wowlan->tcp))
674                 return -EINVAL;
675 #endif
676         if (WARN_ON((wiphy->features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH) &&
677                     (!rdev->ops->tdls_channel_switch ||
678                      !rdev->ops->tdls_cancel_channel_switch)))
679                 return -EINVAL;
680
681         if (WARN_ON((wiphy->interface_modes & BIT(NL80211_IFTYPE_NAN)) &&
682                     (!rdev->ops->start_nan || !rdev->ops->stop_nan ||
683                      !rdev->ops->add_nan_func || !rdev->ops->del_nan_func ||
684                      !(wiphy->nan_supported_bands & BIT(NL80211_BAND_2GHZ)))))
685                 return -EINVAL;
686
687         if (WARN_ON(wiphy->interface_modes & BIT(NL80211_IFTYPE_WDS)))
688                 return -EINVAL;
689
690         if (WARN_ON(wiphy->pmsr_capa && !wiphy->pmsr_capa->ftm.supported))
691                 return -EINVAL;
692
693         if (wiphy->pmsr_capa && wiphy->pmsr_capa->ftm.supported) {
694                 if (WARN_ON(!wiphy->pmsr_capa->ftm.asap &&
695                             !wiphy->pmsr_capa->ftm.non_asap))
696                         return -EINVAL;
697                 if (WARN_ON(!wiphy->pmsr_capa->ftm.preambles ||
698                             !wiphy->pmsr_capa->ftm.bandwidths))
699                         return -EINVAL;
700                 if (WARN_ON(wiphy->pmsr_capa->ftm.preambles &
701                                 ~(BIT(NL80211_PREAMBLE_LEGACY) |
702                                   BIT(NL80211_PREAMBLE_HT) |
703                                   BIT(NL80211_PREAMBLE_VHT) |
704                                   BIT(NL80211_PREAMBLE_HE) |
705                                   BIT(NL80211_PREAMBLE_DMG))))
706                         return -EINVAL;
707                 if (WARN_ON((wiphy->pmsr_capa->ftm.trigger_based ||
708                              wiphy->pmsr_capa->ftm.non_trigger_based) &&
709                             !(wiphy->pmsr_capa->ftm.preambles &
710                               BIT(NL80211_PREAMBLE_HE))))
711                         return -EINVAL;
712                 if (WARN_ON(wiphy->pmsr_capa->ftm.bandwidths &
713                                 ~(BIT(NL80211_CHAN_WIDTH_20_NOHT) |
714                                   BIT(NL80211_CHAN_WIDTH_20) |
715                                   BIT(NL80211_CHAN_WIDTH_40) |
716                                   BIT(NL80211_CHAN_WIDTH_80) |
717                                   BIT(NL80211_CHAN_WIDTH_80P80) |
718                                   BIT(NL80211_CHAN_WIDTH_160) |
719                                   BIT(NL80211_CHAN_WIDTH_5) |
720                                   BIT(NL80211_CHAN_WIDTH_10))))
721                         return -EINVAL;
722         }
723
724         /*
725          * if a wiphy has unsupported modes for regulatory channel enforcement,
726          * opt-out of enforcement checking
727          */
728         if (wiphy->interface_modes & ~(BIT(NL80211_IFTYPE_STATION) |
729                                        BIT(NL80211_IFTYPE_P2P_CLIENT) |
730                                        BIT(NL80211_IFTYPE_AP) |
731                                        BIT(NL80211_IFTYPE_MESH_POINT) |
732                                        BIT(NL80211_IFTYPE_P2P_GO) |
733                                        BIT(NL80211_IFTYPE_ADHOC) |
734                                        BIT(NL80211_IFTYPE_P2P_DEVICE) |
735                                        BIT(NL80211_IFTYPE_NAN) |
736                                        BIT(NL80211_IFTYPE_AP_VLAN) |
737                                        BIT(NL80211_IFTYPE_MONITOR)))
738                 wiphy->regulatory_flags |= REGULATORY_IGNORE_STALE_KICKOFF;
739
740         if (WARN_ON((wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED) &&
741                     (wiphy->regulatory_flags &
742                                         (REGULATORY_CUSTOM_REG |
743                                          REGULATORY_STRICT_REG |
744                                          REGULATORY_COUNTRY_IE_FOLLOW_POWER |
745                                          REGULATORY_COUNTRY_IE_IGNORE))))
746                 return -EINVAL;
747
748         if (WARN_ON(wiphy->coalesce &&
749                     (!wiphy->coalesce->n_rules ||
750                      !wiphy->coalesce->n_patterns) &&
751                     (!wiphy->coalesce->pattern_min_len ||
752                      wiphy->coalesce->pattern_min_len >
753                         wiphy->coalesce->pattern_max_len)))
754                 return -EINVAL;
755
756         if (WARN_ON(wiphy->ap_sme_capa &&
757                     !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
758                 return -EINVAL;
759
760         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
761                 return -EINVAL;
762
763         if (WARN_ON(wiphy->addresses &&
764                     !is_zero_ether_addr(wiphy->perm_addr) &&
765                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
766                            ETH_ALEN)))
767                 return -EINVAL;
768
769         if (WARN_ON(wiphy->max_acl_mac_addrs &&
770                     (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
771                      !rdev->ops->set_mac_acl)))
772                 return -EINVAL;
773
774         /* assure only valid behaviours are flagged by driver
775          * hence subtract 2 as bit 0 is invalid.
776          */
777         if (WARN_ON(wiphy->bss_select_support &&
778                     (wiphy->bss_select_support & ~(BIT(__NL80211_BSS_SELECT_ATTR_AFTER_LAST) - 2))))
779                 return -EINVAL;
780
781         if (WARN_ON(wiphy_ext_feature_isset(&rdev->wiphy,
782                                             NL80211_EXT_FEATURE_4WAY_HANDSHAKE_STA_1X) &&
783                     (!rdev->ops->set_pmk || !rdev->ops->del_pmk)))
784                 return -EINVAL;
785
786         if (WARN_ON(!(rdev->wiphy.flags & WIPHY_FLAG_SUPPORTS_FW_ROAM) &&
787                     rdev->ops->update_connect_params))
788                 return -EINVAL;
789
790         if (wiphy->addresses)
791                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
792
793         /* sanity check ifmodes */
794         WARN_ON(!ifmodes);
795         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
796         if (WARN_ON(ifmodes != wiphy->interface_modes))
797                 wiphy->interface_modes = ifmodes;
798
799         res = wiphy_verify_combinations(wiphy);
800         if (res)
801                 return res;
802
803         /* sanity check supported bands/channels */
804         for (band = 0; band < NUM_NL80211_BANDS; band++) {
805                 u16 types = 0;
806                 bool have_he = false;
807
808                 sband = wiphy->bands[band];
809                 if (!sband)
810                         continue;
811
812                 sband->band = band;
813                 if (WARN_ON(!sband->n_channels))
814                         return -EINVAL;
815                 /*
816                  * on 60GHz or sub-1Ghz band, there are no legacy rates, so
817                  * n_bitrates is 0
818                  */
819                 if (WARN_ON((band != NL80211_BAND_60GHZ &&
820                              band != NL80211_BAND_S1GHZ) &&
821                             !sband->n_bitrates))
822                         return -EINVAL;
823
824                 if (WARN_ON(band == NL80211_BAND_6GHZ &&
825                             (sband->ht_cap.ht_supported ||
826                              sband->vht_cap.vht_supported)))
827                         return -EINVAL;
828
829                 /*
830                  * Since cfg80211_disable_40mhz_24ghz is global, we can
831                  * modify the sband's ht data even if the driver uses a
832                  * global structure for that.
833                  */
834                 if (cfg80211_disable_40mhz_24ghz &&
835                     band == NL80211_BAND_2GHZ &&
836                     sband->ht_cap.ht_supported) {
837                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
838                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
839                 }
840
841                 /*
842                  * Since we use a u32 for rate bitmaps in
843                  * ieee80211_get_response_rate, we cannot
844                  * have more than 32 legacy rates.
845                  */
846                 if (WARN_ON(sband->n_bitrates > 32))
847                         return -EINVAL;
848
849                 for (i = 0; i < sband->n_channels; i++) {
850                         sband->channels[i].orig_flags =
851                                 sband->channels[i].flags;
852                         sband->channels[i].orig_mag = INT_MAX;
853                         sband->channels[i].orig_mpwr =
854                                 sband->channels[i].max_power;
855                         sband->channels[i].band = band;
856
857                         if (WARN_ON(sband->channels[i].freq_offset >= 1000))
858                                 return -EINVAL;
859                 }
860
861                 for (i = 0; i < sband->n_iftype_data; i++) {
862                         const struct ieee80211_sband_iftype_data *iftd;
863                         bool has_ap, has_non_ap;
864                         u32 ap_bits = BIT(NL80211_IFTYPE_AP) |
865                                       BIT(NL80211_IFTYPE_P2P_GO);
866
867                         iftd = &sband->iftype_data[i];
868
869                         if (WARN_ON(!iftd->types_mask))
870                                 return -EINVAL;
871                         if (WARN_ON(types & iftd->types_mask))
872                                 return -EINVAL;
873
874                         /* at least one piece of information must be present */
875                         if (WARN_ON(!iftd->he_cap.has_he))
876                                 return -EINVAL;
877
878                         types |= iftd->types_mask;
879
880                         if (i == 0)
881                                 have_he = iftd->he_cap.has_he;
882                         else
883                                 have_he = have_he &&
884                                           iftd->he_cap.has_he;
885
886                         has_ap = iftd->types_mask & ap_bits;
887                         has_non_ap = iftd->types_mask & ~ap_bits;
888
889                         /*
890                          * For EHT 20 MHz STA, the capabilities format differs
891                          * but to simplify, don't check 20 MHz but rather check
892                          * only if AP and non-AP were mentioned at the same time,
893                          * reject if so.
894                          */
895                         if (WARN_ON(iftd->eht_cap.has_eht &&
896                                     has_ap && has_non_ap))
897                                 return -EINVAL;
898                 }
899
900                 if (WARN_ON(!have_he && band == NL80211_BAND_6GHZ))
901                         return -EINVAL;
902
903                 have_band = true;
904         }
905
906         if (!have_band) {
907                 WARN_ON(1);
908                 return -EINVAL;
909         }
910
911         for (i = 0; i < rdev->wiphy.n_vendor_commands; i++) {
912                 /*
913                  * Validate we have a policy (can be explicitly set to
914                  * VENDOR_CMD_RAW_DATA which is non-NULL) and also that
915                  * we have at least one of doit/dumpit.
916                  */
917                 if (WARN_ON(!rdev->wiphy.vendor_commands[i].policy))
918                         return -EINVAL;
919                 if (WARN_ON(!rdev->wiphy.vendor_commands[i].doit &&
920                             !rdev->wiphy.vendor_commands[i].dumpit))
921                         return -EINVAL;
922         }
923
924 #ifdef CONFIG_PM
925         if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
926                     (!rdev->wiphy.wowlan->pattern_min_len ||
927                      rdev->wiphy.wowlan->pattern_min_len >
928                                 rdev->wiphy.wowlan->pattern_max_len)))
929                 return -EINVAL;
930 #endif
931
932         if (!wiphy->max_num_akm_suites)
933                 wiphy->max_num_akm_suites = NL80211_MAX_NR_AKM_SUITES;
934         else if (wiphy->max_num_akm_suites < NL80211_MAX_NR_AKM_SUITES ||
935                  wiphy->max_num_akm_suites > CFG80211_MAX_NUM_AKM_SUITES)
936                 return -EINVAL;
937
938         /* check and set up bitrates */
939         ieee80211_set_bitrate_flags(wiphy);
940
941         rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
942
943         rtnl_lock();
944         res = device_add(&rdev->wiphy.dev);
945         if (res) {
946                 rtnl_unlock();
947                 return res;
948         }
949
950         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
951         cfg80211_rdev_list_generation++;
952
953         /* add to debugfs */
954         rdev->wiphy.debugfsdir = debugfs_create_dir(wiphy_name(&rdev->wiphy),
955                                                     ieee80211_debugfs_dir);
956
957         cfg80211_debugfs_rdev_add(rdev);
958         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
959
960         /* set up regulatory info */
961         wiphy_regulatory_register(wiphy);
962
963         if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
964                 struct regulatory_request request;
965
966                 request.wiphy_idx = get_wiphy_idx(wiphy);
967                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
968                 request.alpha2[0] = '9';
969                 request.alpha2[1] = '9';
970
971                 nl80211_send_reg_change_event(&request);
972         }
973
974         /* Check that nobody globally advertises any capabilities they do not
975          * advertise on all possible interface types.
976          */
977         if (wiphy->extended_capabilities_len &&
978             wiphy->num_iftype_ext_capab &&
979             wiphy->iftype_ext_capab) {
980                 u8 supported_on_all, j;
981                 const struct wiphy_iftype_ext_capab *capab;
982
983                 capab = wiphy->iftype_ext_capab;
984                 for (j = 0; j < wiphy->extended_capabilities_len; j++) {
985                         if (capab[0].extended_capabilities_len > j)
986                                 supported_on_all =
987                                         capab[0].extended_capabilities[j];
988                         else
989                                 supported_on_all = 0x00;
990                         for (i = 1; i < wiphy->num_iftype_ext_capab; i++) {
991                                 if (j >= capab[i].extended_capabilities_len) {
992                                         supported_on_all = 0x00;
993                                         break;
994                                 }
995                                 supported_on_all &=
996                                         capab[i].extended_capabilities[j];
997                         }
998                         if (WARN_ON(wiphy->extended_capabilities[j] &
999                                     ~supported_on_all))
1000                                 break;
1001                 }
1002         }
1003
1004         rdev->wiphy.registered = true;
1005         rtnl_unlock();
1006
1007         res = rfkill_register(rdev->wiphy.rfkill);
1008         if (res) {
1009                 rfkill_destroy(rdev->wiphy.rfkill);
1010                 rdev->wiphy.rfkill = NULL;
1011                 wiphy_unregister(&rdev->wiphy);
1012                 return res;
1013         }
1014
1015         return 0;
1016 }
1017 EXPORT_SYMBOL(wiphy_register);
1018
1019 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
1020 {
1021         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
1022
1023         if (!rdev->ops->rfkill_poll)
1024                 return;
1025         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
1026         rfkill_resume_polling(wiphy->rfkill);
1027 }
1028 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
1029
1030 void wiphy_unregister(struct wiphy *wiphy)
1031 {
1032         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
1033
1034         wait_event(rdev->dev_wait, ({
1035                 int __count;
1036                 wiphy_lock(&rdev->wiphy);
1037                 __count = rdev->opencount;
1038                 wiphy_unlock(&rdev->wiphy);
1039                 __count == 0; }));
1040
1041         if (rdev->wiphy.rfkill)
1042                 rfkill_unregister(rdev->wiphy.rfkill);
1043
1044         rtnl_lock();
1045         wiphy_lock(&rdev->wiphy);
1046         nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
1047         rdev->wiphy.registered = false;
1048
1049         WARN_ON(!list_empty(&rdev->wiphy.wdev_list));
1050
1051         /*
1052          * First remove the hardware from everywhere, this makes
1053          * it impossible to find from userspace.
1054          */
1055         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
1056         list_del_rcu(&rdev->list);
1057         synchronize_rcu();
1058
1059         /*
1060          * If this device got a regulatory hint tell core its
1061          * free to listen now to a new shiny device regulatory hint
1062          */
1063         wiphy_regulatory_deregister(wiphy);
1064
1065         cfg80211_rdev_list_generation++;
1066         device_del(&rdev->wiphy.dev);
1067
1068         wiphy_unlock(&rdev->wiphy);
1069         rtnl_unlock();
1070
1071         flush_work(&rdev->scan_done_wk);
1072         cancel_work_sync(&rdev->conn_work);
1073         flush_work(&rdev->event_work);
1074         cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
1075         cancel_delayed_work_sync(&rdev->background_cac_done_wk);
1076         flush_work(&rdev->destroy_work);
1077         flush_work(&rdev->sched_scan_stop_wk);
1078         flush_work(&rdev->propagate_radar_detect_wk);
1079         flush_work(&rdev->propagate_cac_done_wk);
1080         flush_work(&rdev->mgmt_registrations_update_wk);
1081         flush_work(&rdev->background_cac_abort_wk);
1082
1083 #ifdef CONFIG_PM
1084         if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
1085                 rdev_set_wakeup(rdev, false);
1086 #endif
1087         cfg80211_rdev_free_wowlan(rdev);
1088         cfg80211_rdev_free_coalesce(rdev);
1089 }
1090 EXPORT_SYMBOL(wiphy_unregister);
1091
1092 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
1093 {
1094         struct cfg80211_internal_bss *scan, *tmp;
1095         struct cfg80211_beacon_registration *reg, *treg;
1096         rfkill_destroy(rdev->wiphy.rfkill);
1097         list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
1098                 list_del(&reg->list);
1099                 kfree(reg);
1100         }
1101         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
1102                 cfg80211_put_bss(&rdev->wiphy, &scan->pub);
1103         mutex_destroy(&rdev->wiphy.mtx);
1104
1105         /*
1106          * The 'regd' can only be non-NULL if we never finished
1107          * initializing the wiphy and thus never went through the
1108          * unregister path - e.g. in failure scenarios. Thus, it
1109          * cannot have been visible to anyone if non-NULL, so we
1110          * can just free it here.
1111          */
1112         kfree(rcu_dereference_raw(rdev->wiphy.regd));
1113
1114         kfree(rdev);
1115 }
1116
1117 void wiphy_free(struct wiphy *wiphy)
1118 {
1119         put_device(&wiphy->dev);
1120 }
1121 EXPORT_SYMBOL(wiphy_free);
1122
1123 void wiphy_rfkill_set_hw_state_reason(struct wiphy *wiphy, bool blocked,
1124                                       enum rfkill_hard_block_reasons reason)
1125 {
1126         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
1127
1128         if (rfkill_set_hw_state_reason(wiphy->rfkill, blocked, reason))
1129                 schedule_work(&rdev->rfkill_block);
1130 }
1131 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state_reason);
1132
1133 void cfg80211_cqm_config_free(struct wireless_dev *wdev)
1134 {
1135         kfree(wdev->cqm_config);
1136         wdev->cqm_config = NULL;
1137 }
1138
1139 static void _cfg80211_unregister_wdev(struct wireless_dev *wdev,
1140                                       bool unregister_netdev)
1141 {
1142         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
1143         unsigned int link_id;
1144
1145         ASSERT_RTNL();
1146         lockdep_assert_held(&rdev->wiphy.mtx);
1147
1148         flush_work(&wdev->pmsr_free_wk);
1149
1150         nl80211_notify_iface(rdev, wdev, NL80211_CMD_DEL_INTERFACE);
1151
1152         wdev->registered = false;
1153
1154         if (wdev->netdev) {
1155                 sysfs_remove_link(&wdev->netdev->dev.kobj, "phy80211");
1156                 if (unregister_netdev)
1157                         unregister_netdevice(wdev->netdev);
1158         }
1159
1160         list_del_rcu(&wdev->list);
1161         synchronize_net();
1162         rdev->devlist_generation++;
1163
1164         cfg80211_mlme_purge_registrations(wdev);
1165
1166         switch (wdev->iftype) {
1167         case NL80211_IFTYPE_P2P_DEVICE:
1168                 cfg80211_stop_p2p_device(rdev, wdev);
1169                 break;
1170         case NL80211_IFTYPE_NAN:
1171                 cfg80211_stop_nan(rdev, wdev);
1172                 break;
1173         default:
1174                 break;
1175         }
1176
1177 #ifdef CONFIG_CFG80211_WEXT
1178         kfree_sensitive(wdev->wext.keys);
1179         wdev->wext.keys = NULL;
1180 #endif
1181         /* only initialized if we have a netdev */
1182         if (wdev->netdev)
1183                 flush_work(&wdev->disconnect_wk);
1184
1185         cfg80211_cqm_config_free(wdev);
1186
1187         /*
1188          * Ensure that all events have been processed and
1189          * freed.
1190          */
1191         cfg80211_process_wdev_events(wdev);
1192
1193         if (wdev->iftype == NL80211_IFTYPE_STATION ||
1194             wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) {
1195                 for (link_id = 0; link_id < ARRAY_SIZE(wdev->links); link_id++) {
1196                         struct cfg80211_internal_bss *curbss;
1197
1198                         curbss = wdev->links[link_id].client.current_bss;
1199
1200                         if (WARN_ON(curbss)) {
1201                                 cfg80211_unhold_bss(curbss);
1202                                 cfg80211_put_bss(wdev->wiphy, &curbss->pub);
1203                                 wdev->links[link_id].client.current_bss = NULL;
1204                         }
1205                 }
1206         }
1207
1208         wdev->connected = false;
1209 }
1210
1211 void cfg80211_unregister_wdev(struct wireless_dev *wdev)
1212 {
1213         _cfg80211_unregister_wdev(wdev, true);
1214 }
1215 EXPORT_SYMBOL(cfg80211_unregister_wdev);
1216
1217 static const struct device_type wiphy_type = {
1218         .name   = "wlan",
1219 };
1220
1221 void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
1222                                enum nl80211_iftype iftype, int num)
1223 {
1224         lockdep_assert_held(&rdev->wiphy.mtx);
1225
1226         rdev->num_running_ifaces += num;
1227         if (iftype == NL80211_IFTYPE_MONITOR)
1228                 rdev->num_running_monitor_ifaces += num;
1229 }
1230
1231 void __cfg80211_leave(struct cfg80211_registered_device *rdev,
1232                       struct wireless_dev *wdev)
1233 {
1234         struct net_device *dev = wdev->netdev;
1235         struct cfg80211_sched_scan_request *pos, *tmp;
1236
1237         lockdep_assert_held(&rdev->wiphy.mtx);
1238         ASSERT_WDEV_LOCK(wdev);
1239
1240         cfg80211_pmsr_wdev_down(wdev);
1241
1242         cfg80211_stop_background_radar_detection(wdev);
1243
1244         switch (wdev->iftype) {
1245         case NL80211_IFTYPE_ADHOC:
1246                 __cfg80211_leave_ibss(rdev, dev, true);
1247                 break;
1248         case NL80211_IFTYPE_P2P_CLIENT:
1249         case NL80211_IFTYPE_STATION:
1250                 list_for_each_entry_safe(pos, tmp, &rdev->sched_scan_req_list,
1251                                          list) {
1252                         if (dev == pos->dev)
1253                                 cfg80211_stop_sched_scan_req(rdev, pos, false);
1254                 }
1255
1256 #ifdef CONFIG_CFG80211_WEXT
1257                 kfree(wdev->wext.ie);
1258                 wdev->wext.ie = NULL;
1259                 wdev->wext.ie_len = 0;
1260                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
1261 #endif
1262                 cfg80211_disconnect(rdev, dev,
1263                                     WLAN_REASON_DEAUTH_LEAVING, true);
1264                 break;
1265         case NL80211_IFTYPE_MESH_POINT:
1266                 __cfg80211_leave_mesh(rdev, dev);
1267                 break;
1268         case NL80211_IFTYPE_AP:
1269         case NL80211_IFTYPE_P2P_GO:
1270                 __cfg80211_stop_ap(rdev, dev, -1, true);
1271                 break;
1272         case NL80211_IFTYPE_OCB:
1273                 __cfg80211_leave_ocb(rdev, dev);
1274                 break;
1275         case NL80211_IFTYPE_P2P_DEVICE:
1276         case NL80211_IFTYPE_NAN:
1277                 /* cannot happen, has no netdev */
1278                 break;
1279         case NL80211_IFTYPE_AP_VLAN:
1280         case NL80211_IFTYPE_MONITOR:
1281                 /* nothing to do */
1282                 break;
1283         case NL80211_IFTYPE_UNSPECIFIED:
1284         case NL80211_IFTYPE_WDS:
1285         case NUM_NL80211_IFTYPES:
1286                 /* invalid */
1287                 break;
1288         }
1289 }
1290
1291 void cfg80211_leave(struct cfg80211_registered_device *rdev,
1292                     struct wireless_dev *wdev)
1293 {
1294         wdev_lock(wdev);
1295         __cfg80211_leave(rdev, wdev);
1296         wdev_unlock(wdev);
1297 }
1298
1299 void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
1300                          gfp_t gfp)
1301 {
1302         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
1303         struct cfg80211_event *ev;
1304         unsigned long flags;
1305
1306         trace_cfg80211_stop_iface(wiphy, wdev);
1307
1308         ev = kzalloc(sizeof(*ev), gfp);
1309         if (!ev)
1310                 return;
1311
1312         ev->type = EVENT_STOPPED;
1313
1314         spin_lock_irqsave(&wdev->event_lock, flags);
1315         list_add_tail(&ev->list, &wdev->event_list);
1316         spin_unlock_irqrestore(&wdev->event_lock, flags);
1317         queue_work(cfg80211_wq, &rdev->event_work);
1318 }
1319 EXPORT_SYMBOL(cfg80211_stop_iface);
1320
1321 void cfg80211_init_wdev(struct wireless_dev *wdev)
1322 {
1323         mutex_init(&wdev->mtx);
1324         INIT_LIST_HEAD(&wdev->event_list);
1325         spin_lock_init(&wdev->event_lock);
1326         INIT_LIST_HEAD(&wdev->mgmt_registrations);
1327         INIT_LIST_HEAD(&wdev->pmsr_list);
1328         spin_lock_init(&wdev->pmsr_lock);
1329         INIT_WORK(&wdev->pmsr_free_wk, cfg80211_pmsr_free_wk);
1330
1331 #ifdef CONFIG_CFG80211_WEXT
1332         wdev->wext.default_key = -1;
1333         wdev->wext.default_mgmt_key = -1;
1334         wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
1335 #endif
1336
1337         if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
1338                 wdev->ps = true;
1339         else
1340                 wdev->ps = false;
1341         /* allow mac80211 to determine the timeout */
1342         wdev->ps_timeout = -1;
1343
1344         if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1345              wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
1346              wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
1347                 wdev->netdev->priv_flags |= IFF_DONT_BRIDGE;
1348
1349         INIT_WORK(&wdev->disconnect_wk, cfg80211_autodisconnect_wk);
1350 }
1351
1352 void cfg80211_register_wdev(struct cfg80211_registered_device *rdev,
1353                             struct wireless_dev *wdev)
1354 {
1355         ASSERT_RTNL();
1356         lockdep_assert_held(&rdev->wiphy.mtx);
1357
1358         /*
1359          * We get here also when the interface changes network namespaces,
1360          * as it's registered into the new one, but we don't want it to
1361          * change ID in that case. Checking if the ID is already assigned
1362          * works, because 0 isn't considered a valid ID and the memory is
1363          * 0-initialized.
1364          */
1365         if (!wdev->identifier)
1366                 wdev->identifier = ++rdev->wdev_id;
1367         list_add_rcu(&wdev->list, &rdev->wiphy.wdev_list);
1368         rdev->devlist_generation++;
1369         wdev->registered = true;
1370
1371         if (wdev->netdev &&
1372             sysfs_create_link(&wdev->netdev->dev.kobj, &rdev->wiphy.dev.kobj,
1373                               "phy80211"))
1374                 pr_err("failed to add phy80211 symlink to netdev!\n");
1375
1376         nl80211_notify_iface(rdev, wdev, NL80211_CMD_NEW_INTERFACE);
1377 }
1378
1379 int cfg80211_register_netdevice(struct net_device *dev)
1380 {
1381         struct wireless_dev *wdev = dev->ieee80211_ptr;
1382         struct cfg80211_registered_device *rdev;
1383         int ret;
1384
1385         ASSERT_RTNL();
1386
1387         if (WARN_ON(!wdev))
1388                 return -EINVAL;
1389
1390         rdev = wiphy_to_rdev(wdev->wiphy);
1391
1392         lockdep_assert_held(&rdev->wiphy.mtx);
1393
1394         /* we'll take care of this */
1395         wdev->registered = true;
1396         wdev->registering = true;
1397         ret = register_netdevice(dev);
1398         if (ret)
1399                 goto out;
1400
1401         cfg80211_register_wdev(rdev, wdev);
1402         ret = 0;
1403 out:
1404         wdev->registering = false;
1405         if (ret)
1406                 wdev->registered = false;
1407         return ret;
1408 }
1409 EXPORT_SYMBOL(cfg80211_register_netdevice);
1410
1411 static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
1412                                          unsigned long state, void *ptr)
1413 {
1414         struct net_device *dev = netdev_notifier_info_to_dev(ptr);
1415         struct wireless_dev *wdev = dev->ieee80211_ptr;
1416         struct cfg80211_registered_device *rdev;
1417         struct cfg80211_sched_scan_request *pos, *tmp;
1418
1419         if (!wdev)
1420                 return NOTIFY_DONE;
1421
1422         rdev = wiphy_to_rdev(wdev->wiphy);
1423
1424         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
1425
1426         switch (state) {
1427         case NETDEV_POST_INIT:
1428                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
1429                 wdev->netdev = dev;
1430                 /* can only change netns with wiphy */
1431                 dev->features |= NETIF_F_NETNS_LOCAL;
1432
1433                 cfg80211_init_wdev(wdev);
1434                 break;
1435         case NETDEV_REGISTER:
1436                 if (!wdev->registered) {
1437                         wiphy_lock(&rdev->wiphy);
1438                         cfg80211_register_wdev(rdev, wdev);
1439                         wiphy_unlock(&rdev->wiphy);
1440                 }
1441                 break;
1442         case NETDEV_UNREGISTER:
1443                 /*
1444                  * It is possible to get NETDEV_UNREGISTER multiple times,
1445                  * so check wdev->registered.
1446                  */
1447                 if (wdev->registered && !wdev->registering) {
1448                         wiphy_lock(&rdev->wiphy);
1449                         _cfg80211_unregister_wdev(wdev, false);
1450                         wiphy_unlock(&rdev->wiphy);
1451                 }
1452                 break;
1453         case NETDEV_GOING_DOWN:
1454                 wiphy_lock(&rdev->wiphy);
1455                 cfg80211_leave(rdev, wdev);
1456                 cfg80211_remove_links(wdev);
1457                 wiphy_unlock(&rdev->wiphy);
1458                 break;
1459         case NETDEV_DOWN:
1460                 wiphy_lock(&rdev->wiphy);
1461                 cfg80211_update_iface_num(rdev, wdev->iftype, -1);
1462                 if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
1463                         if (WARN_ON(!rdev->scan_req->notified &&
1464                                     (!rdev->int_scan_req ||
1465                                      !rdev->int_scan_req->notified)))
1466                                 rdev->scan_req->info.aborted = true;
1467                         ___cfg80211_scan_done(rdev, false);
1468                 }
1469
1470                 list_for_each_entry_safe(pos, tmp,
1471                                          &rdev->sched_scan_req_list, list) {
1472                         if (WARN_ON(pos->dev == wdev->netdev))
1473                                 cfg80211_stop_sched_scan_req(rdev, pos, false);
1474                 }
1475
1476                 rdev->opencount--;
1477                 wiphy_unlock(&rdev->wiphy);
1478                 wake_up(&rdev->dev_wait);
1479                 break;
1480         case NETDEV_UP:
1481                 wiphy_lock(&rdev->wiphy);
1482                 cfg80211_update_iface_num(rdev, wdev->iftype, 1);
1483                 wdev_lock(wdev);
1484                 switch (wdev->iftype) {
1485 #ifdef CONFIG_CFG80211_WEXT
1486                 case NL80211_IFTYPE_ADHOC:
1487                         cfg80211_ibss_wext_join(rdev, wdev);
1488                         break;
1489                 case NL80211_IFTYPE_STATION:
1490                         cfg80211_mgd_wext_connect(rdev, wdev);
1491                         break;
1492 #endif
1493 #ifdef CONFIG_MAC80211_MESH
1494                 case NL80211_IFTYPE_MESH_POINT:
1495                         {
1496                                 /* backward compat code... */
1497                                 struct mesh_setup setup;
1498                                 memcpy(&setup, &default_mesh_setup,
1499                                                 sizeof(setup));
1500                                  /* back compat only needed for mesh_id */
1501                                 setup.mesh_id = wdev->u.mesh.id;
1502                                 setup.mesh_id_len = wdev->u.mesh.id_up_len;
1503                                 if (wdev->u.mesh.id_up_len)
1504                                         __cfg80211_join_mesh(rdev, dev,
1505                                                         &setup,
1506                                                         &default_mesh_config);
1507                                 break;
1508                         }
1509 #endif
1510                 default:
1511                         break;
1512                 }
1513                 wdev_unlock(wdev);
1514                 rdev->opencount++;
1515
1516                 /*
1517                  * Configure power management to the driver here so that its
1518                  * correctly set also after interface type changes etc.
1519                  */
1520                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1521                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
1522                     rdev->ops->set_power_mgmt &&
1523                     rdev_set_power_mgmt(rdev, dev, wdev->ps,
1524                                         wdev->ps_timeout)) {
1525                         /* assume this means it's off */
1526                         wdev->ps = false;
1527                 }
1528                 wiphy_unlock(&rdev->wiphy);
1529                 break;
1530         case NETDEV_PRE_UP:
1531                 if (!cfg80211_iftype_allowed(wdev->wiphy, wdev->iftype,
1532                                              wdev->use_4addr, 0))
1533                         return notifier_from_errno(-EOPNOTSUPP);
1534
1535                 if (rfkill_blocked(rdev->wiphy.rfkill))
1536                         return notifier_from_errno(-ERFKILL);
1537                 break;
1538         default:
1539                 return NOTIFY_DONE;
1540         }
1541
1542         wireless_nlevent_flush();
1543
1544         return NOTIFY_OK;
1545 }
1546
1547 static struct notifier_block cfg80211_netdev_notifier = {
1548         .notifier_call = cfg80211_netdev_notifier_call,
1549 };
1550
1551 static void __net_exit cfg80211_pernet_exit(struct net *net)
1552 {
1553         struct cfg80211_registered_device *rdev;
1554
1555         rtnl_lock();
1556         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1557                 if (net_eq(wiphy_net(&rdev->wiphy), net))
1558                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
1559         }
1560         rtnl_unlock();
1561 }
1562
1563 static struct pernet_operations cfg80211_pernet_ops = {
1564         .exit = cfg80211_pernet_exit,
1565 };
1566
1567 static int __init cfg80211_init(void)
1568 {
1569         int err;
1570
1571         err = register_pernet_device(&cfg80211_pernet_ops);
1572         if (err)
1573                 goto out_fail_pernet;
1574
1575         err = wiphy_sysfs_init();
1576         if (err)
1577                 goto out_fail_sysfs;
1578
1579         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
1580         if (err)
1581                 goto out_fail_notifier;
1582
1583         err = nl80211_init();
1584         if (err)
1585                 goto out_fail_nl80211;
1586
1587         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
1588
1589         err = regulatory_init();
1590         if (err)
1591                 goto out_fail_reg;
1592
1593         cfg80211_wq = alloc_ordered_workqueue("cfg80211", WQ_MEM_RECLAIM);
1594         if (!cfg80211_wq) {
1595                 err = -ENOMEM;
1596                 goto out_fail_wq;
1597         }
1598
1599         return 0;
1600
1601 out_fail_wq:
1602         regulatory_exit();
1603 out_fail_reg:
1604         debugfs_remove(ieee80211_debugfs_dir);
1605         nl80211_exit();
1606 out_fail_nl80211:
1607         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1608 out_fail_notifier:
1609         wiphy_sysfs_exit();
1610 out_fail_sysfs:
1611         unregister_pernet_device(&cfg80211_pernet_ops);
1612 out_fail_pernet:
1613         return err;
1614 }
1615 fs_initcall(cfg80211_init);
1616
1617 static void __exit cfg80211_exit(void)
1618 {
1619         debugfs_remove(ieee80211_debugfs_dir);
1620         nl80211_exit();
1621         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1622         wiphy_sysfs_exit();
1623         regulatory_exit();
1624         unregister_pernet_device(&cfg80211_pernet_ops);
1625         destroy_workqueue(cfg80211_wq);
1626 }
1627 module_exit(cfg80211_exit);