Merge branch 'i2c/for-next' of git://git.kernel.org/pub/scm/linux/kernel/git/wsa...
[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 ieee80211_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         if (wiphy->addresses)
630                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
631
632         /* sanity check ifmodes */
633         WARN_ON(!ifmodes);
634         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
635         if (WARN_ON(ifmodes != wiphy->interface_modes))
636                 wiphy->interface_modes = ifmodes;
637
638         res = wiphy_verify_combinations(wiphy);
639         if (res)
640                 return res;
641
642         /* sanity check supported bands/channels */
643         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
644                 sband = wiphy->bands[band];
645                 if (!sband)
646                         continue;
647
648                 sband->band = band;
649                 if (WARN_ON(!sband->n_channels))
650                         return -EINVAL;
651                 /*
652                  * on 60GHz band, there are no legacy rates, so
653                  * n_bitrates is 0
654                  */
655                 if (WARN_ON(band != IEEE80211_BAND_60GHZ &&
656                             !sband->n_bitrates))
657                         return -EINVAL;
658
659                 /*
660                  * Since cfg80211_disable_40mhz_24ghz is global, we can
661                  * modify the sband's ht data even if the driver uses a
662                  * global structure for that.
663                  */
664                 if (cfg80211_disable_40mhz_24ghz &&
665                     band == IEEE80211_BAND_2GHZ &&
666                     sband->ht_cap.ht_supported) {
667                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
668                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
669                 }
670
671                 /*
672                  * Since we use a u32 for rate bitmaps in
673                  * ieee80211_get_response_rate, we cannot
674                  * have more than 32 legacy rates.
675                  */
676                 if (WARN_ON(sband->n_bitrates > 32))
677                         return -EINVAL;
678
679                 for (i = 0; i < sband->n_channels; i++) {
680                         sband->channels[i].orig_flags =
681                                 sband->channels[i].flags;
682                         sband->channels[i].orig_mag = INT_MAX;
683                         sband->channels[i].orig_mpwr =
684                                 sband->channels[i].max_power;
685                         sband->channels[i].band = band;
686                 }
687
688                 have_band = true;
689         }
690
691         if (!have_band) {
692                 WARN_ON(1);
693                 return -EINVAL;
694         }
695
696 #ifdef CONFIG_PM
697         if (WARN_ON(rdev->wiphy.wowlan && rdev->wiphy.wowlan->n_patterns &&
698                     (!rdev->wiphy.wowlan->pattern_min_len ||
699                      rdev->wiphy.wowlan->pattern_min_len >
700                                 rdev->wiphy.wowlan->pattern_max_len)))
701                 return -EINVAL;
702 #endif
703
704         /* check and set up bitrates */
705         ieee80211_set_bitrate_flags(wiphy);
706
707         rdev->wiphy.features |= NL80211_FEATURE_SCAN_FLUSH;
708
709         rtnl_lock();
710         res = device_add(&rdev->wiphy.dev);
711         if (res) {
712                 rtnl_unlock();
713                 return res;
714         }
715
716         /* set up regulatory info */
717         wiphy_regulatory_register(wiphy);
718
719         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
720         cfg80211_rdev_list_generation++;
721
722         /* add to debugfs */
723         rdev->wiphy.debugfsdir =
724                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
725                                    ieee80211_debugfs_dir);
726         if (IS_ERR(rdev->wiphy.debugfsdir))
727                 rdev->wiphy.debugfsdir = NULL;
728
729         cfg80211_debugfs_rdev_add(rdev);
730         nl80211_notify_wiphy(rdev, NL80211_CMD_NEW_WIPHY);
731
732         if (wiphy->regulatory_flags & REGULATORY_CUSTOM_REG) {
733                 struct regulatory_request request;
734
735                 request.wiphy_idx = get_wiphy_idx(wiphy);
736                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
737                 request.alpha2[0] = '9';
738                 request.alpha2[1] = '9';
739
740                 nl80211_send_reg_change_event(&request);
741         }
742
743         rdev->wiphy.registered = true;
744         rtnl_unlock();
745
746         res = rfkill_register(rdev->rfkill);
747         if (res) {
748                 rfkill_destroy(rdev->rfkill);
749                 rdev->rfkill = NULL;
750                 wiphy_unregister(&rdev->wiphy);
751                 return res;
752         }
753
754         return 0;
755 }
756 EXPORT_SYMBOL(wiphy_register);
757
758 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
759 {
760         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
761
762         if (!rdev->ops->rfkill_poll)
763                 return;
764         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
765         rfkill_resume_polling(rdev->rfkill);
766 }
767 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
768
769 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
770 {
771         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
772
773         rfkill_pause_polling(rdev->rfkill);
774 }
775 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
776
777 void wiphy_unregister(struct wiphy *wiphy)
778 {
779         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
780
781         wait_event(rdev->dev_wait, ({
782                 int __count;
783                 rtnl_lock();
784                 __count = rdev->opencount;
785                 rtnl_unlock();
786                 __count == 0; }));
787
788         if (rdev->rfkill)
789                 rfkill_unregister(rdev->rfkill);
790
791         rtnl_lock();
792         nl80211_notify_wiphy(rdev, NL80211_CMD_DEL_WIPHY);
793         rdev->wiphy.registered = false;
794
795         WARN_ON(!list_empty(&rdev->wdev_list));
796
797         /*
798          * First remove the hardware from everywhere, this makes
799          * it impossible to find from userspace.
800          */
801         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
802         list_del_rcu(&rdev->list);
803         synchronize_rcu();
804
805         /*
806          * If this device got a regulatory hint tell core its
807          * free to listen now to a new shiny device regulatory hint
808          */
809         wiphy_regulatory_deregister(wiphy);
810
811         cfg80211_rdev_list_generation++;
812         device_del(&rdev->wiphy.dev);
813
814         rtnl_unlock();
815
816         flush_work(&rdev->scan_done_wk);
817         cancel_work_sync(&rdev->conn_work);
818         flush_work(&rdev->event_work);
819         cancel_delayed_work_sync(&rdev->dfs_update_channels_wk);
820         flush_work(&rdev->destroy_work);
821         flush_work(&rdev->sched_scan_stop_wk);
822         flush_work(&rdev->mlme_unreg_wk);
823
824 #ifdef CONFIG_PM
825         if (rdev->wiphy.wowlan_config && rdev->ops->set_wakeup)
826                 rdev_set_wakeup(rdev, false);
827 #endif
828         cfg80211_rdev_free_wowlan(rdev);
829         cfg80211_rdev_free_coalesce(rdev);
830 }
831 EXPORT_SYMBOL(wiphy_unregister);
832
833 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
834 {
835         struct cfg80211_internal_bss *scan, *tmp;
836         struct cfg80211_beacon_registration *reg, *treg;
837         rfkill_destroy(rdev->rfkill);
838         list_for_each_entry_safe(reg, treg, &rdev->beacon_registrations, list) {
839                 list_del(&reg->list);
840                 kfree(reg);
841         }
842         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
843                 cfg80211_put_bss(&rdev->wiphy, &scan->pub);
844         kfree(rdev);
845 }
846
847 void wiphy_free(struct wiphy *wiphy)
848 {
849         put_device(&wiphy->dev);
850 }
851 EXPORT_SYMBOL(wiphy_free);
852
853 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
854 {
855         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
856
857         if (rfkill_set_hw_state(rdev->rfkill, blocked))
858                 schedule_work(&rdev->rfkill_sync);
859 }
860 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
861
862 void cfg80211_unregister_wdev(struct wireless_dev *wdev)
863 {
864         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wdev->wiphy);
865
866         ASSERT_RTNL();
867
868         if (WARN_ON(wdev->netdev))
869                 return;
870
871         list_del_rcu(&wdev->list);
872         rdev->devlist_generation++;
873
874         switch (wdev->iftype) {
875         case NL80211_IFTYPE_P2P_DEVICE:
876                 cfg80211_mlme_purge_registrations(wdev);
877                 cfg80211_stop_p2p_device(rdev, wdev);
878                 break;
879         default:
880                 WARN_ON_ONCE(1);
881                 break;
882         }
883 }
884 EXPORT_SYMBOL(cfg80211_unregister_wdev);
885
886 static const struct device_type wiphy_type = {
887         .name   = "wlan",
888 };
889
890 void cfg80211_update_iface_num(struct cfg80211_registered_device *rdev,
891                                enum nl80211_iftype iftype, int num)
892 {
893         ASSERT_RTNL();
894
895         rdev->num_running_ifaces += num;
896         if (iftype == NL80211_IFTYPE_MONITOR)
897                 rdev->num_running_monitor_ifaces += num;
898 }
899
900 void __cfg80211_leave(struct cfg80211_registered_device *rdev,
901                       struct wireless_dev *wdev)
902 {
903         struct net_device *dev = wdev->netdev;
904         struct cfg80211_sched_scan_request *sched_scan_req;
905
906         ASSERT_RTNL();
907         ASSERT_WDEV_LOCK(wdev);
908
909         switch (wdev->iftype) {
910         case NL80211_IFTYPE_ADHOC:
911                 __cfg80211_leave_ibss(rdev, dev, true);
912                 break;
913         case NL80211_IFTYPE_P2P_CLIENT:
914         case NL80211_IFTYPE_STATION:
915                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
916                 if (sched_scan_req && dev == sched_scan_req->dev)
917                         __cfg80211_stop_sched_scan(rdev, false);
918
919 #ifdef CONFIG_CFG80211_WEXT
920                 kfree(wdev->wext.ie);
921                 wdev->wext.ie = NULL;
922                 wdev->wext.ie_len = 0;
923                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
924 #endif
925                 cfg80211_disconnect(rdev, dev,
926                                     WLAN_REASON_DEAUTH_LEAVING, true);
927                 break;
928         case NL80211_IFTYPE_MESH_POINT:
929                 __cfg80211_leave_mesh(rdev, dev);
930                 break;
931         case NL80211_IFTYPE_AP:
932         case NL80211_IFTYPE_P2P_GO:
933                 __cfg80211_stop_ap(rdev, dev, true);
934                 break;
935         case NL80211_IFTYPE_OCB:
936                 __cfg80211_leave_ocb(rdev, dev);
937                 break;
938         case NL80211_IFTYPE_WDS:
939                 /* must be handled by mac80211/driver, has no APIs */
940                 break;
941         case NL80211_IFTYPE_P2P_DEVICE:
942                 /* cannot happen, has no netdev */
943                 break;
944         case NL80211_IFTYPE_AP_VLAN:
945         case NL80211_IFTYPE_MONITOR:
946                 /* nothing to do */
947                 break;
948         case NL80211_IFTYPE_UNSPECIFIED:
949         case NUM_NL80211_IFTYPES:
950                 /* invalid */
951                 break;
952         }
953 }
954
955 void cfg80211_leave(struct cfg80211_registered_device *rdev,
956                     struct wireless_dev *wdev)
957 {
958         wdev_lock(wdev);
959         __cfg80211_leave(rdev, wdev);
960         wdev_unlock(wdev);
961 }
962
963 void cfg80211_stop_iface(struct wiphy *wiphy, struct wireless_dev *wdev,
964                          gfp_t gfp)
965 {
966         struct cfg80211_registered_device *rdev = wiphy_to_rdev(wiphy);
967         struct cfg80211_event *ev;
968         unsigned long flags;
969
970         trace_cfg80211_stop_iface(wiphy, wdev);
971
972         ev = kzalloc(sizeof(*ev), gfp);
973         if (!ev)
974                 return;
975
976         ev->type = EVENT_STOPPED;
977
978         spin_lock_irqsave(&wdev->event_lock, flags);
979         list_add_tail(&ev->list, &wdev->event_list);
980         spin_unlock_irqrestore(&wdev->event_lock, flags);
981         queue_work(cfg80211_wq, &rdev->event_work);
982 }
983 EXPORT_SYMBOL(cfg80211_stop_iface);
984
985 static int cfg80211_netdev_notifier_call(struct notifier_block *nb,
986                                          unsigned long state, void *ptr)
987 {
988         struct net_device *dev = netdev_notifier_info_to_dev(ptr);
989         struct wireless_dev *wdev = dev->ieee80211_ptr;
990         struct cfg80211_registered_device *rdev;
991         struct cfg80211_sched_scan_request *sched_scan_req;
992
993         if (!wdev)
994                 return NOTIFY_DONE;
995
996         rdev = wiphy_to_rdev(wdev->wiphy);
997
998         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
999
1000         switch (state) {
1001         case NETDEV_POST_INIT:
1002                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
1003                 break;
1004         case NETDEV_REGISTER:
1005                 /*
1006                  * NB: cannot take rdev->mtx here because this may be
1007                  * called within code protected by it when interfaces
1008                  * are added with nl80211.
1009                  */
1010                 mutex_init(&wdev->mtx);
1011                 INIT_LIST_HEAD(&wdev->event_list);
1012                 spin_lock_init(&wdev->event_lock);
1013                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
1014                 spin_lock_init(&wdev->mgmt_registrations_lock);
1015
1016                 wdev->identifier = ++rdev->wdev_id;
1017                 list_add_rcu(&wdev->list, &rdev->wdev_list);
1018                 rdev->devlist_generation++;
1019                 /* can only change netns with wiphy */
1020                 dev->features |= NETIF_F_NETNS_LOCAL;
1021
1022                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
1023                                       "phy80211")) {
1024                         pr_err("failed to add phy80211 symlink to netdev!\n");
1025                 }
1026                 wdev->netdev = dev;
1027 #ifdef CONFIG_CFG80211_WEXT
1028                 wdev->wext.default_key = -1;
1029                 wdev->wext.default_mgmt_key = -1;
1030                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
1031 #endif
1032
1033                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
1034                         wdev->ps = true;
1035                 else
1036                         wdev->ps = false;
1037                 /* allow mac80211 to determine the timeout */
1038                 wdev->ps_timeout = -1;
1039
1040                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1041                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
1042                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
1043                         dev->priv_flags |= IFF_DONT_BRIDGE;
1044                 break;
1045         case NETDEV_GOING_DOWN:
1046                 cfg80211_leave(rdev, wdev);
1047                 break;
1048         case NETDEV_DOWN:
1049                 cfg80211_update_iface_num(rdev, wdev->iftype, -1);
1050                 if (rdev->scan_req && rdev->scan_req->wdev == wdev) {
1051                         if (WARN_ON(!rdev->scan_req->notified))
1052                                 rdev->scan_req->aborted = true;
1053                         ___cfg80211_scan_done(rdev, false);
1054                 }
1055
1056                 sched_scan_req = rtnl_dereference(rdev->sched_scan_req);
1057                 if (WARN_ON(sched_scan_req &&
1058                             sched_scan_req->dev == wdev->netdev)) {
1059                         __cfg80211_stop_sched_scan(rdev, false);
1060                 }
1061
1062                 rdev->opencount--;
1063                 wake_up(&rdev->dev_wait);
1064                 break;
1065         case NETDEV_UP:
1066                 cfg80211_update_iface_num(rdev, wdev->iftype, 1);
1067                 wdev_lock(wdev);
1068                 switch (wdev->iftype) {
1069 #ifdef CONFIG_CFG80211_WEXT
1070                 case NL80211_IFTYPE_ADHOC:
1071                         cfg80211_ibss_wext_join(rdev, wdev);
1072                         break;
1073                 case NL80211_IFTYPE_STATION:
1074                         cfg80211_mgd_wext_connect(rdev, wdev);
1075                         break;
1076 #endif
1077 #ifdef CONFIG_MAC80211_MESH
1078                 case NL80211_IFTYPE_MESH_POINT:
1079                         {
1080                                 /* backward compat code... */
1081                                 struct mesh_setup setup;
1082                                 memcpy(&setup, &default_mesh_setup,
1083                                                 sizeof(setup));
1084                                  /* back compat only needed for mesh_id */
1085                                 setup.mesh_id = wdev->ssid;
1086                                 setup.mesh_id_len = wdev->mesh_id_up_len;
1087                                 if (wdev->mesh_id_up_len)
1088                                         __cfg80211_join_mesh(rdev, dev,
1089                                                         &setup,
1090                                                         &default_mesh_config);
1091                                 break;
1092                         }
1093 #endif
1094                 default:
1095                         break;
1096                 }
1097                 wdev_unlock(wdev);
1098                 rdev->opencount++;
1099
1100                 /*
1101                  * Configure power management to the driver here so that its
1102                  * correctly set also after interface type changes etc.
1103                  */
1104                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
1105                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT) &&
1106                     rdev->ops->set_power_mgmt)
1107                         if (rdev_set_power_mgmt(rdev, dev, wdev->ps,
1108                                                 wdev->ps_timeout)) {
1109                                 /* assume this means it's off */
1110                                 wdev->ps = false;
1111                         }
1112                 break;
1113         case NETDEV_UNREGISTER:
1114                 /*
1115                  * It is possible to get NETDEV_UNREGISTER
1116                  * multiple times. To detect that, check
1117                  * that the interface is still on the list
1118                  * of registered interfaces, and only then
1119                  * remove and clean it up.
1120                  */
1121                 if (!list_empty(&wdev->list)) {
1122                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
1123                         list_del_rcu(&wdev->list);
1124                         rdev->devlist_generation++;
1125                         cfg80211_mlme_purge_registrations(wdev);
1126 #ifdef CONFIG_CFG80211_WEXT
1127                         kzfree(wdev->wext.keys);
1128 #endif
1129                 }
1130                 /*
1131                  * synchronise (so that we won't find this netdev
1132                  * from other code any more) and then clear the list
1133                  * head so that the above code can safely check for
1134                  * !list_empty() to avoid double-cleanup.
1135                  */
1136                 synchronize_rcu();
1137                 INIT_LIST_HEAD(&wdev->list);
1138                 /*
1139                  * Ensure that all events have been processed and
1140                  * freed.
1141                  */
1142                 cfg80211_process_wdev_events(wdev);
1143
1144                 if (WARN_ON(wdev->current_bss)) {
1145                         cfg80211_unhold_bss(wdev->current_bss);
1146                         cfg80211_put_bss(wdev->wiphy, &wdev->current_bss->pub);
1147                         wdev->current_bss = NULL;
1148                 }
1149                 break;
1150         case NETDEV_PRE_UP:
1151                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
1152                         return notifier_from_errno(-EOPNOTSUPP);
1153                 if (rfkill_blocked(rdev->rfkill))
1154                         return notifier_from_errno(-ERFKILL);
1155                 break;
1156         default:
1157                 return NOTIFY_DONE;
1158         }
1159
1160         wireless_nlevent_flush();
1161
1162         return NOTIFY_OK;
1163 }
1164
1165 static struct notifier_block cfg80211_netdev_notifier = {
1166         .notifier_call = cfg80211_netdev_notifier_call,
1167 };
1168
1169 static void __net_exit cfg80211_pernet_exit(struct net *net)
1170 {
1171         struct cfg80211_registered_device *rdev;
1172
1173         rtnl_lock();
1174         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
1175                 if (net_eq(wiphy_net(&rdev->wiphy), net))
1176                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
1177         }
1178         rtnl_unlock();
1179 }
1180
1181 static struct pernet_operations cfg80211_pernet_ops = {
1182         .exit = cfg80211_pernet_exit,
1183 };
1184
1185 static int __init cfg80211_init(void)
1186 {
1187         int err;
1188
1189         err = register_pernet_device(&cfg80211_pernet_ops);
1190         if (err)
1191                 goto out_fail_pernet;
1192
1193         err = wiphy_sysfs_init();
1194         if (err)
1195                 goto out_fail_sysfs;
1196
1197         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
1198         if (err)
1199                 goto out_fail_notifier;
1200
1201         err = nl80211_init();
1202         if (err)
1203                 goto out_fail_nl80211;
1204
1205         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
1206
1207         err = regulatory_init();
1208         if (err)
1209                 goto out_fail_reg;
1210
1211         cfg80211_wq = create_singlethread_workqueue("cfg80211");
1212         if (!cfg80211_wq) {
1213                 err = -ENOMEM;
1214                 goto out_fail_wq;
1215         }
1216
1217         return 0;
1218
1219 out_fail_wq:
1220         regulatory_exit();
1221 out_fail_reg:
1222         debugfs_remove(ieee80211_debugfs_dir);
1223         nl80211_exit();
1224 out_fail_nl80211:
1225         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1226 out_fail_notifier:
1227         wiphy_sysfs_exit();
1228 out_fail_sysfs:
1229         unregister_pernet_device(&cfg80211_pernet_ops);
1230 out_fail_pernet:
1231         return err;
1232 }
1233 subsys_initcall(cfg80211_init);
1234
1235 static void __exit cfg80211_exit(void)
1236 {
1237         debugfs_remove(ieee80211_debugfs_dir);
1238         nl80211_exit();
1239         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
1240         wiphy_sysfs_exit();
1241         regulatory_exit();
1242         unregister_pernet_device(&cfg80211_pernet_ops);
1243         destroy_workqueue(cfg80211_wq);
1244 }
1245 module_exit(cfg80211_exit);