util.c 56.8 KB
Newer Older
Johannes Berg's avatar
Johannes Berg committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * Copyright 2002-2005, Instant802 Networks, Inc.
 * Copyright 2005-2006, Devicescape Software, Inc.
 * Copyright 2006-2007	Jiri Benc <jbenc@suse.cz>
 * Copyright 2007	Johannes Berg <johannes@sipsolutions.net>
 *
 * 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.
 *
 * utilities for mac80211
 */

#include <net/mac80211.h>
#include <linux/netdevice.h>
16
#include <linux/export.h>
Johannes Berg's avatar
Johannes Berg committed
17 18 19 20 21 22
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/skbuff.h>
#include <linux/etherdevice.h>
#include <linux/if_arp.h>
#include <linux/bitmap.h>
23
#include <linux/crc32.h>
24
#include <net/net_namespace.h>
Johannes Berg's avatar
Johannes Berg committed
25
#include <net/cfg80211.h>
26
#include <net/rtnetlink.h>
Johannes Berg's avatar
Johannes Berg committed
27 28

#include "ieee80211_i.h"
29
#include "driver-ops.h"
Johannes Berg's avatar
Johannes Berg committed
30
#include "rate.h"
31
#include "mesh.h"
Johannes Berg's avatar
Johannes Berg committed
32
#include "wme.h"
33
#include "led.h"
Johannes Berg's avatar
Johannes Berg committed
34
#include "wep.h"
Johannes Berg's avatar
Johannes Berg committed
35 36 37 38

/* privid for wiphys to determine whether they belong to us or not */
void *mac80211_wiphy_privid = &mac80211_wiphy_privid;

39 40 41 42 43 44 45 46 47
struct ieee80211_hw *wiphy_to_ieee80211_hw(struct wiphy *wiphy)
{
	struct ieee80211_local *local;
	BUG_ON(!wiphy);

	local = wiphy_priv(wiphy);
	return &local->hw;
}
EXPORT_SYMBOL(wiphy_to_ieee80211_hw);
Johannes Berg's avatar
Johannes Berg committed
48

49
u8 *ieee80211_get_bssid(struct ieee80211_hdr *hdr, size_t len,
50
			enum nl80211_iftype type)
Johannes Berg's avatar
Johannes Berg committed
51
{
52
	__le16 fc = hdr->frame_control;
Johannes Berg's avatar
Johannes Berg committed
53

54 55
	 /* drop ACK/CTS frames and incorrect hdr len (ctrl) */
	if (len < 16)
Johannes Berg's avatar
Johannes Berg committed
56 57
		return NULL;

58
	if (ieee80211_is_data(fc)) {
59 60
		if (len < 24) /* drop incorrect hdr len (data) */
			return NULL;
61 62

		if (ieee80211_has_a4(fc))
Johannes Berg's avatar
Johannes Berg committed
63
			return NULL;
64 65 66
		if (ieee80211_has_tods(fc))
			return hdr->addr1;
		if (ieee80211_has_fromds(fc))
Johannes Berg's avatar
Johannes Berg committed
67
			return hdr->addr2;
68 69 70 71 72

		return hdr->addr3;
	}

	if (ieee80211_is_mgmt(fc)) {
73 74
		if (len < 24) /* drop incorrect hdr len (mgmt) */
			return NULL;
Johannes Berg's avatar
Johannes Berg committed
75
		return hdr->addr3;
76 77 78 79
	}

	if (ieee80211_is_ctl(fc)) {
		if(ieee80211_is_pspoll(fc))
Johannes Berg's avatar
Johannes Berg committed
80
			return hdr->addr1;
81 82

		if (ieee80211_is_back_req(fc)) {
83
			switch (type) {
84
			case NL80211_IFTYPE_STATION:
85
				return hdr->addr2;
86 87
			case NL80211_IFTYPE_AP:
			case NL80211_IFTYPE_AP_VLAN:
88 89
				return hdr->addr1;
			default:
90
				break; /* fall through to the return */
91 92
			}
		}
Johannes Berg's avatar
Johannes Berg committed
93 94 95 96 97
	}

	return NULL;
}

98
void ieee80211_tx_set_protected(struct ieee80211_tx_data *tx)
Johannes Berg's avatar
Johannes Berg committed
99
{
100
	struct sk_buff *skb;
101 102
	struct ieee80211_hdr *hdr;

103
	skb_queue_walk(&tx->skbs, skb) {
104 105
		hdr = (struct ieee80211_hdr *) skb->data;
		hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
106
	}
Johannes Berg's avatar
Johannes Berg committed
107 108
}

109
int ieee80211_frame_duration(enum ieee80211_band band, size_t len,
110 111
			     int rate, int erp, int short_preamble,
			     int shift)
Johannes Berg's avatar
Johannes Berg committed
112 113 114 115 116 117 118 119 120 121
{
	int dur;

	/* calculate duration (in microseconds, rounded up to next higher
	 * integer if it includes a fractional microsecond) to send frame of
	 * len bytes (does not include FCS) at the given rate. Duration will
	 * also include SIFS.
	 *
	 * rate is in 100 kbps, so divident is multiplied by 10 in the
	 * DIV_ROUND_UP() operations.
122 123 124
	 *
	 * shift may be 2 for 5 MHz channels or 1 for 10 MHz channels, and
	 * is assumed to be 0 otherwise.
Johannes Berg's avatar
Johannes Berg committed
125 126
	 */

127
	if (band == IEEE80211_BAND_5GHZ || erp) {
Johannes Berg's avatar
Johannes Berg committed
128 129 130 131 132 133 134 135 136
		/*
		 * OFDM:
		 *
		 * N_DBPS = DATARATE x 4
		 * N_SYM = Ceiling((16+8xLENGTH+6) / N_DBPS)
		 *	(16 = SIGNAL time, 6 = tail bits)
		 * TXTIME = T_PREAMBLE + T_SIGNAL + T_SYM x N_SYM + Signal Ext
		 *
		 * T_SYM = 4 usec
137
		 * 802.11a - 18.5.2: aSIFSTime = 16 usec
Johannes Berg's avatar
Johannes Berg committed
138 139 140 141
		 * 802.11g - 19.8.4: aSIFSTime = 10 usec +
		 *	signal ext = 6 usec
		 */
		dur = 16; /* SIFS + signal ext */
142 143
		dur += 16; /* IEEE 802.11-2012 18.3.2.4: T_PREAMBLE = 16 usec */
		dur += 4; /* IEEE 802.11-2012 18.3.2.4: T_SIGNAL = 4 usec */
Johannes Berg's avatar
Johannes Berg committed
144 145
		dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10,
					4 * rate); /* T_SYM x N_SYM */
146 147 148 149 150 151

		/* IEEE 802.11-2012 18.3.2.4: all values above are:
		 *  * times 4 for 5 MHz
		 *  * times 2 for 10 MHz
		 */
		dur *= 1 << shift;
Johannes Berg's avatar
Johannes Berg committed
152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172
	} else {
		/*
		 * 802.11b or 802.11g with 802.11b compatibility:
		 * 18.3.4: TXTIME = PreambleLength + PLCPHeaderTime +
		 * Ceiling(((LENGTH+PBCC)x8)/DATARATE). PBCC=0.
		 *
		 * 802.11 (DS): 15.3.3, 802.11b: 18.3.4
		 * aSIFSTime = 10 usec
		 * aPreambleLength = 144 usec or 72 usec with short preamble
		 * aPLCPHeaderLength = 48 usec or 24 usec with short preamble
		 */
		dur = 10; /* aSIFSTime = 10 usec */
		dur += short_preamble ? (72 + 24) : (144 + 48);

		dur += DIV_ROUND_UP(8 * (len + 4) * 10, rate);
	}

	return dur;
}

/* Exported duration function for driver use */
173 174
__le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw,
					struct ieee80211_vif *vif,
175
					enum ieee80211_band band,
176 177
					size_t frame_len,
					struct ieee80211_rate *rate)
Johannes Berg's avatar
Johannes Berg committed
178
{
179
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
180
	u16 dur;
181
	int erp, shift = 0;
182
	bool short_preamble = false;
Johannes Berg's avatar
Johannes Berg committed
183

184
	erp = 0;
185 186
	if (vif) {
		sdata = vif_to_sdata(vif);
187
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
188 189
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
190
		shift = ieee80211_vif_get_shift(vif);
191
	}
192

193
	dur = ieee80211_frame_duration(band, frame_len, rate->bitrate, erp,
194
				       short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
195 196 197 198 199

	return cpu_to_le16(dur);
}
EXPORT_SYMBOL(ieee80211_generic_frame_duration);

200 201
__le16 ieee80211_rts_duration(struct ieee80211_hw *hw,
			      struct ieee80211_vif *vif, size_t frame_len,
202
			      const struct ieee80211_tx_info *frame_txctl)
Johannes Berg's avatar
Johannes Berg committed
203 204 205
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_rate *rate;
206
	struct ieee80211_sub_if_data *sdata;
207
	bool short_preamble;
208
	int erp, shift = 0;
Johannes Berg's avatar
Johannes Berg committed
209
	u16 dur;
210 211
	struct ieee80211_supported_band *sband;

212
	sband = local->hw.wiphy->bands[frame_txctl->band];
Johannes Berg's avatar
Johannes Berg committed
213

214
	short_preamble = false;
215

216
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
217 218

	erp = 0;
219 220
	if (vif) {
		sdata = vif_to_sdata(vif);
221
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
222 223
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
224
		shift = ieee80211_vif_get_shift(vif);
225
	}
Johannes Berg's avatar
Johannes Berg committed
226 227

	/* CTS duration */
228
	dur = ieee80211_frame_duration(sband->band, 10, rate->bitrate,
229
				       erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
230
	/* Data frame duration */
231
	dur += ieee80211_frame_duration(sband->band, frame_len, rate->bitrate,
232
					erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
233
	/* ACK duration */
234
	dur += ieee80211_frame_duration(sband->band, 10, rate->bitrate,
235
					erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
236 237 238 239 240

	return cpu_to_le16(dur);
}
EXPORT_SYMBOL(ieee80211_rts_duration);

241 242
__le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw,
				    struct ieee80211_vif *vif,
Johannes Berg's avatar
Johannes Berg committed
243
				    size_t frame_len,
244
				    const struct ieee80211_tx_info *frame_txctl)
Johannes Berg's avatar
Johannes Berg committed
245 246 247
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_rate *rate;
248
	struct ieee80211_sub_if_data *sdata;
249
	bool short_preamble;
250
	int erp, shift = 0;
Johannes Berg's avatar
Johannes Berg committed
251
	u16 dur;
252 253
	struct ieee80211_supported_band *sband;

254
	sband = local->hw.wiphy->bands[frame_txctl->band];
Johannes Berg's avatar
Johannes Berg committed
255

256
	short_preamble = false;
257

258
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
259
	erp = 0;
260 261
	if (vif) {
		sdata = vif_to_sdata(vif);
262
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
263 264
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
265
		shift = ieee80211_vif_get_shift(vif);
266
	}
Johannes Berg's avatar
Johannes Berg committed
267 268

	/* Data frame duration */
269
	dur = ieee80211_frame_duration(sband->band, frame_len, rate->bitrate,
270
				       erp, short_preamble, shift);
271
	if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) {
Johannes Berg's avatar
Johannes Berg committed
272
		/* ACK duration */
273
		dur += ieee80211_frame_duration(sband->band, 10, rate->bitrate,
274
						erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
275 276 277 278 279 280
	}

	return cpu_to_le16(dur);
}
EXPORT_SYMBOL(ieee80211_ctstoself_duration);

281 282 283
void ieee80211_propagate_queue_wake(struct ieee80211_local *local, int queue)
{
	struct ieee80211_sub_if_data *sdata;
284 285 286 287
	int n_acs = IEEE80211_NUM_ACS;

	if (local->hw.queues < IEEE80211_NUM_ACS)
		n_acs = 1;
288 289 290 291

	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		int ac;

292 293 294
		if (!sdata->dev)
			continue;

295 296 297 298 299 300 301
		if (test_bit(SDATA_STATE_OFFCHANNEL, &sdata->state))
			continue;

		if (sdata->vif.cab_queue != IEEE80211_INVAL_HW_QUEUE &&
		    local->queue_stop_reasons[sdata->vif.cab_queue] != 0)
			continue;

302
		for (ac = 0; ac < n_acs; ac++) {
303 304 305 306 307 308 309 310 311 312 313
			int ac_queue = sdata->vif.hw_queue[ac];

			if (ac_queue == queue ||
			    (sdata->vif.cab_queue == queue &&
			     local->queue_stop_reasons[ac_queue] == 0 &&
			     skb_queue_empty(&local->pending[ac_queue])))
				netif_wake_subqueue(sdata->dev, ac);
		}
	}
}

314 315
static void __ieee80211_wake_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
316 317 318
{
	struct ieee80211_local *local = hw_to_local(hw);

Johannes Berg's avatar
Johannes Berg committed
319 320
	trace_wake_queue(local, queue, reason);

321 322
	if (WARN_ON(queue >= hw->queues))
		return;
323

324 325 326
	if (!test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

327 328 329 330 331 332
	__clear_bit(reason, &local->queue_stop_reasons[queue]);

	if (local->queue_stop_reasons[queue] != 0)
		/* someone still has this queue stopped */
		return;

333 334
	if (skb_queue_empty(&local->pending[queue])) {
		rcu_read_lock();
335
		ieee80211_propagate_queue_wake(local, queue);
336 337
		rcu_read_unlock();
	} else
Johannes Berg's avatar
Johannes Berg committed
338
		tasklet_schedule(&local->tx_pending_tasklet);
Johannes Berg's avatar
Johannes Berg committed
339
}
340

341 342
void ieee80211_wake_queue_by_reason(struct ieee80211_hw *hw, int queue,
				    enum queue_stop_reason reason)
343 344 345 346 347 348 349 350 351 352 353 354 355 356
{
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	__ieee80211_wake_queue(hw, queue, reason);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

void ieee80211_wake_queue(struct ieee80211_hw *hw, int queue)
{
	ieee80211_wake_queue_by_reason(hw, queue,
				       IEEE80211_QUEUE_STOP_REASON_DRIVER);
}
Johannes Berg's avatar
Johannes Berg committed
357 358
EXPORT_SYMBOL(ieee80211_wake_queue);

359 360
static void __ieee80211_stop_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
361 362
{
	struct ieee80211_local *local = hw_to_local(hw);
363
	struct ieee80211_sub_if_data *sdata;
364
	int n_acs = IEEE80211_NUM_ACS;
Johannes Berg's avatar
Johannes Berg committed
365

Johannes Berg's avatar
Johannes Berg committed
366 367
	trace_stop_queue(local, queue, reason);

368 369
	if (WARN_ON(queue >= hw->queues))
		return;
370

371 372 373
	if (test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

374
	__set_bit(reason, &local->queue_stop_reasons[queue]);
375

376 377 378
	if (local->hw.queues < IEEE80211_NUM_ACS)
		n_acs = 1;

379
	rcu_read_lock();
380 381 382
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		int ac;

383 384 385
		if (!sdata->dev)
			continue;

386
		for (ac = 0; ac < n_acs; ac++) {
387 388 389 390 391
			if (sdata->vif.hw_queue[ac] == queue ||
			    sdata->vif.cab_queue == queue)
				netif_stop_subqueue(sdata->dev, ac);
		}
	}
392
	rcu_read_unlock();
Johannes Berg's avatar
Johannes Berg committed
393
}
394

395 396
void ieee80211_stop_queue_by_reason(struct ieee80211_hw *hw, int queue,
				    enum queue_stop_reason reason)
397 398 399 400 401 402 403 404 405 406 407 408 409 410
{
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	__ieee80211_stop_queue(hw, queue, reason);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

void ieee80211_stop_queue(struct ieee80211_hw *hw, int queue)
{
	ieee80211_stop_queue_by_reason(hw, queue,
				       IEEE80211_QUEUE_STOP_REASON_DRIVER);
}
Johannes Berg's avatar
Johannes Berg committed
411 412
EXPORT_SYMBOL(ieee80211_stop_queue);

413 414 415 416 417
void ieee80211_add_pending_skb(struct ieee80211_local *local,
			       struct sk_buff *skb)
{
	struct ieee80211_hw *hw = &local->hw;
	unsigned long flags;
418
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
419
	int queue = info->hw_queue;
420 421

	if (WARN_ON(!info->control.vif)) {
422
		ieee80211_free_txskb(&local->hw, skb);
423 424
		return;
	}
425 426 427

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	__ieee80211_stop_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD);
Johannes Berg's avatar
Johannes Berg committed
428
	__skb_queue_tail(&local->pending[queue], skb);
429 430 431 432
	__ieee80211_wake_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

433 434 435
void ieee80211_add_pending_skbs_fn(struct ieee80211_local *local,
				   struct sk_buff_head *skbs,
				   void (*fn)(void *data), void *data)
436 437 438 439
{
	struct ieee80211_hw *hw = &local->hw;
	struct sk_buff *skb;
	unsigned long flags;
440
	int queue, i;
441 442 443

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	while ((skb = skb_dequeue(skbs))) {
444 445 446
		struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);

		if (WARN_ON(!info->control.vif)) {
447
			ieee80211_free_txskb(&local->hw, skb);
448 449 450
			continue;
		}

451
		queue = info->hw_queue;
452 453 454 455

		__ieee80211_stop_queue(hw, queue,
				IEEE80211_QUEUE_STOP_REASON_SKB_ADD);

Johannes Berg's avatar
Johannes Berg committed
456
		__skb_queue_tail(&local->pending[queue], skb);
457 458
	}

459 460 461
	if (fn)
		fn(data);

Johannes Berg's avatar
Johannes Berg committed
462
	for (i = 0; i < hw->queues; i++)
463 464 465 466 467
		__ieee80211_wake_queue(hw, i,
			IEEE80211_QUEUE_STOP_REASON_SKB_ADD);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

468
void ieee80211_stop_queues_by_reason(struct ieee80211_hw *hw,
469 470
				     unsigned long queues,
				     enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
471
{
472 473
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
474 475
	int i;

476 477
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

478
	for_each_set_bit(i, &queues, hw->queues)
479 480 481 482 483 484 485
		__ieee80211_stop_queue(hw, i, reason);

	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

void ieee80211_stop_queues(struct ieee80211_hw *hw)
{
486
	ieee80211_stop_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
487
					IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
488 489 490
}
EXPORT_SYMBOL(ieee80211_stop_queues);

491 492 493
int ieee80211_queue_stopped(struct ieee80211_hw *hw, int queue)
{
	struct ieee80211_local *local = hw_to_local(hw);
Johannes Berg's avatar
Johannes Berg committed
494 495
	unsigned long flags;
	int ret;
496

497 498
	if (WARN_ON(queue >= hw->queues))
		return true;
499

Johannes Berg's avatar
Johannes Berg committed
500
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
501 502
	ret = test_bit(IEEE80211_QUEUE_STOP_REASON_DRIVER,
		       &local->queue_stop_reasons[queue]);
Johannes Berg's avatar
Johannes Berg committed
503 504
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
	return ret;
505 506 507
}
EXPORT_SYMBOL(ieee80211_queue_stopped);

508
void ieee80211_wake_queues_by_reason(struct ieee80211_hw *hw,
509
				     unsigned long queues,
510
				     enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
511
{
512 513
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
514 515
	int i;

516 517
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

518
	for_each_set_bit(i, &queues, hw->queues)
519 520 521 522 523 524 525
		__ieee80211_wake_queue(hw, i, reason);

	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

void ieee80211_wake_queues(struct ieee80211_hw *hw)
{
526 527
	ieee80211_wake_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
528 529
}
EXPORT_SYMBOL(ieee80211_wake_queues);
530

531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552
void ieee80211_flush_queues(struct ieee80211_local *local,
			    struct ieee80211_sub_if_data *sdata)
{
	u32 queues;

	if (!local->ops->flush)
		return;

	if (sdata && local->hw.flags & IEEE80211_HW_QUEUE_CONTROL) {
		int ac;

		queues = 0;

		for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
			queues |= BIT(sdata->vif.hw_queue[ac]);
		if (sdata->vif.cab_queue != IEEE80211_INVAL_HW_QUEUE)
			queues |= BIT(sdata->vif.cab_queue);
	} else {
		/* all queues */
		queues = BIT(local->hw.queues) - 1;
	}

553 554 555
	ieee80211_stop_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);

556
	drv_flush(local, queues, false);
557 558 559

	ieee80211_wake_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);
560 561
}

562
void ieee80211_iterate_active_interfaces(
563
	struct ieee80211_hw *hw, u32 iter_flags,
564 565 566
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
567 568 569 570
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_sub_if_data *sdata;

571
	mutex_lock(&local->iflist_mtx);
572 573 574

	list_for_each_entry(sdata, &local->interfaces, list) {
		switch (sdata->vif.type) {
575
		case NL80211_IFTYPE_MONITOR:
576 577 578
			if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
				continue;
			break;
579
		case NL80211_IFTYPE_AP_VLAN:
580
			continue;
581
		default:
582 583
			break;
		}
584 585 586
		if (!(iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL) &&
		    !(sdata->flags & IEEE80211_SDATA_IN_DRIVER))
			continue;
587
		if (ieee80211_sdata_running(sdata))
588
			iterator(data, sdata->vif.addr,
589 590 591
				 &sdata->vif);
	}

592 593
	sdata = rcu_dereference_protected(local->monitor_sdata,
					  lockdep_is_held(&local->iflist_mtx));
594 595 596
	if (sdata &&
	    (iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL ||
	     sdata->flags & IEEE80211_SDATA_IN_DRIVER))
597 598
		iterator(data, sdata->vif.addr, &sdata->vif);

599
	mutex_unlock(&local->iflist_mtx);
600 601 602 603
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces);

void ieee80211_iterate_active_interfaces_atomic(
604
	struct ieee80211_hw *hw, u32 iter_flags,
605 606 607 608 609 610 611
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_sub_if_data *sdata;

612
	rcu_read_lock();
613

614
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
615
		switch (sdata->vif.type) {
616
		case NL80211_IFTYPE_MONITOR:
617 618 619
			if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
				continue;
			break;
620
		case NL80211_IFTYPE_AP_VLAN:
621
			continue;
622
		default:
623 624
			break;
		}
625 626 627
		if (!(iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL) &&
		    !(sdata->flags & IEEE80211_SDATA_IN_DRIVER))
			continue;
628
		if (ieee80211_sdata_running(sdata))
629
			iterator(data, sdata->vif.addr,
630
				 &sdata->vif);
631
	}
632

633
	sdata = rcu_dereference(local->monitor_sdata);
634 635 636
	if (sdata &&
	    (iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL ||
	     sdata->flags & IEEE80211_SDATA_IN_DRIVER))
637 638
		iterator(data, sdata->vif.addr, &sdata->vif);

639
	rcu_read_unlock();
640
}
641
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic);
642

643 644 645 646 647 648 649 650 651
/*
 * Nothing should have been stuffed into the workqueue during
 * the suspend->resume cycle. If this WARN is seen then there
 * is a bug with either the driver suspend or something in
 * mac80211 stuffing into the workqueue which we haven't yet
 * cleared during mac80211's suspend cycle.
 */
static bool ieee80211_can_queue_work(struct ieee80211_local *local)
{
Johannes Berg's avatar
Johannes Berg committed
652 653 654
	if (WARN(local->suspended && !local->resuming,
		 "queueing ieee80211 work while going to suspend\n"))
		return false;
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682

	return true;
}

void ieee80211_queue_work(struct ieee80211_hw *hw, struct work_struct *work)
{
	struct ieee80211_local *local = hw_to_local(hw);

	if (!ieee80211_can_queue_work(local))
		return;

	queue_work(local->workqueue, work);
}
EXPORT_SYMBOL(ieee80211_queue_work);

void ieee80211_queue_delayed_work(struct ieee80211_hw *hw,
				  struct delayed_work *dwork,
				  unsigned long delay)
{
	struct ieee80211_local *local = hw_to_local(hw);

	if (!ieee80211_can_queue_work(local))
		return;

	queue_delayed_work(local->workqueue, dwork, delay);
}
EXPORT_SYMBOL(ieee80211_queue_delayed_work);

683
u32 ieee802_11_parse_elems_crc(const u8 *start, size_t len, bool action,
684 685 686 687
			       struct ieee802_11_elems *elems,
			       u64 filter, u32 crc)
{
	size_t left = len;
688
	const u8 *pos = start;
689
	bool calc_crc = filter != 0;
690
	DECLARE_BITMAP(seen_elems, 256);
691
	const u8 *ie;
692

693
	bitmap_zero(seen_elems, 256);
694 695 696 697 698 699
	memset(elems, 0, sizeof(*elems));
	elems->ie_start = start;
	elems->total_len = len;

	while (left >= 2) {
		u8 id, elen;
700
		bool elem_parse_failed;
701 702 703 704 705

		id = *pos++;
		elen = *pos++;
		left -= 2;

706 707
		if (elen > left) {
			elems->parse_error = true;
708
			break;
709 710
		}

711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738
		switch (id) {
		case WLAN_EID_SSID:
		case WLAN_EID_SUPP_RATES:
		case WLAN_EID_FH_PARAMS:
		case WLAN_EID_DS_PARAMS:
		case WLAN_EID_CF_PARAMS:
		case WLAN_EID_TIM:
		case WLAN_EID_IBSS_PARAMS:
		case WLAN_EID_CHALLENGE:
		case WLAN_EID_RSN:
		case WLAN_EID_ERP_INFO:
		case WLAN_EID_EXT_SUPP_RATES:
		case WLAN_EID_HT_CAPABILITY:
		case WLAN_EID_HT_OPERATION:
		case WLAN_EID_VHT_CAPABILITY:
		case WLAN_EID_VHT_OPERATION:
		case WLAN_EID_MESH_ID:
		case WLAN_EID_MESH_CONFIG:
		case WLAN_EID_PEER_MGMT:
		case WLAN_EID_PREQ:
		case WLAN_EID_PREP:
		case WLAN_EID_PERR:
		case WLAN_EID_RANN:
		case WLAN_EID_CHANNEL_SWITCH:
		case WLAN_EID_EXT_CHANSWITCH_ANN:
		case WLAN_EID_COUNTRY:
		case WLAN_EID_PWR_CONSTRAINT:
		case WLAN_EID_TIMEOUT_INTERVAL:
739
		case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
740 741 742 743 744
		case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
		/*
		 * not listing WLAN_EID_CHANNEL_SWITCH_WRAPPER -- it seems possible
		 * that if the content gets bigger it might be needed more than once
		 */
745 746 747 748 749 750 751
			if (test_bit(id, seen_elems)) {
				elems->parse_error = true;
				left -= elen;
				pos += elen;
				continue;
			}
			break;
752
		}
753 754 755 756

		if (calc_crc && id < 64 && (filter & (1ULL << id)))
			crc = crc32_be(crc, pos - 2, elen + 2);

757 758
		elem_parse_failed = false;

759 760 761 762 763 764 765 766 767 768
		switch (id) {
		case WLAN_EID_SSID:
			elems->ssid = pos;
			elems->ssid_len = elen;
			break;
		case WLAN_EID_SUPP_RATES:
			elems->supp_rates = pos;
			elems->supp_rates_len = elen;
			break;
		case WLAN_EID_DS_PARAMS:
769 770 771 772
			if (elen >= 1)
				elems->ds_params = pos;
			else
				elem_parse_failed = true;
773 774 775 776 777
			break;
		case WLAN_EID_TIM:
			if (elen >= sizeof(struct ieee80211_tim_ie)) {
				elems->tim = (void *)pos;
				elems->tim_len = elen;
778 779
			} else
				elem_parse_failed = true;
780 781 782 783 784 785 786 787 788 789 790 791 792
			break;
		case WLAN_EID_CHALLENGE:
			elems->challenge = pos;
			elems->challenge_len = elen;
			break;
		case WLAN_EID_VENDOR_SPECIFIC:
			if (elen >= 4 && pos[0] == 0x00 && pos[1] == 0x50 &&
			    pos[2] == 0xf2) {
				/* Microsoft OUI (00:50:F2) */

				if (calc_crc)
					crc = crc32_be(crc, pos - 2, elen + 2);

793
				if (elen >= 5 && pos[3] == 2) {
794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809
					/* OUI Type 2 - WMM IE */
					if (pos[4] == 0) {
						elems->wmm_info = pos;
						elems->wmm_info_len = elen;
					} else if (pos[4] == 1) {
						elems->wmm_param = pos;
						elems->wmm_param_len = elen;
					}
				}
			}
			break;
		case WLAN_EID_RSN:
			elems->rsn = pos;
			elems->rsn_len = elen;
			break;
		case WLAN_EID_ERP_INFO:
810 811 812 813
			if (elen >= 1)
				elems->erp_info = pos;
			else
				elem_parse_failed = true;
814 815 816 817 818 819 820 821
			break;
		case WLAN_EID_EXT_SUPP_RATES:
			elems->ext_supp_rates = pos;
			elems->ext_supp_rates_len = elen;
			break;
		case WLAN_EID_HT_CAPABILITY:
			if (elen >= sizeof(struct ieee80211_ht_cap))
				elems->ht_cap_elem = (void *)pos;
822 823
			else
				elem_parse_failed = true;
824
			break;
825 826 827
		case WLAN_EID_HT_OPERATION:
			if (elen >= sizeof(struct ieee80211_ht_operation))
				elems->ht_operation = (void *)pos;
828 829
			else
				elem_parse_failed = true;
830
			break;
Mahesh Palivela's avatar
Mahesh Palivela committed
831 832 833 834 835 836 837 838 839 840 841 842
		case WLAN_EID_VHT_CAPABILITY:
			if (elen >= sizeof(struct ieee80211_vht_cap))
				elems->vht_cap_elem = (void *)pos;
			else
				elem_parse_failed = true;
			break;
		case WLAN_EID_VHT_OPERATION:
			if (elen >= sizeof(struct ieee80211_vht_operation))
				elems->vht_operation = (void *)pos;
			else
				elem_parse_failed = true;
			break;
843 844 845 846 847 848
		case WLAN_EID_OPMODE_NOTIF:
			if (elen > 0)
				elems->opmode_notif = pos;
			else
				elem_parse_failed = true;
			break;
849 850 851 852 853 854 855
		case WLAN_EID_MESH_ID:
			elems->mesh_id = pos;
			elems->mesh_id_len = elen;
			break;
		case WLAN_EID_MESH_CONFIG:
			if (elen >= sizeof(struct ieee80211_meshconf_ie))
				elems->mesh_config = (void *)pos;
856 857
			else
				elem_parse_failed = true;
858 859 860 861 862
			break;
		case WLAN_EID_PEER_MGMT:
			elems->peering = pos;
			elems->peering_len = elen;
			break;
863 864 865 866
		case WLAN_EID_MESH_AWAKE_WINDOW:
			if (elen >= 2)
				elems->awake_window = (void *)pos;
			break;
867 868 869 870 871 872 873 874 875 876 877 878 879 880 881
		case WLAN_EID_PREQ:
			elems->preq = pos;
			elems->preq_len = elen;
			break;
		case WLAN_EID_PREP:
			elems->prep = pos;
			elems->prep_len = elen;
			break;
		case WLAN_EID_PERR:
			elems->perr = pos;
			elems->perr_len = elen;
			break;
		case WLAN_EID_RANN:
			if (elen >= sizeof(struct ieee80211_rann_ie))
				elems->rann = (void *)pos;
882 883
			else
				elem_parse_failed = true;
884 885
			break;
		case WLAN_EID_CHANNEL_SWITCH:
886 887 888 889 890
			if (elen != sizeof(struct ieee80211_channel_sw_ie)) {
				elem_parse_failed = true;
				break;
			}
			elems->ch_switch_ie = (void *)pos;
891
			break;
892 893 894 895 896 897 898
		case WLAN_EID_EXT_CHANSWITCH_ANN:
			if (elen != sizeof(struct ieee80211_ext_chansw_ie)) {
				elem_parse_failed = true;
				break;
			}
			elems->ext_chansw_ie = (void *)pos;
			break;
899 900 901 902 903 904 905
		case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
			if (elen != sizeof(struct ieee80211_sec_chan_offs_ie)) {
				elem_parse_failed = true;
				break;
			}
			elems->sec_chan_offs = (void *)pos;
			break;
906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
		case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
			if (!action ||
			    elen != sizeof(*elems->wide_bw_chansw_ie)) {
				elem_parse_failed = true;
				break;
			}
			elems->wide_bw_chansw_ie = (void *)pos;
			break;
		case WLAN_EID_CHANNEL_SWITCH_WRAPPER:
			if (action) {
				elem_parse_failed = true;
				break;
			}
			/*
			 * This is a bit tricky, but as we only care about
			 * the wide bandwidth channel switch element, so
			 * just parse it out manually.
			 */
			ie = cfg80211_find_ie(WLAN_EID_WIDE_BW_CHANNEL_SWITCH,
					      pos, elen);
			if (ie) {
				if (ie[1] == sizeof(*elems->wide_bw_chansw_ie))
					elems->wide_bw_chansw_ie =
						(void *)(ie + 2);
				else
					elem_parse_failed = true;
			}
			break;
934 935 936 937 938
		case WLAN_EID_COUNTRY:
			elems->country_elem = pos;
			elems->country_elem_len = elen;
			break;
		case WLAN_EID_PWR_CONSTRAINT:
939 940 941 942
			if (elen != 1) {
				elem_parse_failed = true;
				break;
			}
943 944 945
			elems->pwr_constr_elem = pos;
			break;
		case WLAN_EID_TIMEOUT_INTERVAL:
946 947 948 949
			if (elen >= sizeof(struct ieee80211_timeout_interval_ie))
				elems->timeout_int = (void *)pos;
			else
				elem_parse_failed = true;
950 951 952 953 954
			break;
		default:
			break;
		}

955 956 957
		if (elem_parse_failed)
			elems->parse_error = true;
		else
958
			__set_bit(id, seen_elems);
959

960 961 962 963
		left -= elen;
		pos += elen;
	}

964 965 966
	if (left != 0)
		elems->parse_error = true;

967 968 969
	return crc;
}

970 971
void ieee80211_set_wmm_default(struct ieee80211_sub_if_data *sdata,
			       bool bss_notify)
972 973 974
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_tx_queue_params qparam;
Johannes Berg's avatar
Johannes Berg committed
975
	struct ieee80211_chanctx_conf *chanctx_conf;
976
	int ac;
977
	bool use_11b, enable_qos;
978
	int aCWmin, aCWmax;
979 980 981 982

	if (!local->ops->conf_tx)
		return;

983 984 985
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return;

986 987
	memset(&qparam, 0, sizeof(qparam));

Johannes Berg's avatar
Johannes Berg committed
988 989 990
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	use_11b = (chanctx_conf &&
991
		   chanctx_conf->def.chan->band == IEEE80211_BAND_2GHZ) &&
992
		 !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE);
Johannes Berg's avatar
Johannes Berg committed
993
	rcu_read_unlock();
994

995 996 997 998 999 1000 1001
	/*
	 * By default disable QoS in STA mode for old access points, which do
	 * not support 802.11e. New APs will provide proper queue parameters,
	 * that we will configure later.
	 */
	enable_qos = (sdata->vif.type != NL80211_IFTYPE_STATION);

1002
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1003 1004 1005 1006 1007 1008 1009
		/* Set defaults according to 802.11-2007 Table 7-37 */
		aCWmax = 1023;
		if (use_11b)
			aCWmin = 31;
		else
			aCWmin = 15;

1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046
		if (enable_qos) {
			switch (ac) {
			case IEEE80211_AC_BK:
				qparam.cw_max = aCWmax;
				qparam.cw_min = aCWmin;
				qparam.txop = 0;
				qparam.aifs = 7;
				break;
			/* never happens but let's not leave undefined */
			default:
			case IEEE80211_AC_BE:
				qparam.cw_max = aCWmax;
				qparam.cw_min = aCWmin;
				qparam.txop = 0;
				qparam.aifs = 3;
				break;
			case IEEE80211_AC_VI:
				qparam.cw_max = aCWmin;
				qparam.cw_min = (aCWmin + 1) / 2 - 1;
				if (use_11b)
					qparam.txop = 6016/32;
				else
					qparam.txop = 3008/32;
				qparam.aifs = 2;
				break;
			case IEEE80211_AC_VO:
				qparam.cw_max = (aCWmin + 1) / 2 - 1;
				qparam.cw_min = (aCWmin + 1) / 4 - 1;
				if (use_11b)
					qparam.txop = 3264/32;
				else
					qparam.txop = 1504/32;
				qparam.aifs = 2;
				break;
			}
		} else {
			/* Confiure old 802.11b/g medium access rules. */
1047 1048
			qparam.cw_max = aCWmax;
			qparam.cw_min = aCWmin;
1049 1050 1051
			qparam.txop = 0;
			qparam.aifs = 2;
		}
1052

1053 1054
		qparam.uapsd = false;

1055 1056
		sdata->tx_conf[ac] = qparam;
		drv_conf_tx(local, sdata, ac, &qparam);