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