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