Merge branch 'batman-adv/next' of git://git.open-mesh.org/ecsv/linux-merge
[firefly-linux-kernel-4.4.55.git] / net / wireless / core.c
1 /*
2  * This is the linux wireless configuration interface.
3  *
4  * Copyright 2006-2010          Johannes Berg <johannes@sipsolutions.net>
5  */
6
7 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
8
9 #include <linux/if.h>
10 #include <linux/module.h>
11 #include <linux/err.h>
12 #include <linux/list.h>
13 #include <linux/slab.h>
14 #include <linux/nl80211.h>
15 #include <linux/debugfs.h>
16 #include <linux/notifier.h>
17 #include <linux/device.h>
18 #include <linux/etherdevice.h>
19 #include <linux/rtnetlink.h>
20 #include <linux/sched.h>
21 #include <net/genetlink.h>
22 #include <net/cfg80211.h>
23 #include "nl80211.h"
24 #include "core.h"
25 #include "sysfs.h"
26 #include "debugfs.h"
27 #include "wext-compat.h"
28 #include "ethtool.h"
29
30 /* name for sysfs, %d is appended */
31 #define PHY_NAME "phy"
32
33 MODULE_AUTHOR("Johannes Berg");
34 MODULE_LICENSE("GPL");
35 MODULE_DESCRIPTION("wireless configuration support");
36
37 /* RCU-protected (and cfg80211_mutex for writers) */
38 LIST_HEAD(cfg80211_rdev_list);
39 int cfg80211_rdev_list_generation;
40
41 DEFINE_MUTEX(cfg80211_mutex);
42
43 /* for debugfs */
44 static struct dentry *ieee80211_debugfs_dir;
45
46 /* for the cleanup, scan and event works */
47 struct workqueue_struct *cfg80211_wq;
48
49 static bool cfg80211_disable_40mhz_24ghz;
50 module_param(cfg80211_disable_40mhz_24ghz, bool, 0644);
51 MODULE_PARM_DESC(cfg80211_disable_40mhz_24ghz,
52                  "Disable 40MHz support in the 2.4GHz band");
53
54 /* requires cfg80211_mutex to be held! */
55 struct cfg80211_registered_device *cfg80211_rdev_by_wiphy_idx(int wiphy_idx)
56 {
57         struct cfg80211_registered_device *result = NULL, *rdev;
58
59         if (!wiphy_idx_valid(wiphy_idx))
60                 return NULL;
61
62         assert_cfg80211_lock();
63
64         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
65                 if (rdev->wiphy_idx == wiphy_idx) {
66                         result = rdev;
67                         break;
68                 }
69         }
70
71         return result;
72 }
73
74 int get_wiphy_idx(struct wiphy *wiphy)
75 {
76         struct cfg80211_registered_device *rdev;
77         if (!wiphy)
78                 return WIPHY_IDX_STALE;
79         rdev = wiphy_to_dev(wiphy);
80         return rdev->wiphy_idx;
81 }
82
83 /* requires cfg80211_rdev_mutex to be held! */
84 struct wiphy *wiphy_idx_to_wiphy(int wiphy_idx)
85 {
86         struct cfg80211_registered_device *rdev;
87
88         if (!wiphy_idx_valid(wiphy_idx))
89                 return NULL;
90
91         assert_cfg80211_lock();
92
93         rdev = cfg80211_rdev_by_wiphy_idx(wiphy_idx);
94         if (!rdev)
95                 return NULL;
96         return &rdev->wiphy;
97 }
98
99 /* requires cfg80211_mutex to be held! */
100 struct cfg80211_registered_device *
101 __cfg80211_rdev_from_info(struct genl_info *info)
102 {
103         int ifindex;
104         struct cfg80211_registered_device *bywiphyidx = NULL, *byifidx = NULL;
105         struct net_device *dev;
106         int err = -EINVAL;
107
108         assert_cfg80211_lock();
109
110         if (info->attrs[NL80211_ATTR_WIPHY]) {
111                 bywiphyidx = cfg80211_rdev_by_wiphy_idx(
112                                 nla_get_u32(info->attrs[NL80211_ATTR_WIPHY]));
113                 err = -ENODEV;
114         }
115
116         if (info->attrs[NL80211_ATTR_IFINDEX]) {
117                 ifindex = nla_get_u32(info->attrs[NL80211_ATTR_IFINDEX]);
118                 dev = dev_get_by_index(genl_info_net(info), ifindex);
119                 if (dev) {
120                         if (dev->ieee80211_ptr)
121                                 byifidx =
122                                         wiphy_to_dev(dev->ieee80211_ptr->wiphy);
123                         dev_put(dev);
124                 }
125                 err = -ENODEV;
126         }
127
128         if (bywiphyidx && byifidx) {
129                 if (bywiphyidx != byifidx)
130                         return ERR_PTR(-EINVAL);
131                 else
132                         return bywiphyidx; /* == byifidx */
133         }
134         if (bywiphyidx)
135                 return bywiphyidx;
136
137         if (byifidx)
138                 return byifidx;
139
140         return ERR_PTR(err);
141 }
142
143 struct cfg80211_registered_device *
144 cfg80211_get_dev_from_info(struct genl_info *info)
145 {
146         struct cfg80211_registered_device *rdev;
147
148         mutex_lock(&cfg80211_mutex);
149         rdev = __cfg80211_rdev_from_info(info);
150
151         /* if it is not an error we grab the lock on
152          * it to assure it won't be going away while
153          * we operate on it */
154         if (!IS_ERR(rdev))
155                 mutex_lock(&rdev->mtx);
156
157         mutex_unlock(&cfg80211_mutex);
158
159         return rdev;
160 }
161
162 struct cfg80211_registered_device *
163 cfg80211_get_dev_from_ifindex(struct net *net, int ifindex)
164 {
165         struct cfg80211_registered_device *rdev = ERR_PTR(-ENODEV);
166         struct net_device *dev;
167
168         mutex_lock(&cfg80211_mutex);
169         dev = dev_get_by_index(net, ifindex);
170         if (!dev)
171                 goto out;
172         if (dev->ieee80211_ptr) {
173                 rdev = wiphy_to_dev(dev->ieee80211_ptr->wiphy);
174                 mutex_lock(&rdev->mtx);
175         } else
176                 rdev = ERR_PTR(-ENODEV);
177         dev_put(dev);
178  out:
179         mutex_unlock(&cfg80211_mutex);
180         return rdev;
181 }
182
183 /* requires cfg80211_mutex to be held */
184 int cfg80211_dev_rename(struct cfg80211_registered_device *rdev,
185                         char *newname)
186 {
187         struct cfg80211_registered_device *rdev2;
188         int wiphy_idx, taken = -1, result, digits;
189
190         assert_cfg80211_lock();
191
192         /* prohibit calling the thing phy%d when %d is not its number */
193         sscanf(newname, PHY_NAME "%d%n", &wiphy_idx, &taken);
194         if (taken == strlen(newname) && wiphy_idx != rdev->wiphy_idx) {
195                 /* count number of places needed to print wiphy_idx */
196                 digits = 1;
197                 while (wiphy_idx /= 10)
198                         digits++;
199                 /*
200                  * deny the name if it is phy<idx> where <idx> is printed
201                  * without leading zeroes. taken == strlen(newname) here
202                  */
203                 if (taken == strlen(PHY_NAME) + digits)
204                         return -EINVAL;
205         }
206
207
208         /* Ignore nop renames */
209         if (strcmp(newname, dev_name(&rdev->wiphy.dev)) == 0)
210                 return 0;
211
212         /* Ensure another device does not already have this name. */
213         list_for_each_entry(rdev2, &cfg80211_rdev_list, list)
214                 if (strcmp(newname, dev_name(&rdev2->wiphy.dev)) == 0)
215                         return -EINVAL;
216
217         result = device_rename(&rdev->wiphy.dev, newname);
218         if (result)
219                 return result;
220
221         if (rdev->wiphy.debugfsdir &&
222             !debugfs_rename(rdev->wiphy.debugfsdir->d_parent,
223                             rdev->wiphy.debugfsdir,
224                             rdev->wiphy.debugfsdir->d_parent,
225                             newname))
226                 pr_err("failed to rename debugfs dir to %s!\n", newname);
227
228         nl80211_notify_dev_rename(rdev);
229
230         return 0;
231 }
232
233 int cfg80211_switch_netns(struct cfg80211_registered_device *rdev,
234                           struct net *net)
235 {
236         struct wireless_dev *wdev;
237         int err = 0;
238
239         if (!(rdev->wiphy.flags & WIPHY_FLAG_NETNS_OK))
240                 return -EOPNOTSUPP;
241
242         list_for_each_entry(wdev, &rdev->netdev_list, list) {
243                 wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
244                 err = dev_change_net_namespace(wdev->netdev, net, "wlan%d");
245                 if (err)
246                         break;
247                 wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
248         }
249
250         if (err) {
251                 /* failed -- clean up to old netns */
252                 net = wiphy_net(&rdev->wiphy);
253
254                 list_for_each_entry_continue_reverse(wdev, &rdev->netdev_list,
255                                                      list) {
256                         wdev->netdev->features &= ~NETIF_F_NETNS_LOCAL;
257                         err = dev_change_net_namespace(wdev->netdev, net,
258                                                         "wlan%d");
259                         WARN_ON(err);
260                         wdev->netdev->features |= NETIF_F_NETNS_LOCAL;
261                 }
262
263                 return err;
264         }
265
266         wiphy_net_set(&rdev->wiphy, net);
267
268         err = device_rename(&rdev->wiphy.dev, dev_name(&rdev->wiphy.dev));
269         WARN_ON(err);
270
271         return 0;
272 }
273
274 static void cfg80211_rfkill_poll(struct rfkill *rfkill, void *data)
275 {
276         struct cfg80211_registered_device *rdev = data;
277
278         rdev->ops->rfkill_poll(&rdev->wiphy);
279 }
280
281 static int cfg80211_rfkill_set_block(void *data, bool blocked)
282 {
283         struct cfg80211_registered_device *rdev = data;
284         struct wireless_dev *wdev;
285
286         if (!blocked)
287                 return 0;
288
289         rtnl_lock();
290         mutex_lock(&rdev->devlist_mtx);
291
292         list_for_each_entry(wdev, &rdev->netdev_list, list)
293                 dev_close(wdev->netdev);
294
295         mutex_unlock(&rdev->devlist_mtx);
296         rtnl_unlock();
297
298         return 0;
299 }
300
301 static void cfg80211_rfkill_sync_work(struct work_struct *work)
302 {
303         struct cfg80211_registered_device *rdev;
304
305         rdev = container_of(work, struct cfg80211_registered_device, rfkill_sync);
306         cfg80211_rfkill_set_block(rdev, rfkill_blocked(rdev->rfkill));
307 }
308
309 static void cfg80211_event_work(struct work_struct *work)
310 {
311         struct cfg80211_registered_device *rdev;
312
313         rdev = container_of(work, struct cfg80211_registered_device,
314                             event_work);
315
316         rtnl_lock();
317         cfg80211_lock_rdev(rdev);
318
319         cfg80211_process_rdev_events(rdev);
320         cfg80211_unlock_rdev(rdev);
321         rtnl_unlock();
322 }
323
324 /* exported functions */
325
326 struct wiphy *wiphy_new(const struct cfg80211_ops *ops, int sizeof_priv)
327 {
328         static int wiphy_counter;
329
330         struct cfg80211_registered_device *rdev;
331         int alloc_size;
332
333         WARN_ON(ops->add_key && (!ops->del_key || !ops->set_default_key));
334         WARN_ON(ops->auth && (!ops->assoc || !ops->deauth || !ops->disassoc));
335         WARN_ON(ops->connect && !ops->disconnect);
336         WARN_ON(ops->join_ibss && !ops->leave_ibss);
337         WARN_ON(ops->add_virtual_intf && !ops->del_virtual_intf);
338         WARN_ON(ops->add_station && !ops->del_station);
339         WARN_ON(ops->add_mpath && !ops->del_mpath);
340         WARN_ON(ops->join_mesh && !ops->leave_mesh);
341
342         alloc_size = sizeof(*rdev) + sizeof_priv;
343
344         rdev = kzalloc(alloc_size, GFP_KERNEL);
345         if (!rdev)
346                 return NULL;
347
348         rdev->ops = ops;
349
350         mutex_lock(&cfg80211_mutex);
351
352         rdev->wiphy_idx = wiphy_counter++;
353
354         if (unlikely(!wiphy_idx_valid(rdev->wiphy_idx))) {
355                 wiphy_counter--;
356                 mutex_unlock(&cfg80211_mutex);
357                 /* ugh, wrapped! */
358                 kfree(rdev);
359                 return NULL;
360         }
361
362         mutex_unlock(&cfg80211_mutex);
363
364         /* give it a proper name */
365         dev_set_name(&rdev->wiphy.dev, PHY_NAME "%d", rdev->wiphy_idx);
366
367         mutex_init(&rdev->mtx);
368         mutex_init(&rdev->devlist_mtx);
369         INIT_LIST_HEAD(&rdev->netdev_list);
370         spin_lock_init(&rdev->bss_lock);
371         INIT_LIST_HEAD(&rdev->bss_list);
372         INIT_WORK(&rdev->scan_done_wk, __cfg80211_scan_done);
373
374 #ifdef CONFIG_CFG80211_WEXT
375         rdev->wiphy.wext = &cfg80211_wext_handler;
376 #endif
377
378         device_initialize(&rdev->wiphy.dev);
379         rdev->wiphy.dev.class = &ieee80211_class;
380         rdev->wiphy.dev.platform_data = rdev;
381
382 #ifdef CONFIG_CFG80211_DEFAULT_PS
383         rdev->wiphy.flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT;
384 #endif
385
386         wiphy_net_set(&rdev->wiphy, &init_net);
387
388         rdev->rfkill_ops.set_block = cfg80211_rfkill_set_block;
389         rdev->rfkill = rfkill_alloc(dev_name(&rdev->wiphy.dev),
390                                    &rdev->wiphy.dev, RFKILL_TYPE_WLAN,
391                                    &rdev->rfkill_ops, rdev);
392
393         if (!rdev->rfkill) {
394                 kfree(rdev);
395                 return NULL;
396         }
397
398         INIT_WORK(&rdev->rfkill_sync, cfg80211_rfkill_sync_work);
399         INIT_WORK(&rdev->conn_work, cfg80211_conn_work);
400         INIT_WORK(&rdev->event_work, cfg80211_event_work);
401
402         init_waitqueue_head(&rdev->dev_wait);
403
404         /*
405          * Initialize wiphy parameters to IEEE 802.11 MIB default values.
406          * Fragmentation and RTS threshold are disabled by default with the
407          * special -1 value.
408          */
409         rdev->wiphy.retry_short = 7;
410         rdev->wiphy.retry_long = 4;
411         rdev->wiphy.frag_threshold = (u32) -1;
412         rdev->wiphy.rts_threshold = (u32) -1;
413         rdev->wiphy.coverage_class = 0;
414
415         return &rdev->wiphy;
416 }
417 EXPORT_SYMBOL(wiphy_new);
418
419 int wiphy_register(struct wiphy *wiphy)
420 {
421         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
422         int res;
423         enum ieee80211_band band;
424         struct ieee80211_supported_band *sband;
425         bool have_band = false;
426         int i;
427         u16 ifmodes = wiphy->interface_modes;
428
429         if (WARN_ON(wiphy->addresses && !wiphy->n_addresses))
430                 return -EINVAL;
431
432         if (WARN_ON(wiphy->addresses &&
433                     !is_zero_ether_addr(wiphy->perm_addr) &&
434                     memcmp(wiphy->perm_addr, wiphy->addresses[0].addr,
435                            ETH_ALEN)))
436                 return -EINVAL;
437
438         if (wiphy->addresses)
439                 memcpy(wiphy->perm_addr, wiphy->addresses[0].addr, ETH_ALEN);
440
441         /* sanity check ifmodes */
442         WARN_ON(!ifmodes);
443         ifmodes &= ((1 << NUM_NL80211_IFTYPES) - 1) & ~1;
444         if (WARN_ON(ifmodes != wiphy->interface_modes))
445                 wiphy->interface_modes = ifmodes;
446
447         /* sanity check supported bands/channels */
448         for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
449                 sband = wiphy->bands[band];
450                 if (!sband)
451                         continue;
452
453                 sband->band = band;
454
455                 if (WARN_ON(!sband->n_channels || !sband->n_bitrates))
456                         return -EINVAL;
457
458                 /*
459                  * Since cfg80211_disable_40mhz_24ghz is global, we can
460                  * modify the sband's ht data even if the driver uses a
461                  * global structure for that.
462                  */
463                 if (cfg80211_disable_40mhz_24ghz &&
464                     band == IEEE80211_BAND_2GHZ &&
465                     sband->ht_cap.ht_supported) {
466                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SUP_WIDTH_20_40;
467                         sband->ht_cap.cap &= ~IEEE80211_HT_CAP_SGI_40;
468                 }
469
470                 /*
471                  * Since we use a u32 for rate bitmaps in
472                  * ieee80211_get_response_rate, we cannot
473                  * have more than 32 legacy rates.
474                  */
475                 if (WARN_ON(sband->n_bitrates > 32))
476                         return -EINVAL;
477
478                 for (i = 0; i < sband->n_channels; i++) {
479                         sband->channels[i].orig_flags =
480                                 sband->channels[i].flags;
481                         sband->channels[i].orig_mag =
482                                 sband->channels[i].max_antenna_gain;
483                         sband->channels[i].orig_mpwr =
484                                 sband->channels[i].max_power;
485                         sband->channels[i].band = band;
486                 }
487
488                 have_band = true;
489         }
490
491         if (!have_band) {
492                 WARN_ON(1);
493                 return -EINVAL;
494         }
495
496         /* check and set up bitrates */
497         ieee80211_set_bitrate_flags(wiphy);
498
499         mutex_lock(&cfg80211_mutex);
500
501         res = device_add(&rdev->wiphy.dev);
502         if (res) {
503                 mutex_unlock(&cfg80211_mutex);
504                 return res;
505         }
506
507         /* set up regulatory info */
508         wiphy_update_regulatory(wiphy, NL80211_REGDOM_SET_BY_CORE);
509
510         list_add_rcu(&rdev->list, &cfg80211_rdev_list);
511         cfg80211_rdev_list_generation++;
512
513         /* add to debugfs */
514         rdev->wiphy.debugfsdir =
515                 debugfs_create_dir(wiphy_name(&rdev->wiphy),
516                                    ieee80211_debugfs_dir);
517         if (IS_ERR(rdev->wiphy.debugfsdir))
518                 rdev->wiphy.debugfsdir = NULL;
519
520         if (wiphy->flags & WIPHY_FLAG_CUSTOM_REGULATORY) {
521                 struct regulatory_request request;
522
523                 request.wiphy_idx = get_wiphy_idx(wiphy);
524                 request.initiator = NL80211_REGDOM_SET_BY_DRIVER;
525                 request.alpha2[0] = '9';
526                 request.alpha2[1] = '9';
527
528                 nl80211_send_reg_change_event(&request);
529         }
530
531         cfg80211_debugfs_rdev_add(rdev);
532         mutex_unlock(&cfg80211_mutex);
533
534         /*
535          * due to a locking dependency this has to be outside of the
536          * cfg80211_mutex lock
537          */
538         res = rfkill_register(rdev->rfkill);
539         if (res)
540                 goto out_rm_dev;
541
542         return 0;
543
544 out_rm_dev:
545         device_del(&rdev->wiphy.dev);
546         return res;
547 }
548 EXPORT_SYMBOL(wiphy_register);
549
550 void wiphy_rfkill_start_polling(struct wiphy *wiphy)
551 {
552         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
553
554         if (!rdev->ops->rfkill_poll)
555                 return;
556         rdev->rfkill_ops.poll = cfg80211_rfkill_poll;
557         rfkill_resume_polling(rdev->rfkill);
558 }
559 EXPORT_SYMBOL(wiphy_rfkill_start_polling);
560
561 void wiphy_rfkill_stop_polling(struct wiphy *wiphy)
562 {
563         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
564
565         rfkill_pause_polling(rdev->rfkill);
566 }
567 EXPORT_SYMBOL(wiphy_rfkill_stop_polling);
568
569 void wiphy_unregister(struct wiphy *wiphy)
570 {
571         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
572
573         rfkill_unregister(rdev->rfkill);
574
575         /* protect the device list */
576         mutex_lock(&cfg80211_mutex);
577
578         wait_event(rdev->dev_wait, ({
579                 int __count;
580                 mutex_lock(&rdev->devlist_mtx);
581                 __count = rdev->opencount;
582                 mutex_unlock(&rdev->devlist_mtx);
583                 __count == 0;}));
584
585         mutex_lock(&rdev->devlist_mtx);
586         BUG_ON(!list_empty(&rdev->netdev_list));
587         mutex_unlock(&rdev->devlist_mtx);
588
589         /*
590          * First remove the hardware from everywhere, this makes
591          * it impossible to find from userspace.
592          */
593         debugfs_remove_recursive(rdev->wiphy.debugfsdir);
594         list_del_rcu(&rdev->list);
595         synchronize_rcu();
596
597         /*
598          * Try to grab rdev->mtx. If a command is still in progress,
599          * hopefully the driver will refuse it since it's tearing
600          * down the device already. We wait for this command to complete
601          * before unlinking the item from the list.
602          * Note: as codified by the BUG_ON above we cannot get here if
603          * a virtual interface is still present. Hence, we can only get
604          * to lock contention here if userspace issues a command that
605          * identified the hardware by wiphy index.
606          */
607         cfg80211_lock_rdev(rdev);
608         /* nothing */
609         cfg80211_unlock_rdev(rdev);
610
611         /* If this device got a regulatory hint tell core its
612          * free to listen now to a new shiny device regulatory hint */
613         reg_device_remove(wiphy);
614
615         cfg80211_rdev_list_generation++;
616         device_del(&rdev->wiphy.dev);
617
618         mutex_unlock(&cfg80211_mutex);
619
620         flush_work(&rdev->scan_done_wk);
621         cancel_work_sync(&rdev->conn_work);
622         flush_work(&rdev->event_work);
623 }
624 EXPORT_SYMBOL(wiphy_unregister);
625
626 void cfg80211_dev_free(struct cfg80211_registered_device *rdev)
627 {
628         struct cfg80211_internal_bss *scan, *tmp;
629         rfkill_destroy(rdev->rfkill);
630         mutex_destroy(&rdev->mtx);
631         mutex_destroy(&rdev->devlist_mtx);
632         list_for_each_entry_safe(scan, tmp, &rdev->bss_list, list)
633                 cfg80211_put_bss(&scan->pub);
634         kfree(rdev);
635 }
636
637 void wiphy_free(struct wiphy *wiphy)
638 {
639         put_device(&wiphy->dev);
640 }
641 EXPORT_SYMBOL(wiphy_free);
642
643 void wiphy_rfkill_set_hw_state(struct wiphy *wiphy, bool blocked)
644 {
645         struct cfg80211_registered_device *rdev = wiphy_to_dev(wiphy);
646
647         if (rfkill_set_hw_state(rdev->rfkill, blocked))
648                 schedule_work(&rdev->rfkill_sync);
649 }
650 EXPORT_SYMBOL(wiphy_rfkill_set_hw_state);
651
652 static void wdev_cleanup_work(struct work_struct *work)
653 {
654         struct wireless_dev *wdev;
655         struct cfg80211_registered_device *rdev;
656
657         wdev = container_of(work, struct wireless_dev, cleanup_work);
658         rdev = wiphy_to_dev(wdev->wiphy);
659
660         cfg80211_lock_rdev(rdev);
661
662         if (WARN_ON(rdev->scan_req && rdev->scan_req->dev == wdev->netdev)) {
663                 rdev->scan_req->aborted = true;
664                 ___cfg80211_scan_done(rdev, true);
665         }
666
667         cfg80211_unlock_rdev(rdev);
668
669         mutex_lock(&rdev->devlist_mtx);
670         rdev->opencount--;
671         mutex_unlock(&rdev->devlist_mtx);
672         wake_up(&rdev->dev_wait);
673
674         dev_put(wdev->netdev);
675 }
676
677 static struct device_type wiphy_type = {
678         .name   = "wlan",
679 };
680
681 static int cfg80211_netdev_notifier_call(struct notifier_block * nb,
682                                          unsigned long state,
683                                          void *ndev)
684 {
685         struct net_device *dev = ndev;
686         struct wireless_dev *wdev = dev->ieee80211_ptr;
687         struct cfg80211_registered_device *rdev;
688
689         if (!wdev)
690                 return NOTIFY_DONE;
691
692         rdev = wiphy_to_dev(wdev->wiphy);
693
694         WARN_ON(wdev->iftype == NL80211_IFTYPE_UNSPECIFIED);
695
696         switch (state) {
697         case NETDEV_POST_INIT:
698                 SET_NETDEV_DEVTYPE(dev, &wiphy_type);
699                 break;
700         case NETDEV_REGISTER:
701                 /*
702                  * NB: cannot take rdev->mtx here because this may be
703                  * called within code protected by it when interfaces
704                  * are added with nl80211.
705                  */
706                 mutex_init(&wdev->mtx);
707                 INIT_WORK(&wdev->cleanup_work, wdev_cleanup_work);
708                 INIT_LIST_HEAD(&wdev->event_list);
709                 spin_lock_init(&wdev->event_lock);
710                 INIT_LIST_HEAD(&wdev->mgmt_registrations);
711                 spin_lock_init(&wdev->mgmt_registrations_lock);
712
713                 mutex_lock(&rdev->devlist_mtx);
714                 list_add_rcu(&wdev->list, &rdev->netdev_list);
715                 rdev->devlist_generation++;
716                 /* can only change netns with wiphy */
717                 dev->features |= NETIF_F_NETNS_LOCAL;
718
719                 if (sysfs_create_link(&dev->dev.kobj, &rdev->wiphy.dev.kobj,
720                                       "phy80211")) {
721                         pr_err("failed to add phy80211 symlink to netdev!\n");
722                 }
723                 wdev->netdev = dev;
724                 wdev->sme_state = CFG80211_SME_IDLE;
725                 mutex_unlock(&rdev->devlist_mtx);
726 #ifdef CONFIG_CFG80211_WEXT
727                 wdev->wext.default_key = -1;
728                 wdev->wext.default_mgmt_key = -1;
729                 wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
730 #endif
731
732                 if (wdev->wiphy->flags & WIPHY_FLAG_PS_ON_BY_DEFAULT)
733                         wdev->ps = true;
734                 else
735                         wdev->ps = false;
736                 /* allow mac80211 to determine the timeout */
737                 wdev->ps_timeout = -1;
738
739                 if (!dev->ethtool_ops)
740                         dev->ethtool_ops = &cfg80211_ethtool_ops;
741
742                 if ((wdev->iftype == NL80211_IFTYPE_STATION ||
743                      wdev->iftype == NL80211_IFTYPE_P2P_CLIENT ||
744                      wdev->iftype == NL80211_IFTYPE_ADHOC) && !wdev->use_4addr)
745                         dev->priv_flags |= IFF_DONT_BRIDGE;
746                 break;
747         case NETDEV_GOING_DOWN:
748                 switch (wdev->iftype) {
749                 case NL80211_IFTYPE_ADHOC:
750                         cfg80211_leave_ibss(rdev, dev, true);
751                         break;
752                 case NL80211_IFTYPE_P2P_CLIENT:
753                 case NL80211_IFTYPE_STATION:
754                         wdev_lock(wdev);
755 #ifdef CONFIG_CFG80211_WEXT
756                         kfree(wdev->wext.ie);
757                         wdev->wext.ie = NULL;
758                         wdev->wext.ie_len = 0;
759                         wdev->wext.connect.auth_type = NL80211_AUTHTYPE_AUTOMATIC;
760 #endif
761                         __cfg80211_disconnect(rdev, dev,
762                                               WLAN_REASON_DEAUTH_LEAVING, true);
763                         cfg80211_mlme_down(rdev, dev);
764                         wdev_unlock(wdev);
765                         break;
766                 case NL80211_IFTYPE_MESH_POINT:
767                         cfg80211_leave_mesh(rdev, dev);
768                         break;
769                 default:
770                         break;
771                 }
772                 break;
773         case NETDEV_DOWN:
774                 dev_hold(dev);
775                 queue_work(cfg80211_wq, &wdev->cleanup_work);
776                 break;
777         case NETDEV_UP:
778                 /*
779                  * If we have a really quick DOWN/UP succession we may
780                  * have this work still pending ... cancel it and see
781                  * if it was pending, in which case we need to account
782                  * for some of the work it would have done.
783                  */
784                 if (cancel_work_sync(&wdev->cleanup_work)) {
785                         mutex_lock(&rdev->devlist_mtx);
786                         rdev->opencount--;
787                         mutex_unlock(&rdev->devlist_mtx);
788                         dev_put(dev);
789                 }
790                 cfg80211_lock_rdev(rdev);
791                 mutex_lock(&rdev->devlist_mtx);
792                 wdev_lock(wdev);
793                 switch (wdev->iftype) {
794 #ifdef CONFIG_CFG80211_WEXT
795                 case NL80211_IFTYPE_ADHOC:
796                         cfg80211_ibss_wext_join(rdev, wdev);
797                         break;
798                 case NL80211_IFTYPE_STATION:
799                         cfg80211_mgd_wext_connect(rdev, wdev);
800                         break;
801 #endif
802 #ifdef CONFIG_MAC80211_MESH
803                 case NL80211_IFTYPE_MESH_POINT:
804                         {
805                                 /* backward compat code... */
806                                 struct mesh_setup setup;
807                                 memcpy(&setup, &default_mesh_setup,
808                                                 sizeof(setup));
809                                  /* back compat only needed for mesh_id */
810                                 setup.mesh_id = wdev->ssid;
811                                 setup.mesh_id_len = wdev->mesh_id_up_len;
812                                 if (wdev->mesh_id_up_len)
813                                         __cfg80211_join_mesh(rdev, dev,
814                                                         &setup,
815                                                         &default_mesh_config);
816                                 break;
817                         }
818 #endif
819                 default:
820                         break;
821                 }
822                 wdev_unlock(wdev);
823                 rdev->opencount++;
824                 mutex_unlock(&rdev->devlist_mtx);
825                 cfg80211_unlock_rdev(rdev);
826
827                 /*
828                  * Configure power management to the driver here so that its
829                  * correctly set also after interface type changes etc.
830                  */
831                 if (wdev->iftype == NL80211_IFTYPE_STATION &&
832                     rdev->ops->set_power_mgmt)
833                         if (rdev->ops->set_power_mgmt(wdev->wiphy, dev,
834                                                       wdev->ps,
835                                                       wdev->ps_timeout)) {
836                                 /* assume this means it's off */
837                                 wdev->ps = false;
838                         }
839                 break;
840         case NETDEV_UNREGISTER:
841                 /*
842                  * NB: cannot take rdev->mtx here because this may be
843                  * called within code protected by it when interfaces
844                  * are removed with nl80211.
845                  */
846                 mutex_lock(&rdev->devlist_mtx);
847                 /*
848                  * It is possible to get NETDEV_UNREGISTER
849                  * multiple times. To detect that, check
850                  * that the interface is still on the list
851                  * of registered interfaces, and only then
852                  * remove and clean it up.
853                  */
854                 if (!list_empty(&wdev->list)) {
855                         sysfs_remove_link(&dev->dev.kobj, "phy80211");
856                         list_del_rcu(&wdev->list);
857                         rdev->devlist_generation++;
858                         cfg80211_mlme_purge_registrations(wdev);
859 #ifdef CONFIG_CFG80211_WEXT
860                         kfree(wdev->wext.keys);
861 #endif
862                 }
863                 mutex_unlock(&rdev->devlist_mtx);
864                 /*
865                  * synchronise (so that we won't find this netdev
866                  * from other code any more) and then clear the list
867                  * head so that the above code can safely check for
868                  * !list_empty() to avoid double-cleanup.
869                  */
870                 synchronize_rcu();
871                 INIT_LIST_HEAD(&wdev->list);
872                 break;
873         case NETDEV_PRE_UP:
874                 if (!(wdev->wiphy->interface_modes & BIT(wdev->iftype)))
875                         return notifier_from_errno(-EOPNOTSUPP);
876                 if (rfkill_blocked(rdev->rfkill))
877                         return notifier_from_errno(-ERFKILL);
878                 break;
879         }
880
881         return NOTIFY_DONE;
882 }
883
884 static struct notifier_block cfg80211_netdev_notifier = {
885         .notifier_call = cfg80211_netdev_notifier_call,
886 };
887
888 static void __net_exit cfg80211_pernet_exit(struct net *net)
889 {
890         struct cfg80211_registered_device *rdev;
891
892         rtnl_lock();
893         mutex_lock(&cfg80211_mutex);
894         list_for_each_entry(rdev, &cfg80211_rdev_list, list) {
895                 if (net_eq(wiphy_net(&rdev->wiphy), net))
896                         WARN_ON(cfg80211_switch_netns(rdev, &init_net));
897         }
898         mutex_unlock(&cfg80211_mutex);
899         rtnl_unlock();
900 }
901
902 static struct pernet_operations cfg80211_pernet_ops = {
903         .exit = cfg80211_pernet_exit,
904 };
905
906 static int __init cfg80211_init(void)
907 {
908         int err;
909
910         err = register_pernet_device(&cfg80211_pernet_ops);
911         if (err)
912                 goto out_fail_pernet;
913
914         err = wiphy_sysfs_init();
915         if (err)
916                 goto out_fail_sysfs;
917
918         err = register_netdevice_notifier(&cfg80211_netdev_notifier);
919         if (err)
920                 goto out_fail_notifier;
921
922         err = nl80211_init();
923         if (err)
924                 goto out_fail_nl80211;
925
926         ieee80211_debugfs_dir = debugfs_create_dir("ieee80211", NULL);
927
928         err = regulatory_init();
929         if (err)
930                 goto out_fail_reg;
931
932         cfg80211_wq = create_singlethread_workqueue("cfg80211");
933         if (!cfg80211_wq)
934                 goto out_fail_wq;
935
936         return 0;
937
938 out_fail_wq:
939         regulatory_exit();
940 out_fail_reg:
941         debugfs_remove(ieee80211_debugfs_dir);
942 out_fail_nl80211:
943         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
944 out_fail_notifier:
945         wiphy_sysfs_exit();
946 out_fail_sysfs:
947         unregister_pernet_device(&cfg80211_pernet_ops);
948 out_fail_pernet:
949         return err;
950 }
951 subsys_initcall(cfg80211_init);
952
953 static void __exit cfg80211_exit(void)
954 {
955         debugfs_remove(ieee80211_debugfs_dir);
956         nl80211_exit();
957         unregister_netdevice_notifier(&cfg80211_netdev_notifier);
958         wiphy_sysfs_exit();
959         regulatory_exit();
960         unregister_pernet_device(&cfg80211_pernet_ops);
961         destroy_workqueue(cfg80211_wq);
962 }
963 module_exit(cfg80211_exit);