main.c 26.7 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * 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 <net/ieee80211_radiotap.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/wireless.h>
#include <linux/rtnetlink.h>
#include <linux/bitmap.h>
24
#include <net/net_namespace.h>
25 26 27
#include <net/cfg80211.h>

#include "ieee80211_i.h"
J
Johannes Berg 已提交
28
#include "rate.h"
29
#include "mesh.h"
30 31 32
#include "wep.h"
#include "wme.h"
#include "aes_ccm.h"
J
Johannes Berg 已提交
33
#include "led.h"
34
#include "cfg.h"
J
Jiri Benc 已提交
35 36
#include "debugfs.h"
#include "debugfs_netdev.h"
37

38 39 40 41 42 43
/*
 * For seeing transmitted packets on monitor interfaces
 * we have a radiotap header too.
 */
struct ieee80211_tx_status_rtap_hdr {
	struct ieee80211_radiotap_header hdr;
44 45
	u8 rate;
	u8 padding_for_rate;
46 47 48 49
	__le16 tx_flags;
	u8 data_retries;
} __attribute__ ((packed));

50

51
/* must be called under mdev tx lock */
52
void ieee80211_configure_filter(struct ieee80211_local *local)
53 54 55 56
{
	unsigned int changed_flags;
	unsigned int new_flags = 0;

57
	if (atomic_read(&local->iff_promiscs))
58 59
		new_flags |= FIF_PROMISC_IN_BSS;

60
	if (atomic_read(&local->iff_allmultis))
61 62 63
		new_flags |= FIF_ALLMULTI;

	if (local->monitors)
64 65 66 67 68 69 70 71 72 73 74 75 76
		new_flags |= FIF_BCN_PRBRESP_PROMISC;

	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;
77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92

	changed_flags = local->filter_flags ^ new_flags;

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

	local->ops->configure_filter(local_to_hw(local),
				     changed_flags, &new_flags,
				     local->mdev->mc_count,
				     local->mdev->mc_list);

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

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

93
/* master interface */
94

95 96 97 98 99 100 101 102 103 104 105 106 107 108
static int header_parse_80211(const struct sk_buff *skb, unsigned char *haddr)
{
	memcpy(haddr, skb_mac_header(skb) + 10, ETH_ALEN); /* addr2 */
	return ETH_ALEN;
}

static const struct header_ops ieee80211_header_ops = {
	.create		= eth_header,
	.parse		= header_parse_80211,
	.rebuild	= eth_rebuild_header,
	.cache		= eth_header_cache,
	.cache_update	= eth_header_cache_update,
};

109 110
static int ieee80211_master_open(struct net_device *dev)
{
111 112
	struct ieee80211_master_priv *mpriv = netdev_priv(dev);
	struct ieee80211_local *local = mpriv->local;
113 114
	struct ieee80211_sub_if_data *sdata;
	int res = -EOPNOTSUPP;
115

116 117
	/* we hold the RTNL here so can safely walk the list */
	list_for_each_entry(sdata, &local->interfaces, list) {
118
		if (netif_running(sdata->dev)) {
119 120 121 122
			res = 0;
			break;
		}
	}
123 124 125 126

	if (res)
		return res;

127
	netif_tx_start_all_queues(local->mdev);
128 129

	return 0;
130
}
131

132
static int ieee80211_master_stop(struct net_device *dev)
133
{
134 135
	struct ieee80211_master_priv *mpriv = netdev_priv(dev);
	struct ieee80211_local *local = mpriv->local;
136
	struct ieee80211_sub_if_data *sdata;
137

138 139
	/* we hold the RTNL here so can safely walk the list */
	list_for_each_entry(sdata, &local->interfaces, list)
140
		if (netif_running(sdata->dev))
141
			dev_close(sdata->dev);
142

143 144
	return 0;
}
145

146 147
static void ieee80211_master_set_multicast_list(struct net_device *dev)
{
148 149
	struct ieee80211_master_priv *mpriv = netdev_priv(dev);
	struct ieee80211_local *local = mpriv->local;
150 151 152 153

	ieee80211_configure_filter(local);
}

154 155
/* everything else */

156
int ieee80211_if_config(struct ieee80211_sub_if_data *sdata, u32 changed)
157
{
158
	struct ieee80211_local *local = sdata->local;
159 160
	struct ieee80211_if_conf conf;

161 162 163
	if (WARN_ON(!netif_running(sdata->dev)))
		return 0;

164 165 166
	if (WARN_ON(sdata->vif.type == NL80211_IFTYPE_AP_VLAN))
		return -EINVAL;

167
	if (!local->ops->config_interface)
168 169
		return 0;

170
	memset(&conf, 0, sizeof(conf));
171 172
	conf.changed = changed;

173
	if (sdata->vif.type == NL80211_IFTYPE_STATION ||
J
Johannes Berg 已提交
174
	    sdata->vif.type == NL80211_IFTYPE_ADHOC)
175
		conf.bssid = sdata->u.sta.bssid;
J
Johannes Berg 已提交
176
	else if (sdata->vif.type == NL80211_IFTYPE_AP)
177
		conf.bssid = sdata->dev->dev_addr;
J
Johannes Berg 已提交
178
	else if (ieee80211_vif_is_mesh(&sdata->vif)) {
179 180 181 182 183
		u8 zero[ETH_ALEN] = { 0 };
		conf.bssid = zero;
	} else {
		WARN_ON(1);
		return -EINVAL;
184 185
	}

186 187
	if (WARN_ON(!conf.bssid && (changed & IEEE80211_IFCC_BSSID)))
		return -EINVAL;
188

189 190
	return local->ops->config_interface(local_to_hw(local),
					    &sdata->vif, &conf);
191
}
192

193
int ieee80211_hw_config(struct ieee80211_local *local, u32 changed)
194 195 196
{
	struct ieee80211_channel *chan;
	int ret = 0;
197
	int power;
S
Sujith 已提交
198
	enum nl80211_channel_type channel_type;
199

200 201
	might_sleep();

202
	if (local->sw_scanning) {
203
		chan = local->scan_channel;
S
Sujith 已提交
204
		channel_type = NL80211_CHAN_NO_HT;
205
	} else {
206
		chan = local->oper_channel;
S
Sujith 已提交
207
		channel_type = local->oper_channel_type;
208
	}
209

210
	if (chan != local->hw.conf.channel ||
S
Sujith 已提交
211
	    channel_type != local->hw.conf.ht.channel_type) {
212
		local->hw.conf.channel = chan;
S
Sujith 已提交
213 214 215
		local->hw.conf.ht.channel_type = channel_type;
		switch (channel_type) {
		case NL80211_CHAN_NO_HT:
216 217
			local->hw.conf.ht.enabled = false;
			break;
S
Sujith 已提交
218 219 220
		case NL80211_CHAN_HT20:
		case NL80211_CHAN_HT40MINUS:
		case NL80211_CHAN_HT40PLUS:
221 222 223
			local->hw.conf.ht.enabled = true;
			break;
		}
224 225
		changed |= IEEE80211_CONF_CHANGE_CHANNEL;
	}
226 227

	if (!local->hw.conf.power_level)
228
		power = chan->max_power;
229
	else
230 231 232 233 234
		power = min(chan->max_power, local->hw.conf.power_level);
	if (local->hw.conf.power_level != power) {
		changed |= IEEE80211_CONF_CHANGE_POWER;
		local->hw.conf.power_level = power;
	}
235

236 237
	if (changed && local->open_count) {
		ret = local->ops->config(local_to_hw(local), changed);
238
		/*
239
		 * Goal:
240 241
		 * HW reconfiguration should never fail, the driver has told
		 * us what it can support so it should live up to that promise.
242 243 244 245 246 247 248 249 250
		 *
		 * 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
		 *
251
		 */
252
		/* WARN_ON(ret); */
253
	}
254

255 256
	return ret;
}
257

258 259
void ieee80211_bss_info_change_notify(struct ieee80211_sub_if_data *sdata,
				      u32 changed)
260
{
261 262
	struct ieee80211_local *local = sdata->local;

263 264 265
	if (WARN_ON(sdata->vif.type == NL80211_IFTYPE_AP_VLAN))
		return;

266 267 268 269 270 271
	if (!changed)
		return;

	if (local->ops->bss_info_changed)
		local->ops->bss_info_changed(local_to_hw(local),
					     &sdata->vif,
J
Johannes Berg 已提交
272
					     &sdata->vif.bss_conf,
273
					     changed);
274 275
}

276
u32 ieee80211_reset_erp_info(struct ieee80211_sub_if_data *sdata)
277
{
J
Johannes Berg 已提交
278 279 280
	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 已提交
281 282 283
	return BSS_CHANGED_ERP_CTS_PROT |
	       BSS_CHANGED_ERP_PREAMBLE |
	       BSS_CHANGED_ERP_SLOT;
284 285
}

286
void ieee80211_tx_status_irqsafe(struct ieee80211_hw *hw,
287
				 struct sk_buff *skb)
288 289
{
	struct ieee80211_local *local = hw_to_local(hw);
290
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
291 292 293 294
	int tmp;

	skb->dev = local->mdev;
	skb->pkt_type = IEEE80211_TX_STATUS_MSG;
295
	skb_queue_tail(info->flags & IEEE80211_TX_CTL_REQ_TX_STATUS ?
296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313
		       &local->skb_queue : &local->skb_queue_unreliable, skb);
	tmp = skb_queue_len(&local->skb_queue) +
		skb_queue_len(&local->skb_queue_unreliable);
	while (tmp > IEEE80211_IRQSAFE_QUEUE_LIMIT &&
	       (skb = skb_dequeue(&local->skb_queue_unreliable))) {
		dev_kfree_skb_irq(skb);
		tmp--;
		I802_DEBUG_INC(local->tx_status_drop);
	}
	tasklet_schedule(&local->tasklet);
}
EXPORT_SYMBOL(ieee80211_tx_status_irqsafe);

static void ieee80211_tasklet_handler(unsigned long data)
{
	struct ieee80211_local *local = (struct ieee80211_local *) data;
	struct sk_buff *skb;
	struct ieee80211_rx_status rx_status;
314
	struct ieee80211_ra_tid *ra_tid;
315 316 317 318 319 320 321

	while ((skb = skb_dequeue(&local->skb_queue)) ||
	       (skb = skb_dequeue(&local->skb_queue_unreliable))) {
		switch (skb->pkt_type) {
		case IEEE80211_RX_MSG:
			/* status is in skb->cb */
			memcpy(&rx_status, skb->cb, sizeof(rx_status));
322
			/* Clear skb->pkt_type in order to not confuse kernel
323 324 325 326 327 328
			 * netstack. */
			skb->pkt_type = 0;
			__ieee80211_rx(local_to_hw(local), skb, &rx_status);
			break;
		case IEEE80211_TX_STATUS_MSG:
			skb->pkt_type = 0;
329
			ieee80211_tx_status(local_to_hw(local), skb);
330
			break;
331 332 333 334 335 336 337 338 339 340 341 342
		case IEEE80211_DELBA_MSG:
			ra_tid = (struct ieee80211_ra_tid *) &skb->cb;
			ieee80211_stop_tx_ba_cb(local_to_hw(local),
						ra_tid->ra, ra_tid->tid);
			dev_kfree_skb(skb);
			break;
		case IEEE80211_ADDBA_MSG:
			ra_tid = (struct ieee80211_ra_tid *) &skb->cb;
			ieee80211_start_tx_ba_cb(local_to_hw(local),
						 ra_tid->ra, ra_tid->tid);
			dev_kfree_skb(skb);
			break ;
343 344
		default:
			WARN_ON(1);
345 346 347 348 349 350 351 352 353
			dev_kfree_skb(skb);
			break;
		}
	}
}

/* Remove added headers (e.g., QoS control), encryption header/MIC, etc. to
 * make a prepared TX frame (one that has been given to hw) to look like brand
 * new IEEE 802.11 frame that is ready to go through TX processing again.
354
 */
355 356
static void ieee80211_remove_tx_extra(struct ieee80211_local *local,
				      struct ieee80211_key *key,
357
				      struct sk_buff *skb)
358
{
359 360
	unsigned int hdrlen, iv_len, mic_len;
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
361

362
	hdrlen = ieee80211_hdrlen(hdr->frame_control);
363 364 365 366

	if (!key)
		goto no_key;

367
	switch (key->conf.alg) {
368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383
	case ALG_WEP:
		iv_len = WEP_IV_LEN;
		mic_len = WEP_ICV_LEN;
		break;
	case ALG_TKIP:
		iv_len = TKIP_IV_LEN;
		mic_len = TKIP_ICV_LEN;
		break;
	case ALG_CCMP:
		iv_len = CCMP_HDR_LEN;
		mic_len = CCMP_MIC_LEN;
		break;
	default:
		goto no_key;
	}

384
	if (skb->len >= hdrlen + mic_len &&
J
Johannes Berg 已提交
385
	    !(key->flags & KEY_FLAG_UPLOADED_TO_HARDWARE))
386
		skb_trim(skb, skb->len - mic_len);
387
	if (skb->len >= hdrlen + iv_len) {
388
		memmove(skb->data + iv_len, skb->data, hdrlen);
389
		hdr = (struct ieee80211_hdr *)skb_pull(skb, iv_len);
390 391 392
	}

no_key:
393 394 395 396 397
	if (ieee80211_is_data_qos(hdr->frame_control)) {
		hdr->frame_control &= ~cpu_to_le16(IEEE80211_STYPE_QOS_DATA);
		memmove(skb->data + IEEE80211_QOS_CTL_LEN, skb->data,
			hdrlen - IEEE80211_QOS_CTL_LEN);
		skb_pull(skb, IEEE80211_QOS_CTL_LEN);
398 399 400
	}
}

401 402
static void ieee80211_handle_filtered_frame(struct ieee80211_local *local,
					    struct sta_info *sta,
403
					    struct sk_buff *skb)
404 405 406 407 408 409
{
	sta->tx_filtered_count++;

	/*
	 * Clear the TX filter mask for this STA when sending the next
	 * packet. If the STA went to power save mode, this will happen
410
	 * when it wakes up for the next time.
411
	 */
412
	set_sta_flags(sta, WLAN_STA_CLEAR_PS_FILT);
413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443

	/*
	 * This code races in the following way:
	 *
	 *  (1) STA sends frame indicating it will go to sleep and does so
	 *  (2) hardware/firmware adds STA to filter list, passes frame up
	 *  (3) hardware/firmware processes TX fifo and suppresses a frame
	 *  (4) we get TX status before having processed the frame and
	 *	knowing that the STA has gone to sleep.
	 *
	 * This is actually quite unlikely even when both those events are
	 * processed from interrupts coming in quickly after one another or
	 * even at the same time because we queue both TX status events and
	 * RX frames to be processed by a tasklet and process them in the
	 * same order that they were received or TX status last. Hence, there
	 * is no race as long as the frame RX is processed before the next TX
	 * status, which drivers can ensure, see below.
	 *
	 * Note that this can only happen if the hardware or firmware can
	 * actually add STAs to the filter list, if this is done by the
	 * driver in response to set_tim() (which will only reduce the race
	 * this whole filtering tries to solve, not completely solve it)
	 * this situation cannot happen.
	 *
	 * To completely solve this race drivers need to make sure that they
	 *  (a) don't mix the irq-safe/not irq-safe TX status/RX processing
	 *	functions and
	 *  (b) always process RX events before TX status events if ordering
	 *      can be unknown, for example with different interrupt status
	 *	bits.
	 */
444
	if (test_sta_flags(sta, WLAN_STA_PS) &&
445
	    skb_queue_len(&sta->tx_filtered) < STA_MAX_TX_BUFFER) {
446
		ieee80211_remove_tx_extra(local, sta->key, skb);
447 448 449 450
		skb_queue_tail(&sta->tx_filtered, skb);
		return;
	}

S
Sujith 已提交
451
	if (!test_sta_flags(sta, WLAN_STA_PS) && !skb->requeue) {
452
		/* Software retry the packet once */
S
Sujith 已提交
453
		skb->requeue = 1;
454
		ieee80211_remove_tx_extra(local, sta->key, skb);
455 456 457 458
		dev_queue_xmit(skb);
		return;
	}

459
#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
460 461 462 463 464
	if (net_ratelimit())
		printk(KERN_DEBUG "%s: dropped TX filtered frame, "
		       "queue_len=%d PS=%d @%lu\n",
		       wiphy_name(local->hw.wiphy),
		       skb_queue_len(&sta->tx_filtered),
465
		       !!test_sta_flags(sta, WLAN_STA_PS), jiffies);
466
#endif
467 468 469
	dev_kfree_skb(skb);
}

470
void ieee80211_tx_status(struct ieee80211_hw *hw, struct sk_buff *skb)
471 472 473 474
{
	struct sk_buff *skb2;
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
	struct ieee80211_local *local = hw_to_local(hw);
475
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
476
	u16 frag, type;
477
	__le16 fc;
478
	struct ieee80211_supported_band *sband;
479 480
	struct ieee80211_tx_status_rtap_hdr *rthdr;
	struct ieee80211_sub_if_data *sdata;
481
	struct net_device *prev_dev = NULL;
482
	struct sta_info *sta;
483 484 485 486 487 488 489 490 491 492 493 494 495
	int retry_count = -1, i;

	for (i = 0; i < IEEE80211_TX_MAX_RATES; i++) {
		/* the HW cannot have attempted that rate */
		if (i >= hw->max_rates) {
			info->status.rates[i].idx = -1;
			info->status.rates[i].count = 0;
		}

		retry_count += info->status.rates[i].count;
	}
	if (retry_count < 0)
		retry_count = 0;
496

497 498
	rcu_read_lock();

499 500
	sband = local->hw.wiphy->bands[info->band];

501 502 503
	sta = sta_info_get(local, hdr->addr1);

	if (sta) {
504
		if (!(info->flags & IEEE80211_TX_STAT_ACK) &&
505 506 507 508 509 510 511 512
		    test_sta_flags(sta, WLAN_STA_PS)) {
			/*
			 * The STA is in power save mode, so assume
			 * that this TX packet failed because of that.
			 */
			ieee80211_handle_filtered_frame(local, sta, skb);
			rcu_read_unlock();
			return;
513 514
		}

515 516 517 518 519 520
		fc = hdr->frame_control;

		if ((info->flags & IEEE80211_TX_STAT_AMPDU_NO_BACK) &&
		    (ieee80211_is_data_qos(fc))) {
			u16 tid, ssn;
			u8 *qc;
521 522 523 524 525

			qc = ieee80211_get_qos_ctl(hdr);
			tid = qc[0] & 0xf;
			ssn = ((le16_to_cpu(hdr->seq_ctrl) + 0x10)
						& IEEE80211_SCTL_SEQ);
526
			ieee80211_send_bar(sta->sdata, hdr->addr1,
527 528 529
					   tid, ssn);
		}

530
		if (info->flags & IEEE80211_TX_STAT_TX_FILTERED) {
531
			ieee80211_handle_filtered_frame(local, sta, skb);
532
			rcu_read_unlock();
533
			return;
534
		} else {
535
			if (!(info->flags & IEEE80211_TX_STAT_ACK))
536
				sta->tx_retry_failed++;
537
			sta->tx_retry_count += retry_count;
538
		}
539

540
		rate_control_tx_status(local, sband, sta, skb);
541
	}
542

543 544
	rcu_read_unlock();

545 546 547 548 549 550 551 552 553 554
	ieee80211_led_tx(local, 0);

	/* SNMP counters
	 * Fragments are passed to low-level drivers as separate skbs, so these
	 * are actually fragments, not frames. Update frame counters only for
	 * the first fragment of the frame. */

	frag = le16_to_cpu(hdr->seq_ctrl) & IEEE80211_SCTL_FRAG;
	type = le16_to_cpu(hdr->frame_control) & IEEE80211_FCTL_FTYPE;

555
	if (info->flags & IEEE80211_TX_STAT_ACK) {
556 557 558 559
		if (frag == 0) {
			local->dot11TransmittedFrameCount++;
			if (is_multicast_ether_addr(hdr->addr1))
				local->dot11MulticastTransmittedFrameCount++;
560
			if (retry_count > 0)
561
				local->dot11RetryCount++;
562
			if (retry_count > 1)
563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578
				local->dot11MultipleRetryCount++;
		}

		/* This counter shall be incremented for an acknowledged MPDU
		 * with an individual address in the address 1 field or an MPDU
		 * with a multicast address in the address 1 field of type Data
		 * or Management. */
		if (!is_multicast_ether_addr(hdr->addr1) ||
		    type == IEEE80211_FTYPE_DATA ||
		    type == IEEE80211_FTYPE_MGMT)
			local->dot11TransmittedFragmentCount++;
	} else {
		if (frag == 0)
			local->dot11FailedCount++;
	}

579 580 581
	/* this was a transmitted frame, but now we want to reuse it */
	skb_orphan(skb);

582 583 584 585 586
	/*
	 * This is a bit racy but we can avoid a lot of work
	 * with this test...
	 */
	if (!local->monitors && !local->cooked_mntrs) {
587 588 589 590
		dev_kfree_skb(skb);
		return;
	}

591
	/* send frame to monitor interfaces now */
592

593 594
	if (skb_headroom(skb) < sizeof(*rthdr)) {
		printk(KERN_ERR "ieee80211_tx_status: headroom too small\n");
595 596 597 598
		dev_kfree_skb(skb);
		return;
	}

J
Johannes Berg 已提交
599
	rthdr = (struct ieee80211_tx_status_rtap_hdr *)
600 601 602 603 604 605
				skb_push(skb, sizeof(*rthdr));

	memset(rthdr, 0, sizeof(*rthdr));
	rthdr->hdr.it_len = cpu_to_le16(sizeof(*rthdr));
	rthdr->hdr.it_present =
		cpu_to_le32((1 << IEEE80211_RADIOTAP_TX_FLAGS) |
606 607
			    (1 << IEEE80211_RADIOTAP_DATA_RETRIES) |
			    (1 << IEEE80211_RADIOTAP_RATE));
608

609
	if (!(info->flags & IEEE80211_TX_STAT_ACK) &&
610 611 612
	    !is_multicast_ether_addr(hdr->addr1))
		rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_FAIL);

613 614 615 616 617 618 619
	/*
	 * XXX: Once radiotap gets the bitmap reset thing the vendor
	 *	extensions proposal contains, we can actually report
	 *	the whole set of tries we did.
	 */
	if ((info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS) ||
	    (info->status.rates[0].flags & IEEE80211_TX_RC_USE_CTS_PROTECT))
620
		rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_CTS);
621
	else if (info->status.rates[0].flags & IEEE80211_TX_RC_USE_RTS_CTS)
622
		rthdr->tx_flags |= cpu_to_le16(IEEE80211_RADIOTAP_F_TX_RTS);
623 624 625 626
	if (info->status.rates[0].idx >= 0 &&
	    !(info->status.rates[0].flags & IEEE80211_TX_RC_MCS))
		rthdr->rate = sband->bitrates[
				info->status.rates[0].idx].bitrate / 5;
627

628 629
	/* for now report the total retry_count */
	rthdr->data_retries = retry_count;
630

631 632 633 634 635 636 637
	/* XXX: is this sufficient for BPF? */
	skb_set_mac_header(skb, 0);
	skb->ip_summed = CHECKSUM_UNNECESSARY;
	skb->pkt_type = PACKET_OTHERHOST;
	skb->protocol = htons(ETH_P_802_2);
	memset(skb->cb, 0, sizeof(skb->cb));

638 639
	rcu_read_lock();
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
640
		if (sdata->vif.type == NL80211_IFTYPE_MONITOR) {
641 642
			if (!netif_running(sdata->dev))
				continue;
643 644

			if (prev_dev) {
645
				skb2 = skb_clone(skb, GFP_ATOMIC);
646 647 648 649 650 651 652
				if (skb2) {
					skb2->dev = prev_dev;
					netif_rx(skb2);
				}
			}

			prev_dev = sdata->dev;
653 654
		}
	}
655 656 657 658 659
	if (prev_dev) {
		skb->dev = prev_dev;
		netif_rx(skb);
		skb = NULL;
	}
660
	rcu_read_unlock();
661
	dev_kfree_skb(skb);
662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704
}
EXPORT_SYMBOL(ieee80211_tx_status);

struct ieee80211_hw *ieee80211_alloc_hw(size_t priv_data_len,
					const struct ieee80211_ops *ops)
{
	struct ieee80211_local *local;
	int priv_size;
	struct wiphy *wiphy;

	/* 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   |
	 * +-------------------------+
	 *
	 */
	priv_size = ((sizeof(struct ieee80211_local) +
		      NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST) +
		    priv_data_len;

	wiphy = wiphy_new(&mac80211_config_ops, priv_size);

	if (!wiphy)
		return NULL;

	wiphy->privid = mac80211_wiphy_privid;

	local = wiphy_priv(wiphy);
	local->hw.wiphy = wiphy;

	local->hw.priv = (char *)local +
			 ((sizeof(struct ieee80211_local) +
			   NETDEV_ALIGN_CONST) & ~NETDEV_ALIGN_CONST);

705
	BUG_ON(!ops->tx);
706 707
	BUG_ON(!ops->start);
	BUG_ON(!ops->stop);
708 709
	BUG_ON(!ops->config);
	BUG_ON(!ops->add_interface);
710 711
	BUG_ON(!ops->remove_interface);
	BUG_ON(!ops->configure_filter);
712 713
	local->ops = ops;

714 715 716
	/* set up some defaults */
	local->hw.queues = 1;
	local->hw.max_rates = 1;
717 718
	local->rts_threshold = IEEE80211_MAX_RTS_THRESHOLD;
	local->fragmentation_threshold = IEEE80211_MAX_FRAG_THRESHOLD;
719 720
	local->hw.conf.long_frame_max_tx_count = 4;
	local->hw.conf.short_frame_max_tx_count = 7;
721
	local->hw.conf.radio_enabled = true;
722

723
	INIT_LIST_HEAD(&local->interfaces);
724

J
Johannes Berg 已提交
725 726
	spin_lock_init(&local->key_lock);

727
	INIT_DELAYED_WORK(&local->scan_work, ieee80211_scan_work);
728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750

	sta_info_init(local);

	tasklet_init(&local->tx_pending_tasklet, ieee80211_tx_pending,
		     (unsigned long)local);
	tasklet_disable(&local->tx_pending_tasklet);

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

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

	return local_to_hw(local);
}
EXPORT_SYMBOL(ieee80211_alloc_hw);

int ieee80211_register_hw(struct ieee80211_hw *hw)
{
	struct ieee80211_local *local = hw_to_local(hw);
	int result;
751
	enum ieee80211_band band;
752
	struct net_device *mdev;
753
	struct ieee80211_master_priv *mpriv;
754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771

	/*
	 * generic code guarantees at least one band,
	 * set this very early because much code assumes
	 * that hw.conf.channel is assigned
	 */
	for (band = 0; band < IEEE80211_NUM_BANDS; band++) {
		struct ieee80211_supported_band *sband;

		sband = local->hw.wiphy->bands[band];
		if (sband) {
			/* init channel we're on */
			local->hw.conf.channel =
			local->oper_channel =
			local->scan_channel = &sband->channels[0];
			break;
		}
	}
772

773 774 775 776 777 778 779
	/* if low-level driver supports AP, we also support VLAN */
	if (local->hw.wiphy->interface_modes & BIT(NL80211_IFTYPE_AP))
		local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_AP_VLAN);

	/* mac80211 always supports monitor */
	local->hw.wiphy->interface_modes |= BIT(NL80211_IFTYPE_MONITOR);

780 781 782 783
	result = wiphy_register(local->hw.wiphy);
	if (result < 0)
		return result;

784 785 786 787 788 789 790 791 792 793 794
	/*
	 * 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;
	if (hw->ampdu_queues > IEEE80211_MAX_AMPDU_QUEUES)
		hw->ampdu_queues = IEEE80211_MAX_AMPDU_QUEUES;
	if (hw->queues < 4)
		hw->ampdu_queues = 0;

795
	mdev = alloc_netdev_mq(sizeof(struct ieee80211_master_priv),
796 797
			       "wmaster%d", ether_setup,
			       ieee80211_num_queues(hw));
798 799 800
	if (!mdev)
		goto fail_mdev_alloc;

801 802
	mpriv = netdev_priv(mdev);
	mpriv->local = local;
803 804
	local->mdev = mdev;

805
	ieee80211_rx_bss_list_init(local);
806 807 808 809 810 811 812 813

	mdev->hard_start_xmit = ieee80211_master_start_xmit;
	mdev->open = ieee80211_master_open;
	mdev->stop = ieee80211_master_stop;
	mdev->type = ARPHRD_IEEE80211;
	mdev->header_ops = &ieee80211_header_ops;
	mdev->set_multicast_list = ieee80211_master_set_multicast_list;

814 815
	local->hw.workqueue =
		create_freezeable_workqueue(wiphy_name(local->hw.wiphy));
816 817 818 819 820
	if (!local->hw.workqueue) {
		result = -ENOMEM;
		goto fail_workqueue;
	}

821 822 823 824 825
	/*
	 * 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.
	 */
826 827
	local->tx_headroom = max_t(unsigned int , local->hw.extra_tx_headroom,
				   sizeof(struct ieee80211_tx_status_rtap_hdr));
828

J
Jiri Benc 已提交
829 830
	debugfs_hw_add(local);

831 832
	if (local->hw.conf.beacon_int < 10)
		local->hw.conf.beacon_int = 100;
833

834 835 836 837 838
	if (local->hw.max_listen_interval == 0)
		local->hw.max_listen_interval = 1;

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

839 840 841
	local->wstats_flags |= local->hw.flags & (IEEE80211_HW_SIGNAL_UNSPEC |
						  IEEE80211_HW_SIGNAL_DB |
						  IEEE80211_HW_SIGNAL_DBM) ?
842
			       IW_QUAL_QUAL_UPDATED : IW_QUAL_QUAL_INVALID;
843
	local->wstats_flags |= local->hw.flags & IEEE80211_HW_NOISE_DBM ?
844
			       IW_QUAL_NOISE_UPDATED : IW_QUAL_NOISE_INVALID;
845
	if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863
		local->wstats_flags |= IW_QUAL_DBM;

	result = sta_info_start(local);
	if (result < 0)
		goto fail_sta_info;

	rtnl_lock();
	result = dev_alloc_name(local->mdev, local->mdev->name);
	if (result < 0)
		goto fail_dev;

	memcpy(local->mdev->dev_addr, local->hw.wiphy->perm_addr, ETH_ALEN);
	SET_NETDEV_DEV(local->mdev, wiphy_dev(local->hw.wiphy));

	result = register_netdevice(local->mdev);
	if (result < 0)
		goto fail_dev;

864 865
	result = ieee80211_init_rate_ctrl_alg(local,
					      hw->rate_control_algorithm);
866 867
	if (result < 0) {
		printk(KERN_DEBUG "%s: Failed to initialize rate control "
868
		       "algorithm\n", wiphy_name(local->hw.wiphy));
869 870 871 872 873 874
		goto fail_rate;
	}

	result = ieee80211_wep_init(local);

	if (result < 0) {
875 876
		printk(KERN_DEBUG "%s: Failed to initialize wep: %d\n",
		       wiphy_name(local->hw.wiphy), result);
877 878 879
		goto fail_wep;
	}

880
	local->mdev->select_queue = ieee80211_select_queue;
881

882 883 884 885 886 887 888 889
	/* 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)
			printk(KERN_WARNING "%s: Failed to add default virtual iface\n",
			       wiphy_name(local->hw.wiphy));
	}
890 891 892 893 894 895 896 897 898 899 900

	rtnl_unlock();

	ieee80211_led_init(local);

	return 0;

fail_wep:
	rate_control_deinitialize(local);
fail_rate:
	unregister_netdevice(local->mdev);
901
	local->mdev = NULL;
902 903 904 905
fail_dev:
	rtnl_unlock();
	sta_info_stop(local);
fail_sta_info:
J
Jiri Benc 已提交
906
	debugfs_hw_del(local);
907 908
	destroy_workqueue(local->hw.workqueue);
fail_workqueue:
909 910
	if (local->mdev)
		free_netdev(local->mdev);
911
fail_mdev_alloc:
912 913 914 915 916 917 918 919 920 921 922 923 924 925
	wiphy_unregister(local->hw.wiphy);
	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);

	rtnl_lock();

926 927 928 929 930
	/*
	 * At this point, interface list manipulations are fine
	 * because the driver cannot be handing us frames any
	 * more and the tasklet is killed.
	 */
931

932 933
	/* First, we remove all virtual interfaces. */
	ieee80211_remove_interfaces(local);
934 935

	/* then, finally, remove the master interface */
936
	unregister_netdevice(local->mdev);
937 938 939

	rtnl_unlock();

940
	ieee80211_rx_bss_list_deinit(local);
941 942 943
	ieee80211_clear_tx_pending(local);
	sta_info_stop(local);
	rate_control_deinitialize(local);
J
Jiri Benc 已提交
944
	debugfs_hw_del(local);
945 946 947 948

	if (skb_queue_len(&local->skb_queue)
			|| skb_queue_len(&local->skb_queue_unreliable))
		printk(KERN_WARNING "%s: skb_queue not empty\n",
949
		       wiphy_name(local->hw.wiphy));
950 951 952 953 954 955 956
	skb_queue_purge(&local->skb_queue);
	skb_queue_purge(&local->skb_queue_unreliable);

	destroy_workqueue(local->hw.workqueue);
	wiphy_unregister(local->hw.wiphy);
	ieee80211_wep_free(local);
	ieee80211_led_exit(local);
957
	free_netdev(local->mdev);
958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973
}
EXPORT_SYMBOL(ieee80211_unregister_hw);

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

	wiphy_free(local->hw.wiphy);
}
EXPORT_SYMBOL(ieee80211_free_hw);

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

974 975
	BUILD_BUG_ON(sizeof(struct ieee80211_tx_info) > sizeof(skb->cb));
	BUILD_BUG_ON(offsetof(struct ieee80211_tx_info, driver_data) +
J
Johannes Berg 已提交
976
		     IEEE80211_TX_INFO_DRIVER_DATA_SIZE > sizeof(skb->cb));
977

978 979 980 981
	ret = rc80211_minstrel_init();
	if (ret)
		return ret;

982
	ret = rc80211_pid_init();
983
	if (ret)
984
		return ret;
985

J
Jiri Benc 已提交
986 987
	ieee80211_debugfs_netdev_init();

988 989 990 991 992
	return 0;
}

static void __exit ieee80211_exit(void)
{
993
	rc80211_pid_exit();
994
	rc80211_minstrel_exit();
995

996 997 998 999 1000 1001
	/*
	 * For key todo, it'll be empty by now but the work
	 * might still be scheduled.
	 */
	flush_scheduled_work();

1002 1003
	if (mesh_allocated)
		ieee80211s_stop();
J
Johannes Berg 已提交
1004

J
Jiri Benc 已提交
1005
	ieee80211_debugfs_netdev_exit();
1006 1007 1008
}


1009
subsys_initcall(ieee80211_init);
1010 1011 1012 1013
module_exit(ieee80211_exit);

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