util.c 60.7 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
		if (sdata->vif.cab_queue != IEEE80211_INVAL_HW_QUEUE &&
		    local->queue_stop_reasons[sdata->vif.cab_queue] != 0)
			continue;

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

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

Johannes Berg's avatar
Johannes Berg committed
324 325
	trace_wake_queue(local, queue, reason);

326 327
	if (WARN_ON(queue >= hw->queues))
		return;
328

329 330 331
	if (!test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

332 333 334 335 336 337
	__clear_bit(reason, &local->queue_stop_reasons[queue]);

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

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

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

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

Johannes Berg's avatar
Johannes Berg committed
371 372
	trace_stop_queue(local, queue, reason);

373 374
	if (WARN_ON(queue >= hw->queues))
		return;
375

376 377 378
	if (test_bit(reason, &local->queue_stop_reasons[queue]))
		return;

379
	__set_bit(reason, &local->queue_stop_reasons[queue]);
380

381 382 383
	if (local->hw.queues < IEEE80211_NUM_ACS)
		n_acs = 1;

384
	rcu_read_lock();
385 386 387
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
		int ac;

388 389 390
		if (!sdata->dev)
			continue;

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

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

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

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

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

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

	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
	while ((skb = skb_dequeue(skbs))) {
449 450 451
		struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);

		if (WARN_ON(!info->control.vif)) {
452
			ieee80211_free_txskb(&local->hw, skb);
453 454 455
			continue;
		}

456
		queue = info->hw_queue;
457 458 459 460

		__ieee80211_stop_queue(hw, queue,
				IEEE80211_QUEUE_STOP_REASON_SKB_ADD);

Johannes Berg's avatar
Johannes Berg committed
461
		__skb_queue_tail(&local->pending[queue], skb);
462 463
	}

464 465 466
	if (fn)
		fn(data);

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

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

481 482
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

483
	for_each_set_bit(i, &queues, hw->queues)
484 485 486 487 488 489 490
		__ieee80211_stop_queue(hw, i, reason);

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

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

496 497 498
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
499 500
	unsigned long flags;
	int ret;
501

502 503
	if (WARN_ON(queue >= hw->queues))
		return true;
504

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

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

521 522
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

523
	for_each_set_bit(i, &queues, hw->queues)
524 525 526 527 528 529 530
		__ieee80211_wake_queue(hw, i, reason);

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

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

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

558 559 560
	ieee80211_stop_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);

561
	drv_flush(local, queues, false);
562 563 564

	ieee80211_wake_queues_by_reason(&local->hw, IEEE80211_MAX_QUEUE_MAP,
					IEEE80211_QUEUE_STOP_REASON_FLUSH);
565 566
}

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

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

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

603 604 605 606 607 608 609 610 611 612
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);
613
	mutex_unlock(&local->iflist_mtx);
614 615 616 617
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces);

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

625
	rcu_read_lock();
626 627 628 629
	__iterate_active_interfaces(local, iter_flags, iterator, data);
	rcu_read_unlock();
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic);
630

631 632 633 634 635 636 637
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);
638

639
	ASSERT_RTNL();
640

641
	__iterate_active_interfaces(local, iter_flags, iterator, data);
642
}
643
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_rtnl);
644

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

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

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

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

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

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

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

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

759 760
		elem_parse_failed = false;

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

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

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

962 963 964 965
		left -= elen;
		pos += elen;
	}

966 967 968
	if (left != 0)
		elems->parse_error = true;

969 970 971
	return crc;
}

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

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

985 986 987
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return;

988 989
	memset(&qparam, 0, sizeof(qparam));

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

997 998 999 1000 1001 1002 1003
	/*
	 * 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);

1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015
	/* Set defaults according to 802.11-2007 Table 7-37 */
	aCWmax = 1023;
	if (use_11b)
		aCWmin = 31;
	else
		aCWmin = 15;

	/* Confiure old 802.11b/g medium access rules. */
	qparam.cw_max = aCWmax;
	qparam.cw_min = aCWmin;
	qparam.txop = 0;
	qparam.aifs = 2;
1016

1017 1018
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		/* Update if QoS is enabled. */
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 1052 1053
		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;
			}
1054
		}
1055

1056 1057
		qparam.uapsd = false;

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

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