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