main.c 29.2 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * Copyright 2002-2005, Instant802 Networks, Inc.
 * Copyright 2005-2006, Devicescape Software, Inc.
 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <net/mac80211.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/netdevice.h>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/skbuff.h>
#include <linux/etherdevice.h>
#include <linux/if_arp.h>
#include <linux/rtnetlink.h>
#include <linux/bitmap.h>
22
#include <linux/pm_qos.h>
23
#include <linux/inetdevice.h>
24
#include <net/net_namespace.h>
25 26 27
#include <net/cfg80211.h>

#include "ieee80211_i.h"
28
#include "driver-ops.h"
J
Johannes Berg 已提交
29
#include "rate.h"
30
#include "mesh.h"
31
#include "wep.h"
J
Johannes Berg 已提交
32
#include "led.h"
33
#include "cfg.h"
J
Jiri Benc 已提交
34
#include "debugfs.h"
35

J
Johannes Berg 已提交
36 37
static struct lock_class_key ieee80211_rx_skb_queue_class;

38
void ieee80211_configure_filter(struct ieee80211_local *local)
39
{
40
	u64 mc;
41 42 43
	unsigned int changed_flags;
	unsigned int new_flags = 0;

44
	if (atomic_read(&local->iff_promiscs))
45 46
		new_flags |= FIF_PROMISC_IN_BSS;

47
	if (atomic_read(&local->iff_allmultis))
48 49
		new_flags |= FIF_ALLMULTI;

50
	if (local->monitors || test_bit(SCAN_SW_SCANNING, &local->scanning))
51 52
		new_flags |= FIF_BCN_PRBRESP_PROMISC;

53 54 55
	if (local->fif_probe_req || local->probe_req_reg)
		new_flags |= FIF_PROBE_REQ;

56 57 58 59 60 61 62 63 64 65 66
	if (local->fif_fcsfail)
		new_flags |= FIF_FCSFAIL;

	if (local->fif_plcpfail)
		new_flags |= FIF_PLCPFAIL;

	if (local->fif_control)
		new_flags |= FIF_CONTROL;

	if (local->fif_other_bss)
		new_flags |= FIF_OTHER_BSS;
67

I
Igor Perminov 已提交
68 69 70
	if (local->fif_pspoll)
		new_flags |= FIF_PSPOLL;

71
	spin_lock_bh(&local->filter_lock);
72 73
	changed_flags = local->filter_flags ^ new_flags;

74
	mc = drv_prepare_multicast(local, &local->mc_list);
75 76
	spin_unlock_bh(&local->filter_lock);

77 78 79
	/* be a bit nasty */
	new_flags |= (1<<31);

80
	drv_configure_filter(local, changed_flags, &new_flags, mc);
81 82 83 84 85 86

	WARN_ON(new_flags & (1<<31));

	local->filter_flags = new_flags & ~(1<<31);
}

87 88 89 90 91 92 93 94
static void ieee80211_reconfig_filter(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local, reconfig_filter);

	ieee80211_configure_filter(local);
}

95
int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
96
{
97
	struct ieee80211_channel *chan;
98
	int ret = 0;
99
	int power;
S
Sujith 已提交
100
	enum nl80211_channel_type channel_type;
101
	u32 offchannel_flag;
102

103 104
	might_sleep();

105
	offchannel_flag = local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
106 107
	if (local->scan_channel) {
		chan = local->scan_channel;
108 109 110 111 112 113 114
		/* If scanning on oper channel, use whatever channel-type
		 * is currently in use.
		 */
		if (chan == local->oper_channel)
			channel_type = local->_oper_channel_type;
		else
			channel_type = NL80211_CHAN_NO_HT;
115
	} else if (local->tmp_channel) {
116
		chan = local->tmp_channel;
117
		channel_type = local->tmp_channel_type;
118
	} else {
119
		chan = local->oper_channel;
120
		channel_type = local->_oper_channel_type;
121
	}
122 123 124 125 126 127 128

	if (chan != local->oper_channel ||
	    channel_type != local->_oper_channel_type)
		local->hw.conf.flags |= IEEE80211_CONF_OFFCHANNEL;
	else
		local->hw.conf.flags &= ~IEEE80211_CONF_OFFCHANNEL;

129
	offchannel_flag ^= local->hw.conf.flags & IEEE80211_CONF_OFFCHANNEL;
130

131
	if (offchannel_flag || chan != local->hw.conf.channel ||
132
	    channel_type != local->hw.conf.channel_type) {
133
		local->hw.conf.channel = chan;
134
		local->hw.conf.channel_type = channel_type;
135 136
		changed |= IEEE80211_CONF_CHANGE_CHANNEL;
	}
137

138 139 140 141 142 143 144 145 146 147 148 149
	if (!conf_is_ht(&local->hw.conf)) {
		/*
		 * mac80211.h documents that this is only valid
		 * when the channel is set to an HT type, and
		 * that otherwise STATIC is used.
		 */
		local->hw.conf.smps_mode = IEEE80211_SMPS_STATIC;
	} else if (local->hw.conf.smps_mode != local->smps_mode) {
		local->hw.conf.smps_mode = local->smps_mode;
		changed |= IEEE80211_CONF_CHANGE_SMPS;
	}

150 151
	if (test_bit(SCAN_SW_SCANNING, &local->scanning) ||
	    test_bit(SCAN_HW_SCANNING, &local->scanning))
152
		power = chan->max_power;
153
	else
154
		power = local->power_constr_level ?
155 156
			min(chan->max_power,
				(chan->max_reg_power  - local->power_constr_level)) :
157 158
			chan->max_power;

159
	if (local->user_power_level >= 0)
160 161
		power = min(power, local->user_power_level);

162 163 164 165
	if (local->hw.conf.power_level != power) {
		changed |= IEEE80211_CONF_CHANGE_POWER;
		local->hw.conf.power_level = power;
	}
166

167
	if (changed && local->open_count) {
168
		ret = drv_config(local, changed);
169
		/*
170
		 * Goal:
171 172
		 * HW reconfiguration should never fail, the driver has told
		 * us what it can support so it should live up to that promise.
173 174 175 176 177 178 179 180 181
		 *
		 * Current status:
		 * rfkill is not integrated with mac80211 and a
		 * configuration command can thus fail if hardware rfkill
		 * is enabled
		 *
		 * FIXME: integrate rfkill with mac80211 and then add this
		 * WARN_ON() back
		 *
182
		 */
183
		/* WARN_ON(ret); */
184
	}
185

186 187
	return ret;
}
188

189 190
void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata,
				      u32 changed)
191
{
192
	struct ieee80211_local *local = sdata->local;
193
	static const u8 zero[ETH_ALEN] = { 0 };
194 195 196 197

	if (!changed)
		return;

198
	if (sdata->vif.type == NL80211_IFTYPE_STATION) {
J
Johannes Berg 已提交
199
		sdata->vif.bss_conf.bssid = sdata->u.mgd.bssid;
200
	} else if (sdata->vif.type == NL80211_IFTYPE_ADHOC)
201 202
		sdata->vif.bss_conf.bssid = sdata->u.ibss.bssid;
	else if (sdata->vif.type == NL80211_IFTYPE_AP)
203
		sdata->vif.bss_conf.bssid = sdata->vif.addr;
B
Bill Jordan 已提交
204 205
	else if (sdata->vif.type == NL80211_IFTYPE_WDS)
		sdata->vif.bss_conf.bssid = NULL;
206 207 208 209 210 211 212 213 214 215
	else if (ieee80211_vif_is_mesh(&sdata->vif)) {
		sdata->vif.bss_conf.bssid = zero;
	} else {
		WARN_ON(1);
		return;
	}

	switch (sdata->vif.type) {
	case NL80211_IFTYPE_AP:
	case NL80211_IFTYPE_ADHOC:
B
Bill Jordan 已提交
216
	case NL80211_IFTYPE_WDS:
217 218 219 220 221 222 223 224 225 226 227
	case NL80211_IFTYPE_MESH_POINT:
		break;
	default:
		/* do not warn to simplify caller in scan.c */
		changed &= ~BSS_CHANGED_BEACON_ENABLED;
		if (WARN_ON(changed & BSS_CHANGED_BEACON))
			return;
		break;
	}

	if (changed & BSS_CHANGED_BEACON_ENABLED) {
228
		if (local->quiescing || !ieee80211_sdata_running(sdata) ||
229
		    test_bit(SDATA_STATE_OFFCHANNEL, &sdata->state)) {
230 231 232 233 234 235 236 237 238
			sdata->vif.bss_conf.enable_beacon = false;
		} else {
			/*
			 * Beacon should be enabled, but AP mode must
			 * check whether there is a beacon configured.
			 */
			switch (sdata->vif.type) {
			case NL80211_IFTYPE_AP:
				sdata->vif.bss_conf.enable_beacon =
239
					!!sdata->u.ap.beacon;
240 241 242
				break;
			case NL80211_IFTYPE_ADHOC:
				sdata->vif.bss_conf.enable_beacon =
243
					!!sdata->u.ibss.presp;
244
				break;
245
#ifdef CONFIG_MAC80211_MESH
246
			case NL80211_IFTYPE_MESH_POINT:
247 248
				sdata->vif.bss_conf.enable_beacon =
					!!sdata->u.mesh.mesh_id_len;
249
				break;
250
#endif
251 252 253 254 255 256 257 258
			default:
				/* not reached */
				WARN_ON(1);
				break;
			}
		}
	}

J
Johannes Berg 已提交
259
	drv_bss_info_changed(local, sdata, &sdata->vif.bss_conf, changed);
260 261
}

262
u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata)
263
{
J
Johannes Berg 已提交
264 265 266
	sdata->vif.bss_conf.use_cts_prot = false;
	sdata->vif.bss_conf.use_short_preamble = false;
	sdata->vif.bss_conf.use_short_slot = false;
J
Johannes Berg 已提交
267 268 269
	return BSS_CHANGED_ERP_CTS_PROT |
	       BSS_CHANGED_ERP_PREAMBLE |
	       BSS_CHANGED_ERP_SLOT;
270 271
}

272 273 274
static void ieee80211_tasklet_handler(unsigned long data)
{
	struct ieee80211_local *local = (struct ieee80211_local *) data;
275 276
	struct sta_info *sta, *tmp;
	struct skb_eosp_msg_data *eosp_data;
277 278 279 280 281 282
	struct sk_buff *skb;

	while ((skb = skb_dequeue(&local->skb_queue)) ||
	       (skb = skb_dequeue(&local->skb_queue_unreliable))) {
		switch (skb->pkt_type) {
		case IEEE80211_RX_MSG:
283
			/* Clear skb->pkt_type in order to not confuse kernel
284 285
			 * netstack. */
			skb->pkt_type = 0;
J
Johannes Berg 已提交
286
			ieee80211_rx(&local->hw, skb);
287 288 289
			break;
		case IEEE80211_TX_STATUS_MSG:
			skb->pkt_type = 0;
J
Johannes Berg 已提交
290
			ieee80211_tx_status(&local->hw, skb);
291
			break;
292 293 294 295 296 297 298 299 300 301 302 303
		case IEEE80211_EOSP_MSG:
			eosp_data = (void *)skb->cb;
			for_each_sta_info(local, eosp_data->sta, sta, tmp) {
				/* skip wrong virtual interface */
				if (memcmp(eosp_data->iface,
					   sta->sdata->vif.addr, ETH_ALEN))
					continue;
				clear_sta_flag(sta, WLAN_STA_SP);
				break;
			}
			dev_kfree_skb(skb);
			break;
304
		default:
305 306
			WARN(1, "mac80211: Packet is of unknown type %d\n",
			     skb->pkt_type);
307 308 309 310 311 312
			dev_kfree_skb(skb);
			break;
		}
	}
}

313 314 315 316 317
static void ieee80211_restart_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local, restart_work);

318 319 320 321
	/* wait for scan work complete */
	flush_workqueue(local->workqueue);

	mutex_lock(&local->mtx);
322 323
	WARN(test_bit(SCAN_HW_SCANNING, &local->scanning) ||
	     local->sched_scanning,
324 325 326
		"%s called with hardware scan in progress\n", __func__);
	mutex_unlock(&local->mtx);

327
	rtnl_lock();
328
	ieee80211_scan_cancel(local);
329 330 331 332 333 334 335 336
	ieee80211_reconfig(local);
	rtnl_unlock();
}

void ieee80211_restart_hw(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

J
Johannes Berg 已提交
337 338
	trace_api_restart_hw(local);

339 340 341
	wiphy_info(hw->wiphy,
		   "Hardware restart was requested\n");

342
	/* use this reason, ieee80211_reconfig will unblock it */
343 344 345 346 347 348 349
	ieee80211_stop_queues_by_reason(hw,
		IEEE80211_QUEUE_STOP_REASON_SUSPEND);

	schedule_work(&local->restart_work);
}
EXPORT_SYMBOL(ieee80211_restart_hw);

350 351 352 353 354 355
static void ieee80211_recalc_smps_work(struct work_struct *work)
{
	struct ieee80211_local *local =
		container_of(work, struct ieee80211_local, recalc_smps);

	mutex_lock(&local->iflist_mtx);
356
	ieee80211_recalc_smps(local);
357 358 359
	mutex_unlock(&local->iflist_mtx);
}

360
#ifdef CONFIG_INET
361 362 363 364 365 366 367 368 369
static int ieee80211_ifa_changed(struct notifier_block *nb,
				 unsigned long data, void *arg)
{
	struct in_ifaddr *ifa = arg;
	struct ieee80211_local *local =
		container_of(nb, struct ieee80211_local,
			     ifa_notifier);
	struct net_device *ndev = ifa->ifa_dev->dev;
	struct wireless_dev *wdev = ndev->ieee80211_ptr;
370
	struct in_device *idev;
371
	struct ieee80211_sub_if_data *sdata;
372
	struct ieee80211_bss_conf *bss_conf;
373
	struct ieee80211_if_managed *ifmgd;
374
	int c = 0;
375 376 377 378 379 380 381 382 383

	/* Make sure it's our interface that got changed */
	if (!wdev)
		return NOTIFY_DONE;

	if (wdev->wiphy != local->hw.wiphy)
		return NOTIFY_DONE;

	sdata = IEEE80211_DEV_TO_SUB_IF(ndev);
384
	bss_conf = &sdata->vif.bss_conf;
385 386 387 388 389

	/* ARP filtering is only supported in managed mode */
	if (sdata->vif.type != NL80211_IFTYPE_STATION)
		return NOTIFY_DONE;

E
Eric Dumazet 已提交
390
	idev = __in_dev_get_rtnl(sdata->dev);
391 392 393
	if (!idev)
		return NOTIFY_DONE;

394 395
	ifmgd = &sdata->u.mgd;
	mutex_lock(&ifmgd->mtx);
396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413

	/* Copy the addresses to the bss_conf list */
	ifa = idev->ifa_list;
	while (c < IEEE80211_BSS_ARP_ADDR_LIST_LEN && ifa) {
		bss_conf->arp_addr_list[c] = ifa->ifa_address;
		ifa = ifa->ifa_next;
		c++;
	}

	/* If not all addresses fit the list, disable filtering */
	if (ifa) {
		sdata->arp_filter_state = false;
		c = 0;
	} else {
		sdata->arp_filter_state = true;
	}
	bss_conf->arp_addr_cnt = c;

414
	/* Configure driver only if associated (which also implies it is up) */
415 416 417 418 419 420
	if (ifmgd->associated) {
		bss_conf->arp_filter_enabled = sdata->arp_filter_state;
		ieee80211_bss_info_change_notify(sdata,
						 BSS_CHANGED_ARP_FILTER);
	}

421 422 423 424
	mutex_unlock(&ifmgd->mtx);

	return NOTIFY_DONE;
}
425
#endif
426

427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450
static int ieee80211_napi_poll(struct napi_struct *napi, int budget)
{
	struct ieee80211_local *local =
		container_of(napi, struct ieee80211_local, napi);

	return local->ops->napi_poll(&local->hw, budget);
}

void ieee80211_napi_schedule(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	napi_schedule(&local->napi);
}
EXPORT_SYMBOL(ieee80211_napi_schedule);

void ieee80211_napi_complete(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	napi_complete(&local->napi);
}
EXPORT_SYMBOL(ieee80211_napi_complete);

451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481
/* There isn't a lot of sense in it, but you can transmit anything you like */
static const struct ieee80211_txrx_stypes
ieee80211_default_mgmt_stypes[NUM_NL80211_IFTYPES] = {
	[NL80211_IFTYPE_ADHOC] = {
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4),
	},
	[NL80211_IFTYPE_STATION] = {
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
	},
	[NL80211_IFTYPE_AP] = {
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
			BIT(IEEE80211_STYPE_AUTH >> 4) |
			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
			BIT(IEEE80211_STYPE_ACTION >> 4),
	},
	[NL80211_IFTYPE_AP_VLAN] = {
		/* copy AP */
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
			BIT(IEEE80211_STYPE_AUTH >> 4) |
			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
482 483 484 485 486 487 488 489 490 491 492 493
			BIT(IEEE80211_STYPE_ACTION >> 4),
	},
	[NL80211_IFTYPE_P2P_CLIENT] = {
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
			BIT(IEEE80211_STYPE_PROBE_REQ >> 4),
	},
	[NL80211_IFTYPE_P2P_GO] = {
		.tx = 0xffff,
		.rx = BIT(IEEE80211_STYPE_ASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_REASSOC_REQ >> 4) |
			BIT(IEEE80211_STYPE_PROBE_REQ >> 4) |
494 495 496 497 498
			BIT(IEEE80211_STYPE_DISASSOC >> 4) |
			BIT(IEEE80211_STYPE_AUTH >> 4) |
			BIT(IEEE80211_STYPE_DEAUTH >> 4) |
			BIT(IEEE80211_STYPE_ACTION >> 4),
	},
499 500
	[NL80211_IFTYPE_MESH_POINT] = {
		.tx = 0xffff,
501 502 503
		.rx = BIT(IEEE80211_STYPE_ACTION >> 4) |
			BIT(IEEE80211_STYPE_AUTH >> 4) |
			BIT(IEEE80211_STYPE_DEAUTH >> 4),
504
	},
505 506
};

B
Ben Greear 已提交
507 508 509 510 511 512 513 514 515 516 517 518 519
static const struct ieee80211_ht_cap mac80211_ht_capa_mod_mask = {
	.ampdu_params_info = IEEE80211_HT_AMPDU_PARM_FACTOR |
			     IEEE80211_HT_AMPDU_PARM_DENSITY,

	.cap_info = cpu_to_le16(IEEE80211_HT_CAP_SUP_WIDTH_20_40 |
				IEEE80211_HT_CAP_MAX_AMSDU |
				IEEE80211_HT_CAP_SGI_40),
	.mcs = {
		.rx_mask = { 0xff, 0xff, 0xff, 0xff, 0xff,
			     0xff, 0xff, 0xff, 0xff, 0xff, },
	},
};

520 521 522 523
struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
					const struct ieee80211_ops *ops)
{
	struct ieee80211_local *local;
524
	int priv_size, i;
525 526
	struct wiphy *wiphy;

J
Johannes Berg 已提交
527 528 529
	if (WARN_ON(ops->sta_state && (ops->sta_add || ops->sta_remove)))
		return NULL;

530 531 532 533 534 535 536 537 538 539 540 541 542 543 544
	/* Ensure 32-byte alignment of our private data and hw private data.
	 * We use the wiphy priv data for both our ieee80211_local and for
	 * the driver's private data
	 *
	 * In memory it'll be like this:
	 *
	 * +-------------------------+
	 * | struct wiphy	    |
	 * +-------------------------+
	 * | struct ieee80211_local  |
	 * +-------------------------+
	 * | driver's private data   |
	 * +-------------------------+
	 *
	 */
545
	priv_size = ALIGN(sizeof(*local), NETDEV_ALIGN) + priv_data_len;
546 547 548 549 550 551

	wiphy = wiphy_new(&mac80211_config_ops, priv_size);

	if (!wiphy)
		return NULL;

552 553
	wiphy->mgmt_stypes = ieee80211_default_mgmt_stypes;

554 555
	wiphy->privid = mac80211_wiphy_privid;

556 557
	wiphy->flags |= WIPHY_FLAG_NETNS_OK |
			WIPHY_FLAG_4ADDR_AP |
J
Johannes Berg 已提交
558
			WIPHY_FLAG_4ADDR_STATION |
559 560 561
			WIPHY_FLAG_REPORTS_OBSS |
			WIPHY_FLAG_OFFCHAN_TX |
			WIPHY_FLAG_HAS_REMAIN_ON_CHANNEL;
562

563 564
	wiphy->features = NL80211_FEATURE_SK_TX_STATUS |
			  NL80211_FEATURE_HT_IBSS;
J
Johannes Berg 已提交
565

566 567
	if (!ops->set_key)
		wiphy->flags |= WIPHY_FLAG_IBSS_RSN;
568

569
	wiphy->bss_priv_size = sizeof(struct ieee80211_bss);
570 571

	local = wiphy_priv(wiphy);
572

573 574
	local->hw.wiphy = wiphy;

575
	local->hw.priv = (char *)local + ALIGN(sizeof(*local), NETDEV_ALIGN);
576

577
	BUG_ON(!ops->tx && !ops->tx_frags);
578 579
	BUG_ON(!ops->start);
	BUG_ON(!ops->stop);
580 581
	BUG_ON(!ops->config);
	BUG_ON(!ops->add_interface);
582 583
	BUG_ON(!ops->remove_interface);
	BUG_ON(!ops->configure_filter);
584 585
	local->ops = ops;

586 587 588
	/* set up some defaults */
	local->hw.queues = 1;
	local->hw.max_rates = 1;
589
	local->hw.max_report_rates = 0;
590
	local->hw.max_rx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
591
	local->hw.max_tx_aggregation_subframes = IEEE80211_MAX_AMPDU_BUF;
592 593
	local->hw.conf.long_frame_max_tx_count = wiphy->retry_long;
	local->hw.conf.short_frame_max_tx_count = wiphy->retry_short;
594
	local->user_power_level = -1;
B
Ben Greear 已提交
595
	wiphy->ht_capa_mod_mask = &mac80211_ht_capa_mod_mask;
596

597
	INIT_LIST_HEAD(&local->interfaces);
598 599 600

	__hw_addr_init(&local->mc_list);

601
	mutex_init(&local->iflist_mtx);
602
	mutex_init(&local->mtx);
603

J
Johannes Berg 已提交
604
	mutex_init(&local->key_mtx);
J
Johannes Berg 已提交
605
	spin_lock_init(&local->filter_lock);
K
Kalle Valo 已提交
606 607
	spin_lock_init(&local->queue_stop_reason_lock);

J
Johannes Berg 已提交
608 609 610 611 612 613 614 615 616
	/*
	 * The rx_skb_queue is only accessed from tasklets,
	 * but other SKB queues are used from within IRQ
	 * context. Therefore, this one needs a different
	 * locking class so our direct, non-irq-safe use of
	 * the queue's lock doesn't throw lockdep warnings.
	 */
	skb_queue_head_init_class(&local->rx_skb_queue,
				  &ieee80211_rx_skb_queue_class);
617

618
	INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);
619

J
Johannes Berg 已提交
620 621
	ieee80211_work_init(local);

622 623
	INIT_WORK(&local->restart_work, ieee80211_restart_work);

624
	INIT_WORK(&local->reconfig_filter, ieee80211_reconfig_filter);
625 626
	INIT_WORK(&local->recalc_smps, ieee80211_recalc_smps_work);
	local->smps_mode = IEEE80211_SMPS_OFF;
627

628 629 630 631 632 633 634
	INIT_WORK(&local->dynamic_ps_enable_work,
		  ieee80211_dynamic_ps_enable_work);
	INIT_WORK(&local->dynamic_ps_disable_work,
		  ieee80211_dynamic_ps_disable_work);
	setup_timer(&local->dynamic_ps_timer,
		    ieee80211_dynamic_ps_timer, (unsigned long) local);

635 636 637
	INIT_WORK(&local->sched_scan_stopped_work,
		  ieee80211_sched_scan_stopped_work);

J
Johannes Berg 已提交
638 639 640 641 642
	spin_lock_init(&local->ack_status_lock);
	idr_init(&local->ack_status_frames);
	/* preallocate at least one entry */
	idr_pre_get(&local->ack_status_frames, GFP_KERNEL);

643 644
	sta_info_init(local);

645
	for (i = 0; i < IEEE80211_MAX_QUEUES; i++) {
646
		skb_queue_head_init(&local->pending[i]);
647 648
		atomic_set(&local->agg_queue_stop[i], 0);
	}
649 650 651 652 653 654 655 656 657 658
	tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
		     (unsigned long)local);

	tasklet_init(&local->tasklet,
		     ieee80211_tasklet_handler,
		     (unsigned long) local);

	skb_queue_head_init(&local->skb_queue);
	skb_queue_head_init(&local->skb_queue_unreliable);

659 660 661
	/* init dummy netdev for use w/ NAPI */
	init_dummy_netdev(&local->napi_dev);

662 663
	ieee80211_led_names(local);

664 665
	ieee80211_hw_roc_setup(local);

J
Johannes Berg 已提交
666
	return &local->hw;
667 668 669 670 671 672
}
EXPORT_SYMBOL(ieee80211_alloc_hw);

int ieee80211_register_hw(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);
673
	int result, i;
674
	enum ieee80211_band band;
J
Johannes Berg 已提交
675
	int channels, max_bitrates;
676
	bool supp_ht;
677
	static const u32 cipher_suites[] = {
678
		/* keep WEP first, it may be removed below */
679 680 681 682 683 684 685 686
		WLAN_CIPHER_SUITE_WEP40,
		WLAN_CIPHER_SUITE_WEP104,
		WLAN_CIPHER_SUITE_TKIP,
		WLAN_CIPHER_SUITE_CCMP,

		/* keep last -- depends on hw flags! */
		WLAN_CIPHER_SUITE_AES_CMAC
	};
687

688 689 690 691 692
	if ((hw->wiphy->wowlan.flags || hw->wiphy->wowlan.n_patterns)
#ifdef CONFIG_PM
	    && (!local->ops->suspend || !local->ops->resume)
#endif
	    )
693 694
		return -EINVAL;

695 696 697
	if ((hw->flags & IEEE80211_HW_SCAN_WHILE_IDLE) && !local->ops->hw_scan)
		return -EINVAL;

698 699 700
	if (hw->max_report_rates == 0)
		hw->max_report_rates = hw->max_rates;

701 702 703 704 705
	/*
	 * generic code guarantees at least one band,
	 * set this very early because much code assumes
	 * that hw.conf.channel is assigned
	 */
706
	channels = 0;
707
	max_bitrates = 0;
708
	supp_ht = false;
709 710 711 712
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		struct ieee80211_supported_band *sband;

		sband = local->hw.wiphy->bands[band];
713 714 715
		if (!sband)
			continue;
		if (!local->oper_channel) {
716 717
			/* init channel we're on */
			local->hw.conf.channel =
J
Johannes Berg 已提交
718 719
			local->oper_channel = &sband->channels[0];
			local->hw.conf.channel_type = NL80211_CHAN_NO_HT;
720
		}
721 722 723 724
		channels += sband->n_channels;

		if (max_bitrates < sband->n_bitrates)
			max_bitrates = sband->n_bitrates;
725
		supp_ht = supp_ht || sband->ht_cap.ht_supported;
726
	}
727

728 729 730
	local->int_scan_req = kzalloc(sizeof(*local->int_scan_req) +
				      sizeof(void *) * channels, GFP_KERNEL);
	if (!local->int_scan_req)
731 732
		return -ENOMEM;

733 734 735 736 737 738
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		if (!local->hw.wiphy->bands[band])
			continue;
		local->int_scan_req->rates[band] = (u32) -1;
	}

739
	/* if low-level driver supports AP, we also support VLAN */
740 741 742 743
	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP)) {
		hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN);
		hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_AP_VLAN);
	}
744 745

	/* mac80211 always supports monitor */
746 747 748
	hw->wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR);
	hw->wiphy->software_iftypes |= BIT(NL80211_IFTYPE_MONITOR);

749 750 751 752 753 754 755 756 757 758 759
	/*
	 * mac80211 doesn't support more than 1 channel, and also not more
	 * than one IBSS interface
	 */
	for (i = 0; i < hw->wiphy->n_iface_combinations; i++) {
		const struct ieee80211_iface_combination *c;
		int j;

		c = &hw->wiphy->iface_combinations[i];

		if (c->num_different_channels > 1)
760
			return -EINVAL;
761

762 763 764 765 766 767
		for (j = 0; j < c->n_limits; j++)
			if ((c->limits[j].types & BIT(NL80211_IFTYPE_ADHOC)) &&
			    c->limits[j].max > 1)
				return -EINVAL;
	}

J
Johannes Berg 已提交
768 769 770 771 772
#ifndef CONFIG_MAC80211_MESH
	/* mesh depends on Kconfig, but drivers should set it if they want */
	local->hw.wiphy->interface_modes &= ~BIT(NL80211_IFTYPE_MESH_POINT);
#endif

773 774 775 776 777
	/* if the underlying driver supports mesh, mac80211 will (at least)
	 * provide routing of mesh authentication frames to userspace */
	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_MESH_POINT))
		local->hw.wiphy->flags |= WIPHY_FLAG_MESH_AUTH;

778 779 780
	/* mac80211 supports control port protocol changing */
	local->hw.wiphy->flags |= WIPHY_FLAG_CONTROL_PORT_PROTOCOL;

J
Johannes Berg 已提交
781 782 783 784 785
	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
	else if (local->hw.flags & IEEE80211_HW_SIGNAL_UNSPEC)
		local->hw.wiphy->signal_type = CFG80211_SIGNAL_TYPE_UNSPEC;

K
Kalle Valo 已提交
786 787 788 789
	WARN((local->hw.flags & IEEE80211_HW_SUPPORTS_UAPSD)
	     && (local->hw.flags & IEEE80211_HW_PS_NULLFUNC_STACK),
	     "U-APSD not supported with HW_PS_NULLFUNC_STACK\n");

790 791 792
	/*
	 * Calculate scan IE length -- we need this to alloc
	 * memory and to subtract from the driver limit. It
793
	 * includes the DS Params, (extended) supported rates, and HT
794 795
	 * information -- SSID is the driver's responsibility.
	 */
796 797
	local->scan_ies_len = 4 + max_bitrates /* (ext) supp rates */ +
		3 /* DS Params */;
798 799
	if (supp_ht)
		local->scan_ies_len += 2 + sizeof(struct ieee80211_ht_cap);
800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816

	if (!local->ops->hw_scan) {
		/* For hw_scan, driver needs to set these up. */
		local->hw.wiphy->max_scan_ssids = 4;
		local->hw.wiphy->max_scan_ie_len = IEEE80211_MAX_DATA_LEN;
	}

	/*
	 * If the driver supports any scan IEs, then assume the
	 * limit includes the IEs mac80211 will add, otherwise
	 * leave it at zero and let the driver sort it out; we
	 * still pass our IEs to the driver but userspace will
	 * not be allowed to in that case.
	 */
	if (local->hw.wiphy->max_scan_ie_len)
		local->hw.wiphy->max_scan_ie_len -= local->scan_ies_len;

817 818 819 820 821 822 823
	/* Set up cipher suites unless driver already did */
	if (!local->hw.wiphy->cipher_suites) {
		local->hw.wiphy->cipher_suites = cipher_suites;
		local->hw.wiphy->n_cipher_suites = ARRAY_SIZE(cipher_suites);
		if (!(local->hw.flags & IEEE80211_HW_MFP_CAPABLE))
			local->hw.wiphy->n_cipher_suites--;
	}
824
	if (IS_ERR(local->wep_tx_tfm) || IS_ERR(local->wep_rx_tfm)) {
825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850
		if (local->hw.wiphy->cipher_suites == cipher_suites) {
			local->hw.wiphy->cipher_suites += 2;
			local->hw.wiphy->n_cipher_suites -= 2;
		} else {
			u32 *suites;
			int r, w = 0;

			/* Filter out WEP */

			suites = kmemdup(
				local->hw.wiphy->cipher_suites,
				sizeof(u32) * local->hw.wiphy->n_cipher_suites,
				GFP_KERNEL);
			if (!suites)
				return -ENOMEM;
			for (r = 0; r < local->hw.wiphy->n_cipher_suites; r++) {
				u32 suite = local->hw.wiphy->cipher_suites[r];
				if (suite == WLAN_CIPHER_SUITE_WEP40 ||
				    suite == WLAN_CIPHER_SUITE_WEP104)
					continue;
				suites[w++] = suite;
			}
			local->hw.wiphy->cipher_suites = suites;
			local->hw.wiphy->n_cipher_suites = w;
			local->wiphy_ciphers_allocated = true;
		}
851
	}
852

853 854
	if (!local->ops->remain_on_channel)
		local->hw.wiphy->max_remain_on_channel_duration = 5000;
855

856 857 858
	if (local->ops->sched_scan_start)
		local->hw.wiphy->flags |= WIPHY_FLAG_SUPPORTS_SCHED_SCAN;

859 860 861 862
	/* mac80211 based drivers don't support internal TDLS setup */
	if (local->hw.wiphy->flags & WIPHY_FLAG_SUPPORTS_TDLS)
		local->hw.wiphy->flags |= WIPHY_FLAG_TDLS_EXTERNAL_SETUP;

863 864
	result = wiphy_register(local->hw.wiphy);
	if (result < 0)
865
		goto fail_wiphy_register;
866

867 868 869 870 871 872 873
	/*
	 * We use the number of queues for feature tests (QoS, HT) internally
	 * so restrict them appropriately.
	 */
	if (hw->queues > IEEE80211_MAX_QUEUES)
		hw->queues = IEEE80211_MAX_QUEUES;

874
	local->workqueue =
875
		alloc_ordered_workqueue(wiphy_name(local->hw.wiphy), 0);
876
	if (!local->workqueue) {
877 878 879 880
		result = -ENOMEM;
		goto fail_workqueue;
	}

881 882 883 884 885
	/*
	 * The hardware needs headroom for sending the frame,
	 * and we need some headroom for passing the frame to monitor
	 * interfaces, but never both at the same time.
	 */
886
	local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom,
887
				   IEEE80211_TX_STATUS_HEADROOM);
888

J
Jiri Benc 已提交
889 890
	debugfs_hw_add(local);

891 892 893 894
	/*
	 * if the driver doesn't specify a max listen interval we
	 * use 5 which should be a safe default
	 */
895
	if (local->hw.max_listen_interval == 0)
896
		local->hw.max_listen_interval = 5;
897 898 899

	local->hw.conf.listen_interval = local->hw.max_listen_interval;

900
	local->dynamic_ps_forced_timeout = -1;
901

902
	result = ieee80211_wep_init(local);
903
	if (result < 0)
J
Joe Perches 已提交
904 905
		wiphy_debug(local->hw.wiphy, "Failed to initialize wep: %d\n",
			    result);
906

907 908
	ieee80211_led_init(local);

909 910
	rtnl_lock();

911 912
	result = ieee80211_init_rate_ctrl_alg(local,
					      hw->rate_control_algorithm);
913
	if (result < 0) {
J
Joe Perches 已提交
914 915
		wiphy_debug(local->hw.wiphy,
			    "Failed to initialize rate control algorithm\n");
916 917 918
		goto fail_rate;
	}

919 920 921 922 923
	/* add one default STA interface if supported */
	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_STATION)) {
		result = ieee80211_if_add(local, "wlan%d", NULL,
					  NL80211_IFTYPE_STATION, NULL);
		if (result)
J
Joe Perches 已提交
924 925
			wiphy_warn(local->hw.wiphy,
				   "Failed to add default virtual iface\n");
926
	}
927 928 929

	rtnl_unlock();

930 931 932 933 934 935 936 937 938
	local->network_latency_notifier.notifier_call =
		ieee80211_max_network_latency;
	result = pm_qos_add_notifier(PM_QOS_NETWORK_LATENCY,
				     &local->network_latency_notifier);
	if (result) {
		rtnl_lock();
		goto fail_pm_qos;
	}

939
#ifdef CONFIG_INET
940 941 942 943
	local->ifa_notifier.notifier_call = ieee80211_ifa_changed;
	result = register_inetaddr_notifier(&local->ifa_notifier);
	if (result)
		goto fail_ifa;
944
#endif
945

946 947 948
	netif_napi_add(&local->napi_dev, &local->napi, ieee80211_napi_poll,
			local->hw.napi_weight);

949 950
	return 0;

951
#ifdef CONFIG_INET
952 953 954 955
 fail_ifa:
	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
			       &local->network_latency_notifier);
	rtnl_lock();
956
#endif
957 958 959 960
 fail_pm_qos:
	ieee80211_led_exit(local);
	ieee80211_remove_interfaces(local);
 fail_rate:
961
	rtnl_unlock();
962
	ieee80211_wep_free(local);
963
	sta_info_stop(local);
964
	destroy_workqueue(local->workqueue);
965
 fail_workqueue:
966
	wiphy_unregister(local->hw.wiphy);
967
 fail_wiphy_register:
968 969
	if (local->wiphy_ciphers_allocated)
		kfree(local->hw.wiphy->cipher_suites);
970
	kfree(local->int_scan_req);
971 972 973 974 975 976 977 978 979 980 981
	return result;
}
EXPORT_SYMBOL(ieee80211_register_hw);

void ieee80211_unregister_hw(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

	tasklet_kill(&local->tx_pending_tasklet);
	tasklet_kill(&local->tasklet);

982 983
	pm_qos_remove_notifier(PM_QOS_NETWORK_LATENCY,
			       &local->network_latency_notifier);
984
#ifdef CONFIG_INET
985
	unregister_inetaddr_notifier(&local->ifa_notifier);
986
#endif
987

988 989
	rtnl_lock();

990 991 992 993 994
	/*
	 * At this point, interface list manipulations are fine
	 * because the driver cannot be handing us frames any
	 * more and the tasklet is killed.
	 */
995
	ieee80211_remove_interfaces(local);
996

997 998
	rtnl_unlock();

J
Johannes Berg 已提交
999 1000 1001 1002 1003 1004
	/*
	 * Now all work items will be gone, but the
	 * timer might still be armed, so delete it
	 */
	del_timer_sync(&local->work_timer);

1005
	cancel_work_sync(&local->restart_work);
1006 1007
	cancel_work_sync(&local->reconfig_filter);

1008 1009 1010
	ieee80211_clear_tx_pending(local);
	rate_control_deinitialize(local);

1011 1012
	if (skb_queue_len(&local->skb_queue) ||
	    skb_queue_len(&local->skb_queue_unreliable))
J
Joe Perches 已提交
1013
		wiphy_warn(local->hw.wiphy, "skb_queue not empty\n");
1014 1015
	skb_queue_purge(&local->skb_queue);
	skb_queue_purge(&local->skb_queue_unreliable);
1016
	skb_queue_purge(&local->rx_skb_queue);
1017

1018
	destroy_workqueue(local->workqueue);
1019
	wiphy_unregister(local->hw.wiphy);
1020
	sta_info_stop(local);
1021 1022
	ieee80211_wep_free(local);
	ieee80211_led_exit(local);
1023
	kfree(local->int_scan_req);
1024 1025 1026
}
EXPORT_SYMBOL(ieee80211_unregister_hw);

J
Johannes Berg 已提交
1027 1028 1029 1030 1031 1032 1033
static int ieee80211_free_ack_frame(int id, void *p, void *data)
{
	WARN_ONCE(1, "Have pending ack frames!\n");
	kfree_skb(p);
	return 0;
}

1034 1035 1036 1037
void ieee80211_free_hw(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);

1038
	mutex_destroy(&local->iflist_mtx);
1039
	mutex_destroy(&local->mtx);
1040

1041 1042 1043
	if (local->wiphy_ciphers_allocated)
		kfree(local->hw.wiphy->cipher_suites);

J
Johannes Berg 已提交
1044 1045 1046 1047
	idr_for_each(&local->ack_status_frames,
		     ieee80211_free_ack_frame, NULL);
	idr_destroy(&local->ack_status_frames);

1048 1049 1050 1051 1052 1053 1054 1055 1056
	wiphy_free(local->hw.wiphy);
}
EXPORT_SYMBOL(ieee80211_free_hw);

static int __init ieee80211_init(void)
{
	struct sk_buff *skb;
	int ret;

1057 1058
	BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb));
	BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) +
J
Johannes Berg 已提交
1059
		     IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb));
1060

1061 1062 1063 1064
	ret = rc80211_minstrel_init();
	if (ret)
		return ret;

1065 1066 1067 1068
	ret = rc80211_minstrel_ht_init();
	if (ret)
		goto err_minstrel;

1069
	ret = rc80211_pid_init();
1070
	if (ret)
1071
		goto err_pid;
1072

1073 1074 1075
	ret = ieee80211_iface_init();
	if (ret)
		goto err_netdev;
J
Jiri Benc 已提交
1076

1077
	return 0;
1078 1079 1080
 err_netdev:
	rc80211_pid_exit();
 err_pid:
1081 1082
	rc80211_minstrel_ht_exit();
 err_minstrel:
1083 1084 1085
	rc80211_minstrel_exit();

	return ret;
1086 1087 1088 1089
}

static void __exit ieee80211_exit(void)
{
1090
	rc80211_pid_exit();
1091
	rc80211_minstrel_ht_exit();
1092
	rc80211_minstrel_exit();
1093

1094 1095
	if (mesh_allocated)
		ieee80211s_stop();
J
Johannes Berg 已提交
1096

1097
	ieee80211_iface_exit();
1098 1099

	rcu_barrier();
1100 1101 1102
}


1103
subsys_initcall(ieee80211_init);
1104 1105 1106 1107
module_exit(ieee80211_exit);

MODULE_DESCRIPTION("IEEE 802.11 subsystem");
MODULE_LICENSE("GPL");