Merge tag 'mac80211-next-for-davem-2016-04-13' of git://git.kernel.org/pub/scm/linux...
[cascardo/linux.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         WARN_ON(ops->start_p2p_device && !ops->stop_p2p_device);
356         WARN_ON(ops->start_ap && !ops->stop_ap);
357         WARN_ON(ops->join_ocb && !ops->leave_ocb);
358         WARN_ON(ops->suspend && !ops->resume);
359         WARN_ON(ops->sched_scan_start && !ops->sched_scan_stop);
360         WARN_ON(ops->remain_on_channel && !ops->cancel_remain_on_channel);
361         WARN_ON(ops->tdls_channel_switch && !ops->tdls_cancel_channel_switch);
362         WARN_ON(ops->add_tx_ts && !ops->del_tx_ts);
363         WARN_ON(ops->set_tx_power && !ops->get_tx_power);
364         WARN_ON(ops->set_antenna && !ops->get_antenna);
365
366         alloc_size = sizeof(*rdev) + sizeof_priv;
367
368         rdev = kzalloc(alloc_size, GFP_KERNEL);
369         if (!rdev)
370                 return NULL;
371
372         rdev->ops = ops;
373
374         rdev->wiphy_idx = atomic_inc_return(&wiphy_counter);
375
376         if (unlikely(rdev->wiphy_idx < 0)) {
377                 /* ugh, wrapped! */
378                 atomic_dec(&wiphy_counter);
379                 kfree(rdev);
380                 return NULL;
381         }
382
383         /* atomic_inc_return makes it start at 1, make it start at 0 */
384         rdev->wiphy_idx--;
385
386         /* give it a proper name */
387         if (requested_name && requested_name[0]) {
388                 int rv;
389
390                 rtnl_lock();
391                 rv = cfg80211_dev_check_name(rdev, requested_name);
392
393                 if (rv < 0) {
394                         rtnl_unlock();
395                         goto use_default_name;
396                 }
397
398                 rv = dev_set_name(&rdev->wiphy.dev, "%s", requested_name);
399                 rtnl_unlock();
400                 if (rv)
401                         goto use_default_name;
402         } else {
403 use_default_name:
404                 /* NOTE:  This is *probably* safe w/out holding rtnl because of
405                  * the restrictions on phy names.  Probably this call could
406                  * fail if some other part of the kernel (re)named a device
407                  * phyX.  But, might should add some locking and check return
408                  * value, and use a different name if this one exists?
409                  */
410                 dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
411         }
412
413         INIT_LIST_HEAD(&rdev->wdev_list);
414         INIT_LIST_HEAD(&rdev->beacon_registrations);
415         spin_lock_init(&rdev->beacon_registrations_lock);
416         spin_lock_init(&rdev->bss_lock);
417         INIT_LIST_HEAD(&rdev->bss_list);
418         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
419         INIT_WORK(&rdev->sched_scan_results_wk, __cfg80211_sched_scan_results);
420         INIT_LIST_HEAD(&rdev->mlme_unreg);
421         spin_lock_init(&rdev->mlme_unreg_lock);
422         INIT_WORK(&rdev->mlme_unreg_wk, cfg80211_mlme_unreg_wk);
423         INIT_DELAYED_WORK(&rdev->dfs_update_channels_wk,
424                           cfg80211_dfs_channels_update_work);
425 #ifdef CONFIG_CFG80211_WEXT
426         rdev->wiphy.wext = &cfg80211_wext_handler;
427 #endif
428
429         device_initialize(&rdev->wiphy.dev);
430         rdev->wiphy.dev.class = &ieee80211_class;
431         rdev->wiphy.dev.platform_data = rdev;
432         device_enable_async_suspend(&rdev->wiphy.dev);
433
434         INIT_LIST_HEAD(&rdev->destroy_list);
435         spin_lock_init(&rdev->destroy_list_lock);
436         INIT_WORK(&rdev->destroy_work, cfg80211_destroy_iface_wk);
437         INIT_WORK(&rdev->sched_scan_stop_wk, cfg80211_sched_scan_stop_wk);
438
439 #ifdef CONFIG_CFG80211_DEFAULT_PS
440         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
441 #endif
442
443         wiphy_net_set(&rdev->wiphy, &init_net);
444
445         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
446         rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
447                                    &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
448                                    &rdev->rfkill_ops, rdev);
449
450         if (!rdev->rfkill) {
451                 kfree(rdev);
452                 return NULL;
453         }
454
455         INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
456         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
457         INIT_WORK(&rdev->event_work, cfg80211_event_work);
458
459         init_waitqueue_head(&rdev->dev_wait);
460
461         /*
462          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
463          * Fragmentation and RTS threshold are disabled by default with the
464          * special -1 value.
465          */
466         rdev->wiphy.retry_short = 7;
467         rdev->wiphy.retry_long = 4;
468         rdev->wiphy.frag_threshold = (u32) -1;
469         rdev->wiphy.rts_threshold = (u32) -1;
470         rdev->wiphy.coverage_class = 0;
471
472         rdev->wiphy.max_num_csa_counters = 1;
473
474         rdev->wiphy.max_sched_scan_plans = 1;
475         rdev->wiphy.max_sched_scan_plan_interval = U32_MAX;
476
477         return &rdev->wiphy;
478 }
479 EXPORT_SYMBOL(wiphy_new_nm);
480
481 static int wiphy_verify_combinations(struct wiphy *wiphy)
482 {
483         const struct ieee80211_iface_combination *c;
484         int i, j;
485
486         for (i = 0; i < wiphy->n_iface_combinations; i++) {
487                 u32 cnt = 0;
488                 u16 all_iftypes = 0;
489
490                 c = &wiphy->iface_combinations[i];
491
492                 /*
493                  * Combinations with just one interface aren't real,
494                  * however we make an exception for DFS.
495                  */
496                 if (WARN_ON((c->max_interfaces < 2) && !c->radar_detect_widths))
497                         return -EINVAL;
498
499                 /* Need at least one channel */
500                 if (WARN_ON(!c->num_different_channels))
501                         return -EINVAL;
502
503                 /*
504                  * Put a sane limit on maximum number of different
505                  * channels to simplify channel accounting code.
506                  */
507                 if (WARN_ON(c->num_different_channels >
508                                 CFG80211_MAX_NUM_DIFFERENT_CHANNELS))
509                         return -EINVAL;
510
511                 /* DFS only works on one channel. */
512                 if (WARN_ON(c->radar_detect_widths &&
513                             (c->num_different_channels > 1)))
514                         return -EINVAL;
515
516                 if (WARN_ON(!c->n_limits))
517                         return -EINVAL;
518
519                 for (j = 0; j < c->n_limits; j++) {
520                         u16 types = c->limits[j].types;
521
522                         /* interface types shouldn't overlap */
523                         if (WARN_ON(types & all_iftypes))
524                                 return -EINVAL;
525                         all_iftypes |= types;
526
527                         if (WARN_ON(!c->limits[j].max))
528                                 return -EINVAL;
529
530                         /* Shouldn't list software iftypes in combinations! */
531                         if (WARN_ON(wiphy->software_iftypes & types))
532                                 return -EINVAL;
533
534                         /* Only a single P2P_DEVICE can be allowed */
535                         if (WARN_ON(types & BIT(NL80211_IFTYPE_P2P_DEVICE) &&
536                                     c->limits[j].max > 1))
537                                 return -EINVAL;
538
539                         cnt += c->limits[j].max;
540                         /*
541                          * Don't advertise an unsupported type
542                          * in a combination.
543                          */
544                         if (WARN_ON((wiphy->interface_modes & types) != types))
545                                 return -EINVAL;
546                 }
547
548                 /* You can't even choose that many! */
549                 if (WARN_ON(cnt < c->max_interfaces))
550                         return -EINVAL;
551         }
552
553         return 0;
554 }
555
556 int wiphy_register(struct wiphy *wiphy)
557 {
558         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
559         int res;
560         enum nl80211_band band;
561         struct ieee80211_supported_band *sband;
562         bool have_band = false;
563         int i;
564         u16 ifmodes = wiphy->interface_modes;
565
566 #ifdef CONFIG_PM
567         if (WARN_ON(wiphy->wowlan &&
568                     (wiphy->wowlan->flags & WIPHY_WOWLAN_GTK_REKEY_FAILURE) &&
569                     !(wiphy->wowlan->flags & WIPHY_WOWLAN_SUPPORTS_GTK_REKEY)))
570                 return -EINVAL;
571         if (WARN_ON(wiphy->wowlan &&
572                     !wiphy->wowlan->flags && !wiphy->wowlan->n_patterns &&
573                     !wiphy->wowlan->tcp))
574                 return -EINVAL;
575 #endif
576         if (WARN_ON((wiphy->features & NL80211_FEATURE_TDLS_CHANNEL_SWITCH) &&
577                     (!rdev->ops->tdls_channel_switch ||
578                      !rdev->ops->tdls_cancel_channel_switch)))
579                 return -EINVAL;
580
581         /*
582          * if a wiphy has unsupported modes for regulatory channel enforcement,
583          * opt-out of enforcement checking
584          */
585         if (wiphy->interface_modes & ~(BIT(NL80211_IFTYPE_STATION) |
586                                        BIT(NL80211_IFTYPE_P2P_CLIENT) |
587                                        BIT(NL80211_IFTYPE_AP) |
588                                        BIT(NL80211_IFTYPE_P2P_GO) |
589                                        BIT(NL80211_IFTYPE_ADHOC) |
590                                        BIT(NL80211_IFTYPE_P2P_DEVICE) |
591                                        BIT(NL80211_IFTYPE_AP_VLAN) |
592                                        BIT(NL80211_IFTYPE_MONITOR)))
593                 wiphy->regulatory_flags |= REGULATORY_IGNORE_STALE_KICKOFF;
594
595         if (WARN_ON((wiphy->regulatory_flags & REGULATORY_WIPHY_SELF_MANAGED) &&
596                     (wiphy->regulatory_flags &
597                                         (REGULATORY_CUSTOM_REG |
598                                          REGULATORY_STRICT_REG |
599                                          REGULATORY_COUNTRY_IE_FOLLOW_POWER |
600                                          REGULATORY_COUNTRY_IE_IGNORE))))
601                 return -EINVAL;
602
603         if (WARN_ON(wiphy->coalesce &&
604                     (!wiphy->coalesce->n_rules ||
605                      !wiphy->coalesce->n_patterns) &&
606                     (!wiphy->coalesce->pattern_min_len ||
607                      wiphy->coalesce->pattern_min_len >
608                         wiphy->coalesce->pattern_max_len)))
609                 return -EINVAL;
610
611         if (WARN_ON(wiphy->ap_sme_capa &&
612                     !(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME)))
613                 return -EINVAL;
614
615         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
616                 return -EINVAL;
617
618         if (WARN_ON(wiphy->addresses &&
619                     !is_zero_ether_addr(wiphy->perm_addr) &&
620                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
621                            ETH_ALEN)))
622                 return -EINVAL;
623
624         if (WARN_ON(wiphy->max_acl_mac_addrs &&
625                     (!(wiphy->flags & WIPHY_FLAG_HAVE_AP_SME) ||
626                      !rdev->ops->set_mac_acl)))
627                 return -EINVAL;
628
629         /* assure only valid behaviours are flagged by driver
630          * hence subtract 2 as bit 0 is invalid.
631          */
632         if (WARN_ON(wiphy->bss_select_support &&
633                     (wiphy->bss_select_support & ~(BIT(__NL80211_BSS_SELECT_ATTR_AFTER_LAST) - 2))))
634                 return -EINVAL;
635
636         if (wiphy->addresses)
637                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
638
639         /* sanity check ifmodes */
640         WARN_ON(!ifmodes);
641         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
642         if (WARN_ON(ifmodes != wiphy->interface_modes))
643                 wiphy->interface_modes = ifmodes;
644
645         res = wiphy_verify_combinations(wiphy);
646         if (res)
647                 return res;
648
649         /* sanity check supported bands/channels */
650         for (band = 0; band < NUM_NL80211_BANDS; band++) {
651                 sband = wiphy->bands[band];
652                 if (!sband)
653                         continue;
654
655                 sband->band = band;
656                 if (WARN_ON(!sband->n_channels))
657                         return -EINVAL;
658                 /*
659                  * on 60GHz band, there are no legacy rates, so
660                  * n_bitrates is 0
661                  */
662                 if (WARN_ON(band != NL80211_BAND_60GHZ &&
663                             !sband->n_bitrates))
664                         return -EINVAL;
665
666                 /*
667                  * Since cfg80211_disable_40mhz_24ghz is global, we can
668                  * modify the sband's ht data even if the driver uses a
669                  * global structure for that.
670                  */
671                 if (cfg80211_disable_40mhz_24ghz &&
672                     band == NL80211_BAND_2GHZ &&
673                     sband->ht_cap.ht_supported) {
674                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
675                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
676                 }
677
678                 /*
679                  * Since we use a u32 for rate bitmaps in
680                  * ieee80211_get_response_rate, we cannot
681                  * have more than 32 legacy rates.
682                  */
683                 if (WARN_ON(sband->n_bitrates > 32))
684                         return -EINVAL;
685
686                 for (i = 0; i < sband->n_channels; i++) {
687                         sband->channels[i].orig_flags =
688                                 sband->channels[i].flags;
689                         sband->channels[i].orig_mag = INT_MAX;
690                         sband->channels[i].orig_mpwr =
691                                 sband->channels[i].max_power;
692                         sband->channels[i].band = band;
693                 }
694
695                 have_band = true;
696         }
697
698         if (!have_band) {
699                 WARN_ON(1);
700                 return -EINVAL;
701         }
702
703 #ifdef CONFIG_PM
704         if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
705                     (!rdev->wiphy.wowlan->pattern_min_len ||
706                      rdev->wiphy.wowlan->pattern_min_len >
707                                 rdev->wiphy.wowlan->pattern_max_len)))
708                 return -EINVAL;
709 #endif
710
711         /* check and set up bitrates */
712         ieee80211_set_bitrate_flags(wiphy);
713
714         rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
715
716         rtnl_lock();
717         res = device_add(&rdev->wiphy.dev);
718         if (res) {
719                 rtnl_unlock();
720                 return res;
721         }
722
723         /* set up regulatory info */
724         wiphy_regulatory_register(wiphy);
725
726         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
727         cfg80211_rdev_list_generation++;
728
729         /* add to debugfs */
730         rdev->wiphy.debugfsdir =
731                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
732                                    ieee80211_debugfs_dir);
733         if (IS_ERR(rdev->wiphy.debugfsdir))
734                 rdev->wiphy.debugfsdir = NULL;
735
736         cfg80211_debugfs_rdev_add(rdev);
737         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
738
739         if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
740                 struct regulatory_request request;
741
742                 request.wiphy_idx = get_wiphy_idx(wiphy);
743                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
744                 request.alpha2[0] = '9';
745                 request.alpha2[1] = '9';
746
747                 nl80211_send_reg_change_event(&request);
748         }
749
750         rdev->wiphy.registered = true;
751         rtnl_unlock();
752
753         res = rfkill_register(rdev->rfkill);
754         if (res) {
755                 rfkill_destroy(rdev->rfkill);
756                 rdev->rfkill = NULL;
757                 wiphy_unregister(&rdev->wiphy);
758                 return res;
759         }
760
761         return 0;
762 }
763 EXPORT_SYMBOL(wiphy_register);
764
765 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
766 {
767         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
768
769         if (!rdev->ops->rfkill_poll)
770                 return;
771         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
772         rfkill_resume_polling(rdev->rfkill);
773 }
774 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
775
776 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
777 {
778         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
779
780         rfkill_pause_polling(rdev->rfkill);
781 }
782 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
783
784 void wiphy_unregister(struct wiphy *wiphy)
785 {
786         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
787
788         wait_event(rdev->dev_wait, ({
789                 int __count;
790                 rtnl_lock();
791                 __count = rdev->opencount;
792                 rtnl_unlock();
793                 __count == 0; }));
794
795         if (rdev->rfkill)
796                 rfkill_unregister(rdev->rfkill);
797
798         rtnl_lock();
799         nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
800         rdev->wiphy.registered = false;
801
802         WARN_ON(!list_empty(&rdev->wdev_list));
803
804         /*
805          * First remove the hardware from everywhere, this makes
806          * it impossible to find from userspace.
807          */
808         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
809         list_del_rcu(&rdev->list);
810         synchronize_rcu();
811
812         /*
813          * If this device got a regulatory hint tell core its
814          * free to listen now to a new shiny device regulatory hint
815          */
816         wiphy_regulatory_deregister(wiphy);
817
818         cfg80211_rdev_list_generation++;
819         device_del(&rdev->wiphy.dev);
820
821         rtnl_unlock();
822
823         flush_work(&rdev->scan_done_wk);
824         cancel_work_sync(&rdev->conn_work);
825         flush_work(&rdev->event_work);
826         cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
827         flush_work(&rdev->destroy_work);
828         flush_work(&rdev->sched_scan_stop_wk);
829         flush_work(&rdev->mlme_unreg_wk);
830
831 #ifdef CONFIG_PM
832         if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
833                 rdev_set_wakeup(rdev, false);
834 #endif
835         cfg80211_rdev_free_wowlan(rdev);
836         cfg80211_rdev_free_coalesce(rdev);
837 }
838 EXPORT_SYMBOL(wiphy_unregister);
839
840 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
841 {
842         struct cfg80211_internal_bss *scan, *tmp;
843         struct cfg80211_beacon_registration *reg, *treg;
844         rfkill_destroy(rdev->rfkill);
845         list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
846                 list_del(&reg->list);
847                 kfree(reg);
848         }
849         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
850                 cfg80211_put_bss(&rdev->wiphy, &scan->pub);
851         kfree(rdev);
852 }
853
854 void wiphy_free(struct wiphy *wiphy)
855 {
856         put_device(&wiphy->dev);
857 }
858 EXPORT_SYMBOL(wiphy_free);
859
860 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
861 {
862         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
863
864         if (rfkill_set_hw_state(rdev->rfkill, blocked))
865                 schedule_work(&rdev->rfkill_sync);
866 }
867 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
868
869 void cfg80211_unregister_wdev(struct wireless_dev *wdev)
870 {
871         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
872
873         ASSERT_RTNL();
874
875         if (WARN_ON(wdev->netdev))
876                 return;
877
878         list_del_rcu(&wdev->list);
879         rdev->devlist_generation++;
880
881         switch (wdev->iftype) {
882         case NL80211_IFTYPE_P2P_DEVICE:
883                 cfg80211_mlme_purge_registrations(wdev);
884                 cfg80211_stop_p2p_device(rdev, wdev);
885                 break;
886         default:
887                 WARN_ON_ONCE(1);
888                 break;
889         }
890 }
891 EXPORT_SYMBOL(cfg80211_unregister_wdev);
892
893 static const struct device_type wiphy_type = {
894         .name   = "wlan",
895 };
896
897 void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
898                                enum nl80211_iftype iftype, int num)
899 {
900         ASSERT_RTNL();
901
902         rdev->num_running_ifaces += num;
903         if (iftype == NL80211_IFTYPE_MONITOR)
904                 rdev->num_running_monitor_ifaces += num;
905 }
906
907 void __cfg80211_leave(struct cfg80211_registered_device *rdev,
908                       struct wireless_dev *wdev)
909 {
910         struct net_device *dev = wdev->netdev;
911         struct cfg80211_sched_scan_request *sched_scan_req;
912
913         ASSERT_RTNL();
914         ASSERT_WDEV_LOCK(wdev);
915
916         switch (wdev->iftype) {
917         case NL80211_IFTYPE_ADHOC:
918                 __cfg80211_leave_ibss(rdev, dev, true);
919                 break;
920         case NL80211_IFTYPE_P2P_CLIENT:
921         case NL80211_IFTYPE_STATION:
922                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
923                 if (sched_scan_req && dev == sched_scan_req->dev)
924                         __cfg80211_stop_sched_scan(rdev, false);
925
926 #ifdef CONFIG_CFG80211_WEXT
927                 kfree(wdev->wext.ie);
928                 wdev->wext.ie = NULL;
929                 wdev->wext.ie_len = 0;
930                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
931 #endif
932                 cfg80211_disconnect(rdev, dev,
933                                     WLAN_REASON_DEAUTH_LEAVING, true);
934                 break;
935         case NL80211_IFTYPE_MESH_POINT:
936                 __cfg80211_leave_mesh(rdev, dev);
937                 break;
938         case NL80211_IFTYPE_AP:
939         case NL80211_IFTYPE_P2P_GO:
940                 __cfg80211_stop_ap(rdev, dev, true);
941                 break;
942         case NL80211_IFTYPE_OCB:
943                 __cfg80211_leave_ocb(rdev, dev);
944                 break;
945         case NL80211_IFTYPE_WDS:
946                 /* must be handled by mac80211/driver, has no APIs */
947                 break;
948         case NL80211_IFTYPE_P2P_DEVICE:
949                 /* cannot happen, has no netdev */
950                 break;
951         case NL80211_IFTYPE_AP_VLAN:
952         case NL80211_IFTYPE_MONITOR:
953                 /* nothing to do */
954                 break;
955         case NL80211_IFTYPE_UNSPECIFIED:
956         case NUM_NL80211_IFTYPES:
957                 /* invalid */
958                 break;
959         }
960 }
961
962 void cfg80211_leave(struct cfg80211_registered_device *rdev,
963                     struct wireless_dev *wdev)
964 {
965         wdev_lock(wdev);
966         __cfg80211_leave(rdev, wdev);
967         wdev_unlock(wdev);
968 }
969
970 void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
971                          gfp_t gfp)
972 {
973         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
974         struct cfg80211_event *ev;
975         unsigned long flags;
976
977         trace_cfg80211_stop_iface(wiphy, wdev);
978
979         ev = kzalloc(sizeof(*ev), gfp);
980         if (!ev)
981                 return;
982
983         ev->type = EVENT_STOPPED;
984
985         spin_lock_irqsave(&wdev->event_lock, flags);
986         list_add_tail(&ev->list, &wdev->event_list);
987         spin_unlock_irqrestore(&wdev->event_lock, flags);
988         queue_work(cfg80211_wq, &rdev->event_work);
989 }
990 EXPORT_SYMBOL(cfg80211_stop_iface);
991
992 static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
993                                          unsigned long state, void *ptr)
994 {
995         struct net_device *dev = netdev_notifier_info_to_dev(ptr);
996         struct wireless_dev *wdev = dev->ieee80211_ptr;
997         struct cfg80211_registered_device *rdev;
998         struct cfg80211_sched_scan_request *sched_scan_req;
999
1000         if (!wdev)
1001                 return NOTIFY_DONE;
1002
1003         rdev = wiphy_to_rdev(wdev->wiphy);
1004
1005         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
1006
1007         switch (state) {
1008         case NETDEV_POST_INIT:
1009                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
1010                 break;
1011         case NETDEV_REGISTER:
1012                 /*
1013                  * NB: cannot take rdev->mtx here because this may be
1014                  * called within code protected by it when interfaces
1015                  * are added with nl80211.
1016                  */
1017                 mutex_init(&wdev->mtx);
1018                 INIT_LIST_HEAD(&wdev->event_list);
1019                 spin_lock_init(&wdev->event_lock);
1020                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
1021                 spin_lock_init(&wdev->mgmt_registrations_lock);
1022
1023                 wdev->identifier = ++rdev->wdev_id;
1024                 list_add_rcu(&wdev->list, &rdev->wdev_list);
1025                 rdev->devlist_generation++;
1026                 /* can only change netns with wiphy */
1027                 dev->features |= NETIF_F_NETNS_LOCAL;
1028
1029                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
1030                                       "phy80211")) {
1031                         pr_err("failed to add phy80211 symlink to netdev!\n");
1032                 }
1033                 wdev->netdev = dev;
1034 #ifdef CONFIG_CFG80211_WEXT
1035                 wdev->wext.default_key = -1;
1036                 wdev->wext.default_mgmt_key = -1;
1037                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
1038 #endif
1039
1040                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
1041                         wdev->ps = true;
1042                 else
1043                         wdev->ps = false;
1044                 /* allow mac80211 to determine the timeout */
1045                 wdev->ps_timeout = -1;
1046
1047                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1048                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
1049                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
1050                         dev->priv_flags |= IFF_DONT_BRIDGE;
1051                 break;
1052         case NETDEV_GOING_DOWN:
1053                 cfg80211_leave(rdev, wdev);
1054                 break;
1055         case NETDEV_DOWN:
1056                 cfg80211_update_iface_num(rdev, wdev->iftype, -1);
1057                 if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
1058                         if (WARN_ON(!rdev->scan_req->notified))
1059                                 rdev->scan_req->aborted = true;
1060                         ___cfg80211_scan_done(rdev, false);
1061                 }
1062
1063                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
1064                 if (WARN_ON(sched_scan_req &&
1065                             sched_scan_req->dev == wdev->netdev)) {
1066                         __cfg80211_stop_sched_scan(rdev, false);
1067                 }
1068
1069                 rdev->opencount--;
1070                 wake_up(&rdev->dev_wait);
1071                 break;
1072         case NETDEV_UP:
1073                 cfg80211_update_iface_num(rdev, wdev->iftype, 1);
1074                 wdev_lock(wdev);
1075                 switch (wdev->iftype) {
1076 #ifdef CONFIG_CFG80211_WEXT
1077                 case NL80211_IFTYPE_ADHOC:
1078                         cfg80211_ibss_wext_join(rdev, wdev);
1079                         break;
1080                 case NL80211_IFTYPE_STATION:
1081                         cfg80211_mgd_wext_connect(rdev, wdev);
1082                         break;
1083 #endif
1084 #ifdef CONFIG_MAC80211_MESH
1085                 case NL80211_IFTYPE_MESH_POINT:
1086                         {
1087                                 /* backward compat code... */
1088                                 struct mesh_setup setup;
1089                                 memcpy(&setup, &default_mesh_setup,
1090                                                 sizeof(setup));
1091                                  /* back compat only needed for mesh_id */
1092                                 setup.mesh_id = wdev->ssid;
1093                                 setup.mesh_id_len = wdev->mesh_id_up_len;
1094                                 if (wdev->mesh_id_up_len)
1095                                         __cfg80211_join_mesh(rdev, dev,
1096                                                         &setup,
1097                                                         &default_mesh_config);
1098                                 break;
1099                         }
1100 #endif
1101                 default:
1102                         break;
1103                 }
1104                 wdev_unlock(wdev);
1105                 rdev->opencount++;
1106
1107                 /*
1108                  * Configure power management to the driver here so that its
1109                  * correctly set also after interface type changes etc.
1110                  */
1111                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1112                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
1113                     rdev->ops->set_power_mgmt)
1114                         if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
1115                                                 wdev->ps_timeout)) {
1116                                 /* assume this means it's off */
1117                                 wdev->ps = false;
1118                         }
1119                 break;
1120         case NETDEV_UNREGISTER:
1121                 /*
1122                  * It is possible to get NETDEV_UNREGISTER
1123                  * multiple times. To detect that, check
1124                  * that the interface is still on the list
1125                  * of registered interfaces, and only then
1126                  * remove and clean it up.
1127                  */
1128                 if (!list_empty(&wdev->list)) {
1129                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
1130                         list_del_rcu(&wdev->list);
1131                         rdev->devlist_generation++;
1132                         cfg80211_mlme_purge_registrations(wdev);
1133 #ifdef CONFIG_CFG80211_WEXT
1134                         kzfree(wdev->wext.keys);
1135 #endif
1136                 }
1137                 /*
1138                  * synchronise (so that we won't find this netdev
1139                  * from other code any more) and then clear the list
1140                  * head so that the above code can safely check for
1141                  * !list_empty() to avoid double-cleanup.
1142                  */
1143                 synchronize_rcu();
1144                 INIT_LIST_HEAD(&wdev->list);
1145                 /*
1146                  * Ensure that all events have been processed and
1147                  * freed.
1148                  */
1149                 cfg80211_process_wdev_events(wdev);
1150
1151                 if (WARN_ON(wdev->current_bss)) {
1152                         cfg80211_unhold_bss(wdev->current_bss);
1153                         cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
1154                         wdev->current_bss = NULL;
1155                 }
1156                 break;
1157         case NETDEV_PRE_UP:
1158                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
1159                         return notifier_from_errno(-EOPNOTSUPP);
1160                 if (rfkill_blocked(rdev->rfkill))
1161                         return notifier_from_errno(-ERFKILL);
1162                 break;
1163         default:
1164                 return NOTIFY_DONE;
1165         }
1166
1167         wireless_nlevent_flush();
1168
1169         return NOTIFY_OK;
1170 }
1171
1172 static struct notifier_block cfg80211_netdev_notifier = {
1173         .notifier_call = cfg80211_netdev_notifier_call,
1174 };
1175
1176 static void __net_exit cfg80211_pernet_exit(struct net *net)
1177 {
1178         struct cfg80211_registered_device *rdev;
1179
1180         rtnl_lock();
1181         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1182                 if (net_eq(wiphy_net(&rdev->wiphy), net))
1183                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
1184         }
1185         rtnl_unlock();
1186 }
1187
1188 static struct pernet_operations cfg80211_pernet_ops = {
1189         .exit = cfg80211_pernet_exit,
1190 };
1191
1192 static int __init cfg80211_init(void)
1193 {
1194         int err;
1195
1196         err = register_pernet_device(&cfg80211_pernet_ops);
1197         if (err)
1198                 goto out_fail_pernet;
1199
1200         err = wiphy_sysfs_init();
1201         if (err)
1202                 goto out_fail_sysfs;
1203
1204         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
1205         if (err)
1206                 goto out_fail_notifier;
1207
1208         err = nl80211_init();
1209         if (err)
1210                 goto out_fail_nl80211;
1211
1212         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
1213
1214         err = regulatory_init();
1215         if (err)
1216                 goto out_fail_reg;
1217
1218         cfg80211_wq = create_singlethread_workqueue("cfg80211");
1219         if (!cfg80211_wq) {
1220                 err = -ENOMEM;
1221                 goto out_fail_wq;
1222         }
1223
1224         return 0;
1225
1226 out_fail_wq:
1227         regulatory_exit();
1228 out_fail_reg:
1229         debugfs_remove(ieee80211_debugfs_dir);
1230         nl80211_exit();
1231 out_fail_nl80211:
1232         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1233 out_fail_notifier:
1234         wiphy_sysfs_exit();
1235 out_fail_sysfs:
1236         unregister_pernet_device(&cfg80211_pernet_ops);
1237 out_fail_pernet:
1238         return err;
1239 }
1240 subsys_initcall(cfg80211_init);
1241
1242 static void __exit cfg80211_exit(void)
1243 {
1244         debugfs_remove(ieee80211_debugfs_dir);
1245         nl80211_exit();
1246         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1247         wiphy_sysfs_exit();
1248         regulatory_exit();
1249         unregister_pernet_device(&cfg80211_pernet_ops);
1250         destroy_workqueue(cfg80211_wq);
1251 }
1252 module_exit(cfg80211_exit);