util.c 66.1 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
		case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
743
		case WLAN_EID_CHAN_SWITCH_PARAM:
744 745 746 747
		/*
		 * not listing WLAN_EID_CHANNEL_SWITCH_WRAPPER -- it seems possible
		 * that if the content gets bigger it might be needed more than once
		 */
748 749 750 751 752 753 754
			if (test_bit(id, seen_elems)) {
				elems->parse_error = true;
				left -= elen;
				pos += elen;
				continue;
			}
			break;
755
		}
756 757 758 759

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

760 761
		elem_parse_failed = false;

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

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

966 967 968
		if (elem_parse_failed)
			elems->parse_error = true;
		else
969
			__set_bit(id, seen_elems);
970

971 972 973 974
		left -= elen;
		pos += elen;
	}

975 976 977
	if (left != 0)
		elems->parse_error = true;

978 979 980
	return crc;
}

981 982
void ieee80211_set_wmm_default(struct ieee80211_sub_if_data *sdata,
			       bool bss_notify)
983 984 985
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_tx_queue_params qparam;
Johannes Berg's avatar
Johannes Berg committed
986
	struct ieee80211_chanctx_conf *chanctx_conf;
987
	int ac;
988
	bool use_11b, enable_qos;
989
	int aCWmin, aCWmax;
990 991 992 993

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

994 995 996
	if (local->hw.queues < IEEE80211_NUM_ACS)
		return;

997 998
	memset(&qparam, 0, sizeof(qparam));

Johannes Berg's avatar
Johannes Berg committed
999 1000 1001
	rcu_read_lock();
	chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
	use_11b = (chanctx_conf &&
1002
		   chanctx_conf->def.chan->band == IEEE80211_BAND_2GHZ) &&
1003
		 !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE);
Johannes Berg's avatar
Johannes Berg committed
1004
	rcu_read_unlock();
1005

1006 1007 1008 1009 1010 1011 1012
	/*
	 * 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);

1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024
	/* 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;
1025

1026 1027
	for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
		/* Update if QoS is enabled. */
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 1054 1055 1056 1057 1058 1059 1060 1061 1062
		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;
			}
1063
		}
1064

1065 1066
		qparam.uapsd = false;

1067 1068
		sdata->tx_conf[ac] = qparam;
		drv_conf_tx(local, sdata, ac, &qparam);
1069
	}
1070