util.c 60.2 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 144 145 146 147 148 149
		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 */

		/* 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;
150 151 152 153 154 155

		/* rates should already consider the channel bandwidth,
		 * don't apply divisor again.
		 */
		dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10,
					4 * rate); /* T_SYM x N_SYM */
Johannes Berg's avatar
Johannes Berg committed
156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176
	} 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 */
177 178
__le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw,
					struct ieee80211_vif *vif,
179
					enum ieee80211_band band,
180 181
					size_t frame_len,
					struct ieee80211_rate *rate)
Johannes Berg's avatar
Johannes Berg committed
182
{
183
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
184
	u16 dur;
185
	int erp, shift = 0;
186
	bool short_preamble = false;
Johannes Berg's avatar
Johannes Berg committed
187

188
	erp = 0;
189 190
	if (vif) {
		sdata = vif_to_sdata(vif);
191
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
192 193
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
194
		shift = ieee80211_vif_get_shift(vif);
195
	}
196

197
	dur = ieee80211_frame_duration(band, frame_len, rate->bitrate, erp,
198
				       short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
199 200 201 202 203

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

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

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

218
	short_preamble = false;
219

220
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
221 222

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

231 232
	bitrate = DIV_ROUND_UP(rate->bitrate, 1 << shift);

Johannes Berg's avatar
Johannes Berg committed
233
	/* CTS duration */
234
	dur = ieee80211_frame_duration(sband->band, 10, bitrate,
235
				       erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
236
	/* Data frame duration */
237
	dur += ieee80211_frame_duration(sband->band, frame_len, bitrate,
238
					erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
239
	/* ACK duration */
240
	dur += ieee80211_frame_duration(sband->band, 10, bitrate,
241
					erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
242 243 244 245 246

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

247 248
__le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw,
				    struct ieee80211_vif *vif,
Johannes Berg's avatar
Johannes Berg committed
249
				    size_t frame_len,
250
				    const struct ieee80211_tx_info *frame_txctl)
Johannes Berg's avatar
Johannes Berg committed
251 252 253
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_rate *rate;
254
	struct ieee80211_sub_if_data *sdata;
255
	bool short_preamble;
256
	int erp, shift = 0, bitrate;
Johannes Berg's avatar
Johannes Berg committed
257
	u16 dur;
258 259
	struct ieee80211_supported_band *sband;

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

262
	short_preamble = false;
263

264
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
265
	erp = 0;
266 267
	if (vif) {
		sdata = vif_to_sdata(vif);
268
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
269 270
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
271
		shift = ieee80211_vif_get_shift(vif);
272
	}
Johannes Berg's avatar
Johannes Berg committed
273

274 275
	bitrate = DIV_ROUND_UP(rate->bitrate, 1 << shift);

Johannes Berg's avatar
Johannes Berg committed
276
	/* Data frame duration */
277
	dur = ieee80211_frame_duration(sband->band, frame_len, bitrate,
278
				       erp, short_preamble, shift);
279
	if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) {
Johannes Berg's avatar
Johannes Berg committed
280
		/* ACK duration */
281
		dur += ieee80211_frame_duration(sband->band, 10, bitrate,
282
						erp, short_preamble, shift);
Johannes Berg's avatar
Johannes Berg committed
283 284 285 286 287 288
	}

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

289 290 291
void ieee80211_propagate_queue_wake(struct ieee80211_local *local, int queue)
{
	struct ieee80211_sub_if_data *sdata;
292 293 294 295
	int n_acs = IEEE80211_NUM_ACS;

	if (local->hw.queues < IEEE80211_NUM_ACS)
		n_acs = 1;
296 297 298 299

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

300 301 302
		if (!sdata->dev)
			continue;

303 304 305 306 307 308 309
		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;

310
		for (ac = 0; ac < n_acs; ac++) {
311 312 313 314 315 316 317 318 319 320 321
			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);
		}
	}
}

322 323
static void __ieee80211_wake_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
324 325 326
{
	struct ieee80211_local *local = hw_to_local(hw);

Johannes Berg's avatar
Johannes Berg committed
327 328
	trace_wake_queue(local, queue, reason);

329 330
	if (WARN_ON(queue >= hw->queues))
		return;
331

332 333 334
	if (!test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

335 336 337 338 339 340
	__clear_bit(reason, &local->queue_stop_reasons[queue]);

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

341 342
	if (skb_queue_empty(&local->pending[queue])) {
		rcu_read_lock();
343
		ieee80211_propagate_queue_wake(local, queue);
344 345
		rcu_read_unlock();
	} else
Johannes Berg's avatar
Johannes Berg committed
346
		tasklet_schedule(&local->tx_pending_tasklet);
Johannes Berg's avatar
Johannes Berg committed
347
}
348

349 350
void ieee80211_wake_queue_by_reason(struct ieee80211_hw *hw, int queue,
				    enum queue_stop_reason reason)
351 352 353 354 355 356 357 358 359 360 361 362 363 364
{
	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
365 366
EXPORT_SYMBOL(ieee80211_wake_queue);

367 368
static void __ieee80211_stop_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
369 370
{
	struct ieee80211_local *local = hw_to_local(hw);
371
	struct ieee80211_sub_if_data *sdata;
372
	int n_acs = IEEE80211_NUM_ACS;
Johannes Berg's avatar
Johannes Berg committed
373

Johannes Berg's avatar
Johannes Berg committed
374 375
	trace_stop_queue(local, queue, reason);

376 377
	if (WARN_ON(queue >= hw->queues))
		return;
378

379 380 381
	if (test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

382
	__set_bit(reason, &local->queue_stop_reasons[queue]);
383

384 385 386
	if (local->hw.queues < IEEE80211_NUM_ACS)
		n_acs = 1;

387
	rcu_read_lock();
388 389 390
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		int ac;

391 392 393
		if (!sdata->dev)
			continue;

394
		for (ac = 0; ac < n_acs; ac++) {
395 396 397 398 399
			if (sdata->vif.hw_queue[ac] == queue ||
			    sdata->vif.cab_queue == queue)
				netif_stop_subqueue(sdata->dev, ac);
		}
	}
400
	rcu_read_unlock();
Johannes Berg's avatar
Johannes Berg committed
401
}
402

403 404
void ieee80211_stop_queue_by_reason(struct ieee80211_hw *hw, int queue,
				    enum queue_stop_reason reason)
405 406 407 408 409 410 411 412 413 414 415 416 417 418
{
	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
419 420
EXPORT_SYMBOL(ieee80211_stop_queue);

421 422 423 424 425
void ieee80211_add_pending_skb(struct ieee80211_local *local,
			       struct sk_buff *skb)
{
	struct ieee80211_hw *hw = &local->hw;
	unsigned long flags;
426
	struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
427
	int queue = info->hw_queue;
428 429

	if (WARN_ON(!info->control.vif)) {
430
		ieee80211_free_txskb(&local->hw, skb);
431 432
		return;
	}
433 434 435

	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
436
	__skb_queue_tail(&local->pending[queue], skb);
437 438 439 440
	__ieee80211_wake_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

441 442 443
void ieee80211_add_pending_skbs_fn(struct ieee80211_local *local,
				   struct sk_buff_head *skbs,
				   void (*fn)(void *data), void *data)
444 445 446 447
{
	struct ieee80211_hw *hw = &local->hw;
	struct sk_buff *skb;
	unsigned long flags;
448
	int queue, i;
449 450 451

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	while ((skb = skb_dequeue(skbs))) {
452 453 454
		struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);

		if (WARN_ON(!info->control.vif)) {
455
			ieee80211_free_txskb(&local->hw, skb);
456 457 458
			continue;
		}

459
		queue = info->hw_queue;
460 461 462 463

		__ieee80211_stop_queue(hw, queue,
				IEEE80211_QUEUE_STOP_REASON_SKB_ADD);

Johannes Berg's avatar
Johannes Berg committed
464
		__skb_queue_tail(&local->pending[queue], skb);
465 466
	}

467 468 469
	if (fn)
		fn(data);

Johannes Berg's avatar
Johannes Berg committed
470
	for (i = 0; i < hw->queues; i++)
471 472 473 474 475
		__ieee80211_wake_queue(hw, i,
			IEEE80211_QUEUE_STOP_REASON_SKB_ADD);
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
}

476
void ieee80211_stop_queues_by_reason(struct ieee80211_hw *hw,
477 478
				     unsigned long queues,
				     enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
479
{
480 481
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
482 483
	int i;

484 485
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

486
	for_each_set_bit(i, &queues, hw->queues)
487 488 489 490 491 492 493
		__ieee80211_stop_queue(hw, i, reason);

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

void ieee80211_stop_queues(struct ieee80211_hw *hw)
{
494
	ieee80211_stop_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
495
					IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
496 497 498
}
EXPORT_SYMBOL(ieee80211_stop_queues);

499 500 501
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
502 503
	unsigned long flags;
	int ret;
504

505 506
	if (WARN_ON(queue >= hw->queues))
		return true;
507

Johannes Berg's avatar
Johannes Berg committed
508
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
509 510
	ret = test_bit(IEEE80211_QUEUE_STOP_REASON_DRIVER,
		       &local->queue_stop_reasons[queue]);
Johannes Berg's avatar
Johannes Berg committed
511 512
	spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
	return ret;
513 514 515
}
EXPORT_SYMBOL(ieee80211_queue_stopped);

516
void ieee80211_wake_queues_by_reason(struct ieee80211_hw *hw,
517
				     unsigned long queues,
518
				     enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
519
{
520 521
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
522 523
	int i;

524 525
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

526
	for_each_set_bit(i, &queues, hw->queues)
527 528 529 530 531 532 533
		__ieee80211_wake_queue(hw, i, reason);

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

void ieee80211_wake_queues(struct ieee80211_hw *hw)
{
534 535
	ieee80211_wake_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
536 537
}
EXPORT_SYMBOL(ieee80211_wake_queues);
538

539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560
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;
	}

561 562 563
	ieee80211_stop_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);

564
	drv_flush(local, queues, false);
565 566 567

	ieee80211_wake_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);
568 569
}

570 571 572 573 574
static void __iterate_active_interfaces(struct ieee80211_local *local,
					u32 iter_flags,
					void (*iterator)(void *data, u8 *mac,
						struct ieee80211_vif *vif),
					void *data)
575 576 577
{
	struct ieee80211_sub_if_data *sdata;

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

597 598 599
	sdata = rcu_dereference_check(local->monitor_sdata,
				      lockdep_is_held(&local->iflist_mtx) ||
				      lockdep_rtnl_is_held());
600 601 602
	if (sdata &&
	    (iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL ||
	     sdata->flags & IEEE80211_SDATA_IN_DRIVER))
603
		iterator(data, sdata->vif.addr, &sdata->vif);
604
}
605

606 607 608 609 610 611 612 613 614 615
void ieee80211_iterate_active_interfaces(
	struct ieee80211_hw *hw, u32 iter_flags,
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
{
	struct ieee80211_local *local = hw_to_local(hw);

	mutex_lock(&local->iflist_mtx);
	__iterate_active_interfaces(local, iter_flags, iterator, data);
616
	mutex_unlock(&local->iflist_mtx);
617 618 619 620
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces);

void ieee80211_iterate_active_interfaces_atomic(
621
	struct ieee80211_hw *hw, u32 iter_flags,
622 623 624 625 626 627
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
{
	struct ieee80211_local *local = hw_to_local(hw);

628
	rcu_read_lock();
629 630 631 632
	__iterate_active_interfaces(local, iter_flags, iterator, data);
	rcu_read_unlock();
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic);
633

634 635 636 637 638 639 640
void ieee80211_iterate_active_interfaces_rtnl(
	struct ieee80211_hw *hw, u32 iter_flags,
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
{
	struct ieee80211_local *local = hw_to_local(hw);
641

642
	ASSERT_RTNL();
643

644
	__iterate_active_interfaces(local, iter_flags, iterator, data);
645
}
646
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_rtnl);
647

648 649 650 651 652 653 654 655 656
/*
 * 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
657 658 659
	if (WARN(local->suspended && !local->resuming,
		 "queueing ieee80211 work while going to suspend\n"))
		return false;
660 661 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

	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);

688
u32 ieee802_11_parse_elems_crc(const u8 *start, size_t len, bool action,
689 690 691 692
			       struct ieee802_11_elems *elems,
			       u64 filter, u32 crc)
{
	size_t left = len;
693
	const u8 *pos = start;
694
	bool calc_crc = filter != 0;
695
	DECLARE_BITMAP(seen_elems, 256);
696
	const u8 *ie;
697

698
	bitmap_zero(seen_elems, 256);
699 700 701 702 703 704
	memset(elems, 0, sizeof(*elems));
	elems->ie_start = start;
	elems->total_len = len;

	while (left >= 2) {
		u8 id, elen;
705
		bool elem_parse_failed;
706 707 708 709 710

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

711 712
		if (elen > left) {
			elems->parse_error = true;
713
			break;
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 739 740 741 742 743
		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:
744
		case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
745 746 747 748 749
		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
		 */
750 751 752 753 754 755 756
			if (test_bit(id, seen_elems)) {
				elems->parse_error = true;
				left -= elen;
				pos += elen;
				continue;
			}
			break;
757
		}
758 759 760 761

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

762 763
		elem_parse_failed = false;

764 765 766 767 768 769 770 771 772 773
		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:
774 775 776 777
			if (elen >= 1)
				elems->ds_params = pos;
			else
				elem_parse_failed = true;
778 779 780 781 782
			break;
		case WLAN_EID_TIM:
			if (elen >= sizeof(struct ieee80211_tim_ie)) {
				elems->tim = (void *)pos;
				elems->tim_len = elen;
783 784
			} else
				elem_parse_failed = true;
785 786 787 788 789 790 791 792 793 794 795 796 797
			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);

798
				if (elen >= 5 && pos[3] == 2) {
799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814
					/* 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:
815 816 817 818
			if (elen >= 1)
				elems->erp_info = pos;
			else
				elem_parse_failed = true;
819 820 821 822 823 824 825 826
			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;
827 828
			else
				elem_parse_failed = true;
829
			break;
830 831 832
		case WLAN_EID_HT_OPERATION:
			if (elen >= sizeof(struct ieee80211_ht_operation))
				elems->ht_operation = (void *)pos;
833 834
			else
				elem_parse_failed = true;
835
			break;
Mahesh Palivela's avatar
Mahesh Palivela committed
836 837 838 839 840 841 842 843 844 845 846 847
		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;
848 849 850 851 852 853
		case WLAN_EID_OPMODE_NOTIF:
			if (elen > 0)
				elems->opmode_notif = pos;
			else
				elem_parse_failed = true;
			break;
854 855 856 857 858 859 860
		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;
861 862
			else
				elem_parse_failed = true;
863 864 865 866 867
			break;
		case WLAN_EID_PEER_MGMT:
			elems->peering = pos;
			elems->peering_len = elen;
			break;
868 869 870 871
		case WLAN_EID_MESH_AWAKE_WINDOW:
			if (elen >= 2)
				elems->awake_window = (void *)pos;
			break;
872 873 874 875 876 877 878 879 880 881 882 883 884 885 886
		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;
887 888
			else
				elem_parse_failed = true;
889 890
			break;
		case WLAN_EID_CHANNEL_SWITCH:
891 892 893 894 895
			if (elen != sizeof(struct ieee80211_channel_sw_ie)) {
				elem_parse_failed = true;
				break;
			}
			elems->ch_switch_ie = (void *)pos;
896
			break;
897 898 899 900 901 902 903
		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;
904 905 906 907 908 909 910
		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;
911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
		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;
939 940 941 942 943
		case WLAN_EID_COUNTRY:
			elems->country_elem = pos;
			elems->country_elem_len = elen;
			break;
		case WLAN_EID_PWR_CONSTRAINT:
944 945 946 947
			if (elen != 1) {
				elem_parse_failed = true;
				break;
			}
948 949 950
			elems->pwr_constr_elem = pos;
			break;
		case WLAN_EID_TIMEOUT_INTERVAL:
951 952 953 954
			if (elen >= sizeof(struct ieee80211_timeout_interval_ie))
				elems->timeout_int = (void *)pos;
			else
				elem_parse_failed = true;
955 956 957 958 959
			break;
		default:
			break;
		}

960 961 962
		if (elem_parse_failed)
			elems->parse_error = true;
		else
963
			__set_bit(id, seen_elems);
964

965 966 967 968
		left -= elen;
		pos += elen;
	}

969 970 971
	if (left != 0)
		elems->parse_error = true;

972 973 974
	return crc;
}

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

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

988 989 990
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return;

991 992
	memset(&qparam, 0, sizeof(qparam));

Johannes Berg's avatar
Johannes Berg committed
993 994 995
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	use_11b = (chanctx_conf &&
996
		   chanctx_conf->def.chan->band == IEEE80211_BAND_2GHZ) &&
997
		 !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE);
Johannes Berg's avatar
Johannes Berg committed
998
	rcu_read_unlock();
999

1000 1001 1002 1003 1004 1005 1006
	/*
	 * 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);

1007
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1008 1009 1010 1011 1012 1013 1014
		/* Set defaults according to 802.11-2007 Table 7-37 */
		aCWmax = 1023;
		if (use_11b)
			aCWmin = 31;
		else
			aCWmin = 15;

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 1047 1048 1049 1050 1051
		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. */
1052 1053
			qparam.cw_max = aCWmax;
			qparam.cw_min = aCWmin;
1054 1055 1056
			qparam.txop = 0;
			qparam.aifs = 2;
		}
1057

1058 1059
		qparam.uapsd = false;

1060 1061
		sdata->tx_conf[ac] = qparam;
		drv_conf_tx(local, sdata, ac, &qparam);
1062
	}
1063

1064 1065
	if (sdata->vif.type != NL80211_IFTYPE_MONITOR &&
	    sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE) {
1066
		sdata->vif.bss_conf.qos = enable_qos;
1067 1068 1069
		if (bss_notify)
			ieee80211_bss_info_change_notify(sdata,
							 BSS_CHANGED_QOS);