Blame view
net/mac80211/util.c
36 KB
c2d1560ad [MAC80211]: intro... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 |
/* * Copyright 2002-2005, Instant802 Networks, Inc. * Copyright 2005-2006, Devicescape Software, Inc. * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz> * Copyright 2007 Johannes Berg <johannes@sipsolutions.net> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * utilities for mac80211 */ #include <net/mac80211.h> #include <linux/netdevice.h> #include <linux/types.h> #include <linux/slab.h> #include <linux/skbuff.h> #include <linux/etherdevice.h> #include <linux/if_arp.h> |
c2d1560ad [MAC80211]: intro... |
21 |
#include <linux/bitmap.h> |
d91f36db5 mac80211: impleme... |
22 |
#include <linux/crc32.h> |
881d966b4 [NET]: Make the d... |
23 |
#include <net/net_namespace.h> |
c2d1560ad [MAC80211]: intro... |
24 |
#include <net/cfg80211.h> |
dabeb344f mac80211: provide... |
25 |
#include <net/rtnetlink.h> |
c2d1560ad [MAC80211]: intro... |
26 27 |
#include "ieee80211_i.h" |
244879813 mac80211: add dri... |
28 |
#include "driver-ops.h" |
2c8dccc77 mac80211: rename ... |
29 |
#include "rate.h" |
ee3858551 mac80211: mesh da... |
30 |
#include "mesh.h" |
c2d1560ad [MAC80211]: intro... |
31 |
#include "wme.h" |
f2753ddba mac80211: add har... |
32 |
#include "led.h" |
fffd0934b cfg80211: rework ... |
33 |
#include "wep.h" |
c2d1560ad [MAC80211]: intro... |
34 35 36 |
/* privid for wiphys to determine whether they belong to us or not */ void *mac80211_wiphy_privid = &mac80211_wiphy_privid; |
9a95371aa mac80211: allow m... |
37 38 39 40 41 42 43 44 45 |
struct ieee80211_hw *wiphy_to_ieee80211_hw(struct wiphy *wiphy) { struct ieee80211_local *local; BUG_ON(!wiphy); local = wiphy_priv(wiphy); return &local->hw; } EXPORT_SYMBOL(wiphy_to_ieee80211_hw); |
c2d1560ad [MAC80211]: intro... |
46 |
|
713647169 mac80211: A-MPDU ... |
47 |
u8 *ieee80211_get_bssid(struct ieee80211_hdr *hdr, size_t len, |
05c914fe3 mac80211: use nl8... |
48 |
enum nl80211_iftype type) |
c2d1560ad [MAC80211]: intro... |
49 |
{ |
a494bb1ca mac80211: use new... |
50 |
__le16 fc = hdr->frame_control; |
c2d1560ad [MAC80211]: intro... |
51 |
|
98f0b0a3a mac80211: pass in... |
52 53 |
/* drop ACK/CTS frames and incorrect hdr len (ctrl) */ if (len < 16) |
c2d1560ad [MAC80211]: intro... |
54 |
return NULL; |
a494bb1ca mac80211: use new... |
55 |
if (ieee80211_is_data(fc)) { |
98f0b0a3a mac80211: pass in... |
56 57 |
if (len < 24) /* drop incorrect hdr len (data) */ return NULL; |
a494bb1ca mac80211: use new... |
58 59 |
if (ieee80211_has_a4(fc)) |
c2d1560ad [MAC80211]: intro... |
60 |
return NULL; |
a494bb1ca mac80211: use new... |
61 62 63 |
if (ieee80211_has_tods(fc)) return hdr->addr1; if (ieee80211_has_fromds(fc)) |
c2d1560ad [MAC80211]: intro... |
64 |
return hdr->addr2; |
a494bb1ca mac80211: use new... |
65 66 67 68 69 |
return hdr->addr3; } if (ieee80211_is_mgmt(fc)) { |
98f0b0a3a mac80211: pass in... |
70 71 |
if (len < 24) /* drop incorrect hdr len (mgmt) */ return NULL; |
c2d1560ad [MAC80211]: intro... |
72 |
return hdr->addr3; |
a494bb1ca mac80211: use new... |
73 74 75 76 |
} if (ieee80211_is_ctl(fc)) { if(ieee80211_is_pspoll(fc)) |
c2d1560ad [MAC80211]: intro... |
77 |
return hdr->addr1; |
a494bb1ca mac80211: use new... |
78 79 |
if (ieee80211_is_back_req(fc)) { |
713647169 mac80211: A-MPDU ... |
80 |
switch (type) { |
05c914fe3 mac80211: use nl8... |
81 |
case NL80211_IFTYPE_STATION: |
713647169 mac80211: A-MPDU ... |
82 |
return hdr->addr2; |
05c914fe3 mac80211: use nl8... |
83 84 |
case NL80211_IFTYPE_AP: case NL80211_IFTYPE_AP_VLAN: |
713647169 mac80211: A-MPDU ... |
85 86 |
return hdr->addr1; default: |
a494bb1ca mac80211: use new... |
87 |
break; /* fall through to the return */ |
713647169 mac80211: A-MPDU ... |
88 89 |
} } |
c2d1560ad [MAC80211]: intro... |
90 91 92 93 |
} return NULL; } |
5cf121c3c mac80211: split i... |
94 |
void ieee80211_tx_set_protected(struct ieee80211_tx_data *tx) |
c2d1560ad [MAC80211]: intro... |
95 |
{ |
2de8e0d99 mac80211: rewrite... |
96 97 98 99 100 101 102 |
struct sk_buff *skb = tx->skb; struct ieee80211_hdr *hdr; do { hdr = (struct ieee80211_hdr *) skb->data; hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED); } while ((skb = skb->next)); |
c2d1560ad [MAC80211]: intro... |
103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 |
} int ieee80211_frame_duration(struct ieee80211_local *local, size_t len, int rate, int erp, int short_preamble) { int dur; /* calculate duration (in microseconds, rounded up to next higher * integer if it includes a fractional microsecond) to send frame of * len bytes (does not include FCS) at the given rate. Duration will * also include SIFS. * * rate is in 100 kbps, so divident is multiplied by 10 in the * DIV_ROUND_UP() operations. */ |
8318d78a4 cfg80211 API for ... |
118 |
if (local->hw.conf.channel->band == IEEE80211_BAND_5GHZ || erp) { |
c2d1560ad [MAC80211]: intro... |
119 120 121 122 123 124 125 126 127 128 129 130 131 |
/* * OFDM: * * N_DBPS = DATARATE x 4 * N_SYM = Ceiling((16+8xLENGTH+6) / N_DBPS) * (16 = SIGNAL time, 6 = tail bits) * TXTIME = T_PREAMBLE + T_SIGNAL + T_SYM x N_SYM + Signal Ext * * T_SYM = 4 usec * 802.11a - 17.5.2: aSIFSTime = 16 usec * 802.11g - 19.8.4: aSIFSTime = 10 usec + * signal ext = 6 usec */ |
c2d1560ad [MAC80211]: intro... |
132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 |
dur = 16; /* SIFS + signal ext */ dur += 16; /* 17.3.2.3: T_PREAMBLE = 16 usec */ dur += 4; /* 17.3.2.3: T_SIGNAL = 4 usec */ dur += 4 * DIV_ROUND_UP((16 + 8 * (len + 4) + 6) * 10, 4 * rate); /* T_SYM x N_SYM */ } else { /* * 802.11b or 802.11g with 802.11b compatibility: * 18.3.4: TXTIME = PreambleLength + PLCPHeaderTime + * Ceiling(((LENGTH+PBCC)x8)/DATARATE). PBCC=0. * * 802.11 (DS): 15.3.3, 802.11b: 18.3.4 * aSIFSTime = 10 usec * aPreambleLength = 144 usec or 72 usec with short preamble * aPLCPHeaderLength = 48 usec or 24 usec with short preamble */ dur = 10; /* aSIFSTime = 10 usec */ dur += short_preamble ? (72 + 24) : (144 + 48); dur += DIV_ROUND_UP(8 * (len + 4) * 10, rate); } return dur; } /* Exported duration function for driver use */ |
32bfd35d4 mac80211: dont us... |
158 159 |
__le16 ieee80211_generic_frame_duration(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
8318d78a4 cfg80211 API for ... |
160 161 |
size_t frame_len, struct ieee80211_rate *rate) |
c2d1560ad [MAC80211]: intro... |
162 163 |
{ struct ieee80211_local *local = hw_to_local(hw); |
25d834e16 mac80211: fix vir... |
164 |
struct ieee80211_sub_if_data *sdata; |
c2d1560ad [MAC80211]: intro... |
165 166 |
u16 dur; int erp; |
25d834e16 mac80211: fix vir... |
167 |
bool short_preamble = false; |
c2d1560ad [MAC80211]: intro... |
168 |
|
8318d78a4 cfg80211 API for ... |
169 |
erp = 0; |
25d834e16 mac80211: fix vir... |
170 171 |
if (vif) { sdata = vif_to_sdata(vif); |
bda3933a8 mac80211: move bs... |
172 |
short_preamble = sdata->vif.bss_conf.use_short_preamble; |
25d834e16 mac80211: fix vir... |
173 174 175 |
if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) erp = rate->flags & IEEE80211_RATE_ERP_G; } |
8318d78a4 cfg80211 API for ... |
176 177 |
dur = ieee80211_frame_duration(local, frame_len, rate->bitrate, erp, |
25d834e16 mac80211: fix vir... |
178 |
short_preamble); |
c2d1560ad [MAC80211]: intro... |
179 180 181 182 |
return cpu_to_le16(dur); } EXPORT_SYMBOL(ieee80211_generic_frame_duration); |
32bfd35d4 mac80211: dont us... |
183 184 |
__le16 ieee80211_rts_duration(struct ieee80211_hw *hw, struct ieee80211_vif *vif, size_t frame_len, |
e039fa4a4 mac80211: move TX... |
185 |
const struct ieee80211_tx_info *frame_txctl) |
c2d1560ad [MAC80211]: intro... |
186 187 188 |
{ struct ieee80211_local *local = hw_to_local(hw); struct ieee80211_rate *rate; |
25d834e16 mac80211: fix vir... |
189 |
struct ieee80211_sub_if_data *sdata; |
471b3efdf mac80211: add uni... |
190 |
bool short_preamble; |
c2d1560ad [MAC80211]: intro... |
191 192 |
int erp; u16 dur; |
2e92e6f2c mac80211: use rat... |
193 194 195 |
struct ieee80211_supported_band *sband; sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; |
c2d1560ad [MAC80211]: intro... |
196 |
|
25d834e16 mac80211: fix vir... |
197 |
short_preamble = false; |
7e9ed1887 [MAC80211]: impro... |
198 |
|
e039fa4a4 mac80211: move TX... |
199 |
rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx]; |
8318d78a4 cfg80211 API for ... |
200 201 |
erp = 0; |
25d834e16 mac80211: fix vir... |
202 203 |
if (vif) { sdata = vif_to_sdata(vif); |
bda3933a8 mac80211: move bs... |
204 |
short_preamble = sdata->vif.bss_conf.use_short_preamble; |
25d834e16 mac80211: fix vir... |
205 206 207 |
if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) erp = rate->flags & IEEE80211_RATE_ERP_G; } |
c2d1560ad [MAC80211]: intro... |
208 209 |
/* CTS duration */ |
8318d78a4 cfg80211 API for ... |
210 |
dur = ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560ad [MAC80211]: intro... |
211 212 |
erp, short_preamble); /* Data frame duration */ |
8318d78a4 cfg80211 API for ... |
213 |
dur += ieee80211_frame_duration(local, frame_len, rate->bitrate, |
c2d1560ad [MAC80211]: intro... |
214 215 |
erp, short_preamble); /* ACK duration */ |
8318d78a4 cfg80211 API for ... |
216 |
dur += ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560ad [MAC80211]: intro... |
217 218 219 220 221 |
erp, short_preamble); return cpu_to_le16(dur); } EXPORT_SYMBOL(ieee80211_rts_duration); |
32bfd35d4 mac80211: dont us... |
222 223 |
__le16 ieee80211_ctstoself_duration(struct ieee80211_hw *hw, struct ieee80211_vif *vif, |
c2d1560ad [MAC80211]: intro... |
224 |
size_t frame_len, |
e039fa4a4 mac80211: move TX... |
225 |
const struct ieee80211_tx_info *frame_txctl) |
c2d1560ad [MAC80211]: intro... |
226 227 228 |
{ struct ieee80211_local *local = hw_to_local(hw); struct ieee80211_rate *rate; |
25d834e16 mac80211: fix vir... |
229 |
struct ieee80211_sub_if_data *sdata; |
471b3efdf mac80211: add uni... |
230 |
bool short_preamble; |
c2d1560ad [MAC80211]: intro... |
231 232 |
int erp; u16 dur; |
2e92e6f2c mac80211: use rat... |
233 234 235 |
struct ieee80211_supported_band *sband; sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; |
c2d1560ad [MAC80211]: intro... |
236 |
|
25d834e16 mac80211: fix vir... |
237 |
short_preamble = false; |
7e9ed1887 [MAC80211]: impro... |
238 |
|
e039fa4a4 mac80211: move TX... |
239 |
rate = &sband->bitrates[frame_txctl->control.rts_cts_rate_idx]; |
8318d78a4 cfg80211 API for ... |
240 |
erp = 0; |
25d834e16 mac80211: fix vir... |
241 242 |
if (vif) { sdata = vif_to_sdata(vif); |
bda3933a8 mac80211: move bs... |
243 |
short_preamble = sdata->vif.bss_conf.use_short_preamble; |
25d834e16 mac80211: fix vir... |
244 245 246 |
if (sdata->flags & IEEE80211_SDATA_OPERATING_GMODE) erp = rate->flags & IEEE80211_RATE_ERP_G; } |
c2d1560ad [MAC80211]: intro... |
247 248 |
/* Data frame duration */ |
8318d78a4 cfg80211 API for ... |
249 |
dur = ieee80211_frame_duration(local, frame_len, rate->bitrate, |
c2d1560ad [MAC80211]: intro... |
250 |
erp, short_preamble); |
e039fa4a4 mac80211: move TX... |
251 |
if (!(frame_txctl->flags & IEEE80211_TX_CTL_NO_ACK)) { |
c2d1560ad [MAC80211]: intro... |
252 |
/* ACK duration */ |
8318d78a4 cfg80211 API for ... |
253 |
dur += ieee80211_frame_duration(local, 10, rate->bitrate, |
c2d1560ad [MAC80211]: intro... |
254 255 256 257 258 259 |
erp, short_preamble); } return cpu_to_le16(dur); } EXPORT_SYMBOL(ieee80211_ctstoself_duration); |
ce7c9111a mac80211: track m... |
260 261 |
static void __ieee80211_wake_queue(struct ieee80211_hw *hw, int queue, enum queue_stop_reason reason) |
c2d1560ad [MAC80211]: intro... |
262 263 |
{ struct ieee80211_local *local = hw_to_local(hw); |
cf0277e71 mac80211: fix skb... |
264 |
struct ieee80211_sub_if_data *sdata; |
c2d1560ad [MAC80211]: intro... |
265 |
|
b5878a2dc mac80211: enhance... |
266 |
trace_wake_queue(local, queue, reason); |
e4e72fb4d mac80211/iwlwifi:... |
267 268 |
if (WARN_ON(queue >= hw->queues)) return; |
ce7c9111a mac80211: track m... |
269 |
|
96f5e66e8 mac80211: fix agg... |
270 271 272 273 274 |
__clear_bit(reason, &local->queue_stop_reasons[queue]); if (local->queue_stop_reasons[queue] != 0) /* someone still has this queue stopped */ return; |
7236fe29f mac80211: move ne... |
275 276 |
if (skb_queue_empty(&local->pending[queue])) { rcu_read_lock(); |
5b714c6a3 mac80211: fix off... |
277 278 279 |
list_for_each_entry_rcu(sdata, &local->interfaces, list) { if (test_bit(SDATA_STATE_OFFCHANNEL, &sdata->state)) continue; |
2337db8db mac80211: use sub... |
280 |
netif_wake_subqueue(sdata->dev, queue); |
5b714c6a3 mac80211: fix off... |
281 |
} |
7236fe29f mac80211: move ne... |
282 283 |
rcu_read_unlock(); } else |
3b8d81e02 mac80211: remove ... |
284 |
tasklet_schedule(&local->tx_pending_tasklet); |
c2d1560ad [MAC80211]: intro... |
285 |
} |
ce7c9111a mac80211: track m... |
286 |
|
96f5e66e8 mac80211: fix agg... |
287 288 |
void ieee80211_wake_queue_by_reason(struct ieee80211_hw *hw, int queue, enum queue_stop_reason reason) |
ce7c9111a mac80211: track m... |
289 290 291 292 293 294 295 296 297 298 299 300 301 302 |
{ struct ieee80211_local *local = hw_to_local(hw); unsigned long flags; spin_lock_irqsave(&local->queue_stop_reason_lock, flags); __ieee80211_wake_queue(hw, queue, reason); spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); } void ieee80211_wake_queue(struct ieee80211_hw *hw, int queue) { ieee80211_wake_queue_by_reason(hw, queue, IEEE80211_QUEUE_STOP_REASON_DRIVER); } |
c2d1560ad [MAC80211]: intro... |
303 |
EXPORT_SYMBOL(ieee80211_wake_queue); |
ce7c9111a mac80211: track m... |
304 305 |
static void __ieee80211_stop_queue(struct ieee80211_hw *hw, int queue, enum queue_stop_reason reason) |
c2d1560ad [MAC80211]: intro... |
306 307 |
{ struct ieee80211_local *local = hw_to_local(hw); |
cf0277e71 mac80211: fix skb... |
308 |
struct ieee80211_sub_if_data *sdata; |
c2d1560ad [MAC80211]: intro... |
309 |
|
b5878a2dc mac80211: enhance... |
310 |
trace_stop_queue(local, queue, reason); |
e4e72fb4d mac80211/iwlwifi:... |
311 312 |
if (WARN_ON(queue >= hw->queues)) return; |
96f5e66e8 mac80211: fix agg... |
313 |
|
2a577d987 mac80211: rework ... |
314 |
__set_bit(reason, &local->queue_stop_reasons[queue]); |
cf0277e71 mac80211: fix skb... |
315 316 317 |
rcu_read_lock(); list_for_each_entry_rcu(sdata, &local->interfaces, list) |
2337db8db mac80211: use sub... |
318 |
netif_stop_subqueue(sdata->dev, queue); |
cf0277e71 mac80211: fix skb... |
319 |
rcu_read_unlock(); |
c2d1560ad [MAC80211]: intro... |
320 |
} |
ce7c9111a mac80211: track m... |
321 |
|
96f5e66e8 mac80211: fix agg... |
322 323 |
void ieee80211_stop_queue_by_reason(struct ieee80211_hw *hw, int queue, enum queue_stop_reason reason) |
ce7c9111a mac80211: track m... |
324 325 326 327 328 329 330 331 332 333 334 335 336 337 |
{ struct ieee80211_local *local = hw_to_local(hw); unsigned long flags; spin_lock_irqsave(&local->queue_stop_reason_lock, flags); __ieee80211_stop_queue(hw, queue, reason); spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); } void ieee80211_stop_queue(struct ieee80211_hw *hw, int queue) { ieee80211_stop_queue_by_reason(hw, queue, IEEE80211_QUEUE_STOP_REASON_DRIVER); } |
c2d1560ad [MAC80211]: intro... |
338 |
EXPORT_SYMBOL(ieee80211_stop_queue); |
8f77f3849 mac80211: do not ... |
339 340 341 342 343 344 |
void ieee80211_add_pending_skb(struct ieee80211_local *local, struct sk_buff *skb) { struct ieee80211_hw *hw = &local->hw; unsigned long flags; int queue = skb_get_queue_mapping(skb); |
a7bc376c8 mac80211: verify ... |
345 346 347 |
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); if (WARN_ON(!info->control.vif)) { |
0819663d1 mac80211: use kfr... |
348 |
kfree_skb(skb); |
a7bc376c8 mac80211: verify ... |
349 350 |
return; } |
8f77f3849 mac80211: do not ... |
351 352 353 |
spin_lock_irqsave(&local->queue_stop_reason_lock, flags); __ieee80211_stop_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD); |
3b8d81e02 mac80211: remove ... |
354 |
__skb_queue_tail(&local->pending[queue], skb); |
8f77f3849 mac80211: do not ... |
355 356 357 |
__ieee80211_wake_queue(hw, queue, IEEE80211_QUEUE_STOP_REASON_SKB_ADD); spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); } |
50a9432da mac80211: fix pow... |
358 359 360 |
int ieee80211_add_pending_skbs_fn(struct ieee80211_local *local, struct sk_buff_head *skbs, void (*fn)(void *data), void *data) |
8f77f3849 mac80211: do not ... |
361 362 363 364 365 366 367 368 369 370 371 372 |
{ struct ieee80211_hw *hw = &local->hw; struct sk_buff *skb; unsigned long flags; int queue, ret = 0, i; spin_lock_irqsave(&local->queue_stop_reason_lock, flags); for (i = 0; i < hw->queues; i++) __ieee80211_stop_queue(hw, i, IEEE80211_QUEUE_STOP_REASON_SKB_ADD); while ((skb = skb_dequeue(skbs))) { |
a7bc376c8 mac80211: verify ... |
373 374 375 |
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); if (WARN_ON(!info->control.vif)) { |
0819663d1 mac80211: use kfr... |
376 |
kfree_skb(skb); |
a7bc376c8 mac80211: verify ... |
377 378 |
continue; } |
8f77f3849 mac80211: do not ... |
379 380 |
ret++; queue = skb_get_queue_mapping(skb); |
3b8d81e02 mac80211: remove ... |
381 |
__skb_queue_tail(&local->pending[queue], skb); |
8f77f3849 mac80211: do not ... |
382 |
} |
50a9432da mac80211: fix pow... |
383 384 |
if (fn) fn(data); |
3b8d81e02 mac80211: remove ... |
385 |
for (i = 0; i < hw->queues; i++) |
8f77f3849 mac80211: do not ... |
386 387 |
__ieee80211_wake_queue(hw, i, IEEE80211_QUEUE_STOP_REASON_SKB_ADD); |
8f77f3849 mac80211: do not ... |
388 389 390 391 |
spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); return ret; } |
50a9432da mac80211: fix pow... |
392 393 394 395 396 |
int ieee80211_add_pending_skbs(struct ieee80211_local *local, struct sk_buff_head *skbs) { return ieee80211_add_pending_skbs_fn(local, skbs, NULL, NULL); } |
ce7c9111a mac80211: track m... |
397 398 |
void ieee80211_stop_queues_by_reason(struct ieee80211_hw *hw, enum queue_stop_reason reason) |
c2d1560ad [MAC80211]: intro... |
399 |
{ |
ce7c9111a mac80211: track m... |
400 401 |
struct ieee80211_local *local = hw_to_local(hw); unsigned long flags; |
c2d1560ad [MAC80211]: intro... |
402 |
int i; |
ce7c9111a mac80211: track m... |
403 |
spin_lock_irqsave(&local->queue_stop_reason_lock, flags); |
96f5e66e8 mac80211: fix agg... |
404 |
for (i = 0; i < hw->queues; i++) |
ce7c9111a mac80211: track m... |
405 406 407 408 409 410 411 412 413 |
__ieee80211_stop_queue(hw, i, reason); spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); } void ieee80211_stop_queues(struct ieee80211_hw *hw) { ieee80211_stop_queues_by_reason(hw, IEEE80211_QUEUE_STOP_REASON_DRIVER); |
c2d1560ad [MAC80211]: intro... |
414 415 |
} EXPORT_SYMBOL(ieee80211_stop_queues); |
92ab85354 mac80211: add iee... |
416 417 418 |
int ieee80211_queue_stopped(struct ieee80211_hw *hw, int queue) { struct ieee80211_local *local = hw_to_local(hw); |
3b8d81e02 mac80211: remove ... |
419 420 |
unsigned long flags; int ret; |
96f5e66e8 mac80211: fix agg... |
421 |
|
e4e72fb4d mac80211/iwlwifi:... |
422 423 |
if (WARN_ON(queue >= hw->queues)) return true; |
96f5e66e8 mac80211: fix agg... |
424 |
|
3b8d81e02 mac80211: remove ... |
425 426 427 428 |
spin_lock_irqsave(&local->queue_stop_reason_lock, flags); ret = !!local->queue_stop_reasons[queue]; spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); return ret; |
92ab85354 mac80211: add iee... |
429 430 |
} EXPORT_SYMBOL(ieee80211_queue_stopped); |
ce7c9111a mac80211: track m... |
431 432 |
void ieee80211_wake_queues_by_reason(struct ieee80211_hw *hw, enum queue_stop_reason reason) |
c2d1560ad [MAC80211]: intro... |
433 |
{ |
ce7c9111a mac80211: track m... |
434 435 |
struct ieee80211_local *local = hw_to_local(hw); unsigned long flags; |
c2d1560ad [MAC80211]: intro... |
436 |
int i; |
ce7c9111a mac80211: track m... |
437 |
spin_lock_irqsave(&local->queue_stop_reason_lock, flags); |
e4e72fb4d mac80211/iwlwifi:... |
438 |
for (i = 0; i < hw->queues; i++) |
ce7c9111a mac80211: track m... |
439 440 441 442 443 444 445 446 |
__ieee80211_wake_queue(hw, i, reason); spin_unlock_irqrestore(&local->queue_stop_reason_lock, flags); } void ieee80211_wake_queues(struct ieee80211_hw *hw) { ieee80211_wake_queues_by_reason(hw, IEEE80211_QUEUE_STOP_REASON_DRIVER); |
c2d1560ad [MAC80211]: intro... |
447 448 |
} EXPORT_SYMBOL(ieee80211_wake_queues); |
dabeb344f mac80211: provide... |
449 |
|
32bfd35d4 mac80211: dont us... |
450 451 452 453 454 |
void ieee80211_iterate_active_interfaces( struct ieee80211_hw *hw, void (*iterator)(void *data, u8 *mac, struct ieee80211_vif *vif), void *data) |
dabeb344f mac80211: provide... |
455 456 457 |
{ struct ieee80211_local *local = hw_to_local(hw); struct ieee80211_sub_if_data *sdata; |
c771c9d8d mac80211: add int... |
458 |
mutex_lock(&local->iflist_mtx); |
2f561feb3 mac80211: Add RTN... |
459 460 461 |
list_for_each_entry(sdata, &local->interfaces, list) { switch (sdata->vif.type) { |
05c914fe3 mac80211: use nl8... |
462 463 |
case NL80211_IFTYPE_MONITOR: case NL80211_IFTYPE_AP_VLAN: |
2f561feb3 mac80211: Add RTN... |
464 |
continue; |
2ca27bcff mac80211: add p2p... |
465 |
default: |
2f561feb3 mac80211: Add RTN... |
466 467 |
break; } |
9607e6b66 mac80211: add iee... |
468 |
if (ieee80211_sdata_running(sdata)) |
47846c9b0 mac80211: reduce ... |
469 |
iterator(data, sdata->vif.addr, |
2f561feb3 mac80211: Add RTN... |
470 471 |
&sdata->vif); } |
c771c9d8d mac80211: add int... |
472 |
mutex_unlock(&local->iflist_mtx); |
2f561feb3 mac80211: Add RTN... |
473 474 475 476 477 478 479 480 481 482 483 |
} EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces); void ieee80211_iterate_active_interfaces_atomic( struct ieee80211_hw *hw, void (*iterator)(void *data, u8 *mac, struct ieee80211_vif *vif), void *data) { struct ieee80211_local *local = hw_to_local(hw); struct ieee80211_sub_if_data *sdata; |
e38bad476 mac80211: make ie... |
484 |
rcu_read_lock(); |
dabeb344f mac80211: provide... |
485 |
|
e38bad476 mac80211: make ie... |
486 |
list_for_each_entry_rcu(sdata, &local->interfaces, list) { |
51fb61e76 mac80211: move in... |
487 |
switch (sdata->vif.type) { |
05c914fe3 mac80211: use nl8... |
488 489 |
case NL80211_IFTYPE_MONITOR: case NL80211_IFTYPE_AP_VLAN: |
dabeb344f mac80211: provide... |
490 |
continue; |
2ca27bcff mac80211: add p2p... |
491 |
default: |
dabeb344f mac80211: provide... |
492 493 |
break; } |
9607e6b66 mac80211: add iee... |
494 |
if (ieee80211_sdata_running(sdata)) |
47846c9b0 mac80211: reduce ... |
495 |
iterator(data, sdata->vif.addr, |
32bfd35d4 mac80211: dont us... |
496 |
&sdata->vif); |
dabeb344f mac80211: provide... |
497 |
} |
e38bad476 mac80211: make ie... |
498 499 |
rcu_read_unlock(); |
dabeb344f mac80211: provide... |
500 |
} |
2f561feb3 mac80211: Add RTN... |
501 |
EXPORT_SYMBOL_GPL(ieee80211_iterate_active_interfaces_atomic); |
37ffc8da8 mac80211: move IE... |
502 |
|
42935ecaf mac80211: redefin... |
503 504 505 506 507 508 509 510 511 |
/* * Nothing should have been stuffed into the workqueue during * the suspend->resume cycle. If this WARN is seen then there * is a bug with either the driver suspend or something in * mac80211 stuffing into the workqueue which we haven't yet * cleared during mac80211's suspend cycle. */ static bool ieee80211_can_queue_work(struct ieee80211_local *local) { |
ceb99fe07 mac80211: fix resume |
512 513 514 515 |
if (WARN(local->suspended && !local->resuming, "queueing ieee80211 work while going to suspend ")) return false; |
42935ecaf mac80211: redefin... |
516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 |
return true; } void ieee80211_queue_work(struct ieee80211_hw *hw, struct work_struct *work) { struct ieee80211_local *local = hw_to_local(hw); if (!ieee80211_can_queue_work(local)) return; queue_work(local->workqueue, work); } EXPORT_SYMBOL(ieee80211_queue_work); void ieee80211_queue_delayed_work(struct ieee80211_hw *hw, struct delayed_work *dwork, unsigned long delay) { struct ieee80211_local *local = hw_to_local(hw); if (!ieee80211_can_queue_work(local)) return; queue_delayed_work(local->workqueue, dwork, delay); } EXPORT_SYMBOL(ieee80211_queue_delayed_work); |
37ffc8da8 mac80211: move IE... |
543 544 545 |
void ieee802_11_parse_elems(u8 *start, size_t len, struct ieee802_11_elems *elems) { |
d91f36db5 mac80211: impleme... |
546 547 548 549 550 551 552 |
ieee802_11_parse_elems_crc(start, len, elems, 0, 0); } u32 ieee802_11_parse_elems_crc(u8 *start, size_t len, struct ieee802_11_elems *elems, u64 filter, u32 crc) { |
37ffc8da8 mac80211: move IE... |
553 554 |
size_t left = len; u8 *pos = start; |
d91f36db5 mac80211: impleme... |
555 |
bool calc_crc = filter != 0; |
37ffc8da8 mac80211: move IE... |
556 557 558 559 560 561 562 563 564 565 566 567 568 |
memset(elems, 0, sizeof(*elems)); elems->ie_start = start; elems->total_len = len; while (left >= 2) { u8 id, elen; id = *pos++; elen = *pos++; left -= 2; if (elen > left) |
d91f36db5 mac80211: impleme... |
569 |
break; |
1814077fd mac80211: Fix bug... |
570 |
if (calc_crc && id < 64 && (filter & (1ULL << id))) |
d91f36db5 mac80211: impleme... |
571 |
crc = crc32_be(crc, pos - 2, elen + 2); |
37ffc8da8 mac80211: move IE... |
572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 |
switch (id) { case WLAN_EID_SSID: elems->ssid = pos; elems->ssid_len = elen; break; case WLAN_EID_SUPP_RATES: elems->supp_rates = pos; elems->supp_rates_len = elen; break; case WLAN_EID_FH_PARAMS: elems->fh_params = pos; elems->fh_params_len = elen; break; case WLAN_EID_DS_PARAMS: elems->ds_params = pos; elems->ds_params_len = elen; break; case WLAN_EID_CF_PARAMS: elems->cf_params = pos; elems->cf_params_len = elen; break; case WLAN_EID_TIM: |
e7ec86f54 mac80211: validat... |
595 596 597 598 |
if (elen >= sizeof(struct ieee80211_tim_ie)) { elems->tim = (void *)pos; elems->tim_len = elen; } |
37ffc8da8 mac80211: move IE... |
599 600 601 602 603 604 605 606 607 |
break; case WLAN_EID_IBSS_PARAMS: elems->ibss_params = pos; elems->ibss_params_len = elen; break; case WLAN_EID_CHALLENGE: elems->challenge = pos; elems->challenge_len = elen; break; |
d91f36db5 mac80211: impleme... |
608 |
case WLAN_EID_VENDOR_SPECIFIC: |
37ffc8da8 mac80211: move IE... |
609 610 611 |
if (elen >= 4 && pos[0] == 0x00 && pos[1] == 0x50 && pos[2] == 0xf2) { /* Microsoft OUI (00:50:F2) */ |
d91f36db5 mac80211: impleme... |
612 613 614 |
if (calc_crc) crc = crc32_be(crc, pos - 2, elen + 2); |
37ffc8da8 mac80211: move IE... |
615 616 617 618 619 |
if (pos[3] == 1) { /* OUI Type 1 - WPA IE */ elems->wpa = pos; elems->wpa_len = elen; } else if (elen >= 5 && pos[3] == 2) { |
d91f36db5 mac80211: impleme... |
620 |
/* OUI Type 2 - WMM IE */ |
37ffc8da8 mac80211: move IE... |
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 |
if (pos[4] == 0) { elems->wmm_info = pos; elems->wmm_info_len = elen; } else if (pos[4] == 1) { elems->wmm_param = pos; elems->wmm_param_len = elen; } } } break; case WLAN_EID_RSN: elems->rsn = pos; elems->rsn_len = elen; break; case WLAN_EID_ERP_INFO: elems->erp_info = pos; elems->erp_info_len = elen; break; case WLAN_EID_EXT_SUPP_RATES: elems->ext_supp_rates = pos; elems->ext_supp_rates_len = elen; break; case WLAN_EID_HT_CAPABILITY: |
09914813d mac80211: fix HT ... |
644 645 |
if (elen >= sizeof(struct ieee80211_ht_cap)) elems->ht_cap_elem = (void *)pos; |
37ffc8da8 mac80211: move IE... |
646 |
break; |
d9fe60dea 802.11: clean up/... |
647 648 |
case WLAN_EID_HT_INFORMATION: if (elen >= sizeof(struct ieee80211_ht_info)) |
09914813d mac80211: fix HT ... |
649 |
elems->ht_info_elem = (void *)pos; |
37ffc8da8 mac80211: move IE... |
650 651 652 653 654 655 |
break; case WLAN_EID_MESH_ID: elems->mesh_id = pos; elems->mesh_id_len = elen; break; case WLAN_EID_MESH_CONFIG: |
136cfa286 mac80211: use a s... |
656 657 |
if (elen >= sizeof(struct ieee80211_meshconf_ie)) elems->mesh_config = (void *)pos; |
37ffc8da8 mac80211: move IE... |
658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 |
break; case WLAN_EID_PEER_LINK: elems->peer_link = pos; elems->peer_link_len = elen; break; case WLAN_EID_PREQ: elems->preq = pos; elems->preq_len = elen; break; case WLAN_EID_PREP: elems->prep = pos; elems->prep_len = elen; break; case WLAN_EID_PERR: elems->perr = pos; elems->perr_len = elen; break; |
90a5e1699 mac80211: impleme... |
675 676 677 678 |
case WLAN_EID_RANN: if (elen >= sizeof(struct ieee80211_rann_ie)) elems->rann = (void *)pos; break; |
37ffc8da8 mac80211: move IE... |
679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 |
case WLAN_EID_CHANNEL_SWITCH: elems->ch_switch_elem = pos; elems->ch_switch_elem_len = elen; break; case WLAN_EID_QUIET: if (!elems->quiet_elem) { elems->quiet_elem = pos; elems->quiet_elem_len = elen; } elems->num_of_quiet_elem++; break; case WLAN_EID_COUNTRY: elems->country_elem = pos; elems->country_elem_len = elen; break; case WLAN_EID_PWR_CONSTRAINT: elems->pwr_constr_elem = pos; elems->pwr_constr_elem_len = elen; break; |
f797eb7e2 mac80211: Fix MFP... |
698 699 700 |
case WLAN_EID_TIMEOUT_INTERVAL: elems->timeout_int = pos; elems->timeout_int_len = elen; |
63a5ab822 mac80211: 802.11w... |
701 |
break; |
37ffc8da8 mac80211: move IE... |
702 703 704 705 706 707 708 |
default: break; } left -= elen; pos += elen; } |
d91f36db5 mac80211: impleme... |
709 710 |
return crc; |
37ffc8da8 mac80211: move IE... |
711 |
} |
5825fe100 mac80211: initial... |
712 713 714 715 716 |
void ieee80211_set_wmm_default(struct ieee80211_sub_if_data *sdata) { struct ieee80211_local *local = sdata->local; struct ieee80211_tx_queue_params qparam; |
aa837e1d6 mac80211: set def... |
717 718 719 |
int queue; bool use_11b; int aCWmin, aCWmax; |
5825fe100 mac80211: initial... |
720 721 722 723 724 |
if (!local->ops->conf_tx) return; memset(&qparam, 0, sizeof(qparam)); |
aa837e1d6 mac80211: set def... |
725 726 |
use_11b = (local->hw.conf.channel->band == IEEE80211_BAND_2GHZ) && !(sdata->flags & IEEE80211_SDATA_OPERATING_GMODE); |
5825fe100 mac80211: initial... |
727 |
|
aa837e1d6 mac80211: set def... |
728 729 730 731 732 733 734 735 736 737 |
for (queue = 0; queue < local_to_hw(local)->queues; queue++) { /* Set defaults according to 802.11-2007 Table 7-37 */ aCWmax = 1023; if (use_11b) aCWmin = 31; else aCWmin = 15; switch (queue) { case 3: /* AC_BK */ |
7ba10a8ef mac80211: fix tra... |
738 739 |
qparam.cw_max = aCWmax; qparam.cw_min = aCWmin; |
aa837e1d6 mac80211: set def... |
740 741 742 743 744 |
qparam.txop = 0; qparam.aifs = 7; break; default: /* never happens but let's not leave undefined */ case 2: /* AC_BE */ |
7ba10a8ef mac80211: fix tra... |
745 746 |
qparam.cw_max = aCWmax; qparam.cw_min = aCWmin; |
aa837e1d6 mac80211: set def... |
747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 |
qparam.txop = 0; qparam.aifs = 3; break; case 1: /* AC_VI */ qparam.cw_max = aCWmin; qparam.cw_min = (aCWmin + 1) / 2 - 1; if (use_11b) qparam.txop = 6016/32; else qparam.txop = 3008/32; qparam.aifs = 2; break; case 0: /* AC_VO */ qparam.cw_max = (aCWmin + 1) / 2 - 1; qparam.cw_min = (aCWmin + 1) / 4 - 1; if (use_11b) qparam.txop = 3264/32; else qparam.txop = 1504/32; qparam.aifs = 2; break; } |
5825fe100 mac80211: initial... |
769 |
|
ab13315af mac80211: add U-A... |
770 |
qparam.uapsd = false; |
aa837e1d6 mac80211: set def... |
771 772 |
drv_conf_tx(local, queue, &qparam); } |
e1b3ec1a2 mac80211: explici... |
773 774 775 |
/* after reinitialize QoS TX queues setting to default, * disable QoS at all */ |
d97349797 mac80211: Don't s... |
776 777 778 779 780 781 |
if (sdata->vif.type != NL80211_IFTYPE_MONITOR) { sdata->vif.bss_conf.qos = sdata->vif.type != NL80211_IFTYPE_STATION; ieee80211_bss_info_change_notify(sdata, BSS_CHANGED_QOS); } |
5825fe100 mac80211: initial... |
782 |
} |
e50db65c0 mac80211: move fr... |
783 |
|
469002983 mac80211: split I... |
784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 |
void ieee80211_sta_def_wmm_params(struct ieee80211_sub_if_data *sdata, const size_t supp_rates_len, const u8 *supp_rates) { struct ieee80211_local *local = sdata->local; int i, have_higher_than_11mbit = 0; /* cf. IEEE 802.11 9.2.12 */ for (i = 0; i < supp_rates_len; i++) if ((supp_rates[i] & 0x7f) * 5 > 110) have_higher_than_11mbit = 1; if (local->hw.conf.channel->band == IEEE80211_BAND_2GHZ && have_higher_than_11mbit) sdata->flags |= IEEE80211_SDATA_OPERATING_GMODE; else sdata->flags &= ~IEEE80211_SDATA_OPERATING_GMODE; ieee80211_set_wmm_default(sdata); } |
881d948c2 wireless: restric... |
804 |
u32 ieee80211_mandatory_rates(struct ieee80211_local *local, |
96dd22ac0 mac80211: inform ... |
805 806 807 808 |
enum ieee80211_band band) { struct ieee80211_supported_band *sband; struct ieee80211_rate *bitrates; |
881d948c2 wireless: restric... |
809 |
u32 mandatory_rates; |
96dd22ac0 mac80211: inform ... |
810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 |
enum ieee80211_rate_flags mandatory_flag; int i; sband = local->hw.wiphy->bands[band]; if (!sband) { WARN_ON(1); sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; } if (band == IEEE80211_BAND_2GHZ) mandatory_flag = IEEE80211_RATE_MANDATORY_B; else mandatory_flag = IEEE80211_RATE_MANDATORY_A; bitrates = sband->bitrates; mandatory_rates = 0; for (i = 0; i < sband->n_bitrates; i++) if (bitrates[i].flags & mandatory_flag) mandatory_rates |= BIT(i); return mandatory_rates; } |
469002983 mac80211: split I... |
831 832 833 |
void ieee80211_send_auth(struct ieee80211_sub_if_data *sdata, u16 transaction, u16 auth_alg, |
fffd0934b cfg80211: rework ... |
834 835 |
u8 *extra, size_t extra_len, const u8 *bssid, const u8 *key, u8 key_len, u8 key_idx) |
469002983 mac80211: split I... |
836 837 838 839 |
{ struct ieee80211_local *local = sdata->local; struct sk_buff *skb; struct ieee80211_mgmt *mgmt; |
fffd0934b cfg80211: rework ... |
840 |
int err; |
469002983 mac80211: split I... |
841 842 |
skb = dev_alloc_skb(local->hw.extra_tx_headroom + |
65fc73ac4 nl80211: Remove N... |
843 |
sizeof(*mgmt) + 6 + extra_len); |
469002983 mac80211: split I... |
844 845 |
if (!skb) { printk(KERN_DEBUG "%s: failed to allocate buffer for auth " |
47846c9b0 mac80211: reduce ... |
846 847 |
"frame ", sdata->name); |
469002983 mac80211: split I... |
848 849 850 851 852 853 854 855 |
return; } skb_reserve(skb, local->hw.extra_tx_headroom); mgmt = (struct ieee80211_mgmt *) skb_put(skb, 24 + 6); memset(mgmt, 0, 24 + 6); mgmt->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_AUTH); |
469002983 mac80211: split I... |
856 |
memcpy(mgmt->da, bssid, ETH_ALEN); |
47846c9b0 mac80211: reduce ... |
857 |
memcpy(mgmt->sa, sdata->vif.addr, ETH_ALEN); |
469002983 mac80211: split I... |
858 859 860 861 862 863 |
memcpy(mgmt->bssid, bssid, ETH_ALEN); mgmt->u.auth.auth_alg = cpu_to_le16(auth_alg); mgmt->u.auth.auth_transaction = cpu_to_le16(transaction); mgmt->u.auth.status_code = cpu_to_le16(0); if (extra) memcpy(skb_put(skb, extra_len), extra, extra_len); |
469002983 mac80211: split I... |
864 |
|
fffd0934b cfg80211: rework ... |
865 866 867 868 869 |
if (auth_alg == WLAN_AUTH_SHARED_KEY && transaction == 3) { mgmt->frame_control |= cpu_to_le16(IEEE80211_FCTL_PROTECTED); err = ieee80211_wep_encrypt(local, skb, key, key_len, key_idx); WARN_ON(err); } |
62ae67be3 mac80211: remove ... |
870 871 |
IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; ieee80211_tx_skb(sdata, skb); |
469002983 mac80211: split I... |
872 |
} |
de95a54b1 mac80211: pass al... |
873 |
int ieee80211_build_preq_ies(struct ieee80211_local *local, u8 *buffer, |
4d36ec582 mac80211: split h... |
874 |
const u8 *ie, size_t ie_len, |
651b52254 mac80211: Add DS ... |
875 876 |
enum ieee80211_band band, u32 rate_mask, u8 channel) |
de95a54b1 mac80211: pass al... |
877 878 |
{ struct ieee80211_supported_band *sband; |
8e664fb3f mac80211: split u... |
879 880 881 |
u8 *pos; size_t offset = 0, noffset; int supp_rates_len, i; |
8dcb20038 mac80211: Filter ... |
882 883 884 |
u8 rates[32]; int num_rates; int ext_rates_len; |
de95a54b1 mac80211: pass al... |
885 |
|
4d36ec582 mac80211: split h... |
886 |
sband = local->hw.wiphy->bands[band]; |
de95a54b1 mac80211: pass al... |
887 888 |
pos = buffer; |
8dcb20038 mac80211: Filter ... |
889 890 891 892 893 894 895 896 |
num_rates = 0; for (i = 0; i < sband->n_bitrates; i++) { if ((BIT(i) & rate_mask) == 0) continue; /* skip rate */ rates[num_rates++] = (u8) (sband->bitrates[i].bitrate / 5); } supp_rates_len = min_t(int, num_rates, 8); |
8e664fb3f mac80211: split u... |
897 |
|
de95a54b1 mac80211: pass al... |
898 |
*pos++ = WLAN_EID_SUPP_RATES; |
8e664fb3f mac80211: split u... |
899 |
*pos++ = supp_rates_len; |
8dcb20038 mac80211: Filter ... |
900 901 |
memcpy(pos, rates, supp_rates_len); pos += supp_rates_len; |
8e664fb3f mac80211: split u... |
902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 |
/* insert "request information" if in custom IEs */ if (ie && ie_len) { static const u8 before_extrates[] = { WLAN_EID_SSID, WLAN_EID_SUPP_RATES, WLAN_EID_REQUEST, }; noffset = ieee80211_ie_split(ie, ie_len, before_extrates, ARRAY_SIZE(before_extrates), offset); memcpy(pos, ie + offset, noffset - offset); pos += noffset - offset; offset = noffset; } |
8dcb20038 mac80211: Filter ... |
918 919 |
ext_rates_len = num_rates - supp_rates_len; if (ext_rates_len > 0) { |
8e664fb3f mac80211: split u... |
920 |
*pos++ = WLAN_EID_EXT_SUPP_RATES; |
8dcb20038 mac80211: Filter ... |
921 922 923 |
*pos++ = ext_rates_len; memcpy(pos, rates + supp_rates_len, ext_rates_len); pos += ext_rates_len; |
8e664fb3f mac80211: split u... |
924 |
} |
651b52254 mac80211: Add DS ... |
925 926 927 928 929 |
if (channel && sband->band == IEEE80211_BAND_2GHZ) { *pos++ = WLAN_EID_DS_PARAMS; *pos++ = 1; *pos++ = channel; } |
8e664fb3f mac80211: split u... |
930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 |
/* insert custom IEs that go before HT */ if (ie && ie_len) { static const u8 before_ht[] = { WLAN_EID_SSID, WLAN_EID_SUPP_RATES, WLAN_EID_REQUEST, WLAN_EID_EXT_SUPP_RATES, WLAN_EID_DS_PARAMS, WLAN_EID_SUPPORTED_REGULATORY_CLASSES, }; noffset = ieee80211_ie_split(ie, ie_len, before_ht, ARRAY_SIZE(before_ht), offset); memcpy(pos, ie + offset, noffset - offset); pos += noffset - offset; offset = noffset; |
de95a54b1 mac80211: pass al... |
946 |
} |
5ef2d41af mac80211: include... |
947 |
if (sband->ht_cap.ht_supported) { |
f38fd12fa mac80211: allow d... |
948 949 |
u16 cap = sband->ht_cap.cap; __le16 tmp; |
5ef2d41af mac80211: include... |
950 951 952 |
*pos++ = WLAN_EID_HT_CAPABILITY; *pos++ = sizeof(struct ieee80211_ht_cap); memset(pos, 0, sizeof(struct ieee80211_ht_cap)); |
f38fd12fa mac80211: allow d... |
953 |
tmp = cpu_to_le16(cap); |
5ef2d41af mac80211: include... |
954 955 |
memcpy(pos, &tmp, sizeof(u16)); pos += sizeof(u16); |
5ef2d41af mac80211: include... |
956 |
*pos++ = sband->ht_cap.ampdu_factor | |
f38fd12fa mac80211: allow d... |
957 958 |
(sband->ht_cap.ampdu_density << IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT); |
5ef2d41af mac80211: include... |
959 960 961 962 |
memcpy(pos, &sband->ht_cap.mcs, sizeof(sband->ht_cap.mcs)); pos += sizeof(sband->ht_cap.mcs); pos += 2 + 4 + 1; /* ext info, BF cap, antsel */ } |
de95a54b1 mac80211: pass al... |
963 964 965 966 |
/* * If adding more here, adjust code in main.c * that calculates local->scan_ies_len. */ |
8e664fb3f mac80211: split u... |
967 968 969 970 971 |
/* add any remaining custom IEs */ if (ie && ie_len) { noffset = ie_len; memcpy(pos, ie + offset, noffset - offset); pos += noffset - offset; |
de95a54b1 mac80211: pass al... |
972 973 974 975 |
} return pos - buffer; } |
a619a4c0e mac80211: Add fun... |
976 977 978 979 |
struct sk_buff *ieee80211_build_probe_req(struct ieee80211_sub_if_data *sdata, u8 *dst, const u8 *ssid, size_t ssid_len, const u8 *ie, size_t ie_len) |
469002983 mac80211: split I... |
980 981 |
{ struct ieee80211_local *local = sdata->local; |
469002983 mac80211: split I... |
982 983 |
struct sk_buff *skb; struct ieee80211_mgmt *mgmt; |
7c12ce8b8 mac80211: use Pro... |
984 985 |
size_t buf_len; u8 *buf; |
651b52254 mac80211: Add DS ... |
986 |
u8 chan; |
7c12ce8b8 mac80211: use Pro... |
987 988 989 990 991 992 993 |
/* FIXME: come up with a proper value */ buf = kmalloc(200 + ie_len, GFP_KERNEL); if (!buf) { printk(KERN_DEBUG "%s: failed to allocate temporary IE " "buffer ", sdata->name); |
a619a4c0e mac80211: Add fun... |
994 |
return NULL; |
469002983 mac80211: split I... |
995 |
} |
469002983 mac80211: split I... |
996 |
|
651b52254 mac80211: Add DS ... |
997 998 |
chan = ieee80211_frequency_to_channel( local->hw.conf.channel->center_freq); |
7c12ce8b8 mac80211: use Pro... |
999 |
buf_len = ieee80211_build_preq_ies(local, buf, ie, ie_len, |
8dcb20038 mac80211: Filter ... |
1000 1001 |
local->hw.conf.channel->band, sdata->rc_rateidx_mask |
651b52254 mac80211: Add DS ... |
1002 1003 |
[local->hw.conf.channel->band], chan); |
7c12ce8b8 mac80211: use Pro... |
1004 1005 1006 1007 |
skb = ieee80211_probereq_get(&local->hw, &sdata->vif, ssid, ssid_len, buf, buf_len); |
469002983 mac80211: split I... |
1008 |
if (dst) { |
7c12ce8b8 mac80211: use Pro... |
1009 |
mgmt = (struct ieee80211_mgmt *) skb->data; |
469002983 mac80211: split I... |
1010 1011 |
memcpy(mgmt->da, dst, ETH_ALEN); memcpy(mgmt->bssid, dst, ETH_ALEN); |
469002983 mac80211: split I... |
1012 |
} |
469002983 mac80211: split I... |
1013 |
|
62ae67be3 mac80211: remove ... |
1014 |
IEEE80211_SKB_CB(skb)->flags |= IEEE80211_TX_INTFL_DONT_ENCRYPT; |
145b6d1a5 mac80211: fix mem... |
1015 |
kfree(buf); |
a619a4c0e mac80211: Add fun... |
1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 |
return skb; } void ieee80211_send_probe_req(struct ieee80211_sub_if_data *sdata, u8 *dst, const u8 *ssid, size_t ssid_len, const u8 *ie, size_t ie_len) { struct sk_buff *skb; skb = ieee80211_build_probe_req(sdata, dst, ssid, ssid_len, ie, ie_len); if (skb) ieee80211_tx_skb(sdata, skb); |
469002983 mac80211: split I... |
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 |
} u32 ieee80211_sta_get_rates(struct ieee80211_local *local, struct ieee802_11_elems *elems, enum ieee80211_band band) { struct ieee80211_supported_band *sband; struct ieee80211_rate *bitrates; size_t num_rates; u32 supp_rates; int i, j; sband = local->hw.wiphy->bands[band]; if (!sband) { WARN_ON(1); sband = local->hw.wiphy->bands[local->hw.conf.channel->band]; } bitrates = sband->bitrates; num_rates = sband->n_bitrates; supp_rates = 0; for (i = 0; i < elems->supp_rates_len + elems->ext_supp_rates_len; i++) { u8 rate = 0; int own_rate; if (i < elems->supp_rates_len) rate = elems->supp_rates[i]; else if (elems->ext_supp_rates) rate = elems->ext_supp_rates [i - elems->supp_rates_len]; own_rate = 5 * (rate & 0x7f); for (j = 0; j < num_rates; j++) if (bitrates[j].bitrate == own_rate) supp_rates |= BIT(j); } return supp_rates; } |
f2753ddba mac80211: add har... |
1066 |
|
84f6a01ce mac80211: fix con... |
1067 1068 1069 |
void ieee80211_stop_device(struct ieee80211_local *local) { ieee80211_led_radio(local, false); |
67408c8c7 mac80211: selecti... |
1070 |
ieee80211_mod_tpt_led_trig(local, 0, IEEE80211_TPT_LEDTRIG_FL_RADIO); |
84f6a01ce mac80211: fix con... |
1071 1072 |
cancel_work_sync(&local->reconfig_filter); |
84f6a01ce mac80211: fix con... |
1073 1074 |
flush_workqueue(local->workqueue); |
678f415fd mac80211: flush w... |
1075 |
drv_stop(local); |
84f6a01ce mac80211: fix con... |
1076 |
} |
f2753ddba mac80211: add har... |
1077 1078 1079 1080 |
int ieee80211_reconfig(struct ieee80211_local *local) { struct ieee80211_hw *hw = &local->hw; struct ieee80211_sub_if_data *sdata; |
f2753ddba mac80211: add har... |
1081 |
struct sta_info *sta; |
f2753ddba mac80211: add har... |
1082 |
int res; |
5bb644a0f mac80211: cancel/... |
1083 |
|
eecc48000 mac80211: add bas... |
1084 |
#ifdef CONFIG_PM |
ceb99fe07 mac80211: fix resume |
1085 1086 |
if (local->suspended) local->resuming = true; |
f2753ddba mac80211: add har... |
1087 |
|
eecc48000 mac80211: add bas... |
1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 |
if (local->wowlan) { local->wowlan = false; res = drv_resume(local); if (res < 0) { local->resuming = false; return res; } if (res == 0) goto wake_up; WARN_ON(res > 1); /* * res is 1, which means the driver requested * to go through a regular reset on wakeup. */ } #endif |
f2753ddba mac80211: add har... |
1104 1105 |
/* restart hardware */ if (local->open_count) { |
24feda008 mac80211: fix pro... |
1106 1107 1108 1109 1110 1111 |
/* * Upon resume hardware can sometimes be goofy due to * various platform / driver / bus issues, so restarting * the device may at times not work immediately. Propagate * the error. */ |
244879813 mac80211: add dri... |
1112 |
res = drv_start(local); |
24feda008 mac80211: fix pro... |
1113 |
if (res) { |
c7a00dc73 mac80211: correct... |
1114 1115 1116 1117 |
WARN(local->suspended, "Hardware became unavailable " "upon resume. This could be a software issue " "prior to suspend or a hardware issue. "); |
24feda008 mac80211: fix pro... |
1118 1119 |
return res; } |
f2753ddba mac80211: add har... |
1120 |
|
1f87f7d3a cfg80211: add rfk... |
1121 |
ieee80211_led_radio(local, true); |
67408c8c7 mac80211: selecti... |
1122 1123 |
ieee80211_mod_tpt_led_trig(local, IEEE80211_TPT_LEDTRIG_FL_RADIO, 0); |
f2753ddba mac80211: add har... |
1124 1125 1126 1127 1128 1129 |
} /* add interfaces */ list_for_each_entry(sdata, &local->interfaces, list) { if (sdata->vif.type != NL80211_IFTYPE_AP_VLAN && sdata->vif.type != NL80211_IFTYPE_MONITOR && |
1ed32e4fc mac80211: remove ... |
1130 1131 |
ieee80211_sdata_running(sdata)) res = drv_add_interface(local, &sdata->vif); |
f2753ddba mac80211: add har... |
1132 1133 1134 |
} /* add STAs back */ |
34e895075 mac80211: allow s... |
1135 1136 1137 |
mutex_lock(&local->sta_mtx); list_for_each_entry(sta, &local->sta_list, list) { if (sta->uploaded) { |
5bb644a0f mac80211: cancel/... |
1138 |
sdata = sta->sdata; |
f2753ddba mac80211: add har... |
1139 1140 1141 1142 |
if (sdata->vif.type == NL80211_IFTYPE_AP_VLAN) sdata = container_of(sdata->bss, struct ieee80211_sub_if_data, u.ap); |
34e895075 mac80211: allow s... |
1143 |
WARN_ON(drv_sta_add(local, sdata, &sta->sta)); |
f2753ddba mac80211: add har... |
1144 |
} |
f2753ddba mac80211: add har... |
1145 |
} |
34e895075 mac80211: allow s... |
1146 |
mutex_unlock(&local->sta_mtx); |
f2753ddba mac80211: add har... |
1147 |
|
f23a47807 mac80211: support... |
1148 1149 |
/* setup fragmentation threshold */ drv_set_frag_threshold(local, hw->wiphy->frag_threshold); |
f2753ddba mac80211: add har... |
1150 |
/* setup RTS threshold */ |
244879813 mac80211: add dri... |
1151 |
drv_set_rts_threshold(local, hw->wiphy->rts_threshold); |
f2753ddba mac80211: add har... |
1152 1153 1154 |
/* reconfigure hardware */ ieee80211_hw_config(local, ~0); |
f2753ddba mac80211: add har... |
1155 |
ieee80211_configure_filter(local); |
f2753ddba mac80211: add har... |
1156 1157 1158 |
/* Finally also reconfigure all the BSS information */ list_for_each_entry(sdata, &local->interfaces, list) { |
ac8dd506e mac80211: fix BSS... |
1159 |
u32 changed; |
9607e6b66 mac80211: add iee... |
1160 |
if (!ieee80211_sdata_running(sdata)) |
f2753ddba mac80211: add har... |
1161 |
continue; |
ac8dd506e mac80211: fix BSS... |
1162 1163 1164 1165 1166 1167 1168 1169 1170 |
/* common change flags for all interface types */ changed = BSS_CHANGED_ERP_CTS_PROT | BSS_CHANGED_ERP_PREAMBLE | BSS_CHANGED_ERP_SLOT | BSS_CHANGED_HT | BSS_CHANGED_BASIC_RATES | BSS_CHANGED_BEACON_INT | BSS_CHANGED_BSSID | |
4ced3f74d mac80211: move Qo... |
1171 1172 |
BSS_CHANGED_CQM | BSS_CHANGED_QOS; |
ac8dd506e mac80211: fix BSS... |
1173 |
|
f2753ddba mac80211: add har... |
1174 1175 |
switch (sdata->vif.type) { case NL80211_IFTYPE_STATION: |
ac8dd506e mac80211: fix BSS... |
1176 |
changed |= BSS_CHANGED_ASSOC; |
a7b545f7f mac80211: add mis... |
1177 |
mutex_lock(&sdata->u.mgd.mtx); |
ac8dd506e mac80211: fix BSS... |
1178 |
ieee80211_bss_info_change_notify(sdata, changed); |
a7b545f7f mac80211: add mis... |
1179 |
mutex_unlock(&sdata->u.mgd.mtx); |
ac8dd506e mac80211: fix BSS... |
1180 |
break; |
f2753ddba mac80211: add har... |
1181 |
case NL80211_IFTYPE_ADHOC: |
ac8dd506e mac80211: fix BSS... |
1182 1183 |
changed |= BSS_CHANGED_IBSS; /* fall through */ |
f2753ddba mac80211: add har... |
1184 1185 |
case NL80211_IFTYPE_AP: case NL80211_IFTYPE_MESH_POINT: |
ac8dd506e mac80211: fix BSS... |
1186 1187 |
changed |= BSS_CHANGED_BEACON | BSS_CHANGED_BEACON_ENABLED; |
2d0ddec5b mac80211: unify c... |
1188 |
ieee80211_bss_info_change_notify(sdata, changed); |
f2753ddba mac80211: add har... |
1189 1190 1191 1192 1193 1194 1195 1196 |
break; case NL80211_IFTYPE_WDS: break; case NL80211_IFTYPE_AP_VLAN: case NL80211_IFTYPE_MONITOR: /* ignore virtual */ break; case NL80211_IFTYPE_UNSPECIFIED: |
2e161f78e cfg80211/mac80211... |
1197 |
case NUM_NL80211_IFTYPES: |
2ca27bcff mac80211: add p2p... |
1198 1199 |
case NL80211_IFTYPE_P2P_CLIENT: case NL80211_IFTYPE_P2P_GO: |
f2753ddba mac80211: add har... |
1200 1201 1202 1203 |
WARN_ON(1); break; } } |
2a419056c mac80211: simplif... |
1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 |
/* * Clear the WLAN_STA_BLOCK_BA flag so new aggregation * sessions can be established after a resume. * * Also tear down aggregation sessions since reconfiguring * them in a hardware restart scenario is not easily done * right now, and the hardware will have lost information * about the sessions, but we and the AP still think they * are active. This is really a workaround though. */ |
74e2bd1fa mac80211: tear do... |
1214 |
if (hw->flags & IEEE80211_HW_AMPDU_AGGREGATION) { |
2a419056c mac80211: simplif... |
1215 1216 1217 |
mutex_lock(&local->sta_mtx); list_for_each_entry(sta, &local->sta_list, list) { |
53f73c09d mac80211: avoid t... |
1218 |
ieee80211_sta_tear_down_BA_sessions(sta, true); |
2a419056c mac80211: simplif... |
1219 |
clear_sta_flags(sta, WLAN_STA_BLOCK_BA); |
74e2bd1fa mac80211: tear do... |
1220 |
} |
2a419056c mac80211: simplif... |
1221 1222 |
mutex_unlock(&local->sta_mtx); |
74e2bd1fa mac80211: tear do... |
1223 |
} |
74e2bd1fa mac80211: tear do... |
1224 |
|
f2753ddba mac80211: add har... |
1225 1226 |
/* add back keys */ list_for_each_entry(sdata, &local->interfaces, list) |
9607e6b66 mac80211: add iee... |
1227 |
if (ieee80211_sdata_running(sdata)) |
f2753ddba mac80211: add har... |
1228 |
ieee80211_enable_keys(sdata); |
eecc48000 mac80211: add bas... |
1229 |
wake_up: |
f2753ddba mac80211: add har... |
1230 1231 |
ieee80211_wake_queues_by_reason(hw, IEEE80211_QUEUE_STOP_REASON_SUSPEND); |
5bb644a0f mac80211: cancel/... |
1232 1233 1234 1235 |
/* * If this is for hw restart things are still running. * We may want to change that later, however. */ |
ceb99fe07 mac80211: fix resume |
1236 |
if (!local->suspended) |
5bb644a0f mac80211: cancel/... |
1237 1238 1239 |
return 0; #ifdef CONFIG_PM |
ceb99fe07 mac80211: fix resume |
1240 |
/* first set suspended false, then resuming */ |
5bb644a0f mac80211: cancel/... |
1241 |
local->suspended = false; |
ceb99fe07 mac80211: fix resume |
1242 1243 |
mb(); local->resuming = false; |
5bb644a0f mac80211: cancel/... |
1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 |
list_for_each_entry(sdata, &local->interfaces, list) { switch(sdata->vif.type) { case NL80211_IFTYPE_STATION: ieee80211_sta_restart(sdata); break; case NL80211_IFTYPE_ADHOC: ieee80211_ibss_restart(sdata); break; case NL80211_IFTYPE_MESH_POINT: ieee80211_mesh_restart(sdata); break; default: break; } } |
26d59535a mac80211: clean u... |
1260 |
mod_timer(&local->sta_cleanup, jiffies + 1); |
5bb644a0f mac80211: cancel/... |
1261 |
|
34e895075 mac80211: allow s... |
1262 |
mutex_lock(&local->sta_mtx); |
5bb644a0f mac80211: cancel/... |
1263 1264 |
list_for_each_entry(sta, &local->sta_list, list) mesh_plink_restart(sta); |
34e895075 mac80211: allow s... |
1265 |
mutex_unlock(&local->sta_mtx); |
5bb644a0f mac80211: cancel/... |
1266 1267 1268 |
#else WARN_ON(1); #endif |
f2753ddba mac80211: add har... |
1269 1270 |
return 0; } |
42935ecaf mac80211: redefin... |
1271 |
|
0f78231bf mac80211: enable ... |
1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 |
static int check_mgd_smps(struct ieee80211_if_managed *ifmgd, enum ieee80211_smps_mode *smps_mode) { if (ifmgd->associated) { *smps_mode = ifmgd->ap_smps; if (*smps_mode == IEEE80211_SMPS_AUTOMATIC) { if (ifmgd->powersave) *smps_mode = IEEE80211_SMPS_DYNAMIC; else *smps_mode = IEEE80211_SMPS_OFF; } return 1; } return 0; } /* must hold iflist_mtx */ |
025e6be22 mac80211: fix dea... |
1292 |
void ieee80211_recalc_smps(struct ieee80211_local *local) |
0f78231bf mac80211: enable ... |
1293 1294 1295 1296 |
{ struct ieee80211_sub_if_data *sdata; enum ieee80211_smps_mode smps_mode = IEEE80211_SMPS_OFF; int count = 0; |
46a5ebaf0 cfg80211/mac80211... |
1297 |
lockdep_assert_held(&local->iflist_mtx); |
0f78231bf mac80211: enable ... |
1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 |
/* * This function could be improved to handle multiple * interfaces better, but right now it makes any * non-station interfaces force SM PS to be turned * off. If there are multiple station interfaces it * could also use the best possible mode, e.g. if * one is in static and the other in dynamic then * dynamic is ok. */ list_for_each_entry(sdata, &local->interfaces, list) { |
26a58456b mac80211: switch ... |
1310 |
if (!ieee80211_sdata_running(sdata)) |
0f78231bf mac80211: enable ... |
1311 1312 1313 |
continue; if (sdata->vif.type != NL80211_IFTYPE_STATION) goto set; |
025e6be22 mac80211: fix dea... |
1314 1315 |
count += check_mgd_smps(&sdata->u.mgd, &smps_mode); |
0f78231bf mac80211: enable ... |
1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 |
if (count > 1) { smps_mode = IEEE80211_SMPS_OFF; break; } } if (smps_mode == local->smps_mode) return; set: local->smps_mode = smps_mode; /* changed flag is auto-detected for this */ ieee80211_hw_config(local, 0); } |
8e664fb3f mac80211: split u... |
1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 |
static bool ieee80211_id_in_list(const u8 *ids, int n_ids, u8 id) { int i; for (i = 0; i < n_ids; i++) if (ids[i] == id) return true; return false; } /** * ieee80211_ie_split - split an IE buffer according to ordering * * @ies: the IE buffer * @ielen: the length of the IE buffer * @ids: an array with element IDs that are allowed before * the split * @n_ids: the size of the element ID array * @offset: offset where to start splitting in the buffer * * This function splits an IE buffer by updating the @offset * variable to point to the location where the buffer should be * split. * * It assumes that the given IE buffer is well-formed, this * has to be guaranteed by the caller! * * It also assumes that the IEs in the buffer are ordered * correctly, if not the result of using this function will not * be ordered correctly either, i.e. it does no reordering. * * The function returns the offset where the next part of the * buffer starts, which may be @ielen if the entire (remainder) * of the buffer should be used. */ size_t ieee80211_ie_split(const u8 *ies, size_t ielen, const u8 *ids, int n_ids, size_t offset) { size_t pos = offset; while (pos < ielen && ieee80211_id_in_list(ids, n_ids, ies[pos])) pos += 2 + ies[pos + 1]; return pos; } size_t ieee80211_ie_split_vendor(const u8 *ies, size_t ielen, size_t offset) { size_t pos = offset; while (pos < ielen && ies[pos] != WLAN_EID_VENDOR_SPECIFIC) pos += 2 + ies[pos + 1]; return pos; } |