projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
mac80211: avoid unnecessary beacon deref on CSA counter update
[linux-2.6-block.git] / net / mac80211 / util.c
CommitLineData
c2d1560a
JB		 1/*
2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
5 * Copyright 2007 Johannes Berg <johannes@sipsolutions.net>
d98ad83e 6 * Copyright 2013-2014 Intel Mobile Communications GmbH
c2d1560a
JB		 7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 *
12 * utilities for mac80211
13 */
14
15#include <net/mac80211.h>
16#include <linux/netdevice.h>
bc3b2d7f 17#include <linux/export.h>
c2d1560a
JB		 18#include <linux/types.h>
19#include <linux/slab.h>
20#include <linux/skbuff.h>
21#include <linux/etherdevice.h>
22#include <linux/if_arp.h>
c2d1560a 23#include <linux/bitmap.h>
dd76986b 24#include <linux/crc32.h>
881d966b 25#include <net/net_namespace.h>
c2d1560a 26#include <net/cfg80211.h>
dabeb344 27#include <net/rtnetlink.h>
c2d1560a
JB		 28
29#include "ieee80211_i.h"
24487981 30#include "driver-ops.h"
2c8dccc7 31#include "rate.h"
ee385855 32#include "mesh.h"
c2d1560a 33#include "wme.h"
f2753ddb 34#include "led.h"
fffd0934 35#include "wep.h"
c2d1560a
JB		 36
37/* privid for wiphys to determine whether they belong to us or not */
8a47cea7 38const void *const mac80211_wiphy_privid = &mac80211_wiphy_privid;
c2d1560a 39
9a95371a
LR		 40struct ieee80211_hw *wiphy_to_ieee80211_hw(struct wiphy *wiphy)
41{
42 struct ieee80211_local *local;
43 BUG_ON(!wiphy);
44
45 local = wiphy_priv(wiphy);
46 return &local->hw;
47}
48EXPORT_SYMBOL(wiphy_to_ieee80211_hw);
c2d1560a 49
5cf121c3 50void ieee80211_tx_set_protected(struct ieee80211_tx_data *tx)
c2d1560a 51{
252b86c4 52 struct sk_buff *skb;
2de8e0d9
JB		 53 struct ieee80211_hdr *hdr;
54
252b86c4 55 skb_queue_walk(&tx->skbs, skb) {
2de8e0d9
JB		 56 hdr = (struct ieee80211_hdr *) skb->data;
57 hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
252b86c4 58 }
c2d1560a
JB		 59}
60
4ee73f33 61int ieee80211_frame_duration(enum ieee80211_band band, size_t len,
438b61b7
SW		 62 int rate, int erp, int short_preamble,
63 int shift)
c2d1560a
JB		 64{
65 int dur;
66
67 /* calculate duration (in microseconds, rounded up to next higher
68 * integer if it includes a fractional microsecond) to send frame of
69 * len bytes (does not include FCS) at the given rate. Duration will
70 * also include SIFS.
71 *
72 * rate is in 100 kbps, so divident is multiplied by 10 in the
73 * DIV_ROUND_UP() operations.
438b61b7
SW		 74 *
75 * shift may be 2 for 5 MHz channels or 1 for 10 MHz channels, and
76 * is assumed to be 0 otherwise.
c2d1560a
JB		 77 */
78
4ee73f33 79 if (band == IEEE80211_BAND_5GHZ || erp) {
c2d1560a
JB		 80 /*
81 * OFDM:
82 *
83 * N_DBPS = DATARATE x 4
84 * N_SYM = Ceiling((16+8xLENGTH+6) / N_DBPS)
85 * (16 = SIGNAL time, 6 = tail bits)
86 * TXTIME = T_PREAMBLE + T_SIGNAL + T_SYM x N_SYM + Signal Ext
87 *
88 * T_SYM = 4 usec
438b61b7 89 * 802.11a - 18.5.2: aSIFSTime = 16 usec
c2d1560a
JB		 90 * 802.11g - 19.8.4: aSIFSTime = 10 usec +
91 * signal ext = 6 usec
92 */
c2d1560a 93 dur = 16; /* SIFS + signal ext */
438b61b7
SW		 94 dur += 16; /* IEEE 802.11-2012 18.3.2.4: T_PREAMBLE = 16 usec */
95 dur += 4; /* IEEE 802.11-2012 18.3.2.4: T_SIGNAL = 4 usec */
438b61b7
SW		 96
97 /* IEEE 802.11-2012 18.3.2.4: all values above are:
98 * * times 4 for 5 MHz
99 * * times 2 for 10 MHz
100 */
101 dur *= 1 << shift;
2103dec1
SW		 102
103 /* rates should already consider the channel bandwidth,
104 * don't apply divisor again.
105 */
106 dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10,
107 4 * rate); /* T_SYM x N_SYM */
c2d1560a
JB		 108 } else {
109 /*
110 * 802.11b or 802.11g with 802.11b compatibility:
111 * 18.3.4: TXTIME = PreambleLength + PLCPHeaderTime +
112 * Ceiling(((LENGTH+PBCC)x8)/DATARATE). PBCC=0.
113 *
114 * 802.11 (DS): 15.3.3, 802.11b: 18.3.4
115 * aSIFSTime = 10 usec
116 * aPreambleLength = 144 usec or 72 usec with short preamble
117 * aPLCPHeaderLength = 48 usec or 24 usec with short preamble
118 */
119 dur = 10; /* aSIFSTime = 10 usec */
120 dur += short_preamble ? (72 + 24) : (144 + 48);
121
122 dur += DIV_ROUND_UP(8 * (len + 4) * 10, rate);
123 }
124
125 return dur;
126}
127
128/* Exported duration function for driver use */
32bfd35d
JB		 129__le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw,
130 struct ieee80211_vif *vif,
4ee73f33 131 enum ieee80211_band band,
8318d78a
JB		 132 size_t frame_len,
133 struct ieee80211_rate *rate)
c2d1560a 134{
25d834e1 135 struct ieee80211_sub_if_data *sdata;
c2d1560a 136 u16 dur;
438b61b7 137 int erp, shift = 0;
25d834e1 138 bool short_preamble = false;
c2d1560a 139
8318d78a 140 erp = 0;
25d834e1
JB		 141 if (vif) {
142 sdata = vif_to_sdata(vif);
bda3933a 143 short_preamble = sdata->vif.bss_conf.use_short_preamble;
25d834e1
JB		 144 if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
145 erp = rate->flags & IEEE80211_RATE_ERP_G;
438b61b7 146 shift = ieee80211_vif_get_shift(vif);
25d834e1 147 }
8318d78a 148
4ee73f33 149 dur = ieee80211_frame_duration(band, frame_len, rate->bitrate, erp,
438b61b7 150 short_preamble, shift);
c2d1560a
JB		 151
152 return cpu_to_le16(dur);
153}
154EXPORT_SYMBOL(ieee80211_generic_frame_duration);
155
32bfd35d
JB		 156__le16 ieee80211_rts_duration(struct ieee80211_hw *hw,
157 struct ieee80211_vif *vif, size_t frame_len,
e039fa4a 158 const struct ieee80211_tx_info *frame_txctl)
c2d1560a
JB		 159{
160 struct ieee80211_local *local = hw_to_local(hw);
161 struct ieee80211_rate *rate;
25d834e1 162 struct ieee80211_sub_if_data *sdata;
471b3efd 163 bool short_preamble;
2103dec1 164 int erp, shift = 0, bitrate;
c2d1560a 165 u16 dur;
2e92e6f2
JB		 166 struct ieee80211_supported_band *sband;
167
4ee73f33 168 sband = local->hw.wiphy->bands[frame_txctl->band];
c2d1560a 169
25d834e1 170 short_preamble = false;
7e9ed188 171
e039fa4a 172 rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
8318d78a
JB		 173
174 erp = 0;
25d834e1
JB		 175 if (vif) {
176 sdata = vif_to_sdata(vif);
bda3933a 177 short_preamble = sdata->vif.bss_conf.use_short_preamble;
25d834e1
JB		 178 if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
179 erp = rate->flags & IEEE80211_RATE_ERP_G;
438b61b7 180 shift = ieee80211_vif_get_shift(vif);
25d834e1 181 }
c2d1560a 182
2103dec1
SW		 183 bitrate = DIV_ROUND_UP(rate->bitrate, 1 << shift);
184
c2d1560a 185 /* CTS duration */
2103dec1 186 dur = ieee80211_frame_duration(sband->band, 10, bitrate,
438b61b7 187 erp, short_preamble, shift);
c2d1560a 188 /* Data frame duration */
2103dec1 189 dur += ieee80211_frame_duration(sband->band, frame_len, bitrate,
438b61b7 190 erp, short_preamble, shift);
c2d1560a 191 /* ACK duration */
2103dec1 192 dur += ieee80211_frame_duration(sband->band, 10, bitrate,
438b61b7 193 erp, short_preamble, shift);
c2d1560a
JB		 194
195 return cpu_to_le16(dur);
196}
197EXPORT_SYMBOL(ieee80211_rts_duration);
198
32bfd35d
JB		 199__le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw,
200 struct ieee80211_vif *vif,
c2d1560a 201 size_t frame_len,
e039fa4a 202 const struct ieee80211_tx_info *frame_txctl)
c2d1560a
JB		 203{
204 struct ieee80211_local *local = hw_to_local(hw);
205 struct ieee80211_rate *rate;
25d834e1 206 struct ieee80211_sub_if_data *sdata;
471b3efd 207 bool short_preamble;
2103dec1 208 int erp, shift = 0, bitrate;
c2d1560a 209 u16 dur;
2e92e6f2
JB		 210 struct ieee80211_supported_band *sband;
211
4ee73f33 212 sband = local->hw.wiphy->bands[frame_txctl->band];
c2d1560a 213
25d834e1 214 short_preamble = false;
7e9ed188 215
e039fa4a 216 rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx];
8318d78a 217 erp = 0;
25d834e1
JB		 218 if (vif) {
219 sdata = vif_to_sdata(vif);
bda3933a 220 short_preamble = sdata->vif.bss_conf.use_short_preamble;
25d834e1
JB		 221 if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE)
222 erp = rate->flags & IEEE80211_RATE_ERP_G;
438b61b7 223 shift = ieee80211_vif_get_shift(vif);
25d834e1 224 }
c2d1560a 225
2103dec1
SW		 226 bitrate = DIV_ROUND_UP(rate->bitrate, 1 << shift);
227
c2d1560a 228 /* Data frame duration */
2103dec1 229 dur = ieee80211_frame_duration(sband->band, frame_len, bitrate,
438b61b7 230 erp, short_preamble, shift);
e039fa4a 231 if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) {
c2d1560a 232 /* ACK duration */
2103dec1 233 dur += ieee80211_frame_duration(sband->band, 10, bitrate,
438b61b7 234 erp, short_preamble, shift);
c2d1560a
JB		 235 }
236
237 return cpu_to_le16(dur);
238}
239EXPORT_SYMBOL(ieee80211_ctstoself_duration);
240
3a25a8c8
JB		 241void ieee80211_propagate_queue_wake(struct ieee80211_local *local, int queue)
242{
243 struct ieee80211_sub_if_data *sdata;
a6f38ac3
JB		 244 int n_acs = IEEE80211_NUM_ACS;
245
246 if (local->hw.queues < IEEE80211_NUM_ACS)
247 n_acs = 1;
3a25a8c8
JB		 248
249 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
250 int ac;
251
f142c6b9
JB		 252 if (!sdata->dev)
253 continue;
254
3a25a8c8
JB		 255 if (sdata->vif.cab_queue != IEEE80211_INVAL_HW_QUEUE &&
256 local->queue_stop_reasons[sdata->vif.cab_queue] != 0)
257 continue;
258
a6f38ac3 259 for (ac = 0; ac < n_acs; ac++) {
3a25a8c8
JB		 260 int ac_queue = sdata->vif.hw_queue[ac];
261
ba8c3d6f
FF		 262 if (local->ops->wake_tx_queue &&
263 (atomic_read(&sdata->txqs_len[ac]) >
264 local->hw.txq_ac_max_pending))
265 continue;
266
3a25a8c8
JB		 267 if (ac_queue == queue ||
268 (sdata->vif.cab_queue == queue &&
269 local->queue_stop_reasons[ac_queue] == 0 &&
270 skb_queue_empty(&local->pending[ac_queue])))
271 netif_wake_subqueue(sdata->dev, ac);
272 }
273 }
274}
275
ce7c9111 276static void __ieee80211_wake_queue(struct ieee80211_hw *hw, int queue,
cca07b00
LC		 277 enum queue_stop_reason reason,
278 bool refcounted)
c2d1560a
JB		 279{
280 struct ieee80211_local *local = hw_to_local(hw);
281
b5878a2d
JB		 282 trace_wake_queue(local, queue, reason);
283
e4e72fb4
JB		 284 if (WARN_ON(queue >= hw->queues))
285 return;
ce7c9111 286
ada15125
JB		 287 if (!test_bit(reason, &local->queue_stop_reasons[queue]))
288 return;
289
cca07b00
LC		 290 if (!refcounted)
291 local->q_stop_reasons[queue][reason] = 0;
292 else
293 local->q_stop_reasons[queue][reason]--;
294
295 if (local->q_stop_reasons[queue][reason] == 0)
296 __clear_bit(reason, &local->queue_stop_reasons[queue]);
96f5e66e
JB		 297
298 if (local->queue_stop_reasons[queue] != 0)
299 /* someone still has this queue stopped */
300 return;
301
7236fe29
JB		 302 if (skb_queue_empty(&local->pending[queue])) {
303 rcu_read_lock();
3a25a8c8 304 ieee80211_propagate_queue_wake(local, queue);
7236fe29
JB		 305 rcu_read_unlock();
306 } else
3b8d81e0 307 tasklet_schedule(&local->tx_pending_tasklet);
c2d1560a 308}
ce7c9111 309
96f5e66e 310void ieee80211_wake_queue_by_reason(struct ieee80211_hw *hw, int queue,
cca07b00
LC		 311 enum queue_stop_reason reason,
312 bool refcounted)
ce7c9111
KV		 313{
314 struct ieee80211_local *local = hw_to_local(hw);
315 unsigned long flags;
316
317 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
cca07b00 318 __ieee80211_wake_queue(hw, queue, reason, refcounted);
ce7c9111
KV		 319 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
320}
321
322void ieee80211_wake_queue(struct ieee80211_hw *hw, int queue)
323{
324 ieee80211_wake_queue_by_reason(hw, queue,
cca07b00
LC		 325 IEEE80211_QUEUE_STOP_REASON_DRIVER,
326 false);
ce7c9111 327}
c2d1560a
JB		 328EXPORT_SYMBOL(ieee80211_wake_queue);
329
ce7c9111 330static void __ieee80211_stop_queue(struct ieee80211_hw *hw, int queue,
cca07b00
LC		 331 enum queue_stop_reason reason,
332 bool refcounted)
c2d1560a
JB		 333{
334 struct ieee80211_local *local = hw_to_local(hw);
cf0277e7 335 struct ieee80211_sub_if_data *sdata;
a6f38ac3 336 int n_acs = IEEE80211_NUM_ACS;
c2d1560a 337
b5878a2d
JB		 338 trace_stop_queue(local, queue, reason);
339
e4e72fb4
JB		 340 if (WARN_ON(queue >= hw->queues))
341 return;
96f5e66e 342
cca07b00
LC		 343 if (!refcounted)
344 local->q_stop_reasons[queue][reason] = 1;
345 else
346 local->q_stop_reasons[queue][reason]++;
ada15125 347
cca07b00
LC		 348 if (__test_and_set_bit(reason, &local->queue_stop_reasons[queue]))
349 return;
cf0277e7 350
a6f38ac3
JB		 351 if (local->hw.queues < IEEE80211_NUM_ACS)
352 n_acs = 1;
353
cf0277e7 354 rcu_read_lock();
3a25a8c8
JB		 355 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
356 int ac;
357
f142c6b9
JB		 358 if (!sdata->dev)
359 continue;
360
a6f38ac3 361 for (ac = 0; ac < n_acs; ac++) {
3a25a8c8
JB		 362 if (sdata->vif.hw_queue[ac] == queue ||
363 sdata->vif.cab_queue == queue)
364 netif_stop_subqueue(sdata->dev, ac);
365 }
366 }
cf0277e7 367 rcu_read_unlock();
c2d1560a 368}
ce7c9111 369
96f5e66e 370void ieee80211_stop_queue_by_reason(struct ieee80211_hw *hw, int queue,
cca07b00
LC		 371 enum queue_stop_reason reason,
372 bool refcounted)
ce7c9111
KV		 373{
374 struct ieee80211_local *local = hw_to_local(hw);
375 unsigned long flags;
376
377 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
cca07b00 378 __ieee80211_stop_queue(hw, queue, reason, refcounted);
ce7c9111
KV		 379 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
380}
381
382void ieee80211_stop_queue(struct ieee80211_hw *hw, int queue)
383{
384 ieee80211_stop_queue_by_reason(hw, queue,
cca07b00
LC		 385 IEEE80211_QUEUE_STOP_REASON_DRIVER,
386 false);
ce7c9111 387}
c2d1560a
JB		 388EXPORT_SYMBOL(ieee80211_stop_queue);
389
8f77f384
JB		 390void ieee80211_add_pending_skb(struct ieee80211_local *local,
391 struct sk_buff *skb)
392{
393 struct ieee80211_hw *hw = &local->hw;
394 unsigned long flags;
a7bc376c 395 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
3a25a8c8 396 int queue = info->hw_queue;
a7bc376c
JB		 397
398 if (WARN_ON(!info->control.vif)) {
d4fa14cd 399 ieee80211_free_txskb(&local->hw, skb);
a7bc376c
JB		 400 return;
401 }
8f77f384
JB		 402
403 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
cca07b00
LC		 404 __ieee80211_stop_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD,
405 false);
3b8d81e0 406 __skb_queue_tail(&local->pending[queue], skb);
cca07b00
LC		 407 __ieee80211_wake_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD,
408 false);
8f77f384
JB		 409 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
410}
411
e3685e03
JB		 412void ieee80211_add_pending_skbs(struct ieee80211_local *local,
413 struct sk_buff_head *skbs)
8f77f384
JB		 414{
415 struct ieee80211_hw *hw = &local->hw;
416 struct sk_buff *skb;
417 unsigned long flags;
b0b97a8a 418 int queue, i;
8f77f384
JB		 419
420 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
8f77f384 421 while ((skb = skb_dequeue(skbs))) {
a7bc376c
JB		 422 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
423
424 if (WARN_ON(!info->control.vif)) {
d4fa14cd 425 ieee80211_free_txskb(&local->hw, skb);
a7bc376c
JB		 426 continue;
427 }
428
3a25a8c8 429 queue = info->hw_queue;
4644ae89
JB		 430
431 __ieee80211_stop_queue(hw, queue,
cca07b00
LC		 432 IEEE80211_QUEUE_STOP_REASON_SKB_ADD,
433 false);
4644ae89 434
3b8d81e0 435 __skb_queue_tail(&local->pending[queue], skb);
8f77f384
JB		 436 }
437
3b8d81e0 438 for (i = 0; i < hw->queues; i++)
8f77f384 439 __ieee80211_wake_queue(hw, i,
cca07b00
LC		 440 IEEE80211_QUEUE_STOP_REASON_SKB_ADD,
441 false);
8f77f384 442 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
8f77f384
JB		 443}
444
ce7c9111 445void ieee80211_stop_queues_by_reason(struct ieee80211_hw *hw,
445ea4e8 446 unsigned long queues,
cca07b00
LC		 447 enum queue_stop_reason reason,
448 bool refcounted)
c2d1560a 449{
ce7c9111
KV		 450 struct ieee80211_local *local = hw_to_local(hw);
451 unsigned long flags;
c2d1560a
JB		 452 int i;
453
ce7c9111
KV		 454 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
455
445ea4e8 456 for_each_set_bit(i, &queues, hw->queues)
cca07b00 457 __ieee80211_stop_queue(hw, i, reason, refcounted);
ce7c9111
KV		 458
459 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
460}
461
462void ieee80211_stop_queues(struct ieee80211_hw *hw)
463{
445ea4e8 464 ieee80211_stop_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
cca07b00
LC		 465 IEEE80211_QUEUE_STOP_REASON_DRIVER,
466 false);
c2d1560a
JB		 467}
468EXPORT_SYMBOL(ieee80211_stop_queues);
469
92ab8535
TW		 470int ieee80211_queue_stopped(struct ieee80211_hw *hw, int queue)
471{
472 struct ieee80211_local *local = hw_to_local(hw);
3b8d81e0
JB		 473 unsigned long flags;
474 int ret;
96f5e66e 475
e4e72fb4
JB		 476 if (WARN_ON(queue >= hw->queues))
477 return true;
96f5e66e 478
3b8d81e0 479 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
2419ea14
TP		 480 ret = test_bit(IEEE80211_QUEUE_STOP_REASON_DRIVER,
481 &local->queue_stop_reasons[queue]);
3b8d81e0
JB		 482 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
483 return ret;
92ab8535
TW		 484}
485EXPORT_SYMBOL(ieee80211_queue_stopped);
486
ce7c9111 487void ieee80211_wake_queues_by_reason(struct ieee80211_hw *hw,
445ea4e8 488 unsigned long queues,
cca07b00
LC		 489 enum queue_stop_reason reason,
490 bool refcounted)
c2d1560a 491{
ce7c9111
KV		 492 struct ieee80211_local *local = hw_to_local(hw);
493 unsigned long flags;
c2d1560a
JB		 494 int i;
495
ce7c9111
KV		 496 spin_lock_irqsave(&local->queue_stop_reason_lock, flags);
497
445ea4e8 498 for_each_set_bit(i, &queues, hw->queues)
cca07b00 499 __ieee80211_wake_queue(hw, i, reason, refcounted);
ce7c9111
KV		 500
501 spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags);
502}
503
504void ieee80211_wake_queues(struct ieee80211_hw *hw)
505{
445ea4e8 506 ieee80211_wake_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
cca07b00
LC		 507 IEEE80211_QUEUE_STOP_REASON_DRIVER,
508 false);
c2d1560a
JB		 509}
510EXPORT_SYMBOL(ieee80211_wake_queues);
dabeb344 511
26da23b6
LC		 512static unsigned int
513ieee80211_get_vif_queues(struct ieee80211_local *local,
514 struct ieee80211_sub_if_data *sdata)
39ecc01d 515{
26da23b6 516 unsigned int queues;
39ecc01d 517
30686bf7 518 if (sdata && ieee80211_hw_check(&local->hw, QUEUE_CONTROL)) {
39ecc01d
JB		 519 int ac;
520
521 queues = 0;
522
523 for (ac = 0; ac < IEEE80211_NUM_ACS; ac++)
524 queues |= BIT(sdata->vif.hw_queue[ac]);
525 if (sdata->vif.cab_queue != IEEE80211_INVAL_HW_QUEUE)
526 queues |= BIT(sdata->vif.cab_queue);
527 } else {
528 /* all queues */
529 queues = BIT(local->hw.queues) - 1;
530 }
531
26da23b6
LC		 532 return queues;
533}
534
4f9610d5
LK		 535void __ieee80211_flush_queues(struct ieee80211_local *local,
536 struct ieee80211_sub_if_data *sdata,
3b24f4c6 537 unsigned int queues, bool drop)
26da23b6 538{
26da23b6
LC		 539 if (!local->ops->flush)
540 return;
541
4f9610d5
LK		 542 /*
543 * If no queue was set, or if the HW doesn't support
544 * IEEE80211_HW_QUEUE_CONTROL - flush all queues
545 */
30686bf7 546 if (!queues || !ieee80211_hw_check(&local->hw, QUEUE_CONTROL))
4f9610d5 547 queues = ieee80211_get_vif_queues(local, sdata);
26da23b6 548
59f48fe2 549 ieee80211_stop_queues_by_reason(&local->hw, queues,
cca07b00
LC		 550 IEEE80211_QUEUE_STOP_REASON_FLUSH,
551 false);
445ea4e8 552
3b24f4c6 553 drv_flush(local, sdata, queues, drop);
445ea4e8 554
59f48fe2 555 ieee80211_wake_queues_by_reason(&local->hw, queues,
cca07b00
LC		 556 IEEE80211_QUEUE_STOP_REASON_FLUSH,
557 false);
39ecc01d
JB		 558}
559
4f9610d5 560void ieee80211_flush_queues(struct ieee80211_local *local,
3b24f4c6 561 struct ieee80211_sub_if_data *sdata, bool drop)
4f9610d5 562{
3b24f4c6 563 __ieee80211_flush_queues(local, sdata, 0, drop);
4f9610d5
LK		 564}
565
26da23b6
LC		 566void ieee80211_stop_vif_queues(struct ieee80211_local *local,
567 struct ieee80211_sub_if_data *sdata,
568 enum queue_stop_reason reason)
569{
570 ieee80211_stop_queues_by_reason(&local->hw,
571 ieee80211_get_vif_queues(local, sdata),
572 reason, true);
573}
574
575void ieee80211_wake_vif_queues(struct ieee80211_local *local,
576 struct ieee80211_sub_if_data *sdata,
577 enum queue_stop_reason reason)
578{
579 ieee80211_wake_queues_by_reason(&local->hw,
580 ieee80211_get_vif_queues(local, sdata),
581 reason, true);
582}
583
3384d757
AN		 584static void __iterate_interfaces(struct ieee80211_local *local,
585 u32 iter_flags,
586 void (*iterator)(void *data, u8 *mac,
587 struct ieee80211_vif *vif),
588 void *data)
dabeb344 589{
dabeb344 590 struct ieee80211_sub_if_data *sdata;
3384d757 591 bool active_only = iter_flags & IEEE80211_IFACE_ITER_ACTIVE;
dabeb344 592
c7c71066 593 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
2f561feb 594 switch (sdata->vif.type) {
05c914fe 595 case NL80211_IFTYPE_MONITOR:
31eba5bc
FF		 596 if (!(sdata->u.mntr_flags & MONITOR_FLAG_ACTIVE))
597 continue;
598 break;
05c914fe 599 case NL80211_IFTYPE_AP_VLAN:
2f561feb 600 continue;
2ca27bcf 601 default:
2f561feb
ID		 602 break;
603 }
8b2c9824 604 if (!(iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL) &&
3384d757 605 active_only && !(sdata->flags & IEEE80211_SDATA_IN_DRIVER))
8b2c9824 606 continue;
3384d757 607 if (ieee80211_sdata_running(sdata) || !active_only)
47846c9b 608 iterator(data, sdata->vif.addr,
2f561feb
ID		 609 &sdata->vif);
610 }
611
c7c71066
JB		 612 sdata = rcu_dereference_check(local->monitor_sdata,
613 lockdep_is_held(&local->iflist_mtx) ||
614 lockdep_rtnl_is_held());
8b2c9824 615 if (sdata &&
3384d757 616 (iter_flags & IEEE80211_IFACE_ITER_RESUME_ALL || !active_only ||
8b2c9824 617 sdata->flags & IEEE80211_SDATA_IN_DRIVER))
685fb72b 618 iterator(data, sdata->vif.addr, &sdata->vif);
c7c71066 619}
685fb72b 620
3384d757 621void ieee80211_iterate_interfaces(
c7c71066
JB		 622 struct ieee80211_hw *hw, u32 iter_flags,
623 void (*iterator)(void *data, u8 *mac,
624 struct ieee80211_vif *vif),
625 void *data)
626{
627 struct ieee80211_local *local = hw_to_local(hw);
628
629 mutex_lock(&local->iflist_mtx);
3384d757 630 __iterate_interfaces(local, iter_flags, iterator, data);
c771c9d8 631 mutex_unlock(&local->iflist_mtx);
2f561feb 632}
3384d757 633EXPORT_SYMBOL_GPL(ieee80211_iterate_interfaces);
2f561feb
ID		 634
635void ieee80211_iterate_active_interfaces_atomic(
8b2c9824 636 struct ieee80211_hw *hw, u32 iter_flags,
2f561feb
ID		 637 void (*iterator)(void *data, u8 *mac,
638 struct ieee80211_vif *vif),
639 void *data)
640{
641 struct ieee80211_local *local = hw_to_local(hw);
2f561feb 642
e38bad47 643 rcu_read_lock();
3384d757
AN		 644 __iterate_interfaces(local, iter_flags | IEEE80211_IFACE_ITER_ACTIVE,
645 iterator, data);
c7c71066
JB		 646 rcu_read_unlock();
647}
648EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic);
dabeb344 649
c7c71066
JB		 650void ieee80211_iterate_active_interfaces_rtnl(
651 struct ieee80211_hw *hw, u32 iter_flags,
652 void (*iterator)(void *data, u8 *mac,
653 struct ieee80211_vif *vif),
654 void *data)
655{
656 struct ieee80211_local *local = hw_to_local(hw);
e38bad47 657
c7c71066 658 ASSERT_RTNL();
685fb72b 659
3384d757
AN		 660 __iterate_interfaces(local, iter_flags | IEEE80211_IFACE_ITER_ACTIVE,
661 iterator, data);
dabeb344 662}
c7c71066 663EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_rtnl);
37ffc8da 664
0fc1e049
AN		 665static void __iterate_stations(struct ieee80211_local *local,
666 void (*iterator)(void *data,
667 struct ieee80211_sta *sta),
668 void *data)
669{
670 struct sta_info *sta;
671
672 list_for_each_entry_rcu(sta, &local->sta_list, list) {
673 if (!sta->uploaded)
674 continue;
675
676 iterator(data, &sta->sta);
677 }
678}
679
680void ieee80211_iterate_stations_atomic(struct ieee80211_hw *hw,
681 void (*iterator)(void *data,
682 struct ieee80211_sta *sta),
683 void *data)
684{
685 struct ieee80211_local *local = hw_to_local(hw);
686
687 rcu_read_lock();
688 __iterate_stations(local, iterator, data);
689 rcu_read_unlock();
690}
691EXPORT_SYMBOL_GPL(ieee80211_iterate_stations_atomic);
692
ad7e718c
JB		 693struct ieee80211_vif *wdev_to_ieee80211_vif(struct wireless_dev *wdev)
694{
695 struct ieee80211_sub_if_data *sdata = IEEE80211_WDEV_TO_SUB_IF(wdev);
696
697 if (!ieee80211_sdata_running(sdata) ||
698 !(sdata->flags & IEEE80211_SDATA_IN_DRIVER))
699 return NULL;
700 return &sdata->vif;
701}
702EXPORT_SYMBOL_GPL(wdev_to_ieee80211_vif);
703
dc5a1ad7
EG		 704struct wireless_dev *ieee80211_vif_to_wdev(struct ieee80211_vif *vif)
705{
706 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
707
708 if (!ieee80211_sdata_running(sdata) ||
709 !(sdata->flags & IEEE80211_SDATA_IN_DRIVER))
710 return NULL;
711
712 return &sdata->wdev;
713}
714EXPORT_SYMBOL_GPL(ieee80211_vif_to_wdev);
715
42935eca
LR		 716/*
717 * Nothing should have been stuffed into the workqueue during
4afaff17
EG		 718 * the suspend->resume cycle. Since we can't check each caller
719 * of this function if we are already quiescing / suspended,
720 * check here and don't WARN since this can actually happen when
721 * the rx path (for example) is racing against __ieee80211_suspend
722 * and suspending / quiescing was set after the rx path checked
723 * them.
42935eca
LR		 724 */
725static bool ieee80211_can_queue_work(struct ieee80211_local *local)
726{
4afaff17
EG		 727 if (local->quiescing || (local->suspended && !local->resuming)) {
728 pr_warn("queueing ieee80211 work while going to suspend\n");
ceb99fe0 729 return false;
4afaff17 730 }
42935eca
LR		 731
732 return true;
733}
734
735void ieee80211_queue_work(struct ieee80211_hw *hw, struct work_struct *work)
736{
737 struct ieee80211_local *local = hw_to_local(hw);
738
739 if (!ieee80211_can_queue_work(local))
740 return;
741
742 queue_work(local->workqueue, work);
743}
744EXPORT_SYMBOL(ieee80211_queue_work);
745
746void ieee80211_queue_delayed_work(struct ieee80211_hw *hw,
747 struct delayed_work *dwork,
748 unsigned long delay)
749{
750 struct ieee80211_local *local = hw_to_local(hw);
751
752 if (!ieee80211_can_queue_work(local))
753 return;
754
755 queue_delayed_work(local->workqueue, dwork, delay);
756}
757EXPORT_SYMBOL(ieee80211_queue_delayed_work);
758
35d865af 759u32 ieee802_11_parse_elems_crc(const u8 *start, size_t len, bool action,
dd76986b
JB		 760 struct ieee802_11_elems *elems,
761 u64 filter, u32 crc)
762{
763 size_t left = len;
35d865af 764 const u8 *pos = start;
dd76986b 765 bool calc_crc = filter != 0;
fcff4f10 766 DECLARE_BITMAP(seen_elems, 256);
b2e506bf 767 const u8 *ie;
dd76986b 768
fcff4f10 769 bitmap_zero(seen_elems, 256);
dd76986b
JB		 770 memset(elems, 0, sizeof(*elems));
771 elems->ie_start = start;
772 elems->total_len = len;
773
774 while (left >= 2) {
775 u8 id, elen;
fcff4f10 776 bool elem_parse_failed;
dd76986b
JB		 777
778 id = *pos++;
779 elen = *pos++;
780 left -= 2;
781
fcff4f10
PS		 782 if (elen > left) {
783 elems->parse_error = true;
dd76986b 784 break;
fcff4f10
PS		 785 }
786
9690fb16
JB		 787 switch (id) {
788 case WLAN_EID_SSID:
789 case WLAN_EID_SUPP_RATES:
790 case WLAN_EID_FH_PARAMS:
791 case WLAN_EID_DS_PARAMS:
792 case WLAN_EID_CF_PARAMS:
793 case WLAN_EID_TIM:
794 case WLAN_EID_IBSS_PARAMS:
795 case WLAN_EID_CHALLENGE:
796 case WLAN_EID_RSN:
797 case WLAN_EID_ERP_INFO:
798 case WLAN_EID_EXT_SUPP_RATES:
799 case WLAN_EID_HT_CAPABILITY:
800 case WLAN_EID_HT_OPERATION:
801 case WLAN_EID_VHT_CAPABILITY:
802 case WLAN_EID_VHT_OPERATION:
803 case WLAN_EID_MESH_ID:
804 case WLAN_EID_MESH_CONFIG:
805 case WLAN_EID_PEER_MGMT:
806 case WLAN_EID_PREQ:
807 case WLAN_EID_PREP:
808 case WLAN_EID_PERR:
809 case WLAN_EID_RANN:
810 case WLAN_EID_CHANNEL_SWITCH:
811 case WLAN_EID_EXT_CHANSWITCH_ANN:
812 case WLAN_EID_COUNTRY:
813 case WLAN_EID_PWR_CONSTRAINT:
814 case WLAN_EID_TIMEOUT_INTERVAL:
85220d71 815 case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
b2e506bf 816 case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
8f2535b9 817 case WLAN_EID_CHAN_SWITCH_PARAM:
9041c1fa 818 case WLAN_EID_EXT_CAPABILITY:
53837584
AN		 819 case WLAN_EID_CHAN_SWITCH_TIMING:
820 case WLAN_EID_LINK_ID:
b2e506bf
JB		 821 /*
822 * not listing WLAN_EID_CHANNEL_SWITCH_WRAPPER -- it seems possible
823 * that if the content gets bigger it might be needed more than once
824 */
9690fb16
JB		 825 if (test_bit(id, seen_elems)) {
826 elems->parse_error = true;
827 left -= elen;
828 pos += elen;
829 continue;
830 }
831 break;
fcff4f10 832 }
dd76986b
JB		 833
834 if (calc_crc && id < 64 && (filter & (1ULL << id)))
835 crc = crc32_be(crc, pos - 2, elen + 2);
836
fcff4f10
PS		 837 elem_parse_failed = false;
838
dd76986b 839 switch (id) {
53837584
AN		 840 case WLAN_EID_LINK_ID:
841 if (elen + 2 != sizeof(struct ieee80211_tdls_lnkie)) {
842 elem_parse_failed = true;
843 break;
844 }
845 elems->lnk_id = (void *)(pos - 2);
846 break;
847 case WLAN_EID_CHAN_SWITCH_TIMING:
848 if (elen != sizeof(struct ieee80211_ch_switch_timing)) {
849 elem_parse_failed = true;
850 break;
851 }
852 elems->ch_sw_timing = (void *)pos;
853 break;
9041c1fa
AN		 854 case WLAN_EID_EXT_CAPABILITY:
855 elems->ext_capab = pos;
856 elems->ext_capab_len = elen;
857 break;
dd76986b
JB		 858 case WLAN_EID_SSID:
859 elems->ssid = pos;
860 elems->ssid_len = elen;
861 break;
862 case WLAN_EID_SUPP_RATES:
863 elems->supp_rates = pos;
864 elems->supp_rates_len = elen;
865 break;
dd76986b 866 case WLAN_EID_DS_PARAMS:
1cd8e88e
JB		 867 if (elen >= 1)
868 elems->ds_params = pos;
869 else
870 elem_parse_failed = true;
dd76986b 871 break;
dd76986b
JB		 872 case WLAN_EID_TIM:
873 if (elen >= sizeof(struct ieee80211_tim_ie)) {
874 elems->tim = (void *)pos;
875 elems->tim_len = elen;
fcff4f10
PS		 876 } else
877 elem_parse_failed = true;
dd76986b 878 break;
dd76986b
JB		 879 case WLAN_EID_CHALLENGE:
880 elems->challenge = pos;
881 elems->challenge_len = elen;
882 break;
883 case WLAN_EID_VENDOR_SPECIFIC:
884 if (elen >= 4 && pos[0] == 0x00 && pos[1] == 0x50 &&
885 pos[2] == 0xf2) {
886 /* Microsoft OUI (00:50:F2) */
887
888 if (calc_crc)
889 crc = crc32_be(crc, pos - 2, elen + 2);
890
441a33ba 891 if (elen >= 5 && pos[3] == 2) {
dd76986b
JB		 892 /* OUI Type 2 - WMM IE */
893 if (pos[4] == 0) {
894 elems->wmm_info = pos;
895 elems->wmm_info_len = elen;
896 } else if (pos[4] == 1) {
897 elems->wmm_param = pos;
898 elems->wmm_param_len = elen;
899 }
900 }
901 }
902 break;
903 case WLAN_EID_RSN:
904 elems->rsn = pos;
905 elems->rsn_len = elen;
906 break;
907 case WLAN_EID_ERP_INFO:
1946bed9
JB		 908 if (elen >= 1)
909 elems->erp_info = pos;
910 else
911 elem_parse_failed = true;
dd76986b
JB		 912 break;
913 case WLAN_EID_EXT_SUPP_RATES:
914 elems->ext_supp_rates = pos;
915 elems->ext_supp_rates_len = elen;
916 break;
917 case WLAN_EID_HT_CAPABILITY:
918 if (elen >= sizeof(struct ieee80211_ht_cap))
919 elems->ht_cap_elem = (void *)pos;
fcff4f10
PS		 920 else
921 elem_parse_failed = true;
dd76986b 922 break;
074d46d1
JB		 923 case WLAN_EID_HT_OPERATION:
924 if (elen >= sizeof(struct ieee80211_ht_operation))
925 elems->ht_operation = (void *)pos;
fcff4f10
PS		 926 else
927 elem_parse_failed = true;
dd76986b 928 break;
818255ea
MP		 929 case WLAN_EID_VHT_CAPABILITY:
930 if (elen >= sizeof(struct ieee80211_vht_cap))
931 elems->vht_cap_elem = (void *)pos;
932 else
933 elem_parse_failed = true;
934 break;
935 case WLAN_EID_VHT_OPERATION:
936 if (elen >= sizeof(struct ieee80211_vht_operation))
937 elems->vht_operation = (void *)pos;
938 else
939 elem_parse_failed = true;
940 break;
bee7f586
JB		 941 case WLAN_EID_OPMODE_NOTIF:
942 if (elen > 0)
943 elems->opmode_notif = pos;
944 else
945 elem_parse_failed = true;
946 break;
dd76986b
JB		 947 case WLAN_EID_MESH_ID:
948 elems->mesh_id = pos;
949 elems->mesh_id_len = elen;
950 break;
951 case WLAN_EID_MESH_CONFIG:
952 if (elen >= sizeof(struct ieee80211_meshconf_ie))
953 elems->mesh_config = (void *)pos;
fcff4f10
PS		 954 else
955 elem_parse_failed = true;
dd76986b
JB		 956 break;
957 case WLAN_EID_PEER_MGMT:
958 elems->peering = pos;
959 elems->peering_len = elen;
960 break;
3f52b7e3
MP		 961 case WLAN_EID_MESH_AWAKE_WINDOW:
962 if (elen >= 2)
963 elems->awake_window = (void *)pos;
964 break;
dd76986b
JB		 965 case WLAN_EID_PREQ:
966 elems->preq = pos;
967 elems->preq_len = elen;
968 break;
969 case WLAN_EID_PREP:
970 elems->prep = pos;
971 elems->prep_len = elen;
972 break;
973 case WLAN_EID_PERR:
974 elems->perr = pos;
975 elems->perr_len = elen;
976 break;
977 case WLAN_EID_RANN:
978 if (elen >= sizeof(struct ieee80211_rann_ie))
979 elems->rann = (void *)pos;
fcff4f10
PS		 980 else
981 elem_parse_failed = true;
dd76986b
JB		 982 break;
983 case WLAN_EID_CHANNEL_SWITCH:
5bc1420b
JB		 984 if (elen != sizeof(struct ieee80211_channel_sw_ie)) {
985 elem_parse_failed = true;
986 break;
987 }
988 elems->ch_switch_ie = (void *)pos;
dd76986b 989 break;
b4f286a1
JB		 990 case WLAN_EID_EXT_CHANSWITCH_ANN:
991 if (elen != sizeof(struct ieee80211_ext_chansw_ie)) {
992 elem_parse_failed = true;
993 break;
994 }
995 elems->ext_chansw_ie = (void *)pos;
996 break;
85220d71
JB		 997 case WLAN_EID_SECONDARY_CHANNEL_OFFSET:
998 if (elen != sizeof(struct ieee80211_sec_chan_offs_ie)) {
999 elem_parse_failed = true;
1000 break;
1001 }
1002 elems->sec_chan_offs = (void *)pos;
1003 break;
8f2535b9
CYY		 1004 case WLAN_EID_CHAN_SWITCH_PARAM:
1005 if (elen !=
1006 sizeof(*elems->mesh_chansw_params_ie)) {
1007 elem_parse_failed = true;
1008 break;
1009 }
1010 elems->mesh_chansw_params_ie = (void *)pos;
1011 break;
b2e506bf
JB		 1012 case WLAN_EID_WIDE_BW_CHANNEL_SWITCH:
1013 if (!action ||
1014 elen != sizeof(*elems->wide_bw_chansw_ie)) {
1015 elem_parse_failed = true;
1016 break;
1017 }
1018 elems->wide_bw_chansw_ie = (void *)pos;
1019 break;
1020 case WLAN_EID_CHANNEL_SWITCH_WRAPPER:
1021 if (action) {
1022 elem_parse_failed = true;
1023 break;
1024 }
1025 /*
1026 * This is a bit tricky, but as we only care about
1027 * the wide bandwidth channel switch element, so
1028 * just parse it out manually.
1029 */
1030 ie = cfg80211_find_ie(WLAN_EID_WIDE_BW_CHANNEL_SWITCH,
1031 pos, elen);
1032 if (ie) {
1033 if (ie[1] == sizeof(*elems->wide_bw_chansw_ie))
1034 elems->wide_bw_chansw_ie =
1035 (void *)(ie + 2);
1036 else
1037 elem_parse_failed = true;
1038 }
1039 break;
dd76986b
JB		 1040 case WLAN_EID_COUNTRY:
1041 elems->country_elem = pos;
1042 elems->country_elem_len = elen;
1043 break;
1044 case WLAN_EID_PWR_CONSTRAINT:
761a48d2
JB		 1045 if (elen != 1) {
1046 elem_parse_failed = true;
1047 break;
1048 }
dd76986b 1049 elems->pwr_constr_elem = pos;
dd76986b 1050 break;
c8d65917
SG		 1051 case WLAN_EID_CISCO_VENDOR_SPECIFIC:
1052 /* Lots of different options exist, but we only care
1053 * about the Dynamic Transmit Power Control element.
1054 * First check for the Cisco OUI, then for the DTPC
1055 * tag (0x00).
1056 */
1057 if (elen < 4) {
1058 elem_parse_failed = true;
1059 break;
1060 }
1061
1062 if (pos[0] != 0x00 || pos[1] != 0x40 ||
1063 pos[2] != 0x96 || pos[3] != 0x00)
1064 break;
1065
1066 if (elen != 6) {
1067 elem_parse_failed = true;
1068 break;
1069 }
1070
1071 if (calc_crc)
1072 crc = crc32_be(crc, pos - 2, elen + 2);
1073
1074 elems->cisco_dtpc_elem = pos;
1075 break;
dd76986b 1076 case WLAN_EID_TIMEOUT_INTERVAL:
79ba1d89
JB		 1077 if (elen >= sizeof(struct ieee80211_timeout_interval_ie))
1078 elems->timeout_int = (void *)pos;
1079 else
1080 elem_parse_failed = true;
dd76986b
JB		 1081 break;
1082 default:
1083 break;
1084 }
1085
fcff4f10
PS		 1086 if (elem_parse_failed)
1087 elems->parse_error = true;
1088 else
5df45690 1089 __set_bit(id, seen_elems);
fcff4f10 1090
dd76986b
JB		 1091 left -= elen;
1092 pos += elen;
1093 }
1094
fcff4f10
PS		 1095 if (left != 0)
1096 elems->parse_error = true;
1097
dd76986b
JB		 1098 return crc;
1099}
1100
3abead59
JB		 1101void ieee80211_set_wmm_default(struct ieee80211_sub_if_data *sdata,
1102 bool bss_notify)
5825fe10
JB		 1103{
1104 struct ieee80211_local *local = sdata->local;
1105 struct ieee80211_tx_queue_params qparam;
55de908a 1106 struct ieee80211_chanctx_conf *chanctx_conf;
54bcbc69 1107 int ac;
a8ce8544 1108 bool use_11b, enable_qos;
239281f8 1109 bool is_ocb; /* Use another EDCA parameters if dot11OCBActivated=true */
aa837e1d 1110 int aCWmin, aCWmax;
5825fe10
JB		 1111
1112 if (!local->ops->conf_tx)
1113 return;
1114
54bcbc69
JB		 1115 if (local->hw.queues < IEEE80211_NUM_ACS)
1116 return;
1117
5825fe10
JB		 1118 memset(&qparam, 0, sizeof(qparam));
1119
55de908a
JB		 1120 rcu_read_lock();
1121 chanctx_conf = rcu_dereference(sdata->vif.chanctx_conf);
1122 use_11b = (chanctx_conf &&
4bf88530 1123 chanctx_conf->def.chan->band == IEEE80211_BAND_2GHZ) &&
aa837e1d 1124 !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE);
55de908a 1125 rcu_read_unlock();
5825fe10 1126
a8ce8544
SG		 1127 /*
1128 * By default disable QoS in STA mode for old access points, which do
1129 * not support 802.11e. New APs will provide proper queue parameters,
1130 * that we will configure later.
1131 */
1132 enable_qos = (sdata->vif.type != NL80211_IFTYPE_STATION);
1133
239281f8
RL		 1134 is_ocb = (sdata->vif.type == NL80211_IFTYPE_OCB);
1135
1f4ffde8
FZ		 1136 /* Set defaults according to 802.11-2007 Table 7-37 */
1137 aCWmax = 1023;
1138 if (use_11b)
1139 aCWmin = 31;
1140 else
1141 aCWmin = 15;
1142
1143 /* Confiure old 802.11b/g medium access rules. */
1144 qparam.cw_max = aCWmax;
1145 qparam.cw_min = aCWmin;
1146 qparam.txop = 0;
1147 qparam.aifs = 2;
aa837e1d 1148
1f4ffde8
FZ		 1149 for (ac = 0; ac < IEEE80211_NUM_ACS; ac++) {
1150 /* Update if QoS is enabled. */
a8ce8544
SG		 1151 if (enable_qos) {
1152 switch (ac) {
1153 case IEEE80211_AC_BK:
1154 qparam.cw_max = aCWmax;
1155 qparam.cw_min = aCWmin;
1156 qparam.txop = 0;
239281f8
RL		 1157 if (is_ocb)
1158 qparam.aifs = 9;
1159 else
1160 qparam.aifs = 7;
a8ce8544
SG		 1161 break;
1162 /* never happens but let's not leave undefined */
1163 default:
1164 case IEEE80211_AC_BE:
1165 qparam.cw_max = aCWmax;
1166 qparam.cw_min = aCWmin;
1167 qparam.txop = 0;
239281f8
RL		 1168 if (is_ocb)
1169 qparam.aifs = 6;
1170 else
1171 qparam.aifs = 3;
a8ce8544
SG		 1172 break;
1173 case IEEE80211_AC_VI:
1174 qparam.cw_max = aCWmin;
1175 qparam.cw_min = (aCWmin + 1) / 2 - 1;
239281f8
RL		 1176 if (is_ocb)
1177 qparam.txop = 0;
1178 else if (use_11b)
a8ce8544
SG		 1179 qparam.txop = 6016/32;
1180 else
1181 qparam.txop = 3008/32;
239281f8
RL		 1182
1183 if (is_ocb)
1184 qparam.aifs = 3;
1185 else
1186 qparam.aifs = 2;
a8ce8544
SG		 1187 break;
1188 case IEEE80211_AC_VO:
1189 qparam.cw_max = (aCWmin + 1) / 2 - 1;
1190 qparam.cw_min = (aCWmin + 1) / 4 - 1;
239281f8
RL		 1191 if (is_ocb)
1192 qparam.txop = 0;
1193 else if (use_11b)
a8ce8544
SG		 1194 qparam.txop = 3264/32;
1195 else
1196 qparam.txop = 1504/32;
1197 qparam.aifs = 2;
1198 break;
1199 }
aa837e1d 1200 }
5825fe10 1201
ab13315a
KV		 1202 qparam.uapsd = false;
1203
54bcbc69
JB		 1204 sdata->tx_conf[ac] = qparam;
1205 drv_conf_tx(local, sdata, ac, &qparam);
aa837e1d 1206 }
e1b3ec1a 1207
f142c6b9
JB		 1208 if (sdata->vif.type != NL80211_IFTYPE_MONITOR &&
1209 sdata->vif.type != NL80211_IFTYPE_P2P_DEVICE) {
a8ce8544 1210 sdata->vif.bss_conf.qos = enable_qos;
3abead59
JB		 1211 if (bss_notify)
1212 ieee80211_bss_info_change_notify(sdata,
1213 BSS_CHANGED_QOS);
d9734979 1214 }
5825fe10 1215}
e50db65c 1216
46900298 1217void ieee80211_send_auth(struct ieee80211_sub_if_data *sdata,
700e8ea6 1218 u16 transaction, u16 auth_alg, u16 status,
4a3cb702 1219 const u8 *extra, size_t extra_len, const u8 *da,
1672c0e3
JB		 1220 const u8 *bssid, const u8 *key, u8 key_len, u8 key_idx,
1221 u32 tx_flags)
46900298
JB		 1222{
1223 struct ieee80211_local *local = sdata->local;
1224 struct sk_buff *skb;
1225 struct ieee80211_mgmt *mgmt;
fffd0934 1226 int err;
46900298 1227
15e230ab 1228 /* 24 + 6 = header + auth_algo + auth_transaction + status_code */
744462a9
MS		 1229 skb = dev_alloc_skb(local->hw.extra_tx_headroom + IEEE80211_WEP_IV_LEN +
1230 24 + 6 + extra_len + IEEE80211_WEP_ICV_LEN);
d15b8459 1231 if (!skb)
46900298 1232 return;
d15b8459 1233
744462a9 1234 skb_reserve(skb, local->hw.extra_tx_headroom + IEEE80211_WEP_IV_LEN);
46900298
JB		 1235
1236 mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24 + 6);
1237 memset(mgmt, 0, 24 + 6);
1238 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
1239 IEEE80211_STYPE_AUTH);
efa6a09d 1240 memcpy(mgmt->da, da, ETH_ALEN);
47846c9b 1241 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
46900298
JB		 1242 memcpy(mgmt->bssid, bssid, ETH_ALEN);
1243 mgmt->u.auth.auth_alg = cpu_to_le16(auth_alg);
1244 mgmt->u.auth.auth_transaction = cpu_to_le16(transaction);
700e8ea6 1245 mgmt->u.auth.status_code = cpu_to_le16(status);
46900298
JB		 1246 if (extra)
1247 memcpy(skb_put(skb, extra_len), extra, extra_len);
46900298 1248
fffd0934
JB		 1249 if (auth_alg == WLAN_AUTH_SHARED_KEY && transaction == 3) {
1250 mgmt->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED);
1251 err = ieee80211_wep_encrypt(local, skb, key, key_len, key_idx);
1252 WARN_ON(err);
1253 }
1254
1672c0e3
JB		 1255 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT |
1256 tx_flags;
62ae67be 1257 ieee80211_tx_skb(sdata, skb);
46900298
JB		 1258}
1259
6ae16775
AQ		 1260void ieee80211_send_deauth_disassoc(struct ieee80211_sub_if_data *sdata,
1261 const u8 *bssid, u16 stype, u16 reason,
1262 bool send_frame, u8 *frame_buf)
1263{
1264 struct ieee80211_local *local = sdata->local;
1265 struct sk_buff *skb;
1266 struct ieee80211_mgmt *mgmt = (void *)frame_buf;
1267
1268 /* build frame */
1269 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | stype);
1270 mgmt->duration = 0; /* initialize only */
1271 mgmt->seq_ctrl = 0; /* initialize only */
1272 memcpy(mgmt->da, bssid, ETH_ALEN);
1273 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
1274 memcpy(mgmt->bssid, bssid, ETH_ALEN);
1275 /* u.deauth.reason_code == u.disassoc.reason_code */
1276 mgmt->u.deauth.reason_code = cpu_to_le16(reason);
1277
1278 if (send_frame) {
1279 skb = dev_alloc_skb(local->hw.extra_tx_headroom +
1280 IEEE80211_DEAUTH_FRAME_LEN);
1281 if (!skb)
1282 return;
1283
1284 skb_reserve(skb, local->hw.extra_tx_headroom);
1285
1286 /* copy in frame */
1287 memcpy(skb_put(skb, IEEE80211_DEAUTH_FRAME_LEN),
1288 mgmt, IEEE80211_DEAUTH_FRAME_LEN);
1289
1290 if (sdata->vif.type != NL80211_IFTYPE_STATION ||
1291 !(sdata->u.mgd.flags & IEEE80211_STA_MFP_ENABLED))
1292 IEEE80211_SKB_CB(skb)->flags |=
1293 IEEE80211_TX_INTFL_DONT_ENCRYPT;
1294
1295 ieee80211_tx_skb(sdata, skb);
1296 }
1297}
1298
c56ef672
DS		 1299static int ieee80211_build_preq_ies_band(struct ieee80211_local *local,
1300 u8 *buffer, size_t buffer_len,
1301 const u8 *ie, size_t ie_len,
1302 enum ieee80211_band band,
1303 u32 rate_mask,
1304 struct cfg80211_chan_def *chandef,
1305 size_t *offset)
de95a54b
JB		 1306{
1307 struct ieee80211_supported_band *sband;
c604b9f2 1308 u8 *pos = buffer, *end = buffer + buffer_len;
c56ef672 1309 size_t noffset;
8e664fb3 1310 int supp_rates_len, i;
8dcb2003
JM		 1311 u8 rates[32];
1312 int num_rates;
1313 int ext_rates_len;
2103dec1
SW		 1314 int shift;
1315 u32 rate_flags;
40a11ca8 1316 bool have_80mhz = false;
de95a54b 1317
c56ef672
DS		 1318 *offset = 0;
1319
4d36ec58 1320 sband = local->hw.wiphy->bands[band];
d811b3d5
AN		 1321 if (WARN_ON_ONCE(!sband))
1322 return 0;
de95a54b 1323
2103dec1
SW		 1324 rate_flags = ieee80211_chandef_rate_flags(chandef);
1325 shift = ieee80211_chandef_get_shift(chandef);
1326
8dcb2003
JM		 1327 num_rates = 0;
1328 for (i = 0; i < sband->n_bitrates; i++) {
1329 if ((BIT(i) & rate_mask) == 0)
1330 continue; /* skip rate */
2103dec1
SW		 1331 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
1332 continue;
1333
1334 rates[num_rates++] =
1335 (u8) DIV_ROUND_UP(sband->bitrates[i].bitrate,
1336 (1 << shift) * 5);
8dcb2003
JM		 1337 }
1338
1339 supp_rates_len = min_t(int, num_rates, 8);
8e664fb3 1340
c604b9f2
JB		 1341 if (end - pos < 2 + supp_rates_len)
1342 goto out_err;
de95a54b 1343 *pos++ = WLAN_EID_SUPP_RATES;
8e664fb3 1344 *pos++ = supp_rates_len;
8dcb2003
JM		 1345 memcpy(pos, rates, supp_rates_len);
1346 pos += supp_rates_len;
8e664fb3
JB		 1347
1348 /* insert "request information" if in custom IEs */
1349 if (ie && ie_len) {
1350 static const u8 before_extrates[] = {
1351 WLAN_EID_SSID,
1352 WLAN_EID_SUPP_RATES,
1353 WLAN_EID_REQUEST,
1354 };
1355 noffset = ieee80211_ie_split(ie, ie_len,
1356 before_extrates,
1357 ARRAY_SIZE(before_extrates),
c56ef672
DS		 1358 *offset);
1359 if (end - pos < noffset - *offset)
c604b9f2 1360 goto out_err;
c56ef672
DS		 1361 memcpy(pos, ie + *offset, noffset - *offset);
1362 pos += noffset - *offset;
1363 *offset = noffset;
8e664fb3
JB		 1364 }
1365
8dcb2003
JM		 1366 ext_rates_len = num_rates - supp_rates_len;
1367 if (ext_rates_len > 0) {
c604b9f2
JB		 1368 if (end - pos < 2 + ext_rates_len)
1369 goto out_err;
8e664fb3 1370 *pos++ = WLAN_EID_EXT_SUPP_RATES;
8dcb2003
JM		 1371 *pos++ = ext_rates_len;
1372 memcpy(pos, rates + supp_rates_len, ext_rates_len);
1373 pos += ext_rates_len;
8e664fb3
JB		 1374 }
1375
2103dec1 1376 if (chandef->chan && sband->band == IEEE80211_BAND_2GHZ) {
c604b9f2
JB		 1377 if (end - pos < 3)
1378 goto out_err;
651b5225
JM		 1379 *pos++ = WLAN_EID_DS_PARAMS;
1380 *pos++ = 1;
2103dec1
SW		 1381 *pos++ = ieee80211_frequency_to_channel(
1382 chandef->chan->center_freq);
651b5225
JM		 1383 }
1384
8e664fb3
JB		 1385 /* insert custom IEs that go before HT */
1386 if (ie && ie_len) {
1387 static const u8 before_ht[] = {
1388 WLAN_EID_SSID,
1389 WLAN_EID_SUPP_RATES,
1390 WLAN_EID_REQUEST,
1391 WLAN_EID_EXT_SUPP_RATES,
1392 WLAN_EID_DS_PARAMS,
1393 WLAN_EID_SUPPORTED_REGULATORY_CLASSES,
1394 };
1395 noffset = ieee80211_ie_split(ie, ie_len,
1396 before_ht, ARRAY_SIZE(before_ht),
c56ef672
DS		 1397 *offset);
1398 if (end - pos < noffset - *offset)
c604b9f2 1399 goto out_err;
c56ef672
DS		 1400 memcpy(pos, ie + *offset, noffset - *offset);
1401 pos += noffset - *offset;
1402 *offset = noffset;
de95a54b
JB		 1403 }
1404
c604b9f2
JB		 1405 if (sband->ht_cap.ht_supported) {
1406 if (end - pos < 2 + sizeof(struct ieee80211_ht_cap))
1407 goto out_err;
ef96a842
BG		 1408 pos = ieee80211_ie_build_ht_cap(pos, &sband->ht_cap,
1409 sband->ht_cap.cap);
c604b9f2 1410 }
5ef2d41a 1411
de95a54b
JB		 1412 /*
1413 * If adding more here, adjust code in main.c
1414 * that calculates local->scan_ies_len.
1415 */
1416
4d952300 1417 /* insert custom IEs that go before VHT */
8e664fb3 1418 if (ie && ie_len) {
4d952300
JB		 1419 static const u8 before_vht[] = {
1420 WLAN_EID_SSID,
1421 WLAN_EID_SUPP_RATES,
1422 WLAN_EID_REQUEST,
1423 WLAN_EID_EXT_SUPP_RATES,
1424 WLAN_EID_DS_PARAMS,
1425 WLAN_EID_SUPPORTED_REGULATORY_CLASSES,
1426 WLAN_EID_HT_CAPABILITY,
1427 WLAN_EID_BSS_COEX_2040,
1428 WLAN_EID_EXT_CAPABILITY,
1429 WLAN_EID_SSID_LIST,
1430 WLAN_EID_CHANNEL_USAGE,
1431 WLAN_EID_INTERWORKING,
1432 /* mesh ID can't happen here */
1433 /* 60 GHz can't happen here right now */
1434 };
1435 noffset = ieee80211_ie_split(ie, ie_len,
1436 before_vht, ARRAY_SIZE(before_vht),
c56ef672
DS		 1437 *offset);
1438 if (end - pos < noffset - *offset)
c604b9f2 1439 goto out_err;
c56ef672
DS		 1440 memcpy(pos, ie + *offset, noffset - *offset);
1441 pos += noffset - *offset;
1442 *offset = noffset;
de95a54b
JB		 1443 }
1444
40a11ca8
JB		 1445 /* Check if any channel in this sband supports at least 80 MHz */
1446 for (i = 0; i < sband->n_channels; i++) {
fa44b988
AN		 1447 if (sband->channels[i].flags & (IEEE80211_CHAN_DISABLED |
1448 IEEE80211_CHAN_NO_80MHZ))
1449 continue;
1450
1451 have_80mhz = true;
1452 break;
40a11ca8
JB		 1453 }
1454
1455 if (sband->vht_cap.vht_supported && have_80mhz) {
c604b9f2
JB		 1456 if (end - pos < 2 + sizeof(struct ieee80211_vht_cap))
1457 goto out_err;
ba0afa2f
MP		 1458 pos = ieee80211_ie_build_vht_cap(pos, &sband->vht_cap,
1459 sband->vht_cap.cap);
c604b9f2 1460 }
ba0afa2f 1461
c604b9f2
JB		 1462 return pos - buffer;
1463 out_err:
1464 WARN_ONCE(1, "not enough space for preq IEs\n");
de95a54b
JB		 1465 return pos - buffer;
1466}
1467
c56ef672
DS		 1468int ieee80211_build_preq_ies(struct ieee80211_local *local, u8 *buffer,
1469 size_t buffer_len,
1470 struct ieee80211_scan_ies *ie_desc,
1471 const u8 *ie, size_t ie_len,
1472 u8 bands_used, u32 *rate_masks,
1473 struct cfg80211_chan_def *chandef)
1474{
1475 size_t pos = 0, old_pos = 0, custom_ie_offset = 0;
1476 int i;
1477
1478 memset(ie_desc, 0, sizeof(*ie_desc));
1479
1480 for (i = 0; i < IEEE80211_NUM_BANDS; i++) {
1481 if (bands_used & BIT(i)) {
1482 pos += ieee80211_build_preq_ies_band(local,
1483 buffer + pos,
1484 buffer_len - pos,
1485 ie, ie_len, i,
1486 rate_masks[i],
1487 chandef,
1488 &custom_ie_offset);
1489 ie_desc->ies[i] = buffer + old_pos;
1490 ie_desc->len[i] = pos - old_pos;
1491 old_pos = pos;
1492 }
1493 }
1494
1495 /* add any remaining custom IEs */
1496 if (ie && ie_len) {
1497 if (WARN_ONCE(buffer_len - pos < ie_len - custom_ie_offset,
1498 "not enough space for preq custom IEs\n"))
1499 return pos;
1500 memcpy(buffer + pos, ie + custom_ie_offset,
1501 ie_len - custom_ie_offset);
1502 ie_desc->common_ies = buffer + pos;
1503 ie_desc->common_ie_len = ie_len - custom_ie_offset;
1504 pos += ie_len - custom_ie_offset;
1505 }
1506
1507 return pos;
1508};
1509
a619a4c0 1510struct sk_buff *ieee80211_build_probe_req(struct ieee80211_sub_if_data *sdata,
a344d677
JB		 1511 const u8 *src, const u8 *dst,
1512 u32 ratemask,
6b77863b 1513 struct ieee80211_channel *chan,
a619a4c0 1514 const u8 *ssid, size_t ssid_len,
a806c558
PS		 1515 const u8 *ie, size_t ie_len,
1516 bool directed)
46900298
JB		 1517{
1518 struct ieee80211_local *local = sdata->local;
2103dec1 1519 struct cfg80211_chan_def chandef;
46900298
JB		 1520 struct sk_buff *skb;
1521 struct ieee80211_mgmt *mgmt;
b9a9ada1 1522 int ies_len;
c56ef672
DS		 1523 u32 rate_masks[IEEE80211_NUM_BANDS] = {};
1524 struct ieee80211_scan_ies dummy_ie_desc;
46900298 1525
a806c558
PS		 1526 /*
1527 * Do not send DS Channel parameter for directed probe requests
1528 * in order to maximize the chance that we get a response. Some
1529 * badly-behaved APs don't respond when this parameter is included.
1530 */
2103dec1 1531 chandef.width = sdata->vif.bss_conf.chandef.width;
a806c558 1532 if (directed)
2103dec1 1533 chandef.chan = NULL;
a806c558 1534 else
2103dec1 1535 chandef.chan = chan;
651b5225 1536
a344d677
JB		 1537 skb = ieee80211_probereq_get(&local->hw, src, ssid, ssid_len,
1538 100 + ie_len);
5b2bbf75 1539 if (!skb)
b9a9ada1
JB		 1540 return NULL;
1541
c56ef672 1542 rate_masks[chan->band] = ratemask;
b9a9ada1 1543 ies_len = ieee80211_build_preq_ies(local, skb_tail_pointer(skb),
c56ef672
DS		 1544 skb_tailroom(skb), &dummy_ie_desc,
1545 ie, ie_len, BIT(chan->band),
1546 rate_masks, &chandef);
b9a9ada1 1547 skb_put(skb, ies_len);
7c12ce8b 1548
46900298 1549 if (dst) {
7c12ce8b 1550 mgmt = (struct ieee80211_mgmt *) skb->data;
46900298
JB		 1551 memcpy(mgmt->da, dst, ETH_ALEN);
1552 memcpy(mgmt->bssid, dst, ETH_ALEN);
46900298 1553 }
46900298 1554
62ae67be 1555 IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT;
5b2bbf75 1556
a619a4c0
JO		 1557 return skb;
1558}
1559
a344d677
JB		 1560void ieee80211_send_probe_req(struct ieee80211_sub_if_data *sdata,
1561 const u8 *src, const u8 *dst,
a619a4c0 1562 const u8 *ssid, size_t ssid_len,
a806c558 1563 const u8 *ie, size_t ie_len,
1672c0e3 1564 u32 ratemask, bool directed, u32 tx_flags,
55de908a 1565 struct ieee80211_channel *channel, bool scan)
a619a4c0
JO		 1566{
1567 struct sk_buff *skb;
1568
a344d677 1569 skb = ieee80211_build_probe_req(sdata, src, dst, ratemask, channel,
6b77863b 1570 ssid, ssid_len,
85a237fe 1571 ie, ie_len, directed);
aad14ceb 1572 if (skb) {
1672c0e3 1573 IEEE80211_SKB_CB(skb)->flags |= tx_flags;
55de908a
JB		 1574 if (scan)
1575 ieee80211_tx_skb_tid_band(sdata, skb, 7, channel->band);
1576 else
1577 ieee80211_tx_skb(sdata, skb);
aad14ceb 1578 }
46900298
JB		 1579}
1580
2103dec1 1581u32 ieee80211_sta_get_rates(struct ieee80211_sub_if_data *sdata,
46900298 1582 struct ieee802_11_elems *elems,
9ebb61a2 1583 enum ieee80211_band band, u32 *basic_rates)
46900298
JB		 1584{
1585 struct ieee80211_supported_band *sband;
46900298 1586 size_t num_rates;
2103dec1
SW		 1587 u32 supp_rates, rate_flags;
1588 int i, j, shift;
1589 sband = sdata->local->hw.wiphy->bands[band];
1590
1591 rate_flags = ieee80211_chandef_rate_flags(&sdata->vif.bss_conf.chandef);
1592 shift = ieee80211_vif_get_shift(&sdata->vif);
46900298 1593
4ee73f33
MK		 1594 if (WARN_ON(!sband))
1595 return 1;
46900298 1596
46900298
JB		 1597 num_rates = sband->n_bitrates;
1598 supp_rates = 0;
1599 for (i = 0; i < elems->supp_rates_len +
1600 elems->ext_supp_rates_len; i++) {
1601 u8 rate = 0;
1602 int own_rate;
9ebb61a2 1603 bool is_basic;
46900298
JB		 1604 if (i < elems->supp_rates_len)
1605 rate = elems->supp_rates[i];
1606 else if (elems->ext_supp_rates)
1607 rate = elems->ext_supp_rates
1608 [i - elems->supp_rates_len];
1609 own_rate = 5 * (rate & 0x7f);
9ebb61a2
AN		 1610 is_basic = !!(rate & 0x80);
1611
1612 if (is_basic && (rate & 0x7f) == BSS_MEMBERSHIP_SELECTOR_HT_PHY)
1613 continue;
1614
1615 for (j = 0; j < num_rates; j++) {
2103dec1
SW		 1616 int brate;
1617 if ((rate_flags & sband->bitrates[j].flags)
1618 != rate_flags)
1619 continue;
1620
1621 brate = DIV_ROUND_UP(sband->bitrates[j].bitrate,
1622 1 << shift);
1623
1624 if (brate == own_rate) {
46900298 1625 supp_rates |= BIT(j);
9ebb61a2
AN		 1626 if (basic_rates && is_basic)
1627 *basic_rates |= BIT(j);
1628 }
1629 }
46900298
JB		 1630 }
1631 return supp_rates;
1632}
f2753ddb 1633
84f6a01c
JB		 1634void ieee80211_stop_device(struct ieee80211_local *local)
1635{
1636 ieee80211_led_radio(local, false);
67408c8c 1637 ieee80211_mod_tpt_led_trig(local, 0, IEEE80211_TPT_LEDTRIG_FL_RADIO);
84f6a01c
JB		 1638
1639 cancel_work_sync(&local->reconfig_filter);
84f6a01c
JB		 1640
1641 flush_workqueue(local->workqueue);
678f415f 1642 drv_stop(local);
84f6a01c
JB		 1643}
1644
f6837ba8
JB		 1645static void ieee80211_handle_reconfig_failure(struct ieee80211_local *local)
1646{
1647 struct ieee80211_sub_if_data *sdata;
1648 struct ieee80211_chanctx *ctx;
1649
1650 /*
1651 * We get here if during resume the device can't be restarted properly.
1652 * We might also get here if this happens during HW reset, which is a
1653 * slightly different situation and we need to drop all connections in
1654 * the latter case.
1655 *
1656 * Ask cfg80211 to turn off all interfaces, this will result in more
1657 * warnings but at least we'll then get into a clean stopped state.
1658 */
1659
1660 local->resuming = false;
1661 local->suspended = false;
1662 local->started = false;
1663
1664 /* scheduled scan clearly can't be running any more, but tell
1665 * cfg80211 and clear local state
1666 */
1667 ieee80211_sched_scan_end(local);
1668
1669 list_for_each_entry(sdata, &local->interfaces, list)
1670 sdata->flags &= ~IEEE80211_SDATA_IN_DRIVER;
1671
1672 /* Mark channel contexts as not being in the driver any more to avoid
1673 * removing them from the driver during the shutdown process...
1674 */
1675 mutex_lock(&local->chanctx_mtx);
1676 list_for_each_entry(ctx, &local->chanctx_list, list)
1677 ctx->driver_present = false;
1678 mutex_unlock(&local->chanctx_mtx);
1679
1680 cfg80211_shutdown_all_interfaces(local->hw.wiphy);
1681}
1682
153a5fc4
SG		 1683static void ieee80211_assign_chanctx(struct ieee80211_local *local,
1684 struct ieee80211_sub_if_data *sdata)
1685{
1686 struct ieee80211_chanctx_conf *conf;
1687 struct ieee80211_chanctx *ctx;
1688
1689 if (!local->use_chanctx)
1690 return;
1691
1692 mutex_lock(&local->chanctx_mtx);
1693 conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
1694 lockdep_is_held(&local->chanctx_mtx));
1695 if (conf) {
1696 ctx = container_of(conf, struct ieee80211_chanctx, conf);
1697 drv_assign_vif_chanctx(local, sdata, ctx);
1698 }
1699 mutex_unlock(&local->chanctx_mtx);
1700}
1701
f2753ddb
JB		 1702int ieee80211_reconfig(struct ieee80211_local *local)
1703{
1704 struct ieee80211_hw *hw = &local->hw;
1705 struct ieee80211_sub_if_data *sdata;
55de908a 1706 struct ieee80211_chanctx *ctx;
f2753ddb 1707 struct sta_info *sta;
2683d65b 1708 int res, i;
d888130a 1709 bool reconfig_due_to_wowlan = false;
d43c6b6e 1710 struct ieee80211_sub_if_data *sched_scan_sdata;
6ea0a69c 1711 struct cfg80211_sched_scan_request *sched_scan_req;
d43c6b6e 1712 bool sched_scan_stopped = false;
d888130a 1713
0f8b8245
EP		 1714 /* nothing to do if HW shouldn't run */
1715 if (!local->open_count)
1716 goto wake_up;
1717
8f21b0ad 1718#ifdef CONFIG_PM
ceb99fe0
JB		 1719 if (local->suspended)
1720 local->resuming = true;
f2753ddb 1721
eecc4800 1722 if (local->wowlan) {
eecc4800 1723 res = drv_resume(local);
27b3eb9c 1724 local->wowlan = false;
eecc4800
JB		 1725 if (res < 0) {
1726 local->resuming = false;
1727 return res;
1728 }
1729 if (res == 0)
1730 goto wake_up;
1731 WARN_ON(res > 1);
1732 /*
1733 * res is 1, which means the driver requested
1734 * to go through a regular reset on wakeup.
1735 */
d888130a 1736 reconfig_due_to_wowlan = true;
eecc4800
JB		 1737 }
1738#endif
f2753ddb 1739
94f9b97b
JB		 1740 /*
1741 * Upon resume hardware can sometimes be goofy due to
1742 * various platform / driver / bus issues, so restarting
1743 * the device may at times not work immediately. Propagate
1744 * the error.
1745 */
1746 res = drv_start(local);
1747 if (res) {
f6837ba8
JB		 1748 if (local->suspended)
1749 WARN(1, "Hardware became unavailable upon resume. This could be a software issue prior to suspend or a hardware issue.\n");
1750 else
1751 WARN(1, "Hardware became unavailable during restart.\n");
1752 ieee80211_handle_reconfig_failure(local);
94f9b97b 1753 return res;
f2753ddb
JB		 1754 }
1755
7f281975
YAP		 1756 /* setup fragmentation threshold */
1757 drv_set_frag_threshold(local, hw->wiphy->frag_threshold);
1758
1759 /* setup RTS threshold */
1760 drv_set_rts_threshold(local, hw->wiphy->rts_threshold);
1761
1762 /* reset coverage class */
1763 drv_set_coverage_class(local, hw->wiphy->coverage_class);
1764
94f9b97b
JB		 1765 ieee80211_led_radio(local, true);
1766 ieee80211_mod_tpt_led_trig(local,
1767 IEEE80211_TPT_LEDTRIG_FL_RADIO, 0);
1768
f2753ddb 1769 /* add interfaces */
4b6f1dd6
JB		 1770 sdata = rtnl_dereference(local->monitor_sdata);
1771 if (sdata) {
3c3e21e7
JB		 1772 /* in HW restart it exists already */
1773 WARN_ON(local->resuming);
4b6f1dd6
JB		 1774 res = drv_add_interface(local, sdata);
1775 if (WARN_ON(res)) {
0c2bef46 1776 RCU_INIT_POINTER(local->monitor_sdata, NULL);
4b6f1dd6
JB		 1777 synchronize_net();
1778 kfree(sdata);
1779 }
1780 }
1781
f2753ddb
JB		 1782 list_for_each_entry(sdata, &local->interfaces, list) {
1783 if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
1784 sdata->vif.type != NL80211_IFTYPE_MONITOR &&
c8fff3dc 1785 ieee80211_sdata_running(sdata)) {
7b7eab6f 1786 res = drv_add_interface(local, sdata);
c8fff3dc
LC		 1787 if (WARN_ON(res))
1788 break;
1789 }
1790 }
1791
1792 /* If adding any of the interfaces failed above, roll back and
1793 * report failure.
1794 */
1795 if (res) {
1796 list_for_each_entry_continue_reverse(sdata, &local->interfaces,
1797 list)
1798 if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
1799 sdata->vif.type != NL80211_IFTYPE_MONITOR &&
1800 ieee80211_sdata_running(sdata))
1801 drv_remove_interface(local, sdata);
1802 ieee80211_handle_reconfig_failure(local);
1803 return res;
f2753ddb
JB		 1804 }
1805
55de908a 1806 /* add channel contexts */
f0dea9c7
AS		 1807 if (local->use_chanctx) {
1808 mutex_lock(&local->chanctx_mtx);
1809 list_for_each_entry(ctx, &local->chanctx_list, list)
5bcae31d
MK		 1810 if (ctx->replace_state !=
1811 IEEE80211_CHANCTX_REPLACES_OTHER)
1812 WARN_ON(drv_add_chanctx(local, ctx));
f0dea9c7 1813 mutex_unlock(&local->chanctx_mtx);
55de908a 1814
7df180f7
ZG		 1815 list_for_each_entry(sdata, &local->interfaces, list) {
1816 if (!ieee80211_sdata_running(sdata))
1817 continue;
1818 ieee80211_assign_chanctx(local, sdata);
1819 }
6352c87f 1820
7df180f7
ZG		 1821 sdata = rtnl_dereference(local->monitor_sdata);
1822 if (sdata && ieee80211_sdata_running(sdata))
1823 ieee80211_assign_chanctx(local, sdata);
1824 }
fe5f2559 1825
f2753ddb 1826 /* add STAs back */
34e89507
JB		 1827 mutex_lock(&local->sta_mtx);
1828 list_for_each_entry(sta, &local->sta_list, list) {
2e8d397e 1829 enum ieee80211_sta_state state;
f09603a2 1830
2e8d397e
AN		 1831 if (!sta->uploaded)
1832 continue;
1833
1834 /* AP-mode stations will be added later */
1835 if (sta->sdata->vif.type == NL80211_IFTYPE_AP)
1836 continue;
1837
1838 for (state = IEEE80211_STA_NOTEXIST;
1839 state < sta->sta_state; state++)
1840 WARN_ON(drv_sta_state(local, sta->sdata, sta, state,
1841 state + 1));
f2753ddb 1842 }
34e89507 1843 mutex_unlock(&local->sta_mtx);
f2753ddb 1844
2683d65b 1845 /* reconfigure tx conf */
54bcbc69
JB		 1846 if (hw->queues >= IEEE80211_NUM_ACS) {
1847 list_for_each_entry(sdata, &local->interfaces, list) {
1848 if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
1849 sdata->vif.type == NL80211_IFTYPE_MONITOR ||
1850 !ieee80211_sdata_running(sdata))
1851 continue;
f6f3def3 1852
54bcbc69
JB		 1853 for (i = 0; i < IEEE80211_NUM_ACS; i++)
1854 drv_conf_tx(local, sdata, i,
1855 &sdata->tx_conf[i]);
1856 }
f6f3def3 1857 }
2683d65b 1858
f2753ddb
JB		 1859 /* reconfigure hardware */
1860 ieee80211_hw_config(local, ~0);
1861
f2753ddb 1862 ieee80211_configure_filter(local);
f2753ddb
JB		 1863
1864 /* Finally also reconfigure all the BSS information */
1865 list_for_each_entry(sdata, &local->interfaces, list) {
ac8dd506
JB		 1866 u32 changed;
1867
9607e6b6 1868 if (!ieee80211_sdata_running(sdata))
f2753ddb 1869 continue;
ac8dd506
JB		 1870
1871 /* common change flags for all interface types */
1872 changed = BSS_CHANGED_ERP_CTS_PROT |
1873 BSS_CHANGED_ERP_PREAMBLE |
1874 BSS_CHANGED_ERP_SLOT |
1875 BSS_CHANGED_HT |
1876 BSS_CHANGED_BASIC_RATES |
1877 BSS_CHANGED_BEACON_INT |
1878 BSS_CHANGED_BSSID |
4ced3f74 1879 BSS_CHANGED_CQM |
55de47f6 1880 BSS_CHANGED_QOS |
1ea6f9c0
JB		 1881 BSS_CHANGED_IDLE |
1882 BSS_CHANGED_TXPOWER;
ac8dd506 1883
f2753ddb
JB		 1884 switch (sdata->vif.type) {
1885 case NL80211_IFTYPE_STATION:
0d392e93 1886 changed |= BSS_CHANGED_ASSOC |
ab095877
EP		 1887 BSS_CHANGED_ARP_FILTER |
1888 BSS_CHANGED_PS;
c65dd147 1889
989c6505
AB		 1890 /* Re-send beacon info report to the driver */
1891 if (sdata->u.mgd.have_beacon)
1892 changed |= BSS_CHANGED_BEACON_INFO;
c65dd147 1893
8d61ffa5 1894 sdata_lock(sdata);
ac8dd506 1895 ieee80211_bss_info_change_notify(sdata, changed);
8d61ffa5 1896 sdata_unlock(sdata);
ac8dd506 1897 break;
6e0bd6c3 1898 case NL80211_IFTYPE_OCB:
239281f8
RL		 1899 changed |= BSS_CHANGED_OCB;
1900 ieee80211_bss_info_change_notify(sdata, changed);
6e0bd6c3 1901 break;
f2753ddb 1902 case NL80211_IFTYPE_ADHOC:
ac8dd506
JB		 1903 changed |= BSS_CHANGED_IBSS;
1904 /* fall through */
f2753ddb 1905 case NL80211_IFTYPE_AP:
339afbf4 1906 changed |= BSS_CHANGED_SSID | BSS_CHANGED_P2P_PS;
e7979ac7 1907
1041638f 1908 if (sdata->vif.type == NL80211_IFTYPE_AP) {
e7979ac7
AN		 1909 changed |= BSS_CHANGED_AP_PROBE_RESP;
1910
1041638f
JB		 1911 if (rcu_access_pointer(sdata->u.ap.beacon))
1912 drv_start_ap(local, sdata);
1913 }
1914
7827493b 1915 /* fall through */
f2753ddb 1916 case NL80211_IFTYPE_MESH_POINT:
8da34932
JB		 1917 if (sdata->vif.bss_conf.enable_beacon) {
1918 changed |= BSS_CHANGED_BEACON |
1919 BSS_CHANGED_BEACON_ENABLED;
1920 ieee80211_bss_info_change_notify(sdata, changed);
1921 }
f2753ddb
JB		 1922 break;
1923 case NL80211_IFTYPE_WDS:
f2753ddb
JB		 1924 case NL80211_IFTYPE_AP_VLAN:
1925 case NL80211_IFTYPE_MONITOR:
98104fde 1926 case NL80211_IFTYPE_P2P_DEVICE:
b205786e 1927 /* nothing to do */
f142c6b9 1928 break;
f2753ddb 1929 case NL80211_IFTYPE_UNSPECIFIED:
2e161f78 1930 case NUM_NL80211_IFTYPES:
2ca27bcf
JB		 1931 case NL80211_IFTYPE_P2P_CLIENT:
1932 case NL80211_IFTYPE_P2P_GO:
f2753ddb
JB		 1933 WARN_ON(1);
1934 break;
1935 }
1936 }
1937
8e1b23b9
ES		 1938 ieee80211_recalc_ps(local, -1);
1939
6e1b1b24
EP		 1940 /*
1941 * The sta might be in psm against the ap (e.g. because
1942 * this was the state before a hw restart), so we
1943 * explicitly send a null packet in order to make sure
1944 * it'll sync against the ap (and get out of psm).
1945 */
1946 if (!(local->hw.conf.flags & IEEE80211_CONF_PS)) {
1947 list_for_each_entry(sdata, &local->interfaces, list) {
1948 if (sdata->vif.type != NL80211_IFTYPE_STATION)
1949 continue;
20f544ee
JB		 1950 if (!sdata->u.mgd.associated)
1951 continue;
6e1b1b24
EP		 1952
1953 ieee80211_send_nullfunc(local, sdata, 0);
1954 }
1955 }
1956
2e8d397e
AN		 1957 /* APs are now beaconing, add back stations */
1958 mutex_lock(&local->sta_mtx);
1959 list_for_each_entry(sta, &local->sta_list, list) {
1960 enum ieee80211_sta_state state;
1961
1962 if (!sta->uploaded)
1963 continue;
1964
1965 if (sta->sdata->vif.type != NL80211_IFTYPE_AP)
1966 continue;
1967
1968 for (state = IEEE80211_STA_NOTEXIST;
1969 state < sta->sta_state; state++)
1970 WARN_ON(drv_sta_state(local, sta->sdata, sta, state,
1971 state + 1));
1972 }
1973 mutex_unlock(&local->sta_mtx);
1974
7b21aea0 1975 /* add back keys */
f9dca80b
MK		 1976 list_for_each_entry(sdata, &local->interfaces, list)
1977 ieee80211_reset_crypto_tx_tailroom(sdata);
1978
7b21aea0
ES		 1979 list_for_each_entry(sdata, &local->interfaces, list)
1980 if (ieee80211_sdata_running(sdata))
1981 ieee80211_enable_keys(sdata);
1982
c6209488 1983 wake_up:
04800ada
AN		 1984 local->in_reconfig = false;
1985 barrier();
1986
3c3e21e7
JB		 1987 if (local->monitors == local->open_count && local->monitors > 0)
1988 ieee80211_add_virtual_monitor(local);
1989
2a419056
JB		 1990 /*
1991 * Clear the WLAN_STA_BLOCK_BA flag so new aggregation
1992 * sessions can be established after a resume.
1993 *
1994 * Also tear down aggregation sessions since reconfiguring
1995 * them in a hardware restart scenario is not easily done
1996 * right now, and the hardware will have lost information
1997 * about the sessions, but we and the AP still think they
1998 * are active. This is really a workaround though.
1999 */
30686bf7 2000 if (ieee80211_hw_check(hw, AMPDU_AGGREGATION)) {
2a419056
JB		 2001 mutex_lock(&local->sta_mtx);
2002
2003 list_for_each_entry(sta, &local->sta_list, list) {
c82c4a80
JB		 2004 ieee80211_sta_tear_down_BA_sessions(
2005 sta, AGG_STOP_LOCAL_REQUEST);
c2c98fde 2006 clear_sta_flag(sta, WLAN_STA_BLOCK_BA);
74e2bd1f 2007 }
2a419056
JB		 2008
2009 mutex_unlock(&local->sta_mtx);
74e2bd1f 2010 }
74e2bd1f 2011
445ea4e8 2012 ieee80211_wake_queues_by_reason(hw, IEEE80211_MAX_QUEUE_MAP,
cca07b00
LC		 2013 IEEE80211_QUEUE_STOP_REASON_SUSPEND,
2014 false);
f2753ddb 2015
32769814
AN		 2016 /*
2017 * Reconfigure sched scan if it was interrupted by FW restart or
2018 * suspend.
2019 */
2020 mutex_lock(&local->mtx);
2021 sched_scan_sdata = rcu_dereference_protected(local->sched_scan_sdata,
2022 lockdep_is_held(&local->mtx));
6ea0a69c
JB		 2023 sched_scan_req = rcu_dereference_protected(local->sched_scan_req,
2024 lockdep_is_held(&local->mtx));
2025 if (sched_scan_sdata && sched_scan_req)
32769814
AN		 2026 /*
2027 * Sched scan stopped, but we don't want to report it. Instead,
2028 * we're trying to reschedule.
2029 */
2030 if (__ieee80211_request_sched_scan_start(sched_scan_sdata,
6ea0a69c 2031 sched_scan_req))
32769814
AN		 2032 sched_scan_stopped = true;
2033 mutex_unlock(&local->mtx);
2034
2035 if (sched_scan_stopped)
e669ba2d 2036 cfg80211_sched_scan_stopped_rtnl(local->hw.wiphy);
32769814 2037
5bb644a0
JB		 2038 /*
2039 * If this is for hw restart things are still running.
2040 * We may want to change that later, however.
2041 */
0f8b8245 2042 if (local->open_count && (!local->suspended || reconfig_due_to_wowlan))
cf2c92d8 2043 drv_reconfig_complete(local, IEEE80211_RECONFIG_TYPE_RESTART);
8f21b0ad
JB		 2044
2045 if (!local->suspended)
5bb644a0
JB		 2046 return 0;
2047
2048#ifdef CONFIG_PM
ceb99fe0 2049 /* first set suspended false, then resuming */
5bb644a0 2050 local->suspended = false;
ceb99fe0
JB		 2051 mb();
2052 local->resuming = false;
5bb644a0 2053
9120d94e
LC		 2054 /* It's possible that we don't handle the scan completion in
2055 * time during suspend, so if it's still marked as completed
2056 * here, queue the work and flush it to clean things up.
2057 * Instead of calling the worker function directly here, we
2058 * really queue it to avoid potential races with other flows
2059 * scheduling the same work.
2060 */
2061 if (test_bit(SCAN_COMPLETED, &local->scanning)) {
2062 ieee80211_queue_delayed_work(&local->hw, &local->scan_work, 0);
2063 flush_delayed_work(&local->scan_work);
2064 }
2065
0f8b8245 2066 if (local->open_count && !reconfig_due_to_wowlan)
cf2c92d8
EP		 2067 drv_reconfig_complete(local, IEEE80211_RECONFIG_TYPE_SUSPEND);
2068
b8360ab8
JB		 2069 list_for_each_entry(sdata, &local->interfaces, list) {
2070 if (!ieee80211_sdata_running(sdata))
2071 continue;
2072 if (sdata->vif.type == NL80211_IFTYPE_STATION)
2073 ieee80211_sta_restart(sdata);
2074 }
2075
26d59535 2076 mod_timer(&local->sta_cleanup, jiffies + 1);
5bb644a0
JB		 2077#else
2078 WARN_ON(1);
2079#endif
d43c6b6e 2080
f2753ddb
JB		 2081 return 0;
2082}
42935eca 2083
95acac61
JB		 2084void ieee80211_resume_disconnect(struct ieee80211_vif *vif)
2085{
2086 struct ieee80211_sub_if_data *sdata;
2087 struct ieee80211_local *local;
2088 struct ieee80211_key *key;
2089
2090 if (WARN_ON(!vif))
2091 return;
2092
2093 sdata = vif_to_sdata(vif);
2094 local = sdata->local;
2095
2096 if (WARN_ON(!local->resuming))
2097 return;
2098
2099 if (WARN_ON(vif->type != NL80211_IFTYPE_STATION))
2100 return;
2101
2102 sdata->flags |= IEEE80211_SDATA_DISCONNECT_RESUME;
2103
2104 mutex_lock(&local->key_mtx);
2105 list_for_each_entry(key, &sdata->key_list, list)
2106 key->flags |= KEY_FLAG_TAINTED;
2107 mutex_unlock(&local->key_mtx);
2108}
2109EXPORT_SYMBOL_GPL(ieee80211_resume_disconnect);
2110
04ecd257 2111void ieee80211_recalc_smps(struct ieee80211_sub_if_data *sdata)
0f78231b 2112{
04ecd257
JB		 2113 struct ieee80211_local *local = sdata->local;
2114 struct ieee80211_chanctx_conf *chanctx_conf;
2115 struct ieee80211_chanctx *chanctx;
025e6be2 2116
04ecd257 2117 mutex_lock(&local->chanctx_mtx);
0f78231b 2118
04ecd257
JB		 2119 chanctx_conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
2120 lockdep_is_held(&local->chanctx_mtx));
0f78231b 2121
04ecd257 2122 if (WARN_ON_ONCE(!chanctx_conf))
5d8e4237 2123 goto unlock;
0f78231b 2124
04ecd257
JB		 2125 chanctx = container_of(chanctx_conf, struct ieee80211_chanctx, conf);
2126 ieee80211_recalc_smps_chanctx(local, chanctx);
5d8e4237 2127 unlock:
04ecd257 2128 mutex_unlock(&local->chanctx_mtx);
0f78231b 2129}
8e664fb3 2130
21f659bf
EP		 2131void ieee80211_recalc_min_chandef(struct ieee80211_sub_if_data *sdata)
2132{
2133 struct ieee80211_local *local = sdata->local;
2134 struct ieee80211_chanctx_conf *chanctx_conf;
2135 struct ieee80211_chanctx *chanctx;
2136
2137 mutex_lock(&local->chanctx_mtx);
2138
2139 chanctx_conf = rcu_dereference_protected(sdata->vif.chanctx_conf,
2140 lockdep_is_held(&local->chanctx_mtx));
2141
2142 if (WARN_ON_ONCE(!chanctx_conf))
2143 goto unlock;
2144
2145 chanctx = container_of(chanctx_conf, struct ieee80211_chanctx, conf);
2146 ieee80211_recalc_chanctx_min_def(local, chanctx);
2147 unlock:
2148 mutex_unlock(&local->chanctx_mtx);
2149}
2150
8e664fb3
JB		 2151size_t ieee80211_ie_split_vendor(const u8 *ies, size_t ielen, size_t offset)
2152{
2153 size_t pos = offset;
2154
2155 while (pos < ielen && ies[pos] != WLAN_EID_VENDOR_SPECIFIC)
2156 pos += 2 + ies[pos + 1];
2157
2158 return pos;
2159}
615f7b9b
MV		 2160
2161static void _ieee80211_enable_rssi_reports(struct ieee80211_sub_if_data *sdata,
2162 int rssi_min_thold,
2163 int rssi_max_thold)
2164{
2165 trace_api_enable_rssi_reports(sdata, rssi_min_thold, rssi_max_thold);
2166
2167 if (WARN_ON(sdata->vif.type != NL80211_IFTYPE_STATION))
2168 return;
2169
2170 /*
2171 * Scale up threshold values before storing it, as the RSSI averaging
2172 * algorithm uses a scaled up value as well. Change this scaling
2173 * factor if the RSSI averaging algorithm changes.
2174 */
2175 sdata->u.mgd.rssi_min_thold = rssi_min_thold*16;
2176 sdata->u.mgd.rssi_max_thold = rssi_max_thold*16;
2177}
2178
2179void ieee80211_enable_rssi_reports(struct ieee80211_vif *vif,
2180 int rssi_min_thold,
2181 int rssi_max_thold)
2182{
2183 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2184
2185 WARN_ON(rssi_min_thold == rssi_max_thold ||
2186 rssi_min_thold > rssi_max_thold);
2187
2188 _ieee80211_enable_rssi_reports(sdata, rssi_min_thold,
2189 rssi_max_thold);
2190}
2191EXPORT_SYMBOL(ieee80211_enable_rssi_reports);
2192
2193void ieee80211_disable_rssi_reports(struct ieee80211_vif *vif)
2194{
2195 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2196
2197 _ieee80211_enable_rssi_reports(sdata, 0, 0);
2198}
2199EXPORT_SYMBOL(ieee80211_disable_rssi_reports);
768db343 2200
ef96a842 2201u8 *ieee80211_ie_build_ht_cap(u8 *pos, struct ieee80211_sta_ht_cap *ht_cap,
42e7aa77
AS		 2202 u16 cap)
2203{
2204 __le16 tmp;
2205
2206 *pos++ = WLAN_EID_HT_CAPABILITY;
2207 *pos++ = sizeof(struct ieee80211_ht_cap);
2208 memset(pos, 0, sizeof(struct ieee80211_ht_cap));
2209
2210 /* capability flags */
2211 tmp = cpu_to_le16(cap);
2212 memcpy(pos, &tmp, sizeof(u16));
2213 pos += sizeof(u16);
2214
2215 /* AMPDU parameters */
ef96a842
BG		 2216 *pos++ = ht_cap->ampdu_factor |
2217 (ht_cap->ampdu_density <<
42e7aa77
AS		 2218 IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT);
2219
2220 /* MCS set */
ef96a842
BG		 2221 memcpy(pos, &ht_cap->mcs, sizeof(ht_cap->mcs));
2222 pos += sizeof(ht_cap->mcs);
42e7aa77
AS		 2223
2224 /* extended capabilities */
2225 pos += sizeof(__le16);
2226
2227 /* BF capabilities */
2228 pos += sizeof(__le32);
2229
2230 /* antenna selection */
2231 pos += sizeof(u8);
2232
2233 return pos;
2234}
2235
ba0afa2f 2236u8 *ieee80211_ie_build_vht_cap(u8 *pos, struct ieee80211_sta_vht_cap *vht_cap,
cc3983d8 2237 u32 cap)
ba0afa2f
MP		 2238{
2239 __le32 tmp;
2240
2241 *pos++ = WLAN_EID_VHT_CAPABILITY;
d4950281
MP		 2242 *pos++ = sizeof(struct ieee80211_vht_cap);
2243 memset(pos, 0, sizeof(struct ieee80211_vht_cap));
ba0afa2f
MP		 2244
2245 /* capability flags */
2246 tmp = cpu_to_le32(cap);
2247 memcpy(pos, &tmp, sizeof(u32));
2248 pos += sizeof(u32);
2249
2250 /* VHT MCS set */
2251 memcpy(pos, &vht_cap->vht_mcs, sizeof(vht_cap->vht_mcs));
2252 pos += sizeof(vht_cap->vht_mcs);
2253
2254 return pos;
2255}
2256
074d46d1 2257u8 *ieee80211_ie_build_ht_oper(u8 *pos, struct ieee80211_sta_ht_cap *ht_cap,
4bf88530 2258 const struct cfg80211_chan_def *chandef,
431e3154 2259 u16 prot_mode)
42e7aa77 2260{
074d46d1 2261 struct ieee80211_ht_operation *ht_oper;
42e7aa77 2262 /* Build HT Information */
074d46d1
JB		 2263 *pos++ = WLAN_EID_HT_OPERATION;
2264 *pos++ = sizeof(struct ieee80211_ht_operation);
2265 ht_oper = (struct ieee80211_ht_operation *)pos;
4bf88530
JB		 2266 ht_oper->primary_chan = ieee80211_frequency_to_channel(
2267 chandef->chan->center_freq);
2268 switch (chandef->width) {
2269 case NL80211_CHAN_WIDTH_160:
2270 case NL80211_CHAN_WIDTH_80P80:
2271 case NL80211_CHAN_WIDTH_80:
2272 case NL80211_CHAN_WIDTH_40:
2273 if (chandef->center_freq1 > chandef->chan->center_freq)
2274 ht_oper->ht_param = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
2275 else
2276 ht_oper->ht_param = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
42e7aa77 2277 break;
42e7aa77 2278 default:
074d46d1 2279 ht_oper->ht_param = IEEE80211_HT_PARAM_CHA_SEC_NONE;
42e7aa77
AS		 2280 break;
2281 }
aee286c2 2282 if (ht_cap->cap & IEEE80211_HT_CAP_SUP_WIDTH_20_40 &&
4bf88530
JB		 2283 chandef->width != NL80211_CHAN_WIDTH_20_NOHT &&
2284 chandef->width != NL80211_CHAN_WIDTH_20)
074d46d1 2285 ht_oper->ht_param |= IEEE80211_HT_PARAM_CHAN_WIDTH_ANY;
ff3cc5f4 2286
431e3154 2287 ht_oper->operation_mode = cpu_to_le16(prot_mode);
074d46d1 2288 ht_oper->stbc_param = 0x0000;
42e7aa77
AS		 2289
2290 /* It seems that Basic MCS set and Supported MCS set
2291 are identical for the first 10 bytes */
074d46d1
JB		 2292 memset(&ht_oper->basic_set, 0, 16);
2293 memcpy(&ht_oper->basic_set, &ht_cap->mcs, 10);
42e7aa77 2294
074d46d1 2295 return pos + sizeof(struct ieee80211_ht_operation);
42e7aa77
AS		 2296}
2297
fb28ec0c
AN		 2298u8 *ieee80211_ie_build_vht_oper(u8 *pos, struct ieee80211_sta_vht_cap *vht_cap,
2299 const struct cfg80211_chan_def *chandef)
2300{
2301 struct ieee80211_vht_operation *vht_oper;
2302
2303 *pos++ = WLAN_EID_VHT_OPERATION;
2304 *pos++ = sizeof(struct ieee80211_vht_operation);
2305 vht_oper = (struct ieee80211_vht_operation *)pos;
2306 vht_oper->center_freq_seg1_idx = ieee80211_frequency_to_channel(
2307 chandef->center_freq1);
2308 if (chandef->center_freq2)
2309 vht_oper->center_freq_seg2_idx =
2310 ieee80211_frequency_to_channel(chandef->center_freq2);
2311
2312 switch (chandef->width) {
2313 case NL80211_CHAN_WIDTH_160:
2314 vht_oper->chan_width = IEEE80211_VHT_CHANWIDTH_160MHZ;
2315 break;
2316 case NL80211_CHAN_WIDTH_80P80:
2317 vht_oper->chan_width = IEEE80211_VHT_CHANWIDTH_80P80MHZ;
2318 break;
2319 case NL80211_CHAN_WIDTH_80:
2320 vht_oper->chan_width = IEEE80211_VHT_CHANWIDTH_80MHZ;
2321 break;
2322 default:
2323 vht_oper->chan_width = IEEE80211_VHT_CHANWIDTH_USE_HT;
2324 break;
2325 }
2326
2327 /* don't require special VHT peer rates */
2328 vht_oper->basic_mcs_set = cpu_to_le16(0xffff);
2329
2330 return pos + sizeof(struct ieee80211_vht_operation);
2331}
2332
4bf88530 2333void ieee80211_ht_oper_to_chandef(struct ieee80211_channel *control_chan,
4a3cb702 2334 const struct ieee80211_ht_operation *ht_oper,
4bf88530 2335 struct cfg80211_chan_def *chandef)
42e7aa77
AS		 2336{
2337 enum nl80211_channel_type channel_type;
2338
4bf88530
JB		 2339 if (!ht_oper) {
2340 cfg80211_chandef_create(chandef, control_chan,
2341 NL80211_CHAN_NO_HT);
2342 return;
2343 }
42e7aa77 2344
074d46d1 2345 switch (ht_oper->ht_param & IEEE80211_HT_PARAM_CHA_SEC_OFFSET) {
42e7aa77
AS		 2346 case IEEE80211_HT_PARAM_CHA_SEC_NONE:
2347 channel_type = NL80211_CHAN_HT20;
2348 break;
2349 case IEEE80211_HT_PARAM_CHA_SEC_ABOVE:
2350 channel_type = NL80211_CHAN_HT40PLUS;
2351 break;
2352 case IEEE80211_HT_PARAM_CHA_SEC_BELOW:
2353 channel_type = NL80211_CHAN_HT40MINUS;
2354 break;
2355 default:
2356 channel_type = NL80211_CHAN_NO_HT;
2357 }
2358
4bf88530 2359 cfg80211_chandef_create(chandef, control_chan, channel_type);
42e7aa77
AS		 2360}
2361
abcff6ef
JD		 2362void ieee80211_vht_oper_to_chandef(struct ieee80211_channel *control_chan,
2363 const struct ieee80211_vht_operation *oper,
2364 struct cfg80211_chan_def *chandef)
2365{
2366 if (!oper)
2367 return;
2368
2369 chandef->chan = control_chan;
2370
2371 switch (oper->chan_width) {
2372 case IEEE80211_VHT_CHANWIDTH_USE_HT:
2373 break;
2374 case IEEE80211_VHT_CHANWIDTH_80MHZ:
2375 chandef->width = NL80211_CHAN_WIDTH_80;
2376 break;
2377 case IEEE80211_VHT_CHANWIDTH_160MHZ:
2378 chandef->width = NL80211_CHAN_WIDTH_160;
2379 break;
2380 case IEEE80211_VHT_CHANWIDTH_80P80MHZ:
2381 chandef->width = NL80211_CHAN_WIDTH_80P80;
2382 break;
2383 default:
2384 break;
2385 }
2386
2387 chandef->center_freq1 =
2388 ieee80211_channel_to_frequency(oper->center_freq_seg1_idx,
2389 control_chan->band);
2390 chandef->center_freq2 =
2391 ieee80211_channel_to_frequency(oper->center_freq_seg2_idx,
2392 control_chan->band);
2393}
2394
2103dec1
SW		 2395int ieee80211_parse_bitrates(struct cfg80211_chan_def *chandef,
2396 const struct ieee80211_supported_band *sband,
2397 const u8 *srates, int srates_len, u32 *rates)
2398{
2399 u32 rate_flags = ieee80211_chandef_rate_flags(chandef);
2400 int shift = ieee80211_chandef_get_shift(chandef);
2401 struct ieee80211_rate *br;
2402 int brate, rate, i, j, count = 0;
2403
2404 *rates = 0;
2405
2406 for (i = 0; i < srates_len; i++) {
2407 rate = srates[i] & 0x7f;
2408
2409 for (j = 0; j < sband->n_bitrates; j++) {
2410 br = &sband->bitrates[j];
2411 if ((rate_flags & br->flags) != rate_flags)
2412 continue;
2413
2414 brate = DIV_ROUND_UP(br->bitrate, (1 << shift) * 5);
2415 if (brate == rate) {
2416 *rates |= BIT(j);
2417 count++;
2418 break;
2419 }
2420 }
2421 }
2422 return count;
2423}
2424
fc8a7321 2425int ieee80211_add_srates_ie(struct ieee80211_sub_if_data *sdata,
6b77863b
JB		 2426 struct sk_buff *skb, bool need_basic,
2427 enum ieee80211_band band)
768db343 2428{
768db343
AN		 2429 struct ieee80211_local *local = sdata->local;
2430 struct ieee80211_supported_band *sband;
2103dec1 2431 int rate, shift;
768db343 2432 u8 i, rates, *pos;
fc8a7321 2433 u32 basic_rates = sdata->vif.bss_conf.basic_rates;
2103dec1 2434 u32 rate_flags;
768db343 2435
2103dec1
SW		 2436 shift = ieee80211_vif_get_shift(&sdata->vif);
2437 rate_flags = ieee80211_chandef_rate_flags(&sdata->vif.bss_conf.chandef);
6b77863b 2438 sband = local->hw.wiphy->bands[band];
2103dec1
SW		 2439 rates = 0;
2440 for (i = 0; i < sband->n_bitrates; i++) {
2441 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
2442 continue;
2443 rates++;
2444 }
768db343
AN		 2445 if (rates > 8)
2446 rates = 8;
2447
2448 if (skb_tailroom(skb) < rates + 2)
2449 return -ENOMEM;
2450
2451 pos = skb_put(skb, rates + 2);
2452 *pos++ = WLAN_EID_SUPP_RATES;
2453 *pos++ = rates;
2454 for (i = 0; i < rates; i++) {
657c3e0c 2455 u8 basic = 0;
2103dec1
SW		 2456 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
2457 continue;
2458
657c3e0c
AN		 2459 if (need_basic && basic_rates & BIT(i))
2460 basic = 0x80;
768db343 2461 rate = sband->bitrates[i].bitrate;
2103dec1
SW		 2462 rate = DIV_ROUND_UP(sband->bitrates[i].bitrate,
2463 5 * (1 << shift));
2464 *pos++ = basic | (u8) rate;
768db343
AN		 2465 }
2466
2467 return 0;
2468}
2469
fc8a7321 2470int ieee80211_add_ext_srates_ie(struct ieee80211_sub_if_data *sdata,
6b77863b
JB		 2471 struct sk_buff *skb, bool need_basic,
2472 enum ieee80211_band band)
768db343 2473{
768db343
AN		 2474 struct ieee80211_local *local = sdata->local;
2475 struct ieee80211_supported_band *sband;
cc63ec76 2476 int rate, shift;
768db343 2477 u8 i, exrates, *pos;
fc8a7321 2478 u32 basic_rates = sdata->vif.bss_conf.basic_rates;
2103dec1
SW		 2479 u32 rate_flags;
2480
2481 rate_flags = ieee80211_chandef_rate_flags(&sdata->vif.bss_conf.chandef);
2482 shift = ieee80211_vif_get_shift(&sdata->vif);
768db343 2483
6b77863b 2484 sband = local->hw.wiphy->bands[band];
2103dec1
SW		 2485 exrates = 0;
2486 for (i = 0; i < sband->n_bitrates; i++) {
2487 if ((rate_flags & sband->bitrates[i].flags) != rate_flags)
2488 continue;
2489 exrates++;
2490 }
2491
768db343
AN		 2492 if (exrates > 8)
2493 exrates -= 8;
2494 else
2495 exrates = 0;
2496
2497 if (skb_tailroom(skb) < exrates + 2)
2498 return -ENOMEM;
2499
2500 if (exrates) {
2501 pos = skb_put(skb, exrates + 2);
2502 *pos++ = WLAN_EID_EXT_SUPP_RATES;
2503 *pos++ = exrates;
2504 for (i = 8; i < sband->n_bitrates; i++) {
657c3e0c 2505 u8 basic = 0;
2103dec1
SW		 2506 if ((rate_flags & sband->bitrates[i].flags)
2507 != rate_flags)
2508 continue;
657c3e0c
AN		 2509 if (need_basic && basic_rates & BIT(i))
2510 basic = 0x80;
2103dec1
SW		 2511 rate = DIV_ROUND_UP(sband->bitrates[i].bitrate,
2512 5 * (1 << shift));
2513 *pos++ = basic | (u8) rate;
768db343
AN		 2514 }
2515 }
2516 return 0;
2517}
1dae27f8
WYG		 2518
2519int ieee80211_ave_rssi(struct ieee80211_vif *vif)
2520{
2521 struct ieee80211_sub_if_data *sdata = vif_to_sdata(vif);
2522 struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
2523
be6bcabc
WYG		 2524 if (WARN_ON_ONCE(sdata->vif.type != NL80211_IFTYPE_STATION)) {
2525 /* non-managed type inferfaces */
2526 return 0;
2527 }
3a7bba64 2528 return ifmgd->ave_beacon_signal / 16;
1dae27f8 2529}
0d8a0a17 2530EXPORT_SYMBOL_GPL(ieee80211_ave_rssi);
04ecd257
JB		 2531
2532u8 ieee80211_mcs_to_chains(const struct ieee80211_mcs_info *mcs)
2533{
2534 if (!mcs)
2535 return 1;
2536
2537 /* TODO: consider rx_highest */
2538
2539 if (mcs->rx_mask[3])
2540 return 4;
2541 if (mcs->rx_mask[2])
2542 return 3;
2543 if (mcs->rx_mask[1])
2544 return 2;
2545 return 1;
2546}
f4bda337
TP		 2547
2548/**
2549 * ieee80211_calculate_rx_timestamp - calculate timestamp in frame
2550 * @local: mac80211 hw info struct
2551 * @status: RX status
2552 * @mpdu_len: total MPDU length (including FCS)
2553 * @mpdu_offset: offset into MPDU to calculate timestamp at
2554 *
2555 * This function calculates the RX timestamp at the given MPDU offset, taking
2556 * into account what the RX timestamp was. An offset of 0 will just normalize
2557 * the timestamp to TSF at beginning of MPDU reception.
2558 */
2559u64 ieee80211_calculate_rx_timestamp(struct ieee80211_local *local,
2560 struct ieee80211_rx_status *status,
2561 unsigned int mpdu_len,
2562 unsigned int mpdu_offset)
2563{
2564 u64 ts = status->mactime;
2565 struct rate_info ri;
2566 u16 rate;
2567
2568 if (WARN_ON(!ieee80211_have_rx_timestamp(status)))
2569 return 0;
2570
2571 memset(&ri, 0, sizeof(ri));
2572
2573 /* Fill cfg80211 rate info */
2574 if (status->flag & RX_FLAG_HT) {
2575 ri.mcs = status->rate_idx;
2576 ri.flags |= RATE_INFO_FLAGS_MCS;
2577 if (status->flag & RX_FLAG_40MHZ)
b51f3bee
JB		 2578 ri.bw = RATE_INFO_BW_40;
2579 else
2580 ri.bw = RATE_INFO_BW_20;
f4bda337
TP		 2581 if (status->flag & RX_FLAG_SHORT_GI)
2582 ri.flags |= RATE_INFO_FLAGS_SHORT_GI;
5614618e
JB		 2583 } else if (status->flag & RX_FLAG_VHT) {
2584 ri.flags |= RATE_INFO_FLAGS_VHT_MCS;
2585 ri.mcs = status->rate_idx;
2586 ri.nss = status->vht_nss;
2587 if (status->flag & RX_FLAG_40MHZ)
b51f3bee
JB		 2588 ri.bw = RATE_INFO_BW_40;
2589 else if (status->vht_flag & RX_VHT_FLAG_80MHZ)
2590 ri.bw = RATE_INFO_BW_80;
2591 else if (status->vht_flag & RX_VHT_FLAG_160MHZ)
2592 ri.bw = RATE_INFO_BW_160;
2593 else
2594 ri.bw = RATE_INFO_BW_20;
5614618e
JB		 2595 if (status->flag & RX_FLAG_SHORT_GI)
2596 ri.flags |= RATE_INFO_FLAGS_SHORT_GI;
f4bda337
TP		 2597 } else {
2598 struct ieee80211_supported_band *sband;
2103dec1
SW		 2599 int shift = 0;
2600 int bitrate;
2601
b51f3bee 2602 if (status->flag & RX_FLAG_10MHZ) {
2103dec1 2603 shift = 1;
b51f3bee
JB		 2604 ri.bw = RATE_INFO_BW_10;
2605 } else if (status->flag & RX_FLAG_5MHZ) {
2103dec1 2606 shift = 2;
b51f3bee
JB		 2607 ri.bw = RATE_INFO_BW_5;
2608 } else {
2609 ri.bw = RATE_INFO_BW_20;
2610 }
f4bda337
TP		 2611
2612 sband = local->hw.wiphy->bands[status->band];
2103dec1
SW		 2613 bitrate = sband->bitrates[status->rate_idx].bitrate;
2614 ri.legacy = DIV_ROUND_UP(bitrate, (1 << shift));
f4bda337
TP		 2615 }
2616
2617 rate = cfg80211_calculate_bitrate(&ri);
d86aa4f8
JB		 2618 if (WARN_ONCE(!rate,
2619 "Invalid bitrate: flags=0x%x, idx=%d, vht_nss=%d\n",
2620 status->flag, status->rate_idx, status->vht_nss))
2621 return 0;
f4bda337
TP		 2622
2623 /* rewind from end of MPDU */
2624 if (status->flag & RX_FLAG_MACTIME_END)
2625 ts -= mpdu_len * 8 * 10 / rate;
2626
2627 ts += mpdu_offset * 8 * 10 / rate;
2628
2629 return ts;
2630}
164eb02d
SW		 2631
2632void ieee80211_dfs_cac_cancel(struct ieee80211_local *local)
2633{
2634 struct ieee80211_sub_if_data *sdata;
d2859df5 2635 struct cfg80211_chan_def chandef;
164eb02d 2636
34a3740d 2637 mutex_lock(&local->mtx);
164eb02d
SW		 2638 mutex_lock(&local->iflist_mtx);
2639 list_for_each_entry(sdata, &local->interfaces, list) {
34a3740d
JB		 2640 /* it might be waiting for the local->mtx, but then
2641 * by the time it gets it, sdata->wdev.cac_started
2642 * will no longer be true
2643 */
2644 cancel_delayed_work(&sdata->dfs_cac_timer_work);
164eb02d
SW		 2645
2646 if (sdata->wdev.cac_started) {
d2859df5 2647 chandef = sdata->vif.bss_conf.chandef;
164eb02d
SW		 2648 ieee80211_vif_release_channel(sdata);
2649 cfg80211_cac_event(sdata->dev,
d2859df5 2650 &chandef,
164eb02d
SW		 2651 NL80211_RADAR_CAC_ABORTED,
2652 GFP_KERNEL);
2653 }
2654 }
2655 mutex_unlock(&local->iflist_mtx);
34a3740d 2656 mutex_unlock(&local->mtx);
164eb02d
SW		 2657}
2658
2659void ieee80211_dfs_radar_detected_work(struct work_struct *work)
2660{
2661 struct ieee80211_local *local =
2662 container_of(work, struct ieee80211_local, radar_detected_work);
84a3d1c9 2663 struct cfg80211_chan_def chandef = local->hw.conf.chandef;
486cf4c0
MK		 2664 struct ieee80211_chanctx *ctx;
2665 int num_chanctx = 0;
2666
2667 mutex_lock(&local->chanctx_mtx);
2668 list_for_each_entry(ctx, &local->chanctx_list, list) {
2669 if (ctx->replace_state == IEEE80211_CHANCTX_REPLACES_OTHER)
2670 continue;
2671
2672 num_chanctx++;
2673 chandef = ctx->conf.def;
2674 }
2675 mutex_unlock(&local->chanctx_mtx);
164eb02d
SW		 2676
2677 ieee80211_dfs_cac_cancel(local);
2678
486cf4c0
MK		 2679 if (num_chanctx > 1)
2680 /* XXX: multi-channel is not supported yet */
164eb02d 2681 WARN_ON(1);
84a3d1c9 2682 else
164eb02d 2683 cfg80211_radar_event(local->hw.wiphy, &chandef, GFP_KERNEL);
164eb02d
SW		 2684}
2685
2686void ieee80211_radar_detected(struct ieee80211_hw *hw)
2687{
2688 struct ieee80211_local *local = hw_to_local(hw);
2689
2690 trace_api_radar_detected(local);
2691
2692 ieee80211_queue_work(hw, &local->radar_detected_work);
2693}
2694EXPORT_SYMBOL(ieee80211_radar_detected);
e6b7cde4
SW		 2695
2696u32 ieee80211_chandef_downgrade(struct cfg80211_chan_def *c)
2697{
2698 u32 ret;
2699 int tmp;
2700
2701 switch (c->width) {
2702 case NL80211_CHAN_WIDTH_20:
2703 c->width = NL80211_CHAN_WIDTH_20_NOHT;
2704 ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT;
2705 break;
2706 case NL80211_CHAN_WIDTH_40:
2707 c->width = NL80211_CHAN_WIDTH_20;
2708 c->center_freq1 = c->chan->center_freq;
2709 ret = IEEE80211_STA_DISABLE_40MHZ |
2710 IEEE80211_STA_DISABLE_VHT;
2711 break;
2712 case NL80211_CHAN_WIDTH_80:
2713 tmp = (30 + c->chan->center_freq - c->center_freq1)/20;
2714 /* n_P40 */
2715 tmp /= 2;
2716 /* freq_P40 */
2717 c->center_freq1 = c->center_freq1 - 20 + 40 * tmp;
2718 c->width = NL80211_CHAN_WIDTH_40;
2719 ret = IEEE80211_STA_DISABLE_VHT;
2720 break;
2721 case NL80211_CHAN_WIDTH_80P80:
2722 c->center_freq2 = 0;
2723 c->width = NL80211_CHAN_WIDTH_80;
2724 ret = IEEE80211_STA_DISABLE_80P80MHZ |
2725 IEEE80211_STA_DISABLE_160MHZ;
2726 break;
2727 case NL80211_CHAN_WIDTH_160:
2728 /* n_P20 */
2729 tmp = (70 + c->chan->center_freq - c->center_freq1)/20;
2730 /* n_P80 */
2731 tmp /= 4;
2732 c->center_freq1 = c->center_freq1 - 40 + 80 * tmp;
2733 c->width = NL80211_CHAN_WIDTH_80;
2734 ret = IEEE80211_STA_DISABLE_80P80MHZ |
2735 IEEE80211_STA_DISABLE_160MHZ;
2736 break;
2737 default:
2738 case NL80211_CHAN_WIDTH_20_NOHT:
2739 WARN_ON_ONCE(1);
2740 c->width = NL80211_CHAN_WIDTH_20_NOHT;
2741 ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT;
2742 break;
2743 case NL80211_CHAN_WIDTH_5:
2744 case NL80211_CHAN_WIDTH_10:
2745 WARN_ON_ONCE(1);
2746 /* keep c->width */
2747 ret = IEEE80211_STA_DISABLE_HT | IEEE80211_STA_DISABLE_VHT;
2748 break;
2749 }
2750
2751 WARN_ON_ONCE(!cfg80211_chandef_valid(c));
2752
2753 return ret;
2754}
687da132
EG		 2755
2756/*
2757 * Returns true if smps_mode_new is strictly more restrictive than
2758 * smps_mode_old.
2759 */
2760bool ieee80211_smps_is_restrictive(enum ieee80211_smps_mode smps_mode_old,
2761 enum ieee80211_smps_mode smps_mode_new)
2762{
2763 if (WARN_ON_ONCE(smps_mode_old == IEEE80211_SMPS_AUTOMATIC ||
2764 smps_mode_new == IEEE80211_SMPS_AUTOMATIC))
2765 return false;
2766
2767 switch (smps_mode_old) {
2768 case IEEE80211_SMPS_STATIC:
2769 return false;
2770 case IEEE80211_SMPS_DYNAMIC:
2771 return smps_mode_new == IEEE80211_SMPS_STATIC;
2772 case IEEE80211_SMPS_OFF:
2773 return smps_mode_new != IEEE80211_SMPS_OFF;
2774 default:
2775 WARN_ON(1);
2776 }
2777
2778 return false;
2779}
c6da674a
CYY		 2780
2781int ieee80211_send_action_csa(struct ieee80211_sub_if_data *sdata,
2782 struct cfg80211_csa_settings *csa_settings)
2783{
2784 struct sk_buff *skb;
2785 struct ieee80211_mgmt *mgmt;
2786 struct ieee80211_local *local = sdata->local;
2787 int freq;
2788 int hdr_len = offsetof(struct ieee80211_mgmt, u.action.u.chan_switch) +
2789 sizeof(mgmt->u.action.u.chan_switch);
2790 u8 *pos;
2791
2792 if (sdata->vif.type != NL80211_IFTYPE_ADHOC &&
2793 sdata->vif.type != NL80211_IFTYPE_MESH_POINT)
2794 return -EOPNOTSUPP;
2795
2796 skb = dev_alloc_skb(local->tx_headroom + hdr_len +
2797 5 + /* channel switch announcement element */
2798 3 + /* secondary channel offset element */
2799 8); /* mesh channel switch parameters element */
2800 if (!skb)
2801 return -ENOMEM;
2802
2803 skb_reserve(skb, local->tx_headroom);
2804 mgmt = (struct ieee80211_mgmt *)skb_put(skb, hdr_len);
2805 memset(mgmt, 0, hdr_len);
2806 mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
2807 IEEE80211_STYPE_ACTION);
2808
2809 eth_broadcast_addr(mgmt->da);
2810 memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN);
2811 if (ieee80211_vif_is_mesh(&sdata->vif)) {
2812 memcpy(mgmt->bssid, sdata->vif.addr, ETH_ALEN);
2813 } else {
2814 struct ieee80211_if_ibss *ifibss = &sdata->u.ibss;
2815 memcpy(mgmt->bssid, ifibss->bssid, ETH_ALEN);
2816 }
2817 mgmt->u.action.category = WLAN_CATEGORY_SPECTRUM_MGMT;
2818 mgmt->u.action.u.chan_switch.action_code = WLAN_ACTION_SPCT_CHL_SWITCH;
2819 pos = skb_put(skb, 5);
2820 *pos++ = WLAN_EID_CHANNEL_SWITCH; /* EID */
2821 *pos++ = 3; /* IE length */
2822 *pos++ = csa_settings->block_tx ? 1 : 0; /* CSA mode */
2823 freq = csa_settings->chandef.chan->center_freq;
2824 *pos++ = ieee80211_frequency_to_channel(freq); /* channel */
2825 *pos++ = csa_settings->count; /* count */
2826
2827 if (csa_settings->chandef.width == NL80211_CHAN_WIDTH_40) {
2828 enum nl80211_channel_type ch_type;
2829
2830 skb_put(skb, 3);
2831 *pos++ = WLAN_EID_SECONDARY_CHANNEL_OFFSET; /* EID */
2832 *pos++ = 1; /* IE length */
2833 ch_type = cfg80211_get_chandef_type(&csa_settings->chandef);
2834 if (ch_type == NL80211_CHAN_HT40PLUS)
2835 *pos++ = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
2836 else
2837 *pos++ = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
2838 }
2839
2840 if (ieee80211_vif_is_mesh(&sdata->vif)) {
2841 struct ieee80211_if_mesh *ifmsh = &sdata->u.mesh;
c6da674a
CYY		 2842
2843 skb_put(skb, 8);
2844 *pos++ = WLAN_EID_CHAN_SWITCH_PARAM; /* EID */
2845 *pos++ = 6; /* IE length */
2846 *pos++ = sdata->u.mesh.mshcfg.dot11MeshTTL; /* Mesh TTL */
2847 *pos = 0x00; /* Mesh Flag: Tx Restrict, Initiator, Reason */
2848 *pos |= WLAN_EID_CHAN_SWITCH_PARAM_INITIATOR;
2849 *pos++ |= csa_settings->block_tx ?
2850 WLAN_EID_CHAN_SWITCH_PARAM_TX_RESTRICT : 0x00;
2851 put_unaligned_le16(WLAN_REASON_MESH_CHAN, pos); /* Reason Cd */
2852 pos += 2;
ca91dc97 2853 put_unaligned_le16(ifmsh->pre_value, pos);/* Precedence Value */
c6da674a 2854 pos += 2;
c6da674a
CYY		 2855 }
2856
2857 ieee80211_tx_skb(sdata, skb);
2858 return 0;
2859}
2475b1cc
MS		 2860
2861bool ieee80211_cs_valid(const struct ieee80211_cipher_scheme *cs)
2862{
2863 return !(cs == NULL || cs->cipher == 0 ||
2864 cs->hdr_len < cs->pn_len + cs->pn_off ||
2865 cs->hdr_len <= cs->key_idx_off ||
2866 cs->key_idx_shift > 7 ||
2867 cs->key_idx_mask == 0);
2868}
2869
2870bool ieee80211_cs_list_valid(const struct ieee80211_cipher_scheme *cs, int n)
2871{
2872 int i;
2873
2874 /* Ensure we have enough iftype bitmap space for all iftype values */
2875 WARN_ON((NUM_NL80211_IFTYPES / 8 + 1) > sizeof(cs[0].iftype));
2876
2877 for (i = 0; i < n; i++)
2878 if (!ieee80211_cs_valid(&cs[i]))
2879 return false;
2880
2881 return true;
2882}
2883
2884const struct ieee80211_cipher_scheme *
2885ieee80211_cs_get(struct ieee80211_local *local, u32 cipher,
2886 enum nl80211_iftype iftype)
2887{
2888 const struct ieee80211_cipher_scheme *l = local->hw.cipher_schemes;
2889 int n = local->hw.n_cipher_schemes;
2890 int i;
2891 const struct ieee80211_cipher_scheme *cs = NULL;
2892
2893 for (i = 0; i < n; i++) {
2894 if (l[i].cipher == cipher) {
2895 cs = &l[i];
2896 break;
2897 }
2898 }
2899
2900 if (!cs || !(cs->iftype & BIT(iftype)))
2901 return NULL;
2902
2903 return cs;
2904}
2905
2906int ieee80211_cs_headroom(struct ieee80211_local *local,
2907 struct cfg80211_crypto_settings *crypto,
2908 enum nl80211_iftype iftype)
2909{
2910 const struct ieee80211_cipher_scheme *cs;
2911 int headroom = IEEE80211_ENCRYPT_HEADROOM;
2912 int i;
2913
2914 for (i = 0; i < crypto->n_ciphers_pairwise; i++) {
2915 cs = ieee80211_cs_get(local, crypto->ciphers_pairwise[i],
2916 iftype);
2917
2918 if (cs && headroom < cs->hdr_len)
2919 headroom = cs->hdr_len;
2920 }
2921
2922 cs = ieee80211_cs_get(local, crypto->cipher_group, iftype);
2923 if (cs && headroom < cs->hdr_len)
2924 headroom = cs->hdr_len;
2925
2926 return headroom;
2927}
a7022e65
FF		 2928
2929static bool
2930ieee80211_extend_noa_desc(struct ieee80211_noa_data *data, u32 tsf, int i)
2931{
2932 s32 end = data->desc[i].start + data->desc[i].duration - (tsf + 1);
2933 int skip;
2934
2935 if (end > 0)
2936 return false;
2937
2938 /* End time is in the past, check for repetitions */
2939 skip = DIV_ROUND_UP(-end, data->desc[i].interval);
2940 if (data->count[i] < 255) {
2941 if (data->count[i] <= skip) {
2942 data->count[i] = 0;
2943 return false;
2944 }
2945
2946 data->count[i] -= skip;
2947 }
2948
2949 data->desc[i].start += skip * data->desc[i].interval;
2950
2951 return true;
2952}
2953
2954static bool
2955ieee80211_extend_absent_time(struct ieee80211_noa_data *data, u32 tsf,
2956 s32 *offset)
2957{
2958 bool ret = false;
2959 int i;
2960
2961 for (i = 0; i < IEEE80211_P2P_NOA_DESC_MAX; i++) {
2962 s32 cur;
2963
2964 if (!data->count[i])
2965 continue;
2966
2967 if (ieee80211_extend_noa_desc(data, tsf + *offset, i))
2968 ret = true;
2969
2970 cur = data->desc[i].start - tsf;
2971 if (cur > *offset)
2972 continue;
2973
2974 cur = data->desc[i].start + data->desc[i].duration - tsf;
2975 if (cur > *offset)
2976 *offset = cur;
2977 }
2978
2979 return ret;
2980}
2981
2982static u32
2983ieee80211_get_noa_absent_time(struct ieee80211_noa_data *data, u32 tsf)
2984{
2985 s32 offset = 0;
2986 int tries = 0;
2987 /*
2988 * arbitrary limit, used to avoid infinite loops when combined NoA
2989 * descriptors cover the full time period.
2990 */
2991 int max_tries = 5;
2992
2993 ieee80211_extend_absent_time(data, tsf, &offset);
2994 do {
2995 if (!ieee80211_extend_absent_time(data, tsf, &offset))
2996 break;
2997
2998 tries++;
2999 } while (tries < max_tries);
3000
3001 return offset;
3002}
3003
3004void ieee80211_update_p2p_noa(struct ieee80211_noa_data *data, u32 tsf)
3005{
3006 u32 next_offset = BIT(31) - 1;
3007 int i;
3008
3009 data->absent = 0;
3010 data->has_next_tsf = false;
3011 for (i = 0; i < IEEE80211_P2P_NOA_DESC_MAX; i++) {
3012 s32 start;
3013
3014 if (!data->count[i])
3015 continue;
3016
3017 ieee80211_extend_noa_desc(data, tsf, i);
3018 start = data->desc[i].start - tsf;
3019 if (start <= 0)
3020 data->absent |= BIT(i);
3021
3022 if (next_offset > start)
3023 next_offset = start;
3024
3025 data->has_next_tsf = true;
3026 }
3027
3028 if (data->absent)
3029 next_offset = ieee80211_get_noa_absent_time(data, tsf);
3030
3031 data->next_tsf = tsf + next_offset;
3032}
3033EXPORT_SYMBOL(ieee80211_update_p2p_noa);
3034
3035int ieee80211_parse_p2p_noa(const struct ieee80211_p2p_noa_attr *attr,
3036 struct ieee80211_noa_data *data, u32 tsf)
3037{
3038 int ret = 0;
3039 int i;
3040
3041 memset(data, 0, sizeof(*data));
3042
3043 for (i = 0; i < IEEE80211_P2P_NOA_DESC_MAX; i++) {
3044 const struct ieee80211_p2p_noa_desc *desc = &attr->desc[i];
3045
3046 if (!desc->count || !desc->duration)
3047 continue;
3048
3049 data->count[i] = desc->count;
3050 data->desc[i].start = le32_to_cpu(desc->start_time);
3051 data->desc[i].duration = le32_to_cpu(desc->duration);
3052 data->desc[i].interval = le32_to_cpu(desc->interval);
3053
3054 if (data->count[i] > 1 &&
3055 data->desc[i].interval < data->desc[i].duration)
3056 continue;
3057
3058 ieee80211_extend_noa_desc(data, tsf, i);
3059 ret++;
3060 }
3061
3062 if (ret)
3063 ieee80211_update_p2p_noa(data, tsf);
3064
3065 return ret;
3066}
3067EXPORT_SYMBOL(ieee80211_parse_p2p_noa);
057d5f4b
TP		 3068
3069void ieee80211_recalc_dtim(struct ieee80211_local *local,
3070 struct ieee80211_sub_if_data *sdata)
3071{
3072 u64 tsf = drv_get_tsf(local, sdata);
3073 u64 dtim_count = 0;
3074 u16 beacon_int = sdata->vif.bss_conf.beacon_int * 1024;
3075 u8 dtim_period = sdata->vif.bss_conf.dtim_period;
3076 struct ps_data *ps;
3077 u8 bcns_from_dtim;
3078
3079 if (tsf == -1ULL || !beacon_int || !dtim_period)
3080 return;
3081
3082 if (sdata->vif.type == NL80211_IFTYPE_AP ||
3083 sdata->vif.type == NL80211_IFTYPE_AP_VLAN) {
3084 if (!sdata->bss)
3085 return;
3086
3087 ps = &sdata->bss->ps;
3088 } else if (ieee80211_vif_is_mesh(&sdata->vif)) {
3089 ps = &sdata->u.mesh.ps;
3090 } else {
3091 return;
3092 }
3093
3094 /*
3095 * actually finds last dtim_count, mac80211 will update in
3096 * __beacon_add_tim().
3097 * dtim_count = dtim_period - (tsf / bcn_int) % dtim_period
3098 */
3099 do_div(tsf, beacon_int);
3100 bcns_from_dtim = do_div(tsf, dtim_period);
3101 /* just had a DTIM */
3102 if (!bcns_from_dtim)
3103 dtim_count = 0;
3104 else
3105 dtim_count = dtim_period - bcns_from_dtim;
3106
3107 ps->dtim_count = dtim_count;
3108}
73de86a3 3109
71e6195e
MK		 3110static u8 ieee80211_chanctx_radar_detect(struct ieee80211_local *local,
3111 struct ieee80211_chanctx *ctx)
3112{
3113 struct ieee80211_sub_if_data *sdata;
3114 u8 radar_detect = 0;
3115
3116 lockdep_assert_held(&local->chanctx_mtx);
3117
3118 if (WARN_ON(ctx->replace_state == IEEE80211_CHANCTX_WILL_BE_REPLACED))
3119 return 0;
3120
3121 list_for_each_entry(sdata, &ctx->reserved_vifs, reserved_chanctx_list)
3122 if (sdata->reserved_radar_required)
3123 radar_detect |= BIT(sdata->reserved_chandef.width);
3124
3125 /*
3126 * An in-place reservation context should not have any assigned vifs
3127 * until it replaces the other context.
3128 */
3129 WARN_ON(ctx->replace_state == IEEE80211_CHANCTX_REPLACES_OTHER &&
3130 !list_empty(&ctx->assigned_vifs));
3131
3132 list_for_each_entry(sdata, &ctx->assigned_vifs, assigned_chanctx_list)
3133 if (sdata->radar_required)
3134 radar_detect |= BIT(sdata->vif.bss_conf.chandef.width);
3135
3136 return radar_detect;
3137}
3138
73de86a3
LC		 3139int ieee80211_check_combinations(struct ieee80211_sub_if_data *sdata,
3140 const struct cfg80211_chan_def *chandef,
3141 enum ieee80211_chanctx_mode chanmode,
3142 u8 radar_detect)
3143{
3144 struct ieee80211_local *local = sdata->local;
3145 struct ieee80211_sub_if_data *sdata_iter;
3146 enum nl80211_iftype iftype = sdata->wdev.iftype;
3147 int num[NUM_NL80211_IFTYPES];
3148 struct ieee80211_chanctx *ctx;
b6a55015 3149 int num_different_channels = 0;
73de86a3
LC		 3150 int total = 1;
3151
3152 lockdep_assert_held(&local->chanctx_mtx);
3153
3154 if (WARN_ON(hweight32(radar_detect) > 1))
3155 return -EINVAL;
3156
b6a55015
LC		 3157 if (WARN_ON(chandef && chanmode == IEEE80211_CHANCTX_SHARED &&
3158 !chandef->chan))
73de86a3
LC		 3159 return -EINVAL;
3160
b6a55015
LC		 3161 if (chandef)
3162 num_different_channels = 1;
3163
73de86a3
LC		 3164 if (WARN_ON(iftype >= NUM_NL80211_IFTYPES))
3165 return -EINVAL;
3166
3167 /* Always allow software iftypes */
3168 if (local->hw.wiphy->software_iftypes & BIT(iftype)) {
3169 if (radar_detect)
3170 return -EINVAL;
3171 return 0;
3172 }
3173
3174 memset(num, 0, sizeof(num));
3175
3176 if (iftype != NL80211_IFTYPE_UNSPECIFIED)
3177 num[iftype] = 1;
3178
3179 list_for_each_entry(ctx, &local->chanctx_list, list) {
5bcae31d
MK		 3180 if (ctx->replace_state == IEEE80211_CHANCTX_WILL_BE_REPLACED)
3181 continue;
71e6195e 3182 radar_detect |= ieee80211_chanctx_radar_detect(local, ctx);
73de86a3
LC		 3183 if (ctx->mode == IEEE80211_CHANCTX_EXCLUSIVE) {
3184 num_different_channels++;
3185 continue;
3186 }
b6a55015 3187 if (chandef && chanmode == IEEE80211_CHANCTX_SHARED &&
73de86a3
LC		 3188 cfg80211_chandef_compatible(chandef,
3189 &ctx->conf.def))
3190 continue;
3191 num_different_channels++;
3192 }
3193
3194 list_for_each_entry_rcu(sdata_iter, &local->interfaces, list) {
3195 struct wireless_dev *wdev_iter;
3196
3197 wdev_iter = &sdata_iter->wdev;
3198
3199 if (sdata_iter == sdata ||
0f611d28 3200 !ieee80211_sdata_running(sdata_iter) ||
73de86a3
LC		 3201 local->hw.wiphy->software_iftypes & BIT(wdev_iter->iftype))
3202 continue;
3203
3204 num[wdev_iter->iftype]++;
3205 total++;
3206 }
3207
3208 if (total == 1 && !radar_detect)
3209 return 0;
3210
3211 return cfg80211_check_combinations(local->hw.wiphy,
3212 num_different_channels,
3213 radar_detect, num);
3214}
6fa001bc
MK		 3215
3216static void
3217ieee80211_iter_max_chans(const struct ieee80211_iface_combination *c,
3218 void *data)
3219{
3220 u32 *max_num_different_channels = data;
3221
3222 *max_num_different_channels = max(*max_num_different_channels,
3223 c->num_different_channels);
3224}
3225
3226int ieee80211_max_num_channels(struct ieee80211_local *local)
3227{
3228 struct ieee80211_sub_if_data *sdata;
3229 int num[NUM_NL80211_IFTYPES] = {};
3230 struct ieee80211_chanctx *ctx;
3231 int num_different_channels = 0;
3232 u8 radar_detect = 0;
3233 u32 max_num_different_channels = 1;
3234 int err;
3235
3236 lockdep_assert_held(&local->chanctx_mtx);
3237
3238 list_for_each_entry(ctx, &local->chanctx_list, list) {
5bcae31d
MK		 3239 if (ctx->replace_state == IEEE80211_CHANCTX_WILL_BE_REPLACED)
3240 continue;
3241
6fa001bc
MK		 3242 num_different_channels++;
3243
71e6195e 3244 radar_detect |= ieee80211_chanctx_radar_detect(local, ctx);
6fa001bc
MK		 3245 }
3246
3247 list_for_each_entry_rcu(sdata, &local->interfaces, list)
3248 num[sdata->wdev.iftype]++;
3249
3250 err = cfg80211_iter_combinations(local->hw.wiphy,
3251 num_different_channels, radar_detect,
3252 num, ieee80211_iter_max_chans,
3253 &max_num_different_channels);
3254 if (err < 0)
3255 return err;
3256
3257 return max_num_different_channels;
3258}
40b861a0
AN		 3259
3260u8 *ieee80211_add_wmm_info_ie(u8 *buf, u8 qosinfo)
3261{
3262 *buf++ = WLAN_EID_VENDOR_SPECIFIC;
3263 *buf++ = 7; /* len */
3264 *buf++ = 0x00; /* Microsoft OUI 00:50:F2 */
3265 *buf++ = 0x50;
3266 *buf++ = 0xf2;
3267 *buf++ = 2; /* WME */
3268 *buf++ = 0; /* WME info */
3269 *buf++ = 1; /* WME ver */
3270 *buf++ = qosinfo; /* U-APSD no in use */
3271
3272 return buf;
3273}
ba8c3d6f
FF		 3274
3275void ieee80211_init_tx_queue(struct ieee80211_sub_if_data *sdata,
3276 struct sta_info *sta,
3277 struct txq_info *txqi, int tid)
3278{
3279 skb_queue_head_init(&txqi->queue);
3280 txqi->txq.vif = &sdata->vif;
3281
3282 if (sta) {
3283 txqi->txq.sta = &sta->sta;
3284 sta->sta.txq[tid] = &txqi->txq;
3285 txqi->txq.ac = ieee802_1d_to_ac[tid & 7];
3286 } else {
3287 sdata->vif.txq = &txqi->txq;
3288 txqi->txq.ac = IEEE80211_AC_BE;
3289 }
3290}
Linux 6.x block layer and io_uring tree(s)