util.c 19 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
16
17
18
19
20
21
22
/*
 * 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>
#include <linux/types.h>
#include <linux/slab.h>
#include <linux/skbuff.h>
#include <linux/etherdevice.h>
#include <linux/if_arp.h>
#include <linux/wireless.h>
#include <linux/bitmap.h>
23
#include <net/net_namespace.h>
Johannes Berg's avatar
Johannes Berg committed
24
#include <net/cfg80211.h>
25
#include <net/rtnetlink.h>
Johannes Berg's avatar
Johannes Berg committed
26
27

#include "ieee80211_i.h"
Johannes Berg's avatar
Johannes Berg committed
28
#include "rate.h"
29
#include "mesh.h"
Johannes Berg's avatar
Johannes Berg committed
30
31
32
33
34
35
36
#include "wme.h"

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

/* See IEEE 802.1H for LLC/SNAP encapsulation/decapsulation */
/* Ethernet-II snap header (RFC1042 for most EtherTypes) */
37
const unsigned char rfc1042_header[] __aligned(2) =
Johannes Berg's avatar
Johannes Berg committed
38
39
40
	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00 };

/* Bridge-Tunnel header (for EtherTypes ETH_P_AARP and ETH_P_IPX) */
41
const unsigned char bridge_tunnel_header[] __aligned(2) =
Johannes Berg's avatar
Johannes Berg committed
42
43
44
	{ 0xaa, 0xaa, 0x03, 0x00, 0x00, 0xf8 };


45
u8 *ieee80211_get_bssid(struct ieee80211_hdr *hdr, size_t len,
46
			enum nl80211_iftype type)
Johannes Berg's avatar
Johannes Berg committed
47
{
48
	__le16 fc = hdr->frame_control;
Johannes Berg's avatar
Johannes Berg committed
49

50
51
	 /* drop ACK/CTS frames and incorrect hdr len (ctrl) */
	if (len < 16)
Johannes Berg's avatar
Johannes Berg committed
52
53
		return NULL;

54
	if (ieee80211_is_data(fc)) {
55
56
		if (len < 24) /* drop incorrect hdr len (data) */
			return NULL;
57
58

		if (ieee80211_has_a4(fc))
Johannes Berg's avatar
Johannes Berg committed
59
			return NULL;
60
61
62
		if (ieee80211_has_tods(fc))
			return hdr->addr1;
		if (ieee80211_has_fromds(fc))
Johannes Berg's avatar
Johannes Berg committed
63
			return hdr->addr2;
64
65
66
67
68

		return hdr->addr3;
	}

	if (ieee80211_is_mgmt(fc)) {
69
70
		if (len < 24) /* drop incorrect hdr len (mgmt) */
			return NULL;
Johannes Berg's avatar
Johannes Berg committed
71
		return hdr->addr3;
72
73
74
75
	}

	if (ieee80211_is_ctl(fc)) {
		if(ieee80211_is_pspoll(fc))
Johannes Berg's avatar
Johannes Berg committed
76
			return hdr->addr1;
77
78

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

	return NULL;
}

94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
unsigned int ieee80211_hdrlen(__le16 fc)
{
	unsigned int hdrlen = 24;

	if (ieee80211_is_data(fc)) {
		if (ieee80211_has_a4(fc))
			hdrlen = 30;
		if (ieee80211_is_data_qos(fc))
			hdrlen += IEEE80211_QOS_CTL_LEN;
		goto out;
	}

	if (ieee80211_is_ctl(fc)) {
		/*
		 * ACK and CTS are 10 bytes, all others 16. To see how
		 * to get this condition consider
		 *   subtype mask:   0b0000000011110000 (0x00F0)
		 *   ACK subtype:    0b0000000011010000 (0x00D0)
		 *   CTS subtype:    0b0000000011000000 (0x00C0)
		 *   bits that matter:         ^^^      (0x00E0)
		 *   value of those: 0b0000000011000000 (0x00C0)
		 */
		if ((fc & cpu_to_le16(0x00E0)) == cpu_to_le16(0x00C0))
			hdrlen = 10;
		else
			hdrlen = 16;
	}
out:
	return hdrlen;
}
EXPORT_SYMBOL(ieee80211_hdrlen);

126
unsigned int ieee80211_get_hdrlen_from_skb(const struct sk_buff *skb)
Johannes Berg's avatar
Johannes Berg committed
127
{
128
129
	const struct ieee80211_hdr *hdr = (const struct ieee80211_hdr *)skb->data;
	unsigned int hdrlen;
Johannes Berg's avatar
Johannes Berg committed
130
131
132

	if (unlikely(skb->len < 10))
		return 0;
133
	hdrlen = ieee80211_hdrlen(hdr->frame_control);
Johannes Berg's avatar
Johannes Berg committed
134
135
136
137
138
139
	if (unlikely(hdrlen > skb->len))
		return 0;
	return hdrlen;
}
EXPORT_SYMBOL(ieee80211_get_hdrlen_from_skb);

140
141
142
143
144
145
int ieee80211_get_mesh_hdrlen(struct ieee80211s_hdr *meshhdr)
{
	int ae = meshhdr->flags & IEEE80211S_FLAGS_AE;
	/* 7.1.3.5a.2 */
	switch (ae) {
	case 0:
146
		return 6;
147
	case 1:
148
		return 12;
149
	case 2:
150
		return 18;
151
	case 3:
152
		return 24;
153
	default:
154
		return 6;
155
156
157
	}
}

158
void ieee80211_tx_set_protected(struct ieee80211_tx_data *tx)
Johannes Berg's avatar
Johannes Berg committed
159
160
161
162
{
	struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) tx->skb->data;

	hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
163
	if (tx->extra_frag) {
Johannes Berg's avatar
Johannes Berg committed
164
165
		struct ieee80211_hdr *fhdr;
		int i;
166
		for (i = 0; i < tx->num_extra_frag; i++) {
Johannes Berg's avatar
Johannes Berg committed
167
			fhdr = (struct ieee80211_hdr *)
168
				tx->extra_frag[i]->data;
Johannes Berg's avatar
Johannes Berg committed
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
			fhdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
		}
	}
}

int ieee80211_frame_duration(struct ieee80211_local *local, size_t len,
			     int rate, int erp, int short_preamble)
{
	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.
	 */

188
	if (local->hw.conf.channel->band == IEEE80211_BAND_5GHZ || erp) {
Johannes Berg's avatar
Johannes Berg committed
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
		/*
		 * 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
		 * 802.11a - 17.5.2: aSIFSTime = 16 usec
		 * 802.11g - 19.8.4: aSIFSTime = 10 usec +
		 *	signal ext = 6 usec
		 */
		dur = 16; /* SIFS + signal ext */
		dur += 16; /* 17.3.2.3: T_PREAMBLE = 16 usec */
		dur += 4; /* 17.3.2.3: T_SIGNAL = 4 usec */
		dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10,
					4 * rate); /* T_SYM x N_SYM */
	} 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 */
228
229
__le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw,
					struct ieee80211_vif *vif,
230
231
					size_t frame_len,
					struct ieee80211_rate *rate)
Johannes Berg's avatar
Johannes Berg committed
232
233
{
	struct ieee80211_local *local = hw_to_local(hw);
234
	struct ieee80211_sub_if_data *sdata;
Johannes Berg's avatar
Johannes Berg committed
235
236
	u16 dur;
	int erp;
237
	bool short_preamble = false;
Johannes Berg's avatar
Johannes Berg committed
238

239
	erp = 0;
240
241
	if (vif) {
		sdata = vif_to_sdata(vif);
242
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
243
244
245
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
	}
246
247

	dur = ieee80211_frame_duration(local, frame_len, rate->bitrate, erp,
248
				       short_preamble);
Johannes Berg's avatar
Johannes Berg committed
249
250
251
252
253

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

254
255
__le16 ieee80211_rts_duration(struct ieee80211_hw *hw,
			      struct ieee80211_vif *vif, size_t frame_len,
256
			      const struct ieee80211_tx_info *frame_txctl)
Johannes Berg's avatar
Johannes Berg committed
257
258
259
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_rate *rate;
260
	struct ieee80211_sub_if_data *sdata;
261
	bool short_preamble;
Johannes Berg's avatar
Johannes Berg committed
262
263
	int erp;
	u16 dur;
264
265
266
	struct ieee80211_supported_band *sband;

	sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
Johannes Berg's avatar
Johannes Berg committed
267

268
	short_preamble = false;
269

270
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
271
272

	erp = 0;
273
274
	if (vif) {
		sdata = vif_to_sdata(vif);
275
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
276
277
278
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
	}
Johannes Berg's avatar
Johannes Berg committed
279
280

	/* CTS duration */
281
	dur = ieee80211_frame_duration(local, 10, rate->bitrate,
Johannes Berg's avatar
Johannes Berg committed
282
283
				       erp, short_preamble);
	/* Data frame duration */
284
	dur += ieee80211_frame_duration(local, frame_len, rate->bitrate,
Johannes Berg's avatar
Johannes Berg committed
285
286
					erp, short_preamble);
	/* ACK duration */
287
	dur += ieee80211_frame_duration(local, 10, rate->bitrate,
Johannes Berg's avatar
Johannes Berg committed
288
289
290
291
292
293
					erp, short_preamble);

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

294
295
__le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw,
				    struct ieee80211_vif *vif,
Johannes Berg's avatar
Johannes Berg committed
296
				    size_t frame_len,
297
				    const struct ieee80211_tx_info *frame_txctl)
Johannes Berg's avatar
Johannes Berg committed
298
299
300
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_rate *rate;
301
	struct ieee80211_sub_if_data *sdata;
302
	bool short_preamble;
Johannes Berg's avatar
Johannes Berg committed
303
304
	int erp;
	u16 dur;
305
306
307
	struct ieee80211_supported_band *sband;

	sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
Johannes Berg's avatar
Johannes Berg committed
308

309
	short_preamble = false;
310

311
	rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
312
	erp = 0;
313
314
	if (vif) {
		sdata = vif_to_sdata(vif);
315
		short_preamble = sdata->vif.bss_conf.use_short_preamble;
316
317
318
		if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
			erp = rate->flags & IEEE80211_RATE_ERP_G;
	}
Johannes Berg's avatar
Johannes Berg committed
319
320

	/* Data frame duration */
321
	dur = ieee80211_frame_duration(local, frame_len, rate->bitrate,
Johannes Berg's avatar
Johannes Berg committed
322
				       erp, short_preamble);
323
	if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) {
Johannes Berg's avatar
Johannes Berg committed
324
		/* ACK duration */
325
		dur += ieee80211_frame_duration(local, 10, rate->bitrate,
Johannes Berg's avatar
Johannes Berg committed
326
327
328
329
330
331
332
						erp, short_preamble);
	}

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

333
334
static void __ieee80211_wake_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
335
336
337
{
	struct ieee80211_local *local = hw_to_local(hw);

338
339
340
341
342
343
344
345
346
	/* we don't need to track ampdu queues */
	if (queue < ieee80211_num_regular_queues(hw)) {
		__clear_bit(reason, &local->queue_stop_reasons[queue]);

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

347
	if (test_bit(queue, local->queues_pending)) {
348
		set_bit(queue, local->queues_pending_run);
349
350
		tasklet_schedule(&local->tx_pending_tasklet);
	} else {
351
		netif_wake_subqueue(local->mdev, queue);
Johannes Berg's avatar
Johannes Berg committed
352
353
	}
}
354

355
356
static void ieee80211_wake_queue_by_reason(struct ieee80211_hw *hw, int queue,
					   enum queue_stop_reason reason)
357
358
359
360
361
362
363
364
365
366
367
368
369
370
{
	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
371
372
EXPORT_SYMBOL(ieee80211_wake_queue);

373
374
static void __ieee80211_stop_queue(struct ieee80211_hw *hw, int queue,
				   enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
375
376
377
{
	struct ieee80211_local *local = hw_to_local(hw);

378
379
380
381
	/* we don't need to track ampdu queues */
	if (queue < ieee80211_num_regular_queues(hw))
		__set_bit(reason, &local->queue_stop_reasons[queue]);

382
	netif_stop_subqueue(local->mdev, queue);
Johannes Berg's avatar
Johannes Berg committed
383
}
384

385
386
static void ieee80211_stop_queue_by_reason(struct ieee80211_hw *hw, int queue,
					   enum queue_stop_reason reason)
387
388
389
390
391
392
393
394
395
396
397
398
399
400
{
	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
401
402
EXPORT_SYMBOL(ieee80211_stop_queue);

403
404
void ieee80211_stop_queues_by_reason(struct ieee80211_hw *hw,
				    enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
405
{
406
407
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
408
409
	int i;

410
411
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

412
	for (i = 0; i < ieee80211_num_queues(hw); i++)
413
414
415
416
417
418
419
420
421
		__ieee80211_stop_queue(hw, i, reason);

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

void ieee80211_stop_queues(struct ieee80211_hw *hw)
{
	ieee80211_stop_queues_by_reason(hw,
					IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
422
423
424
}
EXPORT_SYMBOL(ieee80211_stop_queues);

425
426
427
428
429
430
431
int ieee80211_queue_stopped(struct ieee80211_hw *hw, int queue)
{
	struct ieee80211_local *local = hw_to_local(hw);
	return __netif_subqueue_stopped(local->mdev, queue);
}
EXPORT_SYMBOL(ieee80211_queue_stopped);

432
433
void ieee80211_wake_queues_by_reason(struct ieee80211_hw *hw,
				     enum queue_stop_reason reason)
Johannes Berg's avatar
Johannes Berg committed
434
{
435
436
	struct ieee80211_local *local = hw_to_local(hw);
	unsigned long flags;
Johannes Berg's avatar
Johannes Berg committed
437
438
	int i;

439
440
	spin_lock_irqsave(&local->queue_stop_reason_lock, flags);

441
	for (i = 0; i < hw->queues + hw->ampdu_queues; i++)
442
443
444
445
446
447
448
449
		__ieee80211_wake_queue(hw, i, reason);

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

void ieee80211_wake_queues(struct ieee80211_hw *hw)
{
	ieee80211_wake_queues_by_reason(hw, IEEE80211_QUEUE_STOP_REASON_DRIVER);
Johannes Berg's avatar
Johannes Berg committed
450
451
}
EXPORT_SYMBOL(ieee80211_wake_queues);
452

453
454
455
456
457
void ieee80211_iterate_active_interfaces(
	struct ieee80211_hw *hw,
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
458
459
460
461
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_sub_if_data *sdata;

462
463
464
465
	rtnl_lock();

	list_for_each_entry(sdata, &local->interfaces, list) {
		switch (sdata->vif.type) {
466
467
468
469
		case __NL80211_IFTYPE_AFTER_LAST:
		case NL80211_IFTYPE_UNSPECIFIED:
		case NL80211_IFTYPE_MONITOR:
		case NL80211_IFTYPE_AP_VLAN:
470
			continue;
471
472
473
474
475
		case NL80211_IFTYPE_AP:
		case NL80211_IFTYPE_STATION:
		case NL80211_IFTYPE_ADHOC:
		case NL80211_IFTYPE_WDS:
		case NL80211_IFTYPE_MESH_POINT:
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
			break;
		}
		if (netif_running(sdata->dev))
			iterator(data, sdata->dev->dev_addr,
				 &sdata->vif);
	}

	rtnl_unlock();
}
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces);

void ieee80211_iterate_active_interfaces_atomic(
	struct ieee80211_hw *hw,
	void (*iterator)(void *data, u8 *mac,
			 struct ieee80211_vif *vif),
	void *data)
{
	struct ieee80211_local *local = hw_to_local(hw);
	struct ieee80211_sub_if_data *sdata;

496
	rcu_read_lock();
497

498
	list_for_each_entry_rcu(sdata, &local->interfaces, list) {
499
		switch (sdata->vif.type) {
500
501
502
503
		case __NL80211_IFTYPE_AFTER_LAST:
		case NL80211_IFTYPE_UNSPECIFIED:
		case NL80211_IFTYPE_MONITOR:
		case NL80211_IFTYPE_AP_VLAN:
504
			continue;
505
506
507
508
509
		case NL80211_IFTYPE_AP:
		case NL80211_IFTYPE_STATION:
		case NL80211_IFTYPE_ADHOC:
		case NL80211_IFTYPE_WDS:
		case NL80211_IFTYPE_MESH_POINT:
510
511
512
513
			break;
		}
		if (netif_running(sdata->dev))
			iterator(data, sdata->dev->dev_addr,
514
				 &sdata->vif);
515
	}
516
517

	rcu_read_unlock();
518
}
519
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic);
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605

void ieee802_11_parse_elems(u8 *start, size_t len,
			    struct ieee802_11_elems *elems)
{
	size_t left = len;
	u8 *pos = start;

	memset(elems, 0, sizeof(*elems));
	elems->ie_start = start;
	elems->total_len = len;

	while (left >= 2) {
		u8 id, elen;

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

		if (elen > left)
			return;

		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_FH_PARAMS:
			elems->fh_params = pos;
			elems->fh_params_len = elen;
			break;
		case WLAN_EID_DS_PARAMS:
			elems->ds_params = pos;
			elems->ds_params_len = elen;
			break;
		case WLAN_EID_CF_PARAMS:
			elems->cf_params = pos;
			elems->cf_params_len = elen;
			break;
		case WLAN_EID_TIM:
			elems->tim = pos;
			elems->tim_len = elen;
			break;
		case WLAN_EID_IBSS_PARAMS:
			elems->ibss_params = pos;
			elems->ibss_params_len = elen;
			break;
		case WLAN_EID_CHALLENGE:
			elems->challenge = pos;
			elems->challenge_len = elen;
			break;
		case WLAN_EID_WPA:
			if (elen >= 4 && pos[0] == 0x00 && pos[1] == 0x50 &&
			    pos[2] == 0xf2) {
				/* Microsoft OUI (00:50:F2) */
				if (pos[3] == 1) {
					/* OUI Type 1 - WPA IE */
					elems->wpa = pos;
					elems->wpa_len = elen;
				} else if (elen >= 5 && pos[3] == 2) {
					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:
			elems->erp_info = pos;
			elems->erp_info_len = elen;
			break;
		case WLAN_EID_EXT_SUPP_RATES:
			elems->ext_supp_rates = pos;
			elems->ext_supp_rates_len = elen;
			break;
		case WLAN_EID_HT_CAPABILITY:
606
607
			if (elen >= sizeof(struct ieee80211_ht_cap))
				elems->ht_cap_elem = (void *)pos;
608
			break;
609
610
		case WLAN_EID_HT_INFORMATION:
			if (elen >= sizeof(struct ieee80211_ht_info))
611
				elems->ht_info_elem = (void *)pos;
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
			break;
		case WLAN_EID_MESH_ID:
			elems->mesh_id = pos;
			elems->mesh_id_len = elen;
			break;
		case WLAN_EID_MESH_CONFIG:
			elems->mesh_config = pos;
			elems->mesh_config_len = elen;
			break;
		case WLAN_EID_PEER_LINK:
			elems->peer_link = pos;
			elems->peer_link_len = elen;
			break;
		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_CHANNEL_SWITCH:
			elems->ch_switch_elem = pos;
			elems->ch_switch_elem_len = elen;
			break;
		case WLAN_EID_QUIET:
			if (!elems->quiet_elem) {
				elems->quiet_elem = pos;
				elems->quiet_elem_len = elen;
			}
			elems->num_of_quiet_elem++;
			break;
		case WLAN_EID_COUNTRY:
			elems->country_elem = pos;
			elems->country_elem_len = elen;
			break;
		case WLAN_EID_PWR_CONSTRAINT:
			elems->pwr_constr_elem = pos;
			elems->pwr_constr_elem_len = elen;
			break;
656
657
658
		case WLAN_EID_TIMEOUT_INTERVAL:
			elems->timeout_int = pos;
			elems->timeout_int_len = elen;
659
			break;
660
661
662
663
664
665
666
667
		default:
			break;
		}

		left -= elen;
		pos += elen;
	}
}
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693

void ieee80211_set_wmm_default(struct ieee80211_sub_if_data *sdata)
{
	struct ieee80211_local *local = sdata->local;
	struct ieee80211_tx_queue_params qparam;
	int i;

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

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

	qparam.aifs = 2;

	if (local->hw.conf.channel->band == IEEE80211_BAND_2GHZ &&
	    !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE))
		qparam.cw_min = 31;
	else
		qparam.cw_min = 15;

	qparam.cw_max = 1023;
	qparam.txop = 0;

	for (i = 0; i < local_to_hw(local)->queues; i++)
		local->ops->conf_tx(local_to_hw(local), i, &qparam);
}
694
695
696
697
698
699
700
701
702
703
704
705
706
707

void ieee80211_tx_skb(struct ieee80211_sub_if_data *sdata, struct sk_buff *skb,
		      int encrypt)
{
	skb->dev = sdata->local->mdev;
	skb_set_mac_header(skb, 0);
	skb_set_network_header(skb, 0);
	skb_set_transport_header(skb, 0);

	skb->iif = sdata->dev->ifindex;
	skb->do_not_encrypt = !encrypt;

	dev_queue_xmit(skb);
}
708
709
710
711
712
713
714
715
716
717

int ieee80211_set_freq(struct ieee80211_sub_if_data *sdata, int freqMHz)
{
	int ret = -EINVAL;
	struct ieee80211_channel *chan;
	struct ieee80211_local *local = sdata->local;

	chan = ieee80211_get_channel(local->hw.wiphy, freqMHz);

	if (chan && !(chan->flags & IEEE80211_CHAN_DISABLED)) {
718
		if (sdata->vif.type == NL80211_IFTYPE_ADHOC &&
719
		    chan->flags & IEEE80211_CHAN_NO_IBSS)
720
721
			return ret;
		local->oper_channel = chan;
Sujith's avatar
Sujith committed
722
		local->oper_channel_type = NL80211_CHAN_NO_HT;
723

724
		if (local->sw_scanning || local->hw_scanning)
725
726
			ret = 0;
		else
727
728
			ret = ieee80211_hw_config(
				local, IEEE80211_CONF_CHANGE_CHANNEL);
729
730
731
732
	}

	return ret;
}
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760

u64 ieee80211_mandatory_rates(struct ieee80211_local *local,
			      enum ieee80211_band band)
{
	struct ieee80211_supported_band *sband;
	struct ieee80211_rate *bitrates;
	u64 mandatory_rates;
	enum ieee80211_rate_flags mandatory_flag;
	int i;

	sband = local->hw.wiphy->bands[band];
	if (!sband) {
		WARN_ON(1);
		sband = local->hw.wiphy->bands[local->hw.conf.channel->band];
	}

	if (band == IEEE80211_BAND_2GHZ)
		mandatory_flag = IEEE80211_RATE_MANDATORY_B;
	else
		mandatory_flag = IEEE80211_RATE_MANDATORY_A;

	bitrates = sband->bitrates;
	mandatory_rates = 0;
	for (i = 0; i < sband->n_bitrates; i++)
		if (bitrates[i].flags & mandatory_flag)
			mandatory_rates |= BIT(i);
	return mandatory_rates;
}