main.c revision 04b7b2ff50fc77380c1e711f1d7223734547e41b
1/*
2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <net/mac80211.h>
12#include <linux/module.h>
13#include <linux/init.h>
14#include <linux/netdevice.h>
15#include <linux/types.h>
16#include <linux/slab.h>
17#include <linux/skbuff.h>
18#include <linux/etherdevice.h>
19#include <linux/if_arp.h>
20#include <linux/rtnetlink.h>
21#include <linux/bitmap.h>
22#include <linux/pm_qos.h>
23#include <linux/inetdevice.h>
24#include <net/net_namespace.h>
25#include <net/cfg80211.h>
26
27#include "ieee80211_i.h"
28#include "driver-ops.h"
29#include "rate.h"
30#include "mesh.h"
31#include "wep.h"
32#include "led.h"
33#include "cfg.h"
34#include "debugfs.h"
35
36static struct lock_class_key ieee80211_rx_skb_queue_class;
37
38void ieee80211_configure_filter(struct ieee80211_local *local)
39{
40	u64 mc;
41	unsigned int changed_flags;
42	unsigned int new_flags = 0;
43
44	if (atomic_read(&local->iff_promiscs))
45		new_flags |= FIF_PROMISC_IN_BSS;
46
47	if (atomic_read(&local->iff_allmultis))
48		new_flags |= FIF_ALLMULTI;
49
50	if (local->monitors || test_bit(SCAN_SW_SCANNING, &local->scanning) ||
51	    test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning))
52		new_flags |= FIF_BCN_PRBRESP_PROMISC;
53
54	if (local->fif_probe_req || local->probe_req_reg)
55		new_flags |= FIF_PROBE_REQ;
56
57	if (local->fif_fcsfail)
58		new_flags |= FIF_FCSFAIL;
59
60	if (local->fif_plcpfail)
61		new_flags |= FIF_PLCPFAIL;
62
63	if (local->fif_control)
64		new_flags |= FIF_CONTROL;
65
66	if (local->fif_other_bss)
67		new_flags |= FIF_OTHER_BSS;
68
69	if (local->fif_pspoll)
70		new_flags |= FIF_PSPOLL;
71
72	spin_lock_bh(&local->filter_lock);
73	changed_flags = local->filter_flags ^ new_flags;
74
75	mc = drv_prepare_multicast(local, &local->mc_list);
76	spin_unlock_bh(&local->filter_lock);
77
78	/* be a bit nasty */
79	new_flags |= (1<<31);
80
81	drv_configure_filter(local, changed_flags, &new_flags, mc);
82
83	WARN_ON(new_flags & (1<<31));
84
85	local->filter_flags = new_flags & ~(1<<31);
86}
87
88static void ieee80211_reconfig_filter(struct work_struct *work)
89{
90	struct ieee80211_local *local =
91		container_of(work, struct ieee80211_local, reconfig_filter);
92
93	ieee80211_configure_filter(local);
94}
95
96int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
97{
98	struct ieee80211_channel *chan;
99	int ret = 0;
100	int power;
101	enum nl80211_channel_type channel_type;
102	u32 offchannel_flag;
103
104	might_sleep();
105
106	offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
107	if (local->scan_channel) {
108		chan = local->scan_channel;
109		/* If scanning on oper channel, use whatever channel-type
110		 * is currently in use.
111		 */
112		if (chan == local->oper_channel)
113			channel_type = local->_oper_channel_type;
114		else
115			channel_type = NL80211_CHAN_NO_HT;
116	} else if (local->tmp_channel) {
117		chan = local->tmp_channel;
118		channel_type = local->tmp_channel_type;
119	} else {
120		chan = local->oper_channel;
121		channel_type = local->_oper_channel_type;
122	}
123
124	if (chan != local->oper_channel ||
125	    channel_type != local->_oper_channel_type)
126		local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL;
127	else
128		local->hw.conf.flags &= ~IEEE80211_CONF_OFFCHANNEL;
129
130	offchannel_flag ^= local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
131
132	if (offchannel_flag || chan != local->hw.conf.channel ||
133	    channel_type != local->hw.conf.channel_type) {
134		local->hw.conf.channel = chan;
135		local->hw.conf.channel_type = channel_type;
136		changed |= IEEE80211_CONF_CHANGE_CHANNEL;
137	}
138
139	if (!conf_is_ht(&local->hw.conf)) {
140		/*
141		 * mac80211.h documents that this is only valid
142		 * when the channel is set to an HT type, and
143		 * that otherwise STATIC is used.
144		 */
145		local->hw.conf.smps_mode = IEEE80211_SMPS_STATIC;
146	} else if (local->hw.conf.smps_mode != local->smps_mode) {
147		local->hw.conf.smps_mode = local->smps_mode;
148		changed |= IEEE80211_CONF_CHANGE_SMPS;
149	}
150
151	if (test_bit(SCAN_SW_SCANNING, &local->scanning) ||
152	    test_bit(SCAN_ONCHANNEL_SCANNING, &local->scanning) ||
153	    test_bit(SCAN_HW_SCANNING, &local->scanning) ||
154	    !local->ap_power_level)
155		power = chan->max_power;
156	else
157		power = min(chan->max_power, local->ap_power_level);
158
159	if (local->user_power_level >= 0)
160		power = min(power, local->user_power_level);
161
162	if (local->hw.conf.power_level != power) {
163		changed |= IEEE80211_CONF_CHANGE_POWER;
164		local->hw.conf.power_level = power;
165	}
166
167	if (changed && local->open_count) {
168		ret = drv_config(local, changed);
169		/*
170		 * Goal:
171		 * HW reconfiguration should never fail, the driver has told
172		 * us what it can support so it should live up to that promise.
173		 *
174		 * Current status:
175		 * rfkill is not integrated with mac80211 and a
176		 * configuration command can thus fail if hardware rfkill
177		 * is enabled
178		 *
179		 * FIXME: integrate rfkill with mac80211 and then add this
180		 * WARN_ON() back
181		 *
182		 */
183		/* WARN_ON(ret); */
184	}
185
186	return ret;
187}
188
189void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata,
190				      u32 changed)
191{
192	struct ieee80211_local *local = sdata->local;
193	static const u8 zero[ETH_ALEN] = { 0 };
194
195	if (!changed)
196		return;
197
198	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
199		sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid;
200	} else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
201		sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid;
202	else if (sdata->vif.type == NL80211_IFTYPE_AP)
203		sdata->vif.bss_conf.bssid = sdata->vif.addr;
204	else if (sdata->vif.type == NL80211_IFTYPE_WDS)
205		sdata->vif.bss_conf.bssid = NULL;
206	else if (ieee80211_vif_is_mesh(&sdata->vif)) {
207		sdata->vif.bss_conf.bssid = zero;
208	} else if (sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE) {
209		sdata->vif.bss_conf.bssid = sdata->vif.addr;
210		WARN_ONCE(changed & ~(BSS_CHANGED_IDLE),
211			  "P2P Device BSS changed %#x", changed);
212	} else {
213		WARN_ON(1);
214		return;
215	}
216
217	switch (sdata->vif.type) {
218	case NL80211_IFTYPE_AP:
219	case NL80211_IFTYPE_ADHOC:
220	case NL80211_IFTYPE_WDS:
221	case NL80211_IFTYPE_MESH_POINT:
222		break;
223	default:
224		/* do not warn to simplify caller in scan.c */
225		changed &= ~BSS_CHANGED_BEACON_ENABLED;
226		if (WARN_ON(changed & BSS_CHANGED_BEACON))
227			return;
228		break;
229	}
230
231	if (changed & BSS_CHANGED_BEACON_ENABLED) {
232		if (local->quiescing || !ieee80211_sdata_running(sdata) ||
233		    test_bit(SDATA_STATE_OFFCHANNEL, &sdata->state)) {
234			sdata->vif.bss_conf.enable_beacon = false;
235		} else {
236			/*
237			 * Beacon should be enabled, but AP mode must
238			 * check whether there is a beacon configured.
239			 */
240			switch (sdata->vif.type) {
241			case NL80211_IFTYPE_AP:
242				sdata->vif.bss_conf.enable_beacon =
243					!!sdata->u.ap.beacon;
244				break;
245			case NL80211_IFTYPE_ADHOC:
246				sdata->vif.bss_conf.enable_beacon =
247					!!sdata->u.ibss.presp;
248				break;
249#ifdef CONFIG_MAC80211_MESH
250			case NL80211_IFTYPE_MESH_POINT:
251				sdata->vif.bss_conf.enable_beacon =
252					!!sdata->u.mesh.mesh_id_len;
253				break;
254#endif
255			default:
256				/* not reached */
257				WARN_ON(1);
258				break;
259			}
260		}
261	}
262
263	drv_bss_info_changed(local, sdata, &sdata->vif.bss_conf, changed);
264}
265
266u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata)
267{
268	sdata->vif.bss_conf.use_cts_prot = false;
269	sdata->vif.bss_conf.use_short_preamble = false;
270	sdata->vif.bss_conf.use_short_slot = false;
271	return BSS_CHANGED_ERP_CTS_PROT |
272	       BSS_CHANGED_ERP_PREAMBLE |
273	       BSS_CHANGED_ERP_SLOT;
274}
275
276static void ieee80211_tasklet_handler(unsigned long data)
277{
278	struct ieee80211_local *local = (struct ieee80211_local *) data;
279	struct sta_info *sta, *tmp;
280	struct skb_eosp_msg_data *eosp_data;
281	struct sk_buff *skb;
282
283	while ((skb = skb_dequeue(&local->skb_queue)) ||
284	       (skb = skb_dequeue(&local->skb_queue_unreliable))) {
285		switch (skb->pkt_type) {
286		case IEEE80211_RX_MSG:
287			/* Clear skb->pkt_type in order to not confuse kernel
288			 * netstack. */
289			skb->pkt_type = 0;
290			ieee80211_rx(&local->hw, skb);
291			break;
292		case IEEE80211_TX_STATUS_MSG:
293			skb->pkt_type = 0;
294			ieee80211_tx_status(&local->hw, skb);
295			break;
296		case IEEE80211_EOSP_MSG:
297			eosp_data = (void *)skb->cb;
298			for_each_sta_info(local, eosp_data->sta, sta, tmp) {
299				/* skip wrong virtual interface */
300				if (memcmp(eosp_data->iface,
301					   sta->sdata->vif.addr, ETH_ALEN))
302					continue;
303				clear_sta_flag(sta, WLAN_STA_SP);
304				break;
305			}
306			dev_kfree_skb(skb);
307			break;
308		default:
309			WARN(1, "mac80211: Packet is of unknown type %d\n",
310			     skb->pkt_type);
311			dev_kfree_skb(skb);
312			break;
313		}
314	}
315}
316
317static void ieee80211_restart_work(struct work_struct *work)
318{
319	struct ieee80211_local *local =
320		container_of(work, struct ieee80211_local, restart_work);
321
322	/* wait for scan work complete */
323	flush_workqueue(local->workqueue);
324
325	mutex_lock(&local->mtx);
326	WARN(test_bit(SCAN_HW_SCANNING, &local->scanning) ||
327	     rcu_dereference_protected(local->sched_scan_sdata,
328				       lockdep_is_held(&local->mtx)),
329		"%s called with hardware scan in progress\n", __func__);
330	mutex_unlock(&local->mtx);
331
332	rtnl_lock();
333	ieee80211_scan_cancel(local);
334	ieee80211_reconfig(local);
335	rtnl_unlock();
336}
337
338void ieee80211_restart_hw(struct ieee80211_hw *hw)
339{
340	struct ieee80211_local *local = hw_to_local(hw);
341
342	trace_api_restart_hw(local);
343
344	wiphy_info(hw->wiphy,
345		   "Hardware restart was requested\n");
346
347	/* use this reason, ieee80211_reconfig will unblock it */
348	ieee80211_stop_queues_by_reason(hw,
349		IEEE80211_QUEUE_STOP_REASON_SUSPEND);
350
351	/*
352	 * Stop all Rx during the reconfig. We don't want state changes
353	 * or driver callbacks while this is in progress.
354	 */
355	local->in_reconfig = true;
356	barrier();
357
358	schedule_work(&local->restart_work);
359}
360EXPORT_SYMBOL(ieee80211_restart_hw);
361
362static void ieee80211_recalc_smps_work(struct work_struct *work)
363{
364	struct ieee80211_local *local =
365		container_of(work, struct ieee80211_local, recalc_smps);
366
367	mutex_lock(&local->iflist_mtx);
368	ieee80211_recalc_smps(local);
369	mutex_unlock(&local->iflist_mtx);
370}
371
372#ifdef CONFIG_INET
373static int ieee80211_ifa_changed(struct notifier_block *nb,
374				 unsigned long data, void *arg)
375{
376	struct in_ifaddr *ifa = arg;
377	struct ieee80211_local *local =
378		container_of(nb, struct ieee80211_local,
379			     ifa_notifier);
380	struct net_device *ndev = ifa->ifa_dev->dev;
381	struct wireless_dev *wdev = ndev->ieee80211_ptr;
382	struct in_device *idev;
383	struct ieee80211_sub_if_data *sdata;
384	struct ieee80211_bss_conf *bss_conf;
385	struct ieee80211_if_managed *ifmgd;
386	int c = 0;
387
388	/* Make sure it's our interface that got changed */
389	if (!wdev)
390		return NOTIFY_DONE;
391
392	if (wdev->wiphy != local->hw.wiphy)
393		return NOTIFY_DONE;
394
395	sdata = IEEE80211_DEV_TO_SUB_IF(ndev);
396	bss_conf = &sdata->vif.bss_conf;
397
398	/* ARP filtering is only supported in managed mode */
399	if (sdata->vif.type != NL80211_IFTYPE_STATION)
400		return NOTIFY_DONE;
401
402	idev = __in_dev_get_rtnl(sdata->dev);
403	if (!idev)
404		return NOTIFY_DONE;
405
406	ifmgd = &sdata->u.mgd;
407	mutex_lock(&ifmgd->mtx);
408
409	/* Copy the addresses to the bss_conf list */
410	ifa = idev->ifa_list;
411	while (c < IEEE80211_BSS_ARP_ADDR_LIST_LEN && ifa) {
412		bss_conf->arp_addr_list[c] = ifa->ifa_address;
413		ifa = ifa->ifa_next;
414		c++;
415	}
416
417	/* If not all addresses fit the list, disable filtering */
418	if (ifa) {
419		sdata->arp_filter_state = false;
420		c = 0;
421	} else {
422		sdata->arp_filter_state = true;
423	}
424	bss_conf->arp_addr_cnt = c;
425
426	/* Configure driver only if associated (which also implies it is up) */
427	if (ifmgd->associated) {
428		bss_conf->arp_filter_enabled = sdata->arp_filter_state;
429		ieee80211_bss_info_change_notify(sdata,
430						 BSS_CHANGED_ARP_FILTER);
431	}
432
433	mutex_unlock(&ifmgd->mtx);
434
435	return NOTIFY_DONE;
436}
437#endif
438
439static int ieee80211_napi_poll(struct napi_struct *napi, int budget)
440{
441	struct ieee80211_local *local =
442		container_of(napi, struct ieee80211_local, napi);
443
444	return local->ops->napi_poll(&local->hw, budget);
445}
446
447void ieee80211_napi_schedule(struct ieee80211_hw *hw)
448{
449	struct ieee80211_local *local = hw_to_local(hw);
450
451	napi_schedule(&local->napi);
452}
453EXPORT_SYMBOL(ieee80211_napi_schedule);
454
455void ieee80211_napi_complete(struct ieee80211_hw *hw)
456{
457	struct ieee80211_local *local = hw_to_local(hw);
458
459	napi_complete(&local->napi);
460}
461EXPORT_SYMBOL(ieee80211_napi_complete);
462
463/* There isn't a lot of sense in it, but you can transmit anything you like */
464static const struct ieee80211_txrx_stypes
465ieee80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = {
466	[NL80211_IFTYPE_ADHOC] = {
467		.tx = 0xffff,
468		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
469			BIT(IEEE80211_STYPE_AUTH >> 4) |
470			BIT(IEEE80211_STYPE_DEAUTH >> 4),
471	},
472	[NL80211_IFTYPE_STATION] = {
473		.tx = 0xffff,
474		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
475			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
476	},
477	[NL80211_IFTYPE_AP] = {
478		.tx = 0xffff,
479		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
480			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
481			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
482			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
483			BIT(IEEE80211_STYPE_AUTH >> 4) |
484			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
485			BIT(IEEE80211_STYPE_ACTION >> 4),
486	},
487	[NL80211_IFTYPE_AP_VLAN] = {
488		/* copy AP */
489		.tx = 0xffff,
490		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
491			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
492			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
493			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
494			BIT(IEEE80211_STYPE_AUTH >> 4) |
495			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
496			BIT(IEEE80211_STYPE_ACTION >> 4),
497	},
498	[NL80211_IFTYPE_P2P_CLIENT] = {
499		.tx = 0xffff,
500		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
501			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
502	},
503	[NL80211_IFTYPE_P2P_GO] = {
504		.tx = 0xffff,
505		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
506			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
507			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
508			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
509			BIT(IEEE80211_STYPE_AUTH >> 4) |
510			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
511			BIT(IEEE80211_STYPE_ACTION >> 4),
512	},
513	[NL80211_IFTYPE_MESH_POINT] = {
514		.tx = 0xffff,
515		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
516			BIT(IEEE80211_STYPE_AUTH >> 4) |
517			BIT(IEEE80211_STYPE_DEAUTH >> 4),
518	},
519	[NL80211_IFTYPE_P2P_DEVICE] = {
520		.tx = 0xffff,
521		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
522			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
523	},
524};
525
526static const struct ieee80211_ht_cap mac80211_ht_capa_mod_mask = {
527	.ampdu_params_info = IEEE80211_HT_AMPDU_PARM_FACTOR |
528			     IEEE80211_HT_AMPDU_PARM_DENSITY,
529
530	.cap_info = cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
531				IEEE80211_HT_CAP_MAX_AMSDU |
532				IEEE80211_HT_CAP_SGI_40),
533	.mcs = {
534		.rx_mask = { 0xff, 0xff, 0xff, 0xff, 0xff,
535			     0xff, 0xff, 0xff, 0xff, 0xff, },
536	},
537};
538
539struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
540					const struct ieee80211_ops *ops)
541{
542	struct ieee80211_local *local;
543	int priv_size, i;
544	struct wiphy *wiphy;
545
546	if (WARN_ON(!ops->tx || !ops->start || !ops->stop || !ops->config ||
547		    !ops->add_interface || !ops->remove_interface ||
548		    !ops->configure_filter))
549		return NULL;
550
551	if (WARN_ON(ops->sta_state && (ops->sta_add || ops->sta_remove)))
552		return NULL;
553
554	/* Ensure 32-byte alignment of our private data and hw private data.
555	 * We use the wiphy priv data for both our ieee80211_local and for
556	 * the driver's private data
557	 *
558	 * In memory it'll be like this:
559	 *
560	 * +-------------------------+
561	 * | struct wiphy	    |
562	 * +-------------------------+
563	 * | struct ieee80211_local  |
564	 * +-------------------------+
565	 * | driver's private data   |
566	 * +-------------------------+
567	 *
568	 */
569	priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len;
570
571	wiphy = wiphy_new(&mac80211_config_ops, priv_size);
572
573	if (!wiphy)
574		return NULL;
575
576	wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes;
577
578	wiphy->privid = mac80211_wiphy_privid;
579
580	wiphy->flags |= WIPHY_FLAG_NETNS_OK |
581			WIPHY_FLAG_4ADDR_AP |
582			WIPHY_FLAG_4ADDR_STATION |
583			WIPHY_FLAG_REPORTS_OBSS |
584			WIPHY_FLAG_OFFCHAN_TX;
585
586	if (ops->remain_on_channel)
587		wiphy->flags |= WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
588
589	wiphy->features = NL80211_FEATURE_SK_TX_STATUS |
590			  NL80211_FEATURE_HT_IBSS;
591
592	if (!ops->set_key)
593		wiphy->flags |= WIPHY_FLAG_IBSS_RSN;
594
595	wiphy->bss_priv_size = sizeof(struct ieee80211_bss);
596
597	local = wiphy_priv(wiphy);
598
599	local->hw.wiphy = wiphy;
600
601	local->hw.priv = (char *)local + ALIGN(sizeof(*local), NETDEV_ALIGN);
602
603	local->ops = ops;
604
605	/* set up some defaults */
606	local->hw.queues = 1;
607	local->hw.max_rates = 1;
608	local->hw.max_report_rates = 0;
609	local->hw.max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
610	local->hw.max_tx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
611	local->hw.offchannel_tx_hw_queue = IEEE80211_INVAL_HW_QUEUE;
612	local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
613	local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
614	local->hw.radiotap_mcs_details = IEEE80211_RADIOTAP_MCS_HAVE_MCS |
615					 IEEE80211_RADIOTAP_MCS_HAVE_GI |
616					 IEEE80211_RADIOTAP_MCS_HAVE_BW;
617	local->user_power_level = -1;
618	wiphy->ht_capa_mod_mask = &mac80211_ht_capa_mod_mask;
619
620	INIT_LIST_HEAD(&local->interfaces);
621
622	__hw_addr_init(&local->mc_list);
623
624	mutex_init(&local->iflist_mtx);
625	mutex_init(&local->mtx);
626
627	mutex_init(&local->key_mtx);
628	spin_lock_init(&local->filter_lock);
629	spin_lock_init(&local->queue_stop_reason_lock);
630
631	/*
632	 * The rx_skb_queue is only accessed from tasklets,
633	 * but other SKB queues are used from within IRQ
634	 * context. Therefore, this one needs a different
635	 * locking class so our direct, non-irq-safe use of
636	 * the queue's lock doesn't throw lockdep warnings.
637	 */
638	skb_queue_head_init_class(&local->rx_skb_queue,
639				  &ieee80211_rx_skb_queue_class);
640
641	INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);
642
643	INIT_WORK(&local->restart_work, ieee80211_restart_work);
644
645	INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter);
646	INIT_WORK(&local->recalc_smps, ieee80211_recalc_smps_work);
647	local->smps_mode = IEEE80211_SMPS_OFF;
648
649	INIT_WORK(&local->dynamic_ps_enable_work,
650		  ieee80211_dynamic_ps_enable_work);
651	INIT_WORK(&local->dynamic_ps_disable_work,
652		  ieee80211_dynamic_ps_disable_work);
653	setup_timer(&local->dynamic_ps_timer,
654		    ieee80211_dynamic_ps_timer, (unsigned long) local);
655
656	INIT_WORK(&local->sched_scan_stopped_work,
657		  ieee80211_sched_scan_stopped_work);
658
659	spin_lock_init(&local->ack_status_lock);
660	idr_init(&local->ack_status_frames);
661	/* preallocate at least one entry */
662	idr_pre_get(&local->ack_status_frames, GFP_KERNEL);
663
664	sta_info_init(local);
665
666	for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
667		skb_queue_head_init(&local->pending[i]);
668		atomic_set(&local->agg_queue_stop[i], 0);
669	}
670	tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
671		     (unsigned long)local);
672
673	tasklet_init(&local->tasklet,
674		     ieee80211_tasklet_handler,
675		     (unsigned long) local);
676
677	skb_queue_head_init(&local->skb_queue);
678	skb_queue_head_init(&local->skb_queue_unreliable);
679
680	/* init dummy netdev for use w/ NAPI */
681	init_dummy_netdev(&local->napi_dev);
682
683	ieee80211_led_names(local);
684
685	ieee80211_roc_setup(local);
686
687	return &local->hw;
688}
689EXPORT_SYMBOL(ieee80211_alloc_hw);
690
691int ieee80211_register_hw(struct ieee80211_hw *hw)
692{
693	struct ieee80211_local *local = hw_to_local(hw);
694	int result, i;
695	enum ieee80211_band band;
696	int channels, max_bitrates;
697	bool supp_ht, supp_vht;
698	netdev_features_t feature_whitelist;
699	static const u32 cipher_suites[] = {
700		/* keep WEP first, it may be removed below */
701		WLAN_CIPHER_SUITE_WEP40,
702		WLAN_CIPHER_SUITE_WEP104,
703		WLAN_CIPHER_SUITE_TKIP,
704		WLAN_CIPHER_SUITE_CCMP,
705
706		/* keep last -- depends on hw flags! */
707		WLAN_CIPHER_SUITE_AES_CMAC
708	};
709
710	if (hw->flags & IEEE80211_HW_QUEUE_CONTROL &&
711	    (local->hw.offchannel_tx_hw_queue == IEEE80211_INVAL_HW_QUEUE ||
712	     local->hw.offchannel_tx_hw_queue >= local->hw.queues))
713		return -EINVAL;
714
715#ifdef CONFIG_PM
716	if ((hw->wiphy->wowlan.flags || hw->wiphy->wowlan.n_patterns) &&
717	    (!local->ops->suspend || !local->ops->resume))
718		return -EINVAL;
719#endif
720
721	if ((hw->flags & IEEE80211_HW_SCAN_WHILE_IDLE) && !local->ops->hw_scan)
722		return -EINVAL;
723
724	/* Only HW csum features are currently compatible with mac80211 */
725	feature_whitelist = NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
726			    NETIF_F_HW_CSUM;
727	if (WARN_ON(hw->netdev_features & ~feature_whitelist))
728		return -EINVAL;
729
730	if (hw->max_report_rates == 0)
731		hw->max_report_rates = hw->max_rates;
732
733	/*
734	 * generic code guarantees at least one band,
735	 * set this very early because much code assumes
736	 * that hw.conf.channel is assigned
737	 */
738	channels = 0;
739	max_bitrates = 0;
740	supp_ht = false;
741	supp_vht = false;
742	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
743		struct ieee80211_supported_band *sband;
744
745		sband = local->hw.wiphy->bands[band];
746		if (!sband)
747			continue;
748		if (!local->oper_channel) {
749			/* init channel we're on */
750			local->hw.conf.channel =
751			local->oper_channel = &sband->channels[0];
752			local->hw.conf.channel_type = NL80211_CHAN_NO_HT;
753		}
754		channels += sband->n_channels;
755
756		if (max_bitrates < sband->n_bitrates)
757			max_bitrates = sband->n_bitrates;
758		supp_ht = supp_ht || sband->ht_cap.ht_supported;
759		supp_vht = supp_vht || sband->vht_cap.vht_supported;
760	}
761
762	local->int_scan_req = kzalloc(sizeof(*local->int_scan_req) +
763				      sizeof(void *) * channels, GFP_KERNEL);
764	if (!local->int_scan_req)
765		return -ENOMEM;
766
767	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
768		if (!local->hw.wiphy->bands[band])
769			continue;
770		local->int_scan_req->rates[band] = (u32) -1;
771	}
772
773	/* if low-level driver supports AP, we also support VLAN */
774	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP)) {
775		hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN);
776		hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_AP_VLAN);
777	}
778
779	/* mac80211 always supports monitor */
780	hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR);
781	hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR);
782
783	/*
784	 * mac80211 doesn't support more than 1 channel, and also not more
785	 * than one IBSS interface
786	 */
787	for (i = 0; i < hw->wiphy->n_iface_combinations; i++) {
788		const struct ieee80211_iface_combination *c;
789		int j;
790
791		c = &hw->wiphy->iface_combinations[i];
792
793		if (c->num_different_channels > 1)
794			return -EINVAL;
795
796		for (j = 0; j < c->n_limits; j++)
797			if ((c->limits[j].types & BIT(NL80211_IFTYPE_ADHOC)) &&
798			    c->limits[j].max > 1)
799				return -EINVAL;
800	}
801
802#ifndef CONFIG_MAC80211_MESH
803	/* mesh depends on Kconfig, but drivers should set it if they want */
804	local->hw.wiphy->interface_modes &= ~BIT(NL80211_IFTYPE_MESH_POINT);
805#endif
806
807	/* if the underlying driver supports mesh, mac80211 will (at least)
808	 * provide routing of mesh authentication frames to userspace */
809	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_MESH_POINT))
810		local->hw.wiphy->flags |= WIPHY_FLAG_MESH_AUTH;
811
812	/* mac80211 supports control port protocol changing */
813	local->hw.wiphy->flags |= WIPHY_FLAG_CONTROL_PORT_PROTOCOL;
814
815	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
816		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
817	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
818		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC;
819
820	WARN((local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)
821	     && (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK),
822	     "U-APSD not supported with HW_PS_NULLFUNC_STACK\n");
823
824	/*
825	 * Calculate scan IE length -- we need this to alloc
826	 * memory and to subtract from the driver limit. It
827	 * includes the DS Params, (extended) supported rates, and HT
828	 * information -- SSID is the driver's responsibility.
829	 */
830	local->scan_ies_len = 4 + max_bitrates /* (ext) supp rates */ +
831		3 /* DS Params */;
832	if (supp_ht)
833		local->scan_ies_len += 2 + sizeof(struct ieee80211_ht_cap);
834
835	if (supp_vht)
836		local->scan_ies_len +=
837			2 + sizeof(struct ieee80211_vht_capabilities);
838
839	if (!local->ops->hw_scan) {
840		/* For hw_scan, driver needs to set these up. */
841		local->hw.wiphy->max_scan_ssids = 4;
842		local->hw.wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN;
843	}
844
845	/*
846	 * If the driver supports any scan IEs, then assume the
847	 * limit includes the IEs mac80211 will add, otherwise
848	 * leave it at zero and let the driver sort it out; we
849	 * still pass our IEs to the driver but userspace will
850	 * not be allowed to in that case.
851	 */
852	if (local->hw.wiphy->max_scan_ie_len)
853		local->hw.wiphy->max_scan_ie_len -= local->scan_ies_len;
854
855	/* Set up cipher suites unless driver already did */
856	if (!local->hw.wiphy->cipher_suites) {
857		local->hw.wiphy->cipher_suites = cipher_suites;
858		local->hw.wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
859		if (!(local->hw.flags & IEEE80211_HW_MFP_CAPABLE))
860			local->hw.wiphy->n_cipher_suites--;
861	}
862	if (IS_ERR(local->wep_tx_tfm) || IS_ERR(local->wep_rx_tfm)) {
863		if (local->hw.wiphy->cipher_suites == cipher_suites) {
864			local->hw.wiphy->cipher_suites += 2;
865			local->hw.wiphy->n_cipher_suites -= 2;
866		} else {
867			u32 *suites;
868			int r, w = 0;
869
870			/* Filter out WEP */
871
872			suites = kmemdup(
873				local->hw.wiphy->cipher_suites,
874				sizeof(u32) * local->hw.wiphy->n_cipher_suites,
875				GFP_KERNEL);
876			if (!suites)
877				return -ENOMEM;
878			for (r = 0; r < local->hw.wiphy->n_cipher_suites; r++) {
879				u32 suite = local->hw.wiphy->cipher_suites[r];
880				if (suite == WLAN_CIPHER_SUITE_WEP40 ||
881				    suite == WLAN_CIPHER_SUITE_WEP104)
882					continue;
883				suites[w++] = suite;
884			}
885			local->hw.wiphy->cipher_suites = suites;
886			local->hw.wiphy->n_cipher_suites = w;
887			local->wiphy_ciphers_allocated = true;
888		}
889	}
890
891	if (!local->ops->remain_on_channel)
892		local->hw.wiphy->max_remain_on_channel_duration = 5000;
893
894	if (local->ops->sched_scan_start)
895		local->hw.wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN;
896
897	/* mac80211 based drivers don't support internal TDLS setup */
898	if (local->hw.wiphy->flags & WIPHY_FLAG_SUPPORTS_TDLS)
899		local->hw.wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP;
900
901	result = wiphy_register(local->hw.wiphy);
902	if (result < 0)
903		goto fail_wiphy_register;
904
905	/*
906	 * We use the number of queues for feature tests (QoS, HT) internally
907	 * so restrict them appropriately.
908	 */
909	if (hw->queues > IEEE80211_MAX_QUEUES)
910		hw->queues = IEEE80211_MAX_QUEUES;
911
912	local->workqueue =
913		alloc_ordered_workqueue(wiphy_name(local->hw.wiphy), 0);
914	if (!local->workqueue) {
915		result = -ENOMEM;
916		goto fail_workqueue;
917	}
918
919	/*
920	 * The hardware needs headroom for sending the frame,
921	 * and we need some headroom for passing the frame to monitor
922	 * interfaces, but never both at the same time.
923	 */
924	local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom,
925				   IEEE80211_TX_STATUS_HEADROOM);
926
927	debugfs_hw_add(local);
928
929	/*
930	 * if the driver doesn't specify a max listen interval we
931	 * use 5 which should be a safe default
932	 */
933	if (local->hw.max_listen_interval == 0)
934		local->hw.max_listen_interval = 5;
935
936	local->hw.conf.listen_interval = local->hw.max_listen_interval;
937
938	local->dynamic_ps_forced_timeout = -1;
939
940	result = ieee80211_wep_init(local);
941	if (result < 0)
942		wiphy_debug(local->hw.wiphy, "Failed to initialize wep: %d\n",
943			    result);
944
945	ieee80211_led_init(local);
946
947	rtnl_lock();
948
949	result = ieee80211_init_rate_ctrl_alg(local,
950					      hw->rate_control_algorithm);
951	if (result < 0) {
952		wiphy_debug(local->hw.wiphy,
953			    "Failed to initialize rate control algorithm\n");
954		goto fail_rate;
955	}
956
957	/* add one default STA interface if supported */
958	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_STATION)) {
959		result = ieee80211_if_add(local, "wlan%d", NULL,
960					  NL80211_IFTYPE_STATION, NULL);
961		if (result)
962			wiphy_warn(local->hw.wiphy,
963				   "Failed to add default virtual iface\n");
964	}
965
966	rtnl_unlock();
967
968	local->network_latency_notifier.notifier_call =
969		ieee80211_max_network_latency;
970	result = pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY,
971				     &local->network_latency_notifier);
972	if (result) {
973		rtnl_lock();
974		goto fail_pm_qos;
975	}
976
977#ifdef CONFIG_INET
978	local->ifa_notifier.notifier_call = ieee80211_ifa_changed;
979	result = register_inetaddr_notifier(&local->ifa_notifier);
980	if (result)
981		goto fail_ifa;
982#endif
983
984	netif_napi_add(&local->napi_dev, &local->napi, ieee80211_napi_poll,
985			local->hw.napi_weight);
986
987	return 0;
988
989#ifdef CONFIG_INET
990 fail_ifa:
991	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
992			       &local->network_latency_notifier);
993	rtnl_lock();
994#endif
995 fail_pm_qos:
996	ieee80211_led_exit(local);
997	ieee80211_remove_interfaces(local);
998 fail_rate:
999	rtnl_unlock();
1000	ieee80211_wep_free(local);
1001	sta_info_stop(local);
1002	destroy_workqueue(local->workqueue);
1003 fail_workqueue:
1004	wiphy_unregister(local->hw.wiphy);
1005 fail_wiphy_register:
1006	if (local->wiphy_ciphers_allocated)
1007		kfree(local->hw.wiphy->cipher_suites);
1008	kfree(local->int_scan_req);
1009	return result;
1010}
1011EXPORT_SYMBOL(ieee80211_register_hw);
1012
1013void ieee80211_unregister_hw(struct ieee80211_hw *hw)
1014{
1015	struct ieee80211_local *local = hw_to_local(hw);
1016
1017	tasklet_kill(&local->tx_pending_tasklet);
1018	tasklet_kill(&local->tasklet);
1019
1020	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
1021			       &local->network_latency_notifier);
1022#ifdef CONFIG_INET
1023	unregister_inetaddr_notifier(&local->ifa_notifier);
1024#endif
1025
1026	rtnl_lock();
1027
1028	/*
1029	 * At this point, interface list manipulations are fine
1030	 * because the driver cannot be handing us frames any
1031	 * more and the tasklet is killed.
1032	 */
1033	ieee80211_remove_interfaces(local);
1034
1035	rtnl_unlock();
1036
1037	cancel_work_sync(&local->restart_work);
1038	cancel_work_sync(&local->reconfig_filter);
1039
1040	ieee80211_clear_tx_pending(local);
1041	rate_control_deinitialize(local);
1042
1043	if (skb_queue_len(&local->skb_queue) ||
1044	    skb_queue_len(&local->skb_queue_unreliable))
1045		wiphy_warn(local->hw.wiphy, "skb_queue not empty\n");
1046	skb_queue_purge(&local->skb_queue);
1047	skb_queue_purge(&local->skb_queue_unreliable);
1048	skb_queue_purge(&local->rx_skb_queue);
1049
1050	destroy_workqueue(local->workqueue);
1051	wiphy_unregister(local->hw.wiphy);
1052	sta_info_stop(local);
1053	ieee80211_wep_free(local);
1054	ieee80211_led_exit(local);
1055	kfree(local->int_scan_req);
1056}
1057EXPORT_SYMBOL(ieee80211_unregister_hw);
1058
1059static int ieee80211_free_ack_frame(int id, void *p, void *data)
1060{
1061	WARN_ONCE(1, "Have pending ack frames!\n");
1062	kfree_skb(p);
1063	return 0;
1064}
1065
1066void ieee80211_free_hw(struct ieee80211_hw *hw)
1067{
1068	struct ieee80211_local *local = hw_to_local(hw);
1069
1070	mutex_destroy(&local->iflist_mtx);
1071	mutex_destroy(&local->mtx);
1072
1073	if (local->wiphy_ciphers_allocated)
1074		kfree(local->hw.wiphy->cipher_suites);
1075
1076	idr_for_each(&local->ack_status_frames,
1077		     ieee80211_free_ack_frame, NULL);
1078	idr_destroy(&local->ack_status_frames);
1079
1080	wiphy_free(local->hw.wiphy);
1081}
1082EXPORT_SYMBOL(ieee80211_free_hw);
1083
1084static int __init ieee80211_init(void)
1085{
1086	struct sk_buff *skb;
1087	int ret;
1088
1089	BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb));
1090	BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) +
1091		     IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb));
1092
1093	ret = rc80211_minstrel_init();
1094	if (ret)
1095		return ret;
1096
1097	ret = rc80211_minstrel_ht_init();
1098	if (ret)
1099		goto err_minstrel;
1100
1101	ret = rc80211_pid_init();
1102	if (ret)
1103		goto err_pid;
1104
1105	ret = ieee80211_iface_init();
1106	if (ret)
1107		goto err_netdev;
1108
1109	return 0;
1110 err_netdev:
1111	rc80211_pid_exit();
1112 err_pid:
1113	rc80211_minstrel_ht_exit();
1114 err_minstrel:
1115	rc80211_minstrel_exit();
1116
1117	return ret;
1118}
1119
1120static void __exit ieee80211_exit(void)
1121{
1122	rc80211_pid_exit();
1123	rc80211_minstrel_ht_exit();
1124	rc80211_minstrel_exit();
1125
1126	if (mesh_allocated)
1127		ieee80211s_stop();
1128
1129	ieee80211_iface_exit();
1130
1131	rcu_barrier();
1132}
1133
1134
1135subsys_initcall(ieee80211_init);
1136module_exit(ieee80211_exit);
1137
1138MODULE_DESCRIPTION("IEEE 802.11 subsystem");
1139MODULE_LICENSE("GPL");
1140