Merge tag 'mac80211-next-for-davem-2015-10-05' of git://git.kernel.org/pub/scm/linux...
[firefly-linux-kernel-4.4.55.git] / net / wireless / core.c
1 /*
2  * This is the linux wireless configuration interface.
3  *
4  * Copyright 2006-2010          Johannes Berg <johannes@sipsolutions.net>
5  * Copyright 2013-2014  Intel Mobile Communications GmbH
6  */
7
8 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
9
10 #include <linux/if.h>
11 #include <linux/module.h>
12 #include <linux/err.h>
13 #include <linux/list.h>
14 #include <linux/slab.h>
15 #include <linux/nl80211.h>
16 #include <linux/debugfs.h>
17 #include <linux/notifier.h>
18 #include <linux/device.h>
19 #include <linux/etherdevice.h>
20 #include <linux/rtnetlink.h>
21 #include <linux/sched.h>
22 #include <net/genetlink.h>
23 #include <net/cfg80211.h>
24 #include "nl80211.h"
25 #include "core.h"
26 #include "sysfs.h"
27 #include "debugfs.h"
28 #include "wext-compat.h"
29 #include "rdev-ops.h"
30
31 /* name for sysfs, %d is appended */
32 #define PHY_NAME "phy"
33
34 MODULE_AUTHOR("Johannes Berg");
35 MODULE_LICENSE("GPL");
36 MODULE_DESCRIPTION("wireless configuration support");
37 MODULE_ALIAS_GENL_FAMILY(NL80211_GENL_NAME);
38
39 /* RCU-protected (and RTNL for writers) */
40 LIST_HEAD(cfg80211_rdev_list);
41 int cfg80211_rdev_list_generation;
42
43 /* for debugfs */
44 static struct dentry *ieee80211_debugfs_dir;
45
46 /* for the cleanup, scan and event works */
47 struct workqueue_struct *cfg80211_wq;
48
49 static bool cfg80211_disable_40mhz_24ghz;
50 module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
51 MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
52                  "Disable 40MHz support in the 2.4GHz band");
53
54 struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
55 {
56         struct cfg80211_registered_device *result = NULL, *rdev;
57
58         ASSERT_RTNL();
59
60         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
61                 if (rdev->wiphy_idx == wiphy_idx) {
62                         result = rdev;
63                         break;
64                 }
65         }
66
67         return result;
68 }
69
70 int get_wiphy_idx(struct wiphy *wiphy)
71 {
72         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
73
74         return rdev->wiphy_idx;
75 }
76
77 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
78 {
79         struct cfg80211_registered_device *rdev;
80
81         ASSERT_RTNL();
82
83         rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
84         if (!rdev)
85                 return NULL;
86         return &rdev->wiphy;
87 }
88
89 static int cfg80211_dev_check_name(struct cfg80211_registered_device *rdev,
90                                    const char *newname)
91 {
92         struct cfg80211_registered_device *rdev2;
93         int wiphy_idx, taken = -1, digits;
94
95         ASSERT_RTNL();
96
97         /* prohibit calling the thing phy%d when %d is not its number */
98         sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
99         if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
100                 /* count number of places needed to print wiphy_idx */
101                 digits = 1;
102                 while (wiphy_idx /= 10)
103                         digits++;
104                 /*
105                  * deny the name if it is phy<idx> where <idx> is printed
106                  * without leading zeroes. taken == strlen(newname) here
107                  */
108                 if (taken == strlen(PHY_NAME) + digits)
109                         return -EINVAL;
110         }
111
112         /* Ensure another device does not already have this name. */
113         list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
114                 if (strcmp(newname, wiphy_name(&rdev2->wiphy)) == 0)
115                         return -EINVAL;
116
117         return 0;
118 }
119
120 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
121                         char *newname)
122 {
123         int result;
124
125         ASSERT_RTNL();
126
127         /* Ignore nop renames */
128         if (strcmp(newname, wiphy_name(&rdev->wiphy)) == 0)
129                 return 0;
130
131         result = cfg80211_dev_check_name(rdev, newname);
132         if (result < 0)
133                 return result;
134
135         result = device_rename(&rdev->wiphy.dev, newname);
136         if (result)
137                 return result;
138
139         if (rdev->wiphy.debugfsdir &&
140             !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
141                             rdev->wiphy.debugfsdir,
142                             rdev->wiphy.debugfsdir->d_parent,
143                             newname))
144                 pr_err("failed to rename debugfs dir to %s!\n", newname);
145
146         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
147
148         return 0;
149 }
150
151 int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
152                           struct net *net)
153 {
154         struct wireless_dev *wdev;
155         int err = 0;
156
157         if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
158                 return -EOPNOTSUPP;
159
160         list_for_each_entry(wdev, &rdev->wdev_list, list) {
161                 if (!wdev->netdev)
162                         continue;
163                 wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
164                 err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
165                 if (err)
166                         break;
167                 wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
168         }
169
170         if (err) {
171                 /* failed -- clean up to old netns */
172                 net = wiphy_net(&rdev->wiphy);
173
174                 list_for_each_entry_continue_reverse(wdev, &rdev->wdev_list,
175                                                      list) {
176                         if (!wdev->netdev)
177                                 continue;
178                         wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
179                         err = dev_change_net_namespace(wdev->netdev, net,
180                                                         "wlan%d");
181                         WARN_ON(err);
182                         wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
183                 }
184
185                 return err;
186         }
187
188         wiphy_net_set(&rdev->wiphy, net);
189
190         err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
191         WARN_ON(err);
192
193         return 0;
194 }
195
196 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
197 {
198         struct cfg80211_registered_device *rdev = data;
199
200         rdev_rfkill_poll(rdev);
201 }
202
203 void cfg80211_stop_p2p_device(struct cfg80211_registered_device *rdev,
204                               struct wireless_dev *wdev)
205 {
206         ASSERT_RTNL();
207
208         if (WARN_ON(wdev->iftype != NL80211_IFTYPE_P2P_DEVICE))
209                 return;
210
211         if (!wdev->p2p_started)
212                 return;
213
214         rdev_stop_p2p_device(rdev, wdev);
215         wdev->p2p_started = false;
216
217         rdev->opencount--;
218
219         if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
220                 if (WARN_ON(!rdev->scan_req->notified))
221                         rdev->scan_req->aborted = true;
222                 ___cfg80211_scan_done(rdev, false);
223         }
224 }
225
226 void cfg80211_shutdown_all_interfaces(struct wiphy *wiphy)
227 {
228         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
229         struct wireless_dev *wdev;
230
231         ASSERT_RTNL();
232
233         list_for_each_entry(wdev, &rdev->wdev_list, list) {
234                 if (wdev->netdev) {
235                         dev_close(wdev->netdev);
236                         continue;
237                 }
238                 /* otherwise, check iftype */
239                 switch (wdev->iftype) {
240                 case NL80211_IFTYPE_P2P_DEVICE:
241                         cfg80211_stop_p2p_device(rdev, wdev);
242                         break;
243                 default:
244                         break;
245                 }
246         }
247 }
248 EXPORT_SYMBOL_GPL(cfg80211_shutdown_all_interfaces);
249
250 static int cfg80211_rfkill_set_block(void *data, bool blocked)
251 {
252         struct cfg80211_registered_device *rdev = data;
253
254         if (!blocked)
255                 return 0;
256
257         rtnl_lock();
258         cfg80211_shutdown_all_interfaces(&rdev->wiphy);
259         rtnl_unlock();
260
261         return 0;
262 }
263
264 static void cfg80211_rfkill_sync_work(struct work_struct *work)
265 {
266         struct cfg80211_registered_device *rdev;
267
268         rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
269         cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
270 }
271
272 static void cfg80211_event_work(struct work_struct *work)
273 {
274         struct cfg80211_registered_device *rdev;
275
276         rdev = container_of(work, struct cfg80211_registered_device,
277                             event_work);
278
279         rtnl_lock();
280         cfg80211_process_rdev_events(rdev);
281         rtnl_unlock();
282 }
283
284 void cfg80211_destroy_ifaces(struct cfg80211_registered_device *rdev)
285 {
286         struct cfg80211_iface_destroy *item;
287
288         ASSERT_RTNL();
289
290         spin_lock_irq(&rdev->destroy_list_lock);
291         while ((item = list_first_entry_or_null(&rdev->destroy_list,
292                                                 struct cfg80211_iface_destroy,
293                                                 list))) {
294                 struct wireless_dev *wdev, *tmp;
295                 u32 nlportid = item->nlportid;
296
297                 list_del(&item->list);
298                 kfree(item);
299                 spin_unlock_irq(&rdev->destroy_list_lock);
300
301                 list_for_each_entry_safe(wdev, tmp, &rdev->wdev_list, list) {
302                         if (nlportid == wdev->owner_nlportid)
303                                 rdev_del_virtual_intf(rdev, wdev);
304                 }
305
306                 spin_lock_irq(&rdev->destroy_list_lock);
307         }
308         spin_unlock_irq(&rdev->destroy_list_lock);
309 }
310
311 static void cfg80211_destroy_iface_wk(struct work_struct *work)
312 {
313         struct cfg80211_registered_device *rdev;
314
315         rdev = container_of(work, struct cfg80211_registered_device,
316                             destroy_work);
317
318         rtnl_lock();
319         cfg80211_destroy_ifaces(rdev);
320         rtnl_unlock();
321 }
322
323 static void cfg80211_sched_scan_stop_wk(struct work_struct *work)
324 {
325         struct cfg80211_registered_device *rdev;
326
327         rdev = container_of(work, struct cfg80211_registered_device,
328                            sched_scan_stop_wk);
329
330         rtnl_lock();
331
332         __cfg80211_stop_sched_scan(rdev, false);
333
334         rtnl_unlock();
335 }
336
337 /* exported functions */
338
339 struct wiphy *wiphy_new_nm(const struct cfg80211_ops *ops, int sizeof_priv,
340                            const char *requested_name)
341 {
342         static atomic_t wiphy_counter = ATOMIC_INIT(0);
343
344         struct cfg80211_registered_device *rdev;
345         int alloc_size;
346
347         WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
348         WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
349         WARN_ON(ops->connect && !ops->disconnect);
350         WARN_ON(ops->join_ibss && !ops->leave_ibss);
351         WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
352         WARN_ON(ops->add_station && !ops->del_station);
353         WARN_ON(ops->add_mpath && !ops->del_mpath);
354         WARN_ON(ops->join_mesh && !ops->leave_mesh);
355
356         alloc_size = sizeof(*rdev) + sizeof_priv;
357
358         rdev = kzalloc(alloc_size, GFP_KERNEL);
359         if (!rdev)
360                 return NULL;
361
362         rdev->ops = ops;
363
364         rdev->wiphy_idx = atomic_inc_return(&wiphy_counter);
365
366         if (unlikely(rdev->wiphy_idx < 0)) {
367                 /* ugh, wrapped! */
368                 atomic_dec(&wiphy_counter);
369                 kfree(rdev);
370                 return NULL;
371         }
372
373         /* atomic_inc_return makes it start at 1, make it start at 0 */
374         rdev->wiphy_idx--;
375
376         /* give it a proper name */
377         if (requested_name && requested_name[0]) {
378                 int rv;
379
380                 rtnl_lock();
381                 rv = cfg80211_dev_check_name(rdev, requested_name);
382
383                 if (rv < 0) {
384                         rtnl_unlock();
385                         goto use_default_name;
386                 }
387
388                 rv = dev_set_name(&rdev->wiphy.dev, "%s", requested_name);
389                 rtnl_unlock();
390                 if (rv)
391                         goto use_default_name;
392         } else {
393 use_default_name:
394                 /* NOTE:  This is *probably* safe w/out holding rtnl because of
395                  * the restrictions on phy names.  Probably this call could
396                  * fail if some other part of the kernel (re)named a device
397                  * phyX.  But, might should add some locking and check return
398                  * value, and use a different name if this one exists?
399                  */
400                 dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
401         }
402
403         INIT_LIST_HEAD(&rdev->wdev_list);
404         INIT_LIST_HEAD(&rdev->beacon_registrations);
405         spin_lock_init(&rdev->beacon_registrations_lock);
406         spin_lock_init(&rdev->bss_lock);
407         INIT_LIST_HEAD(&rdev->bss_list);
408         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
409         INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
410         INIT_LIST_HEAD(&rdev->mlme_unreg);
411         spin_lock_init(&rdev->mlme_unreg_lock);
412         INIT_WORK(&rdev->mlme_unreg_wk, cfg80211_mlme_unreg_wk);
413         INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
414                           cfg80211_dfs_channels_update_work);
415 #ifdef CONFIG_CFG80211_WEXT
416         rdev->wiphy.wext = &cfg80211_wext_handler;
417 #endif
418
419         device_initialize(&rdev->wiphy.dev);
420         rdev->wiphy.dev.class = &ieee80211_class;
421         rdev->wiphy.dev.platform_data = rdev;
422         device_enable_async_suspend(&rdev->wiphy.dev);
423
424         INIT_LIST_HEAD(&rdev->destroy_list);
425         spin_lock_init(&rdev->destroy_list_lock);
426         INIT_WORK(&rdev->destroy_work, cfg80211_destroy_iface_wk);
427         INIT_WORK(&rdev->sched_scan_stop_wk, cfg80211_sched_scan_stop_wk);
428
429 #ifdef CONFIG_CFG80211_DEFAULT_PS
430         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
431 #endif
432
433         wiphy_net_set(&rdev->wiphy, &init_net);
434
435         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
436         rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
437                                    &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
438                                    &rdev->rfkill_ops, rdev);
439
440         if (!rdev->rfkill) {
441                 kfree(rdev);
442                 return NULL;
443         }
444
445         INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
446         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
447         INIT_WORK(&rdev->event_work, cfg80211_event_work);
448
449         init_waitqueue_head(&rdev->dev_wait);
450
451         /*
452          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
453          * Fragmentation and RTS threshold are disabled by default with the
454          * special -1 value.
455          */
456         rdev->wiphy.retry_short = 7;
457         rdev->wiphy.retry_long = 4;
458         rdev->wiphy.frag_threshold = (u32) -1;
459         rdev->wiphy.rts_threshold = (u32) -1;
460         rdev->wiphy.coverage_class = 0;
461
462         rdev->wiphy.max_num_csa_counters = 1;
463
464         return &rdev->wiphy;
465 }
466 EXPORT_SYMBOL(wiphy_new_nm);
467
468 static int wiphy_verify_combinations(struct wiphy *wiphy)
469 {
470         const struct ieee80211_iface_combination *c;
471         int i, j;
472
473         for (i = 0; i < wiphy->n_iface_combinations; i++) {
474                 u32 cnt = 0;
475                 u16 all_iftypes = 0;
476
477                 c = &wiphy->iface_combinations[i];
478
479                 /*
480                  * Combinations with just one interface aren't real,
481                  * however we make an exception for DFS.
482                  */
483                 if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
484                         return -EINVAL;
485
486                 /* Need at least one channel */
487                 if (WARN_ON(!c->num_different_channels))
488                         return -EINVAL;
489
490                 /*
491                  * Put a sane limit on maximum number of different
492                  * channels to simplify channel accounting code.
493                  */
494                 if (WARN_ON(c->num_different_channels >
495                                 CFG80211_MAX_NUM_DIFFERENT_CHANNELS))
496                         return -EINVAL;
497
498                 /* DFS only works on one channel. */
499                 if (WARN_ON(c->radar_detect_widths &&
500                             (c->num_different_channels > 1)))
501                         return -EINVAL;
502
503                 if (WARN_ON(!c->n_limits))
504                         return -EINVAL;
505
506                 for (j = 0; j < c->n_limits; j++) {
507                         u16 types = c->limits[j].types;
508
509                         /* interface types shouldn't overlap */
510                         if (WARN_ON(types & all_iftypes))
511                                 return -EINVAL;
512                         all_iftypes |= types;
513
514                         if (WARN_ON(!c->limits[j].max))
515                                 return -EINVAL;
516
517                         /* Shouldn't list software iftypes in combinations! */
518                         if (WARN_ON(wiphy->software_iftypes & types))
519                                 return -EINVAL;
520
521                         /* Only a single P2P_DEVICE can be allowed */
522                         if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
523                                     c->limits[j].max > 1))
524                                 return -EINVAL;
525
526                         cnt += c->limits[j].max;
527                         /*
528                          * Don't advertise an unsupported type
529                          * in a combination.
530                          */
531                         if (WARN_ON((wiphy->interface_modes & types) != types))
532                                 return -EINVAL;
533                 }
534
535                 /* You can't even choose that many! */
536                 if (WARN_ON(cnt < c->max_interfaces))
537                         return -EINVAL;
538         }
539
540         return 0;
541 }
542
543 int wiphy_register(struct wiphy *wiphy)
544 {
545         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
546         int res;
547         enum ieee80211_band band;
548         struct ieee80211_supported_band *sband;
549         bool have_band = false;
550         int i;
551         u16 ifmodes = wiphy->interface_modes;
552
553 #ifdef CONFIG_PM
554         if (WARN_ON(wiphy->wowlan &&
555                     (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
556                     !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
557                 return -EINVAL;
558         if (WARN_ON(wiphy->wowlan &&
559                     !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
560                     !wiphy->wowlan->tcp))
561                 return -EINVAL;
562 #endif
563         if (WARN_ON((wiphy->features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH) &&
564                     (!rdev->ops->tdls_channel_switch ||
565                      !rdev->ops->tdls_cancel_channel_switch)))
566                 return -EINVAL;
567
568         /*
569          * if a wiphy has unsupported modes for regulatory channel enforcement,
570          * opt-out of enforcement checking
571          */
572         if (wiphy->interface_modes & ~(BIT(NL80211_IFTYPE_STATION) |
573                                        BIT(NL80211_IFTYPE_P2P_CLIENT) |
574                                        BIT(NL80211_IFTYPE_AP) |
575                                        BIT(NL80211_IFTYPE_P2P_GO) |
576                                        BIT(NL80211_IFTYPE_ADHOC) |
577                                        BIT(NL80211_IFTYPE_P2P_DEVICE) |
578                                        BIT(NL80211_IFTYPE_AP_VLAN) |
579                                        BIT(NL80211_IFTYPE_MONITOR)))
580                 wiphy->regulatory_flags |= REGULATORY_IGNORE_STALE_KICKOFF;
581
582         if (WARN_ON((wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED) &&
583                     (wiphy->regulatory_flags &
584                                         (REGULATORY_CUSTOM_REG |
585                                          REGULATORY_STRICT_REG |
586                                          REGULATORY_COUNTRY_IE_FOLLOW_POWER |
587                                          REGULATORY_COUNTRY_IE_IGNORE))))
588                 return -EINVAL;
589
590         if (WARN_ON(wiphy->coalesce &&
591                     (!wiphy->coalesce->n_rules ||
592                      !wiphy->coalesce->n_patterns) &&
593                     (!wiphy->coalesce->pattern_min_len ||
594                      wiphy->coalesce->pattern_min_len >
595                         wiphy->coalesce->pattern_max_len)))
596                 return -EINVAL;
597
598         if (WARN_ON(wiphy->ap_sme_capa &&
599                     !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
600                 return -EINVAL;
601
602         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
603                 return -EINVAL;
604
605         if (WARN_ON(wiphy->addresses &&
606                     !is_zero_ether_addr(wiphy->perm_addr) &&
607                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
608                            ETH_ALEN)))
609                 return -EINVAL;
610
611         if (WARN_ON(wiphy->max_acl_mac_addrs &&
612                     (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
613                      !rdev->ops->set_mac_acl)))
614                 return -EINVAL;
615
616         if (wiphy->addresses)
617                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
618
619         /* sanity check ifmodes */
620         WARN_ON(!ifmodes);
621         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
622         if (WARN_ON(ifmodes != wiphy->interface_modes))
623                 wiphy->interface_modes = ifmodes;
624
625         res = wiphy_verify_combinations(wiphy);
626         if (res)
627                 return res;
628
629         /* sanity check supported bands/channels */
630         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
631                 sband = wiphy->bands[band];
632                 if (!sband)
633                         continue;
634
635                 sband->band = band;
636                 if (WARN_ON(!sband->n_channels))
637                         return -EINVAL;
638                 /*
639                  * on 60gHz band, there are no legacy rates, so
640                  * n_bitrates is 0
641                  */
642                 if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
643                             !sband->n_bitrates))
644                         return -EINVAL;
645
646                 /*
647                  * Since cfg80211_disable_40mhz_24ghz is global, we can
648                  * modify the sband's ht data even if the driver uses a
649                  * global structure for that.
650                  */
651                 if (cfg80211_disable_40mhz_24ghz &&
652                     band == IEEE80211_BAND_2GHZ &&
653                     sband->ht_cap.ht_supported) {
654                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
655                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
656                 }
657
658                 /*
659                  * Since we use a u32 for rate bitmaps in
660                  * ieee80211_get_response_rate, we cannot
661                  * have more than 32 legacy rates.
662                  */
663                 if (WARN_ON(sband->n_bitrates > 32))
664                         return -EINVAL;
665
666                 for (i = 0; i < sband->n_channels; i++) {
667                         sband->channels[i].orig_flags =
668                                 sband->channels[i].flags;
669                         sband->channels[i].orig_mag = INT_MAX;
670                         sband->channels[i].orig_mpwr =
671                                 sband->channels[i].max_power;
672                         sband->channels[i].band = band;
673                 }
674
675                 have_band = true;
676         }
677
678         if (!have_band) {
679                 WARN_ON(1);
680                 return -EINVAL;
681         }
682
683 #ifdef CONFIG_PM
684         if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
685                     (!rdev->wiphy.wowlan->pattern_min_len ||
686                      rdev->wiphy.wowlan->pattern_min_len >
687                                 rdev->wiphy.wowlan->pattern_max_len)))
688                 return -EINVAL;
689 #endif
690
691         /* check and set up bitrates */
692         ieee80211_set_bitrate_flags(wiphy);
693
694         rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
695
696         rtnl_lock();
697         res = device_add(&rdev->wiphy.dev);
698         if (res) {
699                 rtnl_unlock();
700                 return res;
701         }
702
703         /* set up regulatory info */
704         wiphy_regulatory_register(wiphy);
705
706         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
707         cfg80211_rdev_list_generation++;
708
709         /* add to debugfs */
710         rdev->wiphy.debugfsdir =
711                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
712                                    ieee80211_debugfs_dir);
713         if (IS_ERR(rdev->wiphy.debugfsdir))
714                 rdev->wiphy.debugfsdir = NULL;
715
716         cfg80211_debugfs_rdev_add(rdev);
717         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
718
719         if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
720                 struct regulatory_request request;
721
722                 request.wiphy_idx = get_wiphy_idx(wiphy);
723                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
724                 request.alpha2[0] = '9';
725                 request.alpha2[1] = '9';
726
727                 nl80211_send_reg_change_event(&request);
728         }
729
730         rdev->wiphy.registered = true;
731         rtnl_unlock();
732
733         res = rfkill_register(rdev->rfkill);
734         if (res) {
735                 rfkill_destroy(rdev->rfkill);
736                 rdev->rfkill = NULL;
737                 wiphy_unregister(&rdev->wiphy);
738                 return res;
739         }
740
741         return 0;
742 }
743 EXPORT_SYMBOL(wiphy_register);
744
745 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
746 {
747         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
748
749         if (!rdev->ops->rfkill_poll)
750                 return;
751         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
752         rfkill_resume_polling(rdev->rfkill);
753 }
754 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
755
756 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
757 {
758         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
759
760         rfkill_pause_polling(rdev->rfkill);
761 }
762 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
763
764 void wiphy_unregister(struct wiphy *wiphy)
765 {
766         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
767
768         wait_event(rdev->dev_wait, ({
769                 int __count;
770                 rtnl_lock();
771                 __count = rdev->opencount;
772                 rtnl_unlock();
773                 __count == 0; }));
774
775         if (rdev->rfkill)
776                 rfkill_unregister(rdev->rfkill);
777
778         rtnl_lock();
779         nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
780         rdev->wiphy.registered = false;
781
782         WARN_ON(!list_empty(&rdev->wdev_list));
783
784         /*
785          * First remove the hardware from everywhere, this makes
786          * it impossible to find from userspace.
787          */
788         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
789         list_del_rcu(&rdev->list);
790         synchronize_rcu();
791
792         /*
793          * If this device got a regulatory hint tell core its
794          * free to listen now to a new shiny device regulatory hint
795          */
796         wiphy_regulatory_deregister(wiphy);
797
798         cfg80211_rdev_list_generation++;
799         device_del(&rdev->wiphy.dev);
800
801         rtnl_unlock();
802
803         flush_work(&rdev->scan_done_wk);
804         cancel_work_sync(&rdev->conn_work);
805         flush_work(&rdev->event_work);
806         cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
807         flush_work(&rdev->destroy_work);
808         flush_work(&rdev->sched_scan_stop_wk);
809         flush_work(&rdev->mlme_unreg_wk);
810
811 #ifdef CONFIG_PM
812         if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
813                 rdev_set_wakeup(rdev, false);
814 #endif
815         cfg80211_rdev_free_wowlan(rdev);
816         cfg80211_rdev_free_coalesce(rdev);
817 }
818 EXPORT_SYMBOL(wiphy_unregister);
819
820 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
821 {
822         struct cfg80211_internal_bss *scan, *tmp;
823         struct cfg80211_beacon_registration *reg, *treg;
824         rfkill_destroy(rdev->rfkill);
825         list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
826                 list_del(&reg->list);
827                 kfree(reg);
828         }
829         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
830                 cfg80211_put_bss(&rdev->wiphy, &scan->pub);
831         kfree(rdev);
832 }
833
834 void wiphy_free(struct wiphy *wiphy)
835 {
836         put_device(&wiphy->dev);
837 }
838 EXPORT_SYMBOL(wiphy_free);
839
840 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
841 {
842         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
843
844         if (rfkill_set_hw_state(rdev->rfkill, blocked))
845                 schedule_work(&rdev->rfkill_sync);
846 }
847 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
848
849 void cfg80211_unregister_wdev(struct wireless_dev *wdev)
850 {
851         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
852
853         ASSERT_RTNL();
854
855         if (WARN_ON(wdev->netdev))
856                 return;
857
858         list_del_rcu(&wdev->list);
859         rdev->devlist_generation++;
860
861         switch (wdev->iftype) {
862         case NL80211_IFTYPE_P2P_DEVICE:
863                 cfg80211_mlme_purge_registrations(wdev);
864                 cfg80211_stop_p2p_device(rdev, wdev);
865                 break;
866         default:
867                 WARN_ON_ONCE(1);
868                 break;
869         }
870 }
871 EXPORT_SYMBOL(cfg80211_unregister_wdev);
872
873 static const struct device_type wiphy_type = {
874         .name   = "wlan",
875 };
876
877 void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
878                                enum nl80211_iftype iftype, int num)
879 {
880         ASSERT_RTNL();
881
882         rdev->num_running_ifaces += num;
883         if (iftype == NL80211_IFTYPE_MONITOR)
884                 rdev->num_running_monitor_ifaces += num;
885 }
886
887 void __cfg80211_leave(struct cfg80211_registered_device *rdev,
888                       struct wireless_dev *wdev)
889 {
890         struct net_device *dev = wdev->netdev;
891         struct cfg80211_sched_scan_request *sched_scan_req;
892
893         ASSERT_RTNL();
894         ASSERT_WDEV_LOCK(wdev);
895
896         switch (wdev->iftype) {
897         case NL80211_IFTYPE_ADHOC:
898                 __cfg80211_leave_ibss(rdev, dev, true);
899                 break;
900         case NL80211_IFTYPE_P2P_CLIENT:
901         case NL80211_IFTYPE_STATION:
902                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
903                 if (sched_scan_req && dev == sched_scan_req->dev)
904                         __cfg80211_stop_sched_scan(rdev, false);
905
906 #ifdef CONFIG_CFG80211_WEXT
907                 kfree(wdev->wext.ie);
908                 wdev->wext.ie = NULL;
909                 wdev->wext.ie_len = 0;
910                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
911 #endif
912                 cfg80211_disconnect(rdev, dev,
913                                     WLAN_REASON_DEAUTH_LEAVING, true);
914                 break;
915         case NL80211_IFTYPE_MESH_POINT:
916                 __cfg80211_leave_mesh(rdev, dev);
917                 break;
918         case NL80211_IFTYPE_AP:
919         case NL80211_IFTYPE_P2P_GO:
920                 __cfg80211_stop_ap(rdev, dev, true);
921                 break;
922         case NL80211_IFTYPE_OCB:
923                 __cfg80211_leave_ocb(rdev, dev);
924                 break;
925         case NL80211_IFTYPE_WDS:
926                 /* must be handled by mac80211/driver, has no APIs */
927                 break;
928         case NL80211_IFTYPE_P2P_DEVICE:
929                 /* cannot happen, has no netdev */
930                 break;
931         case NL80211_IFTYPE_AP_VLAN:
932         case NL80211_IFTYPE_MONITOR:
933                 /* nothing to do */
934                 break;
935         case NL80211_IFTYPE_UNSPECIFIED:
936         case NUM_NL80211_IFTYPES:
937                 /* invalid */
938                 break;
939         }
940 }
941
942 void cfg80211_leave(struct cfg80211_registered_device *rdev,
943                     struct wireless_dev *wdev)
944 {
945         wdev_lock(wdev);
946         __cfg80211_leave(rdev, wdev);
947         wdev_unlock(wdev);
948 }
949
950 void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
951                          gfp_t gfp)
952 {
953         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
954         struct cfg80211_event *ev;
955         unsigned long flags;
956
957         trace_cfg80211_stop_iface(wiphy, wdev);
958
959         ev = kzalloc(sizeof(*ev), gfp);
960         if (!ev)
961                 return;
962
963         ev->type = EVENT_STOPPED;
964
965         spin_lock_irqsave(&wdev->event_lock, flags);
966         list_add_tail(&ev->list, &wdev->event_list);
967         spin_unlock_irqrestore(&wdev->event_lock, flags);
968         queue_work(cfg80211_wq, &rdev->event_work);
969 }
970 EXPORT_SYMBOL(cfg80211_stop_iface);
971
972 static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
973                                          unsigned long state, void *ptr)
974 {
975         struct net_device *dev = netdev_notifier_info_to_dev(ptr);
976         struct wireless_dev *wdev = dev->ieee80211_ptr;
977         struct cfg80211_registered_device *rdev;
978         struct cfg80211_sched_scan_request *sched_scan_req;
979
980         if (!wdev)
981                 return NOTIFY_DONE;
982
983         rdev = wiphy_to_rdev(wdev->wiphy);
984
985         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
986
987         switch (state) {
988         case NETDEV_POST_INIT:
989                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
990                 break;
991         case NETDEV_REGISTER:
992                 /*
993                  * NB: cannot take rdev->mtx here because this may be
994                  * called within code protected by it when interfaces
995                  * are added with nl80211.
996                  */
997                 mutex_init(&wdev->mtx);
998                 INIT_LIST_HEAD(&wdev->event_list);
999                 spin_lock_init(&wdev->event_lock);
1000                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
1001                 spin_lock_init(&wdev->mgmt_registrations_lock);
1002
1003                 wdev->identifier = ++rdev->wdev_id;
1004                 list_add_rcu(&wdev->list, &rdev->wdev_list);
1005                 rdev->devlist_generation++;
1006                 /* can only change netns with wiphy */
1007                 dev->features |= NETIF_F_NETNS_LOCAL;
1008
1009                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
1010                                       "phy80211")) {
1011                         pr_err("failed to add phy80211 symlink to netdev!\n");
1012                 }
1013                 wdev->netdev = dev;
1014 #ifdef CONFIG_CFG80211_WEXT
1015                 wdev->wext.default_key = -1;
1016                 wdev->wext.default_mgmt_key = -1;
1017                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
1018 #endif
1019
1020                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
1021                         wdev->ps = true;
1022                 else
1023                         wdev->ps = false;
1024                 /* allow mac80211 to determine the timeout */
1025                 wdev->ps_timeout = -1;
1026
1027                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1028                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
1029                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
1030                         dev->priv_flags |= IFF_DONT_BRIDGE;
1031                 break;
1032         case NETDEV_GOING_DOWN:
1033                 cfg80211_leave(rdev, wdev);
1034                 break;
1035         case NETDEV_DOWN:
1036                 cfg80211_update_iface_num(rdev, wdev->iftype, -1);
1037                 if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
1038                         if (WARN_ON(!rdev->scan_req->notified))
1039                                 rdev->scan_req->aborted = true;
1040                         ___cfg80211_scan_done(rdev, false);
1041                 }
1042
1043                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
1044                 if (WARN_ON(sched_scan_req &&
1045                             sched_scan_req->dev == wdev->netdev)) {
1046                         __cfg80211_stop_sched_scan(rdev, false);
1047                 }
1048
1049                 rdev->opencount--;
1050                 wake_up(&rdev->dev_wait);
1051                 break;
1052         case NETDEV_UP:
1053                 cfg80211_update_iface_num(rdev, wdev->iftype, 1);
1054                 wdev_lock(wdev);
1055                 switch (wdev->iftype) {
1056 #ifdef CONFIG_CFG80211_WEXT
1057                 case NL80211_IFTYPE_ADHOC:
1058                         cfg80211_ibss_wext_join(rdev, wdev);
1059                         break;
1060                 case NL80211_IFTYPE_STATION:
1061                         cfg80211_mgd_wext_connect(rdev, wdev);
1062                         break;
1063 #endif
1064 #ifdef CONFIG_MAC80211_MESH
1065                 case NL80211_IFTYPE_MESH_POINT:
1066                         {
1067                                 /* backward compat code... */
1068                                 struct mesh_setup setup;
1069                                 memcpy(&setup, &default_mesh_setup,
1070                                                 sizeof(setup));
1071                                  /* back compat only needed for mesh_id */
1072                                 setup.mesh_id = wdev->ssid;
1073                                 setup.mesh_id_len = wdev->mesh_id_up_len;
1074                                 if (wdev->mesh_id_up_len)
1075                                         __cfg80211_join_mesh(rdev, dev,
1076                                                         &setup,
1077                                                         &default_mesh_config);
1078                                 break;
1079                         }
1080 #endif
1081                 default:
1082                         break;
1083                 }
1084                 wdev_unlock(wdev);
1085                 rdev->opencount++;
1086
1087                 /*
1088                  * Configure power management to the driver here so that its
1089                  * correctly set also after interface type changes etc.
1090                  */
1091                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1092                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
1093                     rdev->ops->set_power_mgmt)
1094                         if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
1095                                                 wdev->ps_timeout)) {
1096                                 /* assume this means it's off */
1097                                 wdev->ps = false;
1098                         }
1099                 break;
1100         case NETDEV_UNREGISTER:
1101                 /*
1102                  * It is possible to get NETDEV_UNREGISTER
1103                  * multiple times. To detect that, check
1104                  * that the interface is still on the list
1105                  * of registered interfaces, and only then
1106                  * remove and clean it up.
1107                  */
1108                 if (!list_empty(&wdev->list)) {
1109                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
1110                         list_del_rcu(&wdev->list);
1111                         rdev->devlist_generation++;
1112                         cfg80211_mlme_purge_registrations(wdev);
1113 #ifdef CONFIG_CFG80211_WEXT
1114                         kzfree(wdev->wext.keys);
1115 #endif
1116                 }
1117                 /*
1118                  * synchronise (so that we won't find this netdev
1119                  * from other code any more) and then clear the list
1120                  * head so that the above code can safely check for
1121                  * !list_empty() to avoid double-cleanup.
1122                  */
1123                 synchronize_rcu();
1124                 INIT_LIST_HEAD(&wdev->list);
1125                 /*
1126                  * Ensure that all events have been processed and
1127                  * freed.
1128                  */
1129                 cfg80211_process_wdev_events(wdev);
1130
1131                 if (WARN_ON(wdev->current_bss)) {
1132                         cfg80211_unhold_bss(wdev->current_bss);
1133                         cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
1134                         wdev->current_bss = NULL;
1135                 }
1136                 break;
1137         case NETDEV_PRE_UP:
1138                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
1139                         return notifier_from_errno(-EOPNOTSUPP);
1140                 if (rfkill_blocked(rdev->rfkill))
1141                         return notifier_from_errno(-ERFKILL);
1142                 break;
1143         default:
1144                 return NOTIFY_DONE;
1145         }
1146
1147         return NOTIFY_OK;
1148 }
1149
1150 static struct notifier_block cfg80211_netdev_notifier = {
1151         .notifier_call = cfg80211_netdev_notifier_call,
1152 };
1153
1154 static void __net_exit cfg80211_pernet_exit(struct net *net)
1155 {
1156         struct cfg80211_registered_device *rdev;
1157
1158         rtnl_lock();
1159         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1160                 if (net_eq(wiphy_net(&rdev->wiphy), net))
1161                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
1162         }
1163         rtnl_unlock();
1164 }
1165
1166 static struct pernet_operations cfg80211_pernet_ops = {
1167         .exit = cfg80211_pernet_exit,
1168 };
1169
1170 static int __init cfg80211_init(void)
1171 {
1172         int err;
1173
1174         err = register_pernet_device(&cfg80211_pernet_ops);
1175         if (err)
1176                 goto out_fail_pernet;
1177
1178         err = wiphy_sysfs_init();
1179         if (err)
1180                 goto out_fail_sysfs;
1181
1182         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
1183         if (err)
1184                 goto out_fail_notifier;
1185
1186         err = nl80211_init();
1187         if (err)
1188                 goto out_fail_nl80211;
1189
1190         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
1191
1192         err = regulatory_init();
1193         if (err)
1194                 goto out_fail_reg;
1195
1196         cfg80211_wq = create_singlethread_workqueue("cfg80211");
1197         if (!cfg80211_wq) {
1198                 err = -ENOMEM;
1199                 goto out_fail_wq;
1200         }
1201
1202         return 0;
1203
1204 out_fail_wq:
1205         regulatory_exit();
1206 out_fail_reg:
1207         debugfs_remove(ieee80211_debugfs_dir);
1208         nl80211_exit();
1209 out_fail_nl80211:
1210         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1211 out_fail_notifier:
1212         wiphy_sysfs_exit();
1213 out_fail_sysfs:
1214         unregister_pernet_device(&cfg80211_pernet_ops);
1215 out_fail_pernet:
1216         return err;
1217 }
1218 subsys_initcall(cfg80211_init);
1219
1220 static void __exit cfg80211_exit(void)
1221 {
1222         debugfs_remove(ieee80211_debugfs_dir);
1223         nl80211_exit();
1224         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1225         wiphy_sysfs_exit();
1226         regulatory_exit();
1227         unregister_pernet_device(&cfg80211_pernet_ops);
1228         destroy_workqueue(cfg80211_wq);
1229 }
1230 module_exit(cfg80211_exit);