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