mac80211: remove unused rate function parameter
[linux-2.6-block.git] / net / mac80211 / rx.c
CommitLineData
571ecf67
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>
84040805 5 * Copyright 2007-2010 Johannes Berg <johannes@sipsolutions.net>
571ecf67
JB
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License version 2 as
9 * published by the Free Software Foundation.
10 */
11
ab46623e 12#include <linux/jiffies.h>
5a0e3ad6 13#include <linux/slab.h>
571ecf67
JB
14#include <linux/kernel.h>
15#include <linux/skbuff.h>
16#include <linux/netdevice.h>
17#include <linux/etherdevice.h>
d4e46a3d 18#include <linux/rcupdate.h>
571ecf67
JB
19#include <net/mac80211.h>
20#include <net/ieee80211_radiotap.h>
21
22#include "ieee80211_i.h"
24487981 23#include "driver-ops.h"
2c8dccc7 24#include "led.h"
33b64eb2 25#include "mesh.h"
571ecf67
JB
26#include "wep.h"
27#include "wpa.h"
28#include "tkip.h"
29#include "wme.h"
30
b2e7771e
JB
31/*
32 * monitor mode reception
33 *
34 * This function cleans up the SKB, i.e. it removes all the stuff
35 * only useful for monitoring.
36 */
37static struct sk_buff *remove_monitor_info(struct ieee80211_local *local,
0869aea0 38 struct sk_buff *skb)
b2e7771e 39{
b2e7771e
JB
40 if (local->hw.flags & IEEE80211_HW_RX_INCLUDES_FCS) {
41 if (likely(skb->len > FCS_LEN))
e3cf8b3f 42 __pskb_trim(skb, skb->len - FCS_LEN);
b2e7771e
JB
43 else {
44 /* driver bug */
45 WARN_ON(1);
46 dev_kfree_skb(skb);
47 skb = NULL;
48 }
49 }
50
51 return skb;
52}
53
f1d58c25 54static inline int should_drop_frame(struct sk_buff *skb,
0869aea0 55 int present_fcs_len)
b2e7771e 56{
f1d58c25 57 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
182503ab 58 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
b2e7771e
JB
59
60 if (status->flag & (RX_FLAG_FAILED_FCS_CRC | RX_FLAG_FAILED_PLCP_CRC))
61 return 1;
0869aea0 62 if (unlikely(skb->len < 16 + present_fcs_len))
b2e7771e 63 return 1;
87228f57
HH
64 if (ieee80211_is_ctl(hdr->frame_control) &&
65 !ieee80211_is_pspoll(hdr->frame_control) &&
66 !ieee80211_is_back_req(hdr->frame_control))
b2e7771e
JB
67 return 1;
68 return 0;
69}
70
601ae7f2
BR
71static int
72ieee80211_rx_radiotap_len(struct ieee80211_local *local,
73 struct ieee80211_rx_status *status)
74{
75 int len;
76
77 /* always present fields */
78 len = sizeof(struct ieee80211_radiotap_header) + 9;
79
80 if (status->flag & RX_FLAG_TSFT)
81 len += 8;
7fee5372 82 if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM)
601ae7f2 83 len += 1;
601ae7f2
BR
84
85 if (len & 1) /* padding for RX_FLAGS if necessary */
86 len++;
87
601ae7f2
BR
88 return len;
89}
90
d1c3a37c 91/*
601ae7f2
BR
92 * ieee80211_add_rx_radiotap_header - add radiotap header
93 *
94 * add a radiotap header containing all the fields which the hardware provided.
95 */
96static void
97ieee80211_add_rx_radiotap_header(struct ieee80211_local *local,
98 struct sk_buff *skb,
601ae7f2
BR
99 struct ieee80211_rate *rate,
100 int rtap_len)
101{
f1d58c25 102 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
601ae7f2
BR
103 struct ieee80211_radiotap_header *rthdr;
104 unsigned char *pos;
6a86b9c7 105 u16 rx_flags = 0;
601ae7f2
BR
106
107 rthdr = (struct ieee80211_radiotap_header *)skb_push(skb, rtap_len);
108 memset(rthdr, 0, rtap_len);
109
110 /* radiotap header, set always present flags */
111 rthdr->it_present =
112 cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS) |
601ae7f2
BR
113 (1 << IEEE80211_RADIOTAP_CHANNEL) |
114 (1 << IEEE80211_RADIOTAP_ANTENNA) |
115 (1 << IEEE80211_RADIOTAP_RX_FLAGS));
116 rthdr->it_len = cpu_to_le16(rtap_len);
117
118 pos = (unsigned char *)(rthdr+1);
119
120 /* the order of the following fields is important */
121
122 /* IEEE80211_RADIOTAP_TSFT */
123 if (status->flag & RX_FLAG_TSFT) {
6a86b9c7 124 put_unaligned_le64(status->mactime, pos);
601ae7f2
BR
125 rthdr->it_present |=
126 cpu_to_le32(1 << IEEE80211_RADIOTAP_TSFT);
127 pos += 8;
128 }
129
130 /* IEEE80211_RADIOTAP_FLAGS */
131 if (local->hw.flags & IEEE80211_HW_RX_INCLUDES_FCS)
132 *pos |= IEEE80211_RADIOTAP_F_FCS;
aae89831
JB
133 if (status->flag & (RX_FLAG_FAILED_FCS_CRC | RX_FLAG_FAILED_PLCP_CRC))
134 *pos |= IEEE80211_RADIOTAP_F_BADFCS;
b4f28bbb
BR
135 if (status->flag & RX_FLAG_SHORTPRE)
136 *pos |= IEEE80211_RADIOTAP_F_SHORTPRE;
601ae7f2
BR
137 pos++;
138
139 /* IEEE80211_RADIOTAP_RATE */
0fb8ca45
JM
140 if (status->flag & RX_FLAG_HT) {
141 /*
142 * TODO: add following information into radiotap header once
143 * suitable fields are defined for it:
144 * - MCS index (status->rate_idx)
145 * - HT40 (status->flag & RX_FLAG_40MHZ)
146 * - short-GI (status->flag & RX_FLAG_SHORT_GI)
147 */
148 *pos = 0;
8d6f658e 149 } else {
ebe6c7ba 150 rthdr->it_present |= cpu_to_le32(1 << IEEE80211_RADIOTAP_RATE);
0fb8ca45 151 *pos = rate->bitrate / 5;
8d6f658e 152 }
601ae7f2
BR
153 pos++;
154
155 /* IEEE80211_RADIOTAP_CHANNEL */
6a86b9c7 156 put_unaligned_le16(status->freq, pos);
601ae7f2
BR
157 pos += 2;
158 if (status->band == IEEE80211_BAND_5GHZ)
6a86b9c7
JB
159 put_unaligned_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_5GHZ,
160 pos);
5f0b7de5
JB
161 else if (status->flag & RX_FLAG_HT)
162 put_unaligned_le16(IEEE80211_CHAN_DYN | IEEE80211_CHAN_2GHZ,
163 pos);
9deb1ae5 164 else if (rate->flags & IEEE80211_RATE_ERP_G)
6a86b9c7
JB
165 put_unaligned_le16(IEEE80211_CHAN_OFDM | IEEE80211_CHAN_2GHZ,
166 pos);
601ae7f2 167 else
6a86b9c7
JB
168 put_unaligned_le16(IEEE80211_CHAN_CCK | IEEE80211_CHAN_2GHZ,
169 pos);
601ae7f2
BR
170 pos += 2;
171
172 /* IEEE80211_RADIOTAP_DBM_ANTSIGNAL */
173 if (local->hw.flags & IEEE80211_HW_SIGNAL_DBM) {
174 *pos = status->signal;
175 rthdr->it_present |=
176 cpu_to_le32(1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL);
177 pos++;
178 }
179
601ae7f2
BR
180 /* IEEE80211_RADIOTAP_LOCK_QUALITY is missing */
181
182 /* IEEE80211_RADIOTAP_ANTENNA */
183 *pos = status->antenna;
184 pos++;
185
601ae7f2
BR
186 /* IEEE80211_RADIOTAP_DB_ANTNOISE is not used */
187
188 /* IEEE80211_RADIOTAP_RX_FLAGS */
189 /* ensure 2 byte alignment for the 2 byte field as required */
6a86b9c7 190 if ((pos - (u8 *)rthdr) & 1)
601ae7f2 191 pos++;
aae89831 192 if (status->flag & RX_FLAG_FAILED_PLCP_CRC)
6a86b9c7
JB
193 rx_flags |= IEEE80211_RADIOTAP_F_RX_BADPLCP;
194 put_unaligned_le16(rx_flags, pos);
601ae7f2
BR
195 pos += 2;
196}
197
b2e7771e
JB
198/*
199 * This function copies a received frame to all monitor interfaces and
200 * returns a cleaned-up SKB that no longer includes the FCS nor the
201 * radiotap header the driver might have added.
202 */
203static struct sk_buff *
204ieee80211_rx_monitor(struct ieee80211_local *local, struct sk_buff *origskb,
8318d78a 205 struct ieee80211_rate *rate)
b2e7771e 206{
f1d58c25 207 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(origskb);
b2e7771e 208 struct ieee80211_sub_if_data *sdata;
b2e7771e 209 int needed_headroom = 0;
b2e7771e
JB
210 struct sk_buff *skb, *skb2;
211 struct net_device *prev_dev = NULL;
212 int present_fcs_len = 0;
b2e7771e
JB
213
214 /*
215 * First, we may need to make a copy of the skb because
216 * (1) we need to modify it for radiotap (if not present), and
217 * (2) the other RX handlers will modify the skb we got.
218 *
219 * We don't need to, of course, if we aren't going to return
220 * the SKB because it has a bad FCS/PLCP checksum.
221 */
0869aea0
JB
222
223 /* room for the radiotap header based on driver features */
224 needed_headroom = ieee80211_rx_radiotap_len(local, status);
b2e7771e
JB
225
226 if (local->hw.flags & IEEE80211_HW_RX_INCLUDES_FCS)
227 present_fcs_len = FCS_LEN;
228
e3cf8b3f
ZY
229 /* make sure hdr->frame_control is on the linear part */
230 if (!pskb_may_pull(origskb, 2)) {
231 dev_kfree_skb(origskb);
232 return NULL;
233 }
234
b2e7771e 235 if (!local->monitors) {
0869aea0 236 if (should_drop_frame(origskb, present_fcs_len)) {
b2e7771e
JB
237 dev_kfree_skb(origskb);
238 return NULL;
239 }
240
0869aea0 241 return remove_monitor_info(local, origskb);
b2e7771e
JB
242 }
243
0869aea0 244 if (should_drop_frame(origskb, present_fcs_len)) {
b2e7771e
JB
245 /* only need to expand headroom if necessary */
246 skb = origskb;
247 origskb = NULL;
248
249 /*
250 * This shouldn't trigger often because most devices have an
251 * RX header they pull before we get here, and that should
252 * be big enough for our radiotap information. We should
253 * probably export the length to drivers so that we can have
254 * them allocate enough headroom to start with.
255 */
256 if (skb_headroom(skb) < needed_headroom &&
c49e5ea3 257 pskb_expand_head(skb, needed_headroom, 0, GFP_ATOMIC)) {
b2e7771e
JB
258 dev_kfree_skb(skb);
259 return NULL;
260 }
261 } else {
262 /*
263 * Need to make a copy and possibly remove radiotap header
264 * and FCS from the original.
265 */
266 skb = skb_copy_expand(origskb, needed_headroom, 0, GFP_ATOMIC);
267
0869aea0 268 origskb = remove_monitor_info(local, origskb);
b2e7771e
JB
269
270 if (!skb)
271 return origskb;
272 }
273
0869aea0
JB
274 /* prepend radiotap information */
275 ieee80211_add_rx_radiotap_header(local, skb, rate, needed_headroom);
b2e7771e 276
ce3edf6d 277 skb_reset_mac_header(skb);
b2e7771e
JB
278 skb->ip_summed = CHECKSUM_UNNECESSARY;
279 skb->pkt_type = PACKET_OTHERHOST;
280 skb->protocol = htons(ETH_P_802_2);
281
282 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
05c914fe 283 if (sdata->vif.type != NL80211_IFTYPE_MONITOR)
b2e7771e
JB
284 continue;
285
3d30d949
MW
286 if (sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES)
287 continue;
288
9607e6b6 289 if (!ieee80211_sdata_running(sdata))
47846c9b
JB
290 continue;
291
b2e7771e
JB
292 if (prev_dev) {
293 skb2 = skb_clone(skb, GFP_ATOMIC);
294 if (skb2) {
295 skb2->dev = prev_dev;
5548a8a1 296 netif_receive_skb(skb2);
b2e7771e
JB
297 }
298 }
299
300 prev_dev = sdata->dev;
301 sdata->dev->stats.rx_packets++;
302 sdata->dev->stats.rx_bytes += skb->len;
303 }
304
305 if (prev_dev) {
306 skb->dev = prev_dev;
5548a8a1 307 netif_receive_skb(skb);
b2e7771e
JB
308 } else
309 dev_kfree_skb(skb);
310
311 return origskb;
312}
313
314
5cf121c3 315static void ieee80211_parse_qos(struct ieee80211_rx_data *rx)
6e0d114d 316{
238f74a2 317 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
6e0d114d
JB
318 int tid;
319
320 /* does the frame have a qos control field? */
238f74a2
HH
321 if (ieee80211_is_data_qos(hdr->frame_control)) {
322 u8 *qc = ieee80211_get_qos_ctl(hdr);
6e0d114d 323 /* frame has qos control */
238f74a2
HH
324 tid = *qc & IEEE80211_QOS_CTL_TID_MASK;
325 if (*qc & IEEE80211_QOS_CONTROL_A_MSDU_PRESENT)
5cf121c3 326 rx->flags |= IEEE80211_RX_AMSDU;
fd4c7f2f 327 else
5cf121c3 328 rx->flags &= ~IEEE80211_RX_AMSDU;
6e0d114d 329 } else {
1411f9b5
JB
330 /*
331 * IEEE 802.11-2007, 7.1.3.4.1 ("Sequence Number field"):
332 *
333 * Sequence numbers for management frames, QoS data
334 * frames with a broadcast/multicast address in the
335 * Address 1 field, and all non-QoS data frames sent
336 * by QoS STAs are assigned using an additional single
337 * modulo-4096 counter, [...]
338 *
339 * We also use that counter for non-QoS STAs.
340 */
341 tid = NUM_RX_DATA_QUEUES - 1;
6e0d114d 342 }
52865dfd 343
5cf121c3 344 rx->queue = tid;
6e0d114d
JB
345 /* Set skb->priority to 1d tag if highest order bit of TID is not set.
346 * For now, set skb->priority to 0 for other cases. */
347 rx->skb->priority = (tid > 7) ? 0 : tid;
38f3714d 348}
6e0d114d 349
d1c3a37c
JB
350/**
351 * DOC: Packet alignment
352 *
353 * Drivers always need to pass packets that are aligned to two-byte boundaries
354 * to the stack.
355 *
356 * Additionally, should, if possible, align the payload data in a way that
357 * guarantees that the contained IP header is aligned to a four-byte
358 * boundary. In the case of regular frames, this simply means aligning the
359 * payload to a four-byte boundary (because either the IP header is directly
360 * contained, or IV/RFC1042 headers that have a length divisible by four are
59d9cb07
KV
361 * in front of it). If the payload data is not properly aligned and the
362 * architecture doesn't support efficient unaligned operations, mac80211
363 * will align the data.
d1c3a37c
JB
364 *
365 * With A-MSDU frames, however, the payload data address must yield two modulo
366 * four because there are 14-byte 802.3 headers within the A-MSDU frames that
367 * push the IP header further back to a multiple of four again. Thankfully, the
368 * specs were sane enough this time around to require padding each A-MSDU
369 * subframe to a length that is a multiple of four.
370 *
371 * Padding like Atheros hardware adds which is inbetween the 802.11 header and
372 * the payload is not supported, the driver is required to move the 802.11
373 * header to be directly in front of the payload in that case.
374 */
375static void ieee80211_verify_alignment(struct ieee80211_rx_data *rx)
38f3714d 376{
59d9cb07
KV
377#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
378 WARN_ONCE((unsigned long)rx->skb->data & 1,
379 "unaligned packet at 0x%p\n", rx->skb->data);
d1c3a37c 380#endif
6e0d114d
JB
381}
382
6368e4b1 383
571ecf67
JB
384/* rx handlers */
385
49461622 386static ieee80211_rx_result debug_noinline
5cf121c3 387ieee80211_rx_h_passive_scan(struct ieee80211_rx_data *rx)
571ecf67
JB
388{
389 struct ieee80211_local *local = rx->local;
390 struct sk_buff *skb = rx->skb;
391
fbe9c429 392 if (unlikely(test_bit(SCAN_HW_SCANNING, &local->scanning)))
f1d58c25 393 return ieee80211_scan_rx(rx->sdata, skb);
ece8eddd 394
142b9f50
HS
395 if (unlikely(test_bit(SCAN_SW_SCANNING, &local->scanning) &&
396 (rx->flags & IEEE80211_RX_IN_SCAN))) {
ece8eddd 397 /* drop all the other packets during a software scan anyway */
f1d58c25 398 if (ieee80211_scan_rx(rx->sdata, skb) != RX_QUEUED)
ece8eddd 399 dev_kfree_skb(skb);
9ae54c84 400 return RX_QUEUED;
571ecf67
JB
401 }
402
5cf121c3 403 if (unlikely(rx->flags & IEEE80211_RX_IN_SCAN)) {
571ecf67
JB
404 /* scanning finished during invoking of handlers */
405 I802_DEBUG_INC(local->rx_handlers_drop_passive_scan);
e4c26add 406 return RX_DROP_UNUSABLE;
571ecf67
JB
407 }
408
9ae54c84 409 return RX_CONTINUE;
571ecf67
JB
410}
411
3cfcf6ac
JM
412
413static int ieee80211_is_unicast_robust_mgmt_frame(struct sk_buff *skb)
414{
415 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
416
417 if (skb->len < 24 || is_multicast_ether_addr(hdr->addr1))
418 return 0;
419
420 return ieee80211_is_robust_mgmt_frame(hdr);
421}
422
423
424static int ieee80211_is_multicast_robust_mgmt_frame(struct sk_buff *skb)
425{
426 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
427
428 if (skb->len < 24 || !is_multicast_ether_addr(hdr->addr1))
429 return 0;
430
431 return ieee80211_is_robust_mgmt_frame(hdr);
432}
433
434
435/* Get the BIP key index from MMIE; return -1 if this is not a BIP frame */
436static int ieee80211_get_mmie_keyidx(struct sk_buff *skb)
437{
438 struct ieee80211_mgmt *hdr = (struct ieee80211_mgmt *) skb->data;
439 struct ieee80211_mmie *mmie;
440
441 if (skb->len < 24 + sizeof(*mmie) ||
442 !is_multicast_ether_addr(hdr->da))
443 return -1;
444
445 if (!ieee80211_is_robust_mgmt_frame((struct ieee80211_hdr *) hdr))
446 return -1; /* not a robust management frame */
447
448 mmie = (struct ieee80211_mmie *)
449 (skb->data + skb->len - sizeof(*mmie));
450 if (mmie->element_id != WLAN_EID_MMIE ||
451 mmie->length != sizeof(*mmie) - 2)
452 return -1;
453
454 return le16_to_cpu(mmie->key_id);
455}
456
457
33b64eb2 458static ieee80211_rx_result
5cf121c3 459ieee80211_rx_mesh_check(struct ieee80211_rx_data *rx)
33b64eb2 460{
a7767f95
HH
461 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
462 unsigned int hdrlen = ieee80211_hdrlen(hdr->frame_control);
47846c9b 463 char *dev_addr = rx->sdata->vif.addr;
d6d1a5a7 464
a7767f95 465 if (ieee80211_is_data(hdr->frame_control)) {
3c5772a5
JC
466 if (is_multicast_ether_addr(hdr->addr1)) {
467 if (ieee80211_has_tods(hdr->frame_control) ||
468 !ieee80211_has_fromds(hdr->frame_control))
469 return RX_DROP_MONITOR;
470 if (memcmp(hdr->addr3, dev_addr, ETH_ALEN) == 0)
471 return RX_DROP_MONITOR;
472 } else {
473 if (!ieee80211_has_a4(hdr->frame_control))
474 return RX_DROP_MONITOR;
475 if (memcmp(hdr->addr4, dev_addr, ETH_ALEN) == 0)
476 return RX_DROP_MONITOR;
477 }
33b64eb2
LCC
478 }
479
480 /* If there is not an established peer link and this is not a peer link
481 * establisment frame, beacon or probe, drop the frame.
482 */
483
b4e08ea1 484 if (!rx->sta || sta_plink_state(rx->sta) != PLINK_ESTAB) {
33b64eb2 485 struct ieee80211_mgmt *mgmt;
d6d1a5a7 486
a7767f95 487 if (!ieee80211_is_mgmt(hdr->frame_control))
33b64eb2
LCC
488 return RX_DROP_MONITOR;
489
a7767f95 490 if (ieee80211_is_action(hdr->frame_control)) {
33b64eb2 491 mgmt = (struct ieee80211_mgmt *)hdr;
97ad9139 492 if (mgmt->u.action.category != WLAN_CATEGORY_MESH_PLINK)
33b64eb2 493 return RX_DROP_MONITOR;
33b64eb2 494 return RX_CONTINUE;
33b64eb2
LCC
495 }
496
a7767f95
HH
497 if (ieee80211_is_probe_req(hdr->frame_control) ||
498 ieee80211_is_probe_resp(hdr->frame_control) ||
499 ieee80211_is_beacon(hdr->frame_control))
500 return RX_CONTINUE;
501
502 return RX_DROP_MONITOR;
503
504 }
505
506#define msh_h_get(h, l) ((struct ieee80211s_hdr *) ((u8 *)h + l))
507
508 if (ieee80211_is_data(hdr->frame_control) &&
509 is_multicast_ether_addr(hdr->addr1) &&
3c5772a5 510 mesh_rmc_check(hdr->addr3, msh_h_get(hdr, hdrlen), rx->sdata))
33b64eb2 511 return RX_DROP_MONITOR;
902acc78 512#undef msh_h_get
d6d1a5a7 513
902acc78
JB
514 return RX_CONTINUE;
515}
33b64eb2 516
1edfb1af
JB
517#define SEQ_MODULO 0x1000
518#define SEQ_MASK 0xfff
519
520static inline int seq_less(u16 sq1, u16 sq2)
521{
522 return ((sq1 - sq2) & SEQ_MASK) > (SEQ_MODULO >> 1);
523}
524
525static inline u16 seq_inc(u16 sq)
526{
527 return (sq + 1) & SEQ_MASK;
528}
529
530static inline u16 seq_sub(u16 sq1, u16 sq2)
531{
532 return (sq1 - sq2) & SEQ_MASK;
533}
534
535
536static void ieee80211_release_reorder_frame(struct ieee80211_hw *hw,
537 struct tid_ampdu_rx *tid_agg_rx,
2569a826
JB
538 int index,
539 struct sk_buff_head *frames)
1edfb1af 540{
1edfb1af 541 struct sk_buff *skb = tid_agg_rx->reorder_buf[index];
1edfb1af
JB
542
543 if (!skb)
544 goto no_frame;
545
071d9ac2 546 /* release the frame from the reorder ring buffer */
1edfb1af
JB
547 tid_agg_rx->stored_mpdu_num--;
548 tid_agg_rx->reorder_buf[index] = NULL;
d29cecda 549 __skb_queue_tail(frames, skb);
1edfb1af
JB
550
551no_frame:
552 tid_agg_rx->head_seq_num = seq_inc(tid_agg_rx->head_seq_num);
553}
554
555static void ieee80211_release_reorder_frames(struct ieee80211_hw *hw,
556 struct tid_ampdu_rx *tid_agg_rx,
2569a826
JB
557 u16 head_seq_num,
558 struct sk_buff_head *frames)
1edfb1af
JB
559{
560 int index;
561
562 while (seq_less(tid_agg_rx->head_seq_num, head_seq_num)) {
563 index = seq_sub(tid_agg_rx->head_seq_num, tid_agg_rx->ssn) %
564 tid_agg_rx->buf_size;
2569a826 565 ieee80211_release_reorder_frame(hw, tid_agg_rx, index, frames);
1edfb1af
JB
566 }
567}
568
569/*
570 * Timeout (in jiffies) for skb's that are waiting in the RX reorder buffer. If
571 * the skb was added to the buffer longer than this time ago, the earlier
572 * frames that have not yet been received are assumed to be lost and the skb
573 * can be released for processing. This may also release other skb's from the
574 * reorder buffer if there are no additional gaps between the frames.
575 */
576#define HT_RX_REORDER_BUF_TIMEOUT (HZ / 10)
577
aa0c8636
CL
578static void ieee80211_sta_reorder_release(struct ieee80211_hw *hw,
579 struct tid_ampdu_rx *tid_agg_rx,
580 struct sk_buff_head *frames)
581{
582 int index;
583
584 /* release the buffer until next missing frame */
585 index = seq_sub(tid_agg_rx->head_seq_num, tid_agg_rx->ssn) %
586 tid_agg_rx->buf_size;
587 if (!tid_agg_rx->reorder_buf[index] &&
588 tid_agg_rx->stored_mpdu_num > 1) {
589 /*
590 * No buffers ready to be released, but check whether any
591 * frames in the reorder buffer have timed out.
592 */
593 int j;
594 int skipped = 1;
595 for (j = (index + 1) % tid_agg_rx->buf_size; j != index;
596 j = (j + 1) % tid_agg_rx->buf_size) {
597 if (!tid_agg_rx->reorder_buf[j]) {
598 skipped++;
599 continue;
600 }
601 if (!time_after(jiffies, tid_agg_rx->reorder_time[j] +
602 HT_RX_REORDER_BUF_TIMEOUT))
603 break;
604
605#ifdef CONFIG_MAC80211_HT_DEBUG
606 if (net_ratelimit())
607 printk(KERN_DEBUG "%s: release an RX reorder "
608 "frame due to timeout on earlier "
609 "frames\n",
610 wiphy_name(hw->wiphy));
611#endif
612 ieee80211_release_reorder_frame(hw, tid_agg_rx,
613 j, frames);
614
615 /*
616 * Increment the head seq# also for the skipped slots.
617 */
618 tid_agg_rx->head_seq_num =
619 (tid_agg_rx->head_seq_num + skipped) & SEQ_MASK;
620 skipped = 0;
621 }
622 } else while (tid_agg_rx->reorder_buf[index]) {
623 ieee80211_release_reorder_frame(hw, tid_agg_rx, index, frames);
624 index = seq_sub(tid_agg_rx->head_seq_num, tid_agg_rx->ssn) %
625 tid_agg_rx->buf_size;
626 }
627}
628
1edfb1af
JB
629/*
630 * As this function belongs to the RX path it must be under
631 * rcu_read_lock protection. It returns false if the frame
632 * can be processed immediately, true if it was consumed.
633 */
634static bool ieee80211_sta_manage_reorder_buf(struct ieee80211_hw *hw,
635 struct tid_ampdu_rx *tid_agg_rx,
2569a826
JB
636 struct sk_buff *skb,
637 struct sk_buff_head *frames)
1edfb1af
JB
638{
639 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
640 u16 sc = le16_to_cpu(hdr->seq_ctrl);
641 u16 mpdu_seq_num = (sc & IEEE80211_SCTL_SEQ) >> 4;
642 u16 head_seq_num, buf_size;
643 int index;
644
645 buf_size = tid_agg_rx->buf_size;
646 head_seq_num = tid_agg_rx->head_seq_num;
647
648 /* frame with out of date sequence number */
649 if (seq_less(mpdu_seq_num, head_seq_num)) {
650 dev_kfree_skb(skb);
651 return true;
652 }
653
654 /*
655 * If frame the sequence number exceeds our buffering window
656 * size release some previous frames to make room for this one.
657 */
658 if (!seq_less(mpdu_seq_num, head_seq_num + buf_size)) {
659 head_seq_num = seq_inc(seq_sub(mpdu_seq_num, buf_size));
660 /* release stored frames up to new head to stack */
2569a826
JB
661 ieee80211_release_reorder_frames(hw, tid_agg_rx, head_seq_num,
662 frames);
1edfb1af
JB
663 }
664
665 /* Now the new frame is always in the range of the reordering buffer */
666
667 index = seq_sub(mpdu_seq_num, tid_agg_rx->ssn) % tid_agg_rx->buf_size;
668
669 /* check if we already stored this frame */
670 if (tid_agg_rx->reorder_buf[index]) {
671 dev_kfree_skb(skb);
672 return true;
673 }
674
675 /*
676 * If the current MPDU is in the right order and nothing else
677 * is stored we can process it directly, no need to buffer it.
678 */
679 if (mpdu_seq_num == tid_agg_rx->head_seq_num &&
680 tid_agg_rx->stored_mpdu_num == 0) {
681 tid_agg_rx->head_seq_num = seq_inc(tid_agg_rx->head_seq_num);
682 return false;
683 }
684
685 /* put the frame in the reordering buffer */
686 tid_agg_rx->reorder_buf[index] = skb;
687 tid_agg_rx->reorder_time[index] = jiffies;
688 tid_agg_rx->stored_mpdu_num++;
aa0c8636 689 ieee80211_sta_reorder_release(hw, tid_agg_rx, frames);
1edfb1af
JB
690
691 return true;
692}
693
694/*
695 * Reorder MPDUs from A-MPDUs, keeping them on a buffer. Returns
696 * true if the MPDU was buffered, false if it should be processed.
697 */
2569a826
JB
698static void ieee80211_rx_reorder_ampdu(struct ieee80211_rx_data *rx,
699 struct sk_buff_head *frames)
1edfb1af 700{
2569a826
JB
701 struct sk_buff *skb = rx->skb;
702 struct ieee80211_local *local = rx->local;
1edfb1af
JB
703 struct ieee80211_hw *hw = &local->hw;
704 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *) skb->data;
2569a826 705 struct sta_info *sta = rx->sta;
1edfb1af
JB
706 struct tid_ampdu_rx *tid_agg_rx;
707 u16 sc;
708 int tid;
709
710 if (!ieee80211_is_data_qos(hdr->frame_control))
2569a826 711 goto dont_reorder;
1edfb1af
JB
712
713 /*
714 * filter the QoS data rx stream according to
715 * STA/TID and check if this STA/TID is on aggregation
716 */
717
1edfb1af 718 if (!sta)
2569a826 719 goto dont_reorder;
1edfb1af
JB
720
721 tid = *ieee80211_get_qos_ctl(hdr) & IEEE80211_QOS_CTL_TID_MASK;
722
a87f736d
JB
723 tid_agg_rx = rcu_dereference(sta->ampdu_mlme.tid_rx[tid]);
724 if (!tid_agg_rx)
725 goto dont_reorder;
1edfb1af
JB
726
727 /* qos null data frames are excluded */
728 if (unlikely(hdr->frame_control & cpu_to_le16(IEEE80211_STYPE_NULLFUNC)))
a87f736d 729 goto dont_reorder;
1edfb1af
JB
730
731 /* new, potentially un-ordered, ampdu frame - process it */
732
733 /* reset session timer */
734 if (tid_agg_rx->timeout)
735 mod_timer(&tid_agg_rx->session_timer,
736 TU_TO_EXP_TIME(tid_agg_rx->timeout));
737
738 /* if this mpdu is fragmented - terminate rx aggregation session */
739 sc = le16_to_cpu(hdr->seq_ctrl);
740 if (sc & IEEE80211_SCTL_FRAG) {
c1475ca9 741 skb->pkt_type = IEEE80211_SDATA_QUEUE_TYPE_FRAME;
344eec67
JB
742 skb_queue_tail(&rx->sdata->skb_queue, skb);
743 ieee80211_queue_work(&local->hw, &rx->sdata->work);
2569a826 744 return;
1edfb1af
JB
745 }
746
a87f736d
JB
747 /*
748 * No locking needed -- we will only ever process one
749 * RX packet at a time, and thus own tid_agg_rx. All
750 * other code manipulating it needs to (and does) make
751 * sure that we cannot get to it any more before doing
752 * anything with it.
753 */
754 if (ieee80211_sta_manage_reorder_buf(hw, tid_agg_rx, skb, frames))
2569a826
JB
755 return;
756
757 dont_reorder:
758 __skb_queue_tail(frames, skb);
1edfb1af 759}
33b64eb2 760
49461622 761static ieee80211_rx_result debug_noinline
5cf121c3 762ieee80211_rx_h_check(struct ieee80211_rx_data *rx)
571ecf67 763{
a7767f95 764 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
571ecf67
JB
765
766 /* Drop duplicate 802.11 retransmissions (IEEE 802.11 Chap. 9.2.9) */
767 if (rx->sta && !is_multicast_ether_addr(hdr->addr1)) {
a7767f95 768 if (unlikely(ieee80211_has_retry(hdr->frame_control) &&
5cf121c3 769 rx->sta->last_seq_ctrl[rx->queue] ==
571ecf67 770 hdr->seq_ctrl)) {
5cf121c3 771 if (rx->flags & IEEE80211_RX_RA_MATCH) {
571ecf67
JB
772 rx->local->dot11FrameDuplicateCount++;
773 rx->sta->num_duplicates++;
774 }
e4c26add 775 return RX_DROP_MONITOR;
571ecf67 776 } else
5cf121c3 777 rx->sta->last_seq_ctrl[rx->queue] = hdr->seq_ctrl;
571ecf67
JB
778 }
779
571ecf67
JB
780 if (unlikely(rx->skb->len < 16)) {
781 I802_DEBUG_INC(rx->local->rx_handlers_drop_short);
e4c26add 782 return RX_DROP_MONITOR;
571ecf67
JB
783 }
784
571ecf67
JB
785 /* Drop disallowed frame classes based on STA auth/assoc state;
786 * IEEE 802.11, Chap 5.5.
787 *
ccd7b362
JB
788 * mac80211 filters only based on association state, i.e. it drops
789 * Class 3 frames from not associated stations. hostapd sends
571ecf67
JB
790 * deauth/disassoc frames when needed. In addition, hostapd is
791 * responsible for filtering on both auth and assoc states.
792 */
33b64eb2 793
902acc78 794 if (ieee80211_vif_is_mesh(&rx->sdata->vif))
33b64eb2 795 return ieee80211_rx_mesh_check(rx);
33b64eb2 796
a7767f95
HH
797 if (unlikely((ieee80211_is_data(hdr->frame_control) ||
798 ieee80211_is_pspoll(hdr->frame_control)) &&
05c914fe 799 rx->sdata->vif.type != NL80211_IFTYPE_ADHOC &&
07346f81 800 (!rx->sta || !test_sta_flags(rx->sta, WLAN_STA_ASSOC)))) {
a7767f95
HH
801 if ((!ieee80211_has_fromds(hdr->frame_control) &&
802 !ieee80211_has_tods(hdr->frame_control) &&
803 ieee80211_is_data(hdr->frame_control)) ||
804 !(rx->flags & IEEE80211_RX_RA_MATCH)) {
571ecf67
JB
805 /* Drop IBSS frames and frames for other hosts
806 * silently. */
e4c26add 807 return RX_DROP_MONITOR;
571ecf67
JB
808 }
809
e4c26add 810 return RX_DROP_MONITOR;
571ecf67
JB
811 }
812
9ae54c84 813 return RX_CONTINUE;
570bd537
JB
814}
815
816
49461622 817static ieee80211_rx_result debug_noinline
5cf121c3 818ieee80211_rx_h_decrypt(struct ieee80211_rx_data *rx)
570bd537 819{
eb9fb5b8
JB
820 struct sk_buff *skb = rx->skb;
821 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
822 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
3017b80b
JB
823 int keyidx;
824 int hdrlen;
e4c26add 825 ieee80211_rx_result result = RX_DROP_UNUSABLE;
d4e46a3d 826 struct ieee80211_key *stakey = NULL;
3cfcf6ac 827 int mmie_keyidx = -1;
761ab470 828 __le16 fc;
570bd537 829
3017b80b
JB
830 /*
831 * Key selection 101
832 *
3cfcf6ac 833 * There are four types of keys:
3017b80b 834 * - GTK (group keys)
3cfcf6ac 835 * - IGTK (group keys for management frames)
3017b80b
JB
836 * - PTK (pairwise keys)
837 * - STK (station-to-station pairwise keys)
838 *
839 * When selecting a key, we have to distinguish between multicast
840 * (including broadcast) and unicast frames, the latter can only
3cfcf6ac
JM
841 * use PTKs and STKs while the former always use GTKs and IGTKs.
842 * Unless, of course, actual WEP keys ("pre-RSNA") are used, then
843 * unicast frames can also use key indices like GTKs. Hence, if we
844 * don't have a PTK/STK we check the key index for a WEP key.
3017b80b 845 *
8dc06a1c
JB
846 * Note that in a regular BSS, multicast frames are sent by the
847 * AP only, associated stations unicast the frame to the AP first
848 * which then multicasts it on their behalf.
849 *
3017b80b
JB
850 * There is also a slight problem in IBSS mode: GTKs are negotiated
851 * with each station, that is something we don't currently handle.
8dc06a1c
JB
852 * The spec seems to expect that one negotiates the same key with
853 * every station but there's no such requirement; VLANs could be
854 * possible.
3017b80b
JB
855 */
856
3017b80b 857 /*
1990af8d 858 * No point in finding a key and decrypting if the frame is neither
3017b80b
JB
859 * addressed to us nor a multicast frame.
860 */
5cf121c3 861 if (!(rx->flags & IEEE80211_RX_RA_MATCH))
9ae54c84 862 return RX_CONTINUE;
3017b80b 863
2569a826
JB
864 /* start without a key */
865 rx->key = NULL;
866
d4e46a3d
JB
867 if (rx->sta)
868 stakey = rcu_dereference(rx->sta->key);
869
761ab470
JB
870 fc = hdr->frame_control;
871
872 if (!ieee80211_has_protected(fc))
0c7c10c7
JM
873 mmie_keyidx = ieee80211_get_mmie_keyidx(rx->skb);
874
d4e46a3d
JB
875 if (!is_multicast_ether_addr(hdr->addr1) && stakey) {
876 rx->key = stakey;
0c7c10c7 877 /* Skip decryption if the frame is not protected. */
761ab470 878 if (!ieee80211_has_protected(fc))
0c7c10c7 879 return RX_CONTINUE;
3cfcf6ac
JM
880 } else if (mmie_keyidx >= 0) {
881 /* Broadcast/multicast robust management frame / BIP */
eb9fb5b8
JB
882 if ((status->flag & RX_FLAG_DECRYPTED) &&
883 (status->flag & RX_FLAG_IV_STRIPPED))
3cfcf6ac
JM
884 return RX_CONTINUE;
885
886 if (mmie_keyidx < NUM_DEFAULT_KEYS ||
887 mmie_keyidx >= NUM_DEFAULT_KEYS + NUM_DEFAULT_MGMT_KEYS)
888 return RX_DROP_MONITOR; /* unexpected BIP keyidx */
889 rx->key = rcu_dereference(rx->sdata->keys[mmie_keyidx]);
761ab470 890 } else if (!ieee80211_has_protected(fc)) {
0c7c10c7
JM
891 /*
892 * The frame was not protected, so skip decryption. However, we
893 * need to set rx->key if there is a key that could have been
894 * used so that the frame may be dropped if encryption would
895 * have been expected.
896 */
897 struct ieee80211_key *key = NULL;
761ab470 898 if (ieee80211_is_mgmt(fc) &&
0c7c10c7
JM
899 is_multicast_ether_addr(hdr->addr1) &&
900 (key = rcu_dereference(rx->sdata->default_mgmt_key)))
901 rx->key = key;
902 else if ((key = rcu_dereference(rx->sdata->default_key)))
903 rx->key = key;
904 return RX_CONTINUE;
571ecf67 905 } else {
39184b15 906 u8 keyid;
3017b80b
JB
907 /*
908 * The device doesn't give us the IV so we won't be
909 * able to look up the key. That's ok though, we
910 * don't need to decrypt the frame, we just won't
911 * be able to keep statistics accurate.
912 * Except for key threshold notifications, should
913 * we somehow allow the driver to tell us which key
914 * the hardware used if this flag is set?
915 */
eb9fb5b8
JB
916 if ((status->flag & RX_FLAG_DECRYPTED) &&
917 (status->flag & RX_FLAG_IV_STRIPPED))
9ae54c84 918 return RX_CONTINUE;
3017b80b 919
761ab470 920 hdrlen = ieee80211_hdrlen(fc);
3017b80b
JB
921
922 if (rx->skb->len < 8 + hdrlen)
e4c26add 923 return RX_DROP_UNUSABLE; /* TODO: count this? */
3017b80b
JB
924
925 /*
926 * no need to call ieee80211_wep_get_keyidx,
927 * it verifies a bunch of things we've done already
928 */
39184b15
ZY
929 skb_copy_bits(rx->skb, hdrlen + 3, &keyid, 1);
930 keyidx = keyid >> 6;
3017b80b 931
d4e46a3d 932 rx->key = rcu_dereference(rx->sdata->keys[keyidx]);
3017b80b
JB
933
934 /*
935 * RSNA-protected unicast frames should always be sent with
936 * pairwise or station-to-station keys, but for WEP we allow
937 * using a key index as well.
938 */
8f20fc24 939 if (rx->key && rx->key->conf.alg != ALG_WEP &&
3017b80b
JB
940 !is_multicast_ether_addr(hdr->addr1))
941 rx->key = NULL;
571ecf67
JB
942 }
943
3017b80b 944 if (rx->key) {
571ecf67 945 rx->key->tx_rx_count++;
011bfcc4 946 /* TODO: add threshold stuff again */
1990af8d 947 } else {
e4c26add 948 return RX_DROP_MONITOR;
70f08765
JB
949 }
950
39184b15
ZY
951 if (skb_linearize(rx->skb))
952 return RX_DROP_UNUSABLE;
761ab470 953 /* the hdr variable is invalid now! */
1990af8d 954
70f08765
JB
955 switch (rx->key->conf.alg) {
956 case ALG_WEP:
761ab470
JB
957 /* Check for weak IVs if possible */
958 if (rx->sta && ieee80211_is_data(fc) &&
959 (!(status->flag & RX_FLAG_IV_STRIPPED) ||
960 !(status->flag & RX_FLAG_DECRYPTED)) &&
961 ieee80211_wep_is_weak_iv(rx->skb, rx->key))
962 rx->sta->wep_weak_iv_count++;
963
e2f036da
MN
964 result = ieee80211_crypto_wep_decrypt(rx);
965 break;
70f08765 966 case ALG_TKIP:
e2f036da
MN
967 result = ieee80211_crypto_tkip_decrypt(rx);
968 break;
70f08765 969 case ALG_CCMP:
e2f036da
MN
970 result = ieee80211_crypto_ccmp_decrypt(rx);
971 break;
3cfcf6ac
JM
972 case ALG_AES_CMAC:
973 result = ieee80211_crypto_aes_cmac_decrypt(rx);
974 break;
70f08765
JB
975 }
976
e2f036da 977 /* either the frame has been decrypted or will be dropped */
eb9fb5b8 978 status->flag |= RX_FLAG_DECRYPTED;
e2f036da
MN
979
980 return result;
70f08765
JB
981}
982
572e0012
KV
983static ieee80211_rx_result debug_noinline
984ieee80211_rx_h_check_more_data(struct ieee80211_rx_data *rx)
985{
986 struct ieee80211_local *local;
987 struct ieee80211_hdr *hdr;
988 struct sk_buff *skb;
989
990 local = rx->local;
991 skb = rx->skb;
992 hdr = (struct ieee80211_hdr *) skb->data;
993
994 if (!local->pspolling)
995 return RX_CONTINUE;
996
997 if (!ieee80211_has_fromds(hdr->frame_control))
998 /* this is not from AP */
999 return RX_CONTINUE;
1000
1001 if (!ieee80211_is_data(hdr->frame_control))
1002 return RX_CONTINUE;
1003
1004 if (!ieee80211_has_moredata(hdr->frame_control)) {
1005 /* AP has no more frames buffered for us */
1006 local->pspolling = false;
1007 return RX_CONTINUE;
1008 }
1009
1010 /* more data bit is set, let's request a new frame from the AP */
1011 ieee80211_send_pspoll(local, rx->sdata);
1012
1013 return RX_CONTINUE;
1014}
1015
133b8226 1016static void ap_sta_ps_start(struct sta_info *sta)
571ecf67 1017{
133b8226 1018 struct ieee80211_sub_if_data *sdata = sta->sdata;
4571d3bf 1019 struct ieee80211_local *local = sdata->local;
0795af57 1020
3e122be0 1021 atomic_inc(&sdata->bss->num_sta_ps);
af818581 1022 set_sta_flags(sta, WLAN_STA_PS_STA);
12375ef9 1023 drv_sta_notify(local, sdata, STA_NOTIFY_SLEEP, &sta->sta);
571ecf67 1024#ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
0c68ae26 1025 printk(KERN_DEBUG "%s: STA %pM aid %d enters power save mode\n",
47846c9b 1026 sdata->name, sta->sta.addr, sta->sta.aid);
571ecf67
JB
1027#endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
1028}
1029
ff9458d3 1030static void ap_sta_ps_end(struct sta_info *sta)
571ecf67 1031{
133b8226 1032 struct ieee80211_sub_if_data *sdata = sta->sdata;
571ecf67 1033
3e122be0 1034 atomic_dec(&sdata->bss->num_sta_ps);
004c872e 1035
af818581 1036 clear_sta_flags(sta, WLAN_STA_PS_STA);
004c872e 1037
571ecf67 1038#ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
0c68ae26 1039 printk(KERN_DEBUG "%s: STA %pM aid %d exits power save mode\n",
47846c9b 1040 sdata->name, sta->sta.addr, sta->sta.aid);
571ecf67 1041#endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
004c872e 1042
af818581 1043 if (test_sta_flags(sta, WLAN_STA_PS_DRIVER)) {
571ecf67 1044#ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
af818581 1045 printk(KERN_DEBUG "%s: STA %pM aid %d driver-ps-blocked\n",
47846c9b 1046 sdata->name, sta->sta.addr, sta->sta.aid);
571ecf67 1047#endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
af818581
JB
1048 return;
1049 }
1050
1051 ieee80211_sta_ps_deliver_wakeup(sta);
571ecf67
JB
1052}
1053
49461622 1054static ieee80211_rx_result debug_noinline
5cf121c3 1055ieee80211_rx_h_sta_process(struct ieee80211_rx_data *rx)
571ecf67
JB
1056{
1057 struct sta_info *sta = rx->sta;
eb9fb5b8
JB
1058 struct sk_buff *skb = rx->skb;
1059 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
1060 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
571ecf67
JB
1061
1062 if (!sta)
9ae54c84 1063 return RX_CONTINUE;
571ecf67 1064
b291ba11
JB
1065 /*
1066 * Update last_rx only for IBSS packets which are for the current
1067 * BSSID to avoid keeping the current IBSS network alive in cases
1068 * where other STAs start using different BSSID.
1069 */
05c914fe 1070 if (rx->sdata->vif.type == NL80211_IFTYPE_ADHOC) {
71364716 1071 u8 *bssid = ieee80211_get_bssid(hdr, rx->skb->len,
05c914fe 1072 NL80211_IFTYPE_ADHOC);
46900298 1073 if (compare_ether_addr(bssid, rx->sdata->u.ibss.bssid) == 0)
571ecf67 1074 sta->last_rx = jiffies;
b291ba11
JB
1075 } else if (!is_multicast_ether_addr(hdr->addr1)) {
1076 /*
33b64eb2
LCC
1077 * Mesh beacons will update last_rx when if they are found to
1078 * match the current local configuration when processed.
571ecf67 1079 */
b291ba11 1080 sta->last_rx = jiffies;
571ecf67
JB
1081 }
1082
5cf121c3 1083 if (!(rx->flags & IEEE80211_RX_RA_MATCH))
9ae54c84 1084 return RX_CONTINUE;
571ecf67 1085
3cf335d5
KV
1086 if (rx->sdata->vif.type == NL80211_IFTYPE_STATION)
1087 ieee80211_sta_rx_notify(rx->sdata, hdr);
1088
571ecf67
JB
1089 sta->rx_fragments++;
1090 sta->rx_bytes += rx->skb->len;
eb9fb5b8 1091 sta->last_signal = status->signal;
571ecf67 1092
72eaa43a
JB
1093 /*
1094 * Change STA power saving mode only at the end of a frame
1095 * exchange sequence.
1096 */
3e122be0 1097 if (!ieee80211_has_morefrags(hdr->frame_control) &&
05c914fe
JB
1098 (rx->sdata->vif.type == NL80211_IFTYPE_AP ||
1099 rx->sdata->vif.type == NL80211_IFTYPE_AP_VLAN)) {
af818581 1100 if (test_sta_flags(sta, WLAN_STA_PS_STA)) {
72eaa43a
JB
1101 /*
1102 * Ignore doze->wake transitions that are
1103 * indicated by non-data frames, the standard
1104 * is unclear here, but for example going to
1105 * PS mode and then scanning would cause a
1106 * doze->wake transition for the probe request,
1107 * and that is clearly undesirable.
1108 */
1109 if (ieee80211_is_data(hdr->frame_control) &&
1110 !ieee80211_has_pm(hdr->frame_control))
ff9458d3 1111 ap_sta_ps_end(sta);
72eaa43a
JB
1112 } else {
1113 if (ieee80211_has_pm(hdr->frame_control))
1114 ap_sta_ps_start(sta);
1115 }
571ecf67
JB
1116 }
1117
22403def
JB
1118 /*
1119 * Drop (qos-)data::nullfunc frames silently, since they
1120 * are used only to control station power saving mode.
1121 */
1122 if (ieee80211_is_nullfunc(hdr->frame_control) ||
1123 ieee80211_is_qos_nullfunc(hdr->frame_control)) {
571ecf67 1124 I802_DEBUG_INC(rx->local->rx_handlers_drop_nullfunc);
d524215f
FF
1125
1126 /*
1127 * If we receive a 4-addr nullfunc frame from a STA
1128 * that was not moved to a 4-addr STA vlan yet, drop
1129 * the frame to the monitor interface, to make sure
1130 * that hostapd sees it
1131 */
1132 if (ieee80211_has_a4(hdr->frame_control) &&
1133 (rx->sdata->vif.type == NL80211_IFTYPE_AP ||
1134 (rx->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
1135 !rx->sdata->u.vlan.sta)))
1136 return RX_DROP_MONITOR;
22403def
JB
1137 /*
1138 * Update counter and free packet here to avoid
1139 * counting this as a dropped packed.
1140 */
571ecf67
JB
1141 sta->rx_packets++;
1142 dev_kfree_skb(rx->skb);
9ae54c84 1143 return RX_QUEUED;
571ecf67
JB
1144 }
1145
9ae54c84 1146 return RX_CONTINUE;
571ecf67
JB
1147} /* ieee80211_rx_h_sta_process */
1148
571ecf67
JB
1149static inline struct ieee80211_fragment_entry *
1150ieee80211_reassemble_add(struct ieee80211_sub_if_data *sdata,
1151 unsigned int frag, unsigned int seq, int rx_queue,
1152 struct sk_buff **skb)
1153{
1154 struct ieee80211_fragment_entry *entry;
1155 int idx;
1156
1157 idx = sdata->fragment_next;
1158 entry = &sdata->fragments[sdata->fragment_next++];
1159 if (sdata->fragment_next >= IEEE80211_FRAGMENT_MAX)
1160 sdata->fragment_next = 0;
1161
1162 if (!skb_queue_empty(&entry->skb_list)) {
f4ea83dd 1163#ifdef CONFIG_MAC80211_VERBOSE_DEBUG
571ecf67
JB
1164 struct ieee80211_hdr *hdr =
1165 (struct ieee80211_hdr *) entry->skb_list.next->data;
1166 printk(KERN_DEBUG "%s: RX reassembly removed oldest "
1167 "fragment entry (idx=%d age=%lu seq=%d last_frag=%d "
0c68ae26 1168 "addr1=%pM addr2=%pM\n",
47846c9b 1169 sdata->name, idx,
571ecf67 1170 jiffies - entry->first_frag_time, entry->seq,
0c68ae26 1171 entry->last_frag, hdr->addr1, hdr->addr2);
f4ea83dd 1172#endif
571ecf67
JB
1173 __skb_queue_purge(&entry->skb_list);
1174 }
1175
1176 __skb_queue_tail(&entry->skb_list, *skb); /* no need for locking */
1177 *skb = NULL;
1178 entry->first_frag_time = jiffies;
1179 entry->seq = seq;
1180 entry->rx_queue = rx_queue;
1181 entry->last_frag = frag;
1182 entry->ccmp = 0;
1183 entry->extra_len = 0;
1184
1185 return entry;
1186}
1187
1188static inline struct ieee80211_fragment_entry *
1189ieee80211_reassemble_find(struct ieee80211_sub_if_data *sdata,
b73d70ad 1190 unsigned int frag, unsigned int seq,
571ecf67
JB
1191 int rx_queue, struct ieee80211_hdr *hdr)
1192{
1193 struct ieee80211_fragment_entry *entry;
1194 int i, idx;
1195
1196 idx = sdata->fragment_next;
1197 for (i = 0; i < IEEE80211_FRAGMENT_MAX; i++) {
1198 struct ieee80211_hdr *f_hdr;
571ecf67
JB
1199
1200 idx--;
1201 if (idx < 0)
1202 idx = IEEE80211_FRAGMENT_MAX - 1;
1203
1204 entry = &sdata->fragments[idx];
1205 if (skb_queue_empty(&entry->skb_list) || entry->seq != seq ||
1206 entry->rx_queue != rx_queue ||
1207 entry->last_frag + 1 != frag)
1208 continue;
1209
b73d70ad 1210 f_hdr = (struct ieee80211_hdr *)entry->skb_list.next->data;
571ecf67 1211
b73d70ad
HH
1212 /*
1213 * Check ftype and addresses are equal, else check next fragment
1214 */
1215 if (((hdr->frame_control ^ f_hdr->frame_control) &
1216 cpu_to_le16(IEEE80211_FCTL_FTYPE)) ||
571ecf67
JB
1217 compare_ether_addr(hdr->addr1, f_hdr->addr1) != 0 ||
1218 compare_ether_addr(hdr->addr2, f_hdr->addr2) != 0)
1219 continue;
1220
ab46623e 1221 if (time_after(jiffies, entry->first_frag_time + 2 * HZ)) {
571ecf67
JB
1222 __skb_queue_purge(&entry->skb_list);
1223 continue;
1224 }
1225 return entry;
1226 }
1227
1228 return NULL;
1229}
1230
49461622 1231static ieee80211_rx_result debug_noinline
5cf121c3 1232ieee80211_rx_h_defragment(struct ieee80211_rx_data *rx)
571ecf67
JB
1233{
1234 struct ieee80211_hdr *hdr;
1235 u16 sc;
358c8d9d 1236 __le16 fc;
571ecf67
JB
1237 unsigned int frag, seq;
1238 struct ieee80211_fragment_entry *entry;
1239 struct sk_buff *skb;
1240
b73d70ad 1241 hdr = (struct ieee80211_hdr *)rx->skb->data;
358c8d9d 1242 fc = hdr->frame_control;
571ecf67
JB
1243 sc = le16_to_cpu(hdr->seq_ctrl);
1244 frag = sc & IEEE80211_SCTL_FRAG;
1245
358c8d9d 1246 if (likely((!ieee80211_has_morefrags(fc) && frag == 0) ||
571ecf67
JB
1247 (rx->skb)->len < 24 ||
1248 is_multicast_ether_addr(hdr->addr1))) {
1249 /* not fragmented */
1250 goto out;
1251 }
1252 I802_DEBUG_INC(rx->local->rx_handlers_fragments);
1253
e3cf8b3f
ZY
1254 if (skb_linearize(rx->skb))
1255 return RX_DROP_UNUSABLE;
1256
058897a4
AK
1257 /*
1258 * skb_linearize() might change the skb->data and
1259 * previously cached variables (in this case, hdr) need to
1260 * be refreshed with the new data.
1261 */
1262 hdr = (struct ieee80211_hdr *)rx->skb->data;
571ecf67
JB
1263 seq = (sc & IEEE80211_SCTL_SEQ) >> 4;
1264
1265 if (frag == 0) {
1266 /* This is the first fragment of a new frame. */
1267 entry = ieee80211_reassemble_add(rx->sdata, frag, seq,
5cf121c3 1268 rx->queue, &(rx->skb));
8f20fc24 1269 if (rx->key && rx->key->conf.alg == ALG_CCMP &&
358c8d9d 1270 ieee80211_has_protected(fc)) {
9190252c
JM
1271 int queue = ieee80211_is_mgmt(fc) ?
1272 NUM_RX_DATA_QUEUES : rx->queue;
571ecf67
JB
1273 /* Store CCMP PN so that we can verify that the next
1274 * fragment has a sequential PN value. */
1275 entry->ccmp = 1;
1276 memcpy(entry->last_pn,
9190252c 1277 rx->key->u.ccmp.rx_pn[queue],
571ecf67
JB
1278 CCMP_PN_LEN);
1279 }
9ae54c84 1280 return RX_QUEUED;
571ecf67
JB
1281 }
1282
1283 /* This is a fragment for a frame that should already be pending in
1284 * fragment cache. Add this fragment to the end of the pending entry.
1285 */
b73d70ad 1286 entry = ieee80211_reassemble_find(rx->sdata, frag, seq, rx->queue, hdr);
571ecf67
JB
1287 if (!entry) {
1288 I802_DEBUG_INC(rx->local->rx_handlers_drop_defrag);
e4c26add 1289 return RX_DROP_MONITOR;
571ecf67
JB
1290 }
1291
1292 /* Verify that MPDUs within one MSDU have sequential PN values.
1293 * (IEEE 802.11i, 8.3.3.4.5) */
1294 if (entry->ccmp) {
1295 int i;
1296 u8 pn[CCMP_PN_LEN], *rpn;
9190252c 1297 int queue;
8f20fc24 1298 if (!rx->key || rx->key->conf.alg != ALG_CCMP)
e4c26add 1299 return RX_DROP_UNUSABLE;
571ecf67
JB
1300 memcpy(pn, entry->last_pn, CCMP_PN_LEN);
1301 for (i = CCMP_PN_LEN - 1; i >= 0; i--) {
1302 pn[i]++;
1303 if (pn[i])
1304 break;
1305 }
9190252c
JM
1306 queue = ieee80211_is_mgmt(fc) ?
1307 NUM_RX_DATA_QUEUES : rx->queue;
1308 rpn = rx->key->u.ccmp.rx_pn[queue];
f4ea83dd 1309 if (memcmp(pn, rpn, CCMP_PN_LEN))
e4c26add 1310 return RX_DROP_UNUSABLE;
571ecf67
JB
1311 memcpy(entry->last_pn, pn, CCMP_PN_LEN);
1312 }
1313
358c8d9d 1314 skb_pull(rx->skb, ieee80211_hdrlen(fc));
571ecf67
JB
1315 __skb_queue_tail(&entry->skb_list, rx->skb);
1316 entry->last_frag = frag;
1317 entry->extra_len += rx->skb->len;
358c8d9d 1318 if (ieee80211_has_morefrags(fc)) {
571ecf67 1319 rx->skb = NULL;
9ae54c84 1320 return RX_QUEUED;
571ecf67
JB
1321 }
1322
1323 rx->skb = __skb_dequeue(&entry->skb_list);
1324 if (skb_tailroom(rx->skb) < entry->extra_len) {
1325 I802_DEBUG_INC(rx->local->rx_expand_skb_head2);
1326 if (unlikely(pskb_expand_head(rx->skb, 0, entry->extra_len,
1327 GFP_ATOMIC))) {
1328 I802_DEBUG_INC(rx->local->rx_handlers_drop_defrag);
1329 __skb_queue_purge(&entry->skb_list);
e4c26add 1330 return RX_DROP_UNUSABLE;
571ecf67
JB
1331 }
1332 }
1333 while ((skb = __skb_dequeue(&entry->skb_list))) {
1334 memcpy(skb_put(rx->skb, skb->len), skb->data, skb->len);
1335 dev_kfree_skb(skb);
1336 }
1337
1338 /* Complete frame has been reassembled - process it now */
5cf121c3 1339 rx->flags |= IEEE80211_RX_FRAGMENTED;
571ecf67
JB
1340
1341 out:
1342 if (rx->sta)
1343 rx->sta->rx_packets++;
1344 if (is_multicast_ether_addr(hdr->addr1))
1345 rx->local->dot11MulticastReceivedFrameCount++;
1346 else
1347 ieee80211_led_rx(rx->local);
9ae54c84 1348 return RX_CONTINUE;
571ecf67
JB
1349}
1350
49461622 1351static ieee80211_rx_result debug_noinline
5cf121c3 1352ieee80211_rx_h_ps_poll(struct ieee80211_rx_data *rx)
571ecf67 1353{
af818581 1354 struct ieee80211_sub_if_data *sdata = rx->sdata;
358c8d9d 1355 __le16 fc = ((struct ieee80211_hdr *)rx->skb->data)->frame_control;
571ecf67 1356
358c8d9d 1357 if (likely(!rx->sta || !ieee80211_is_pspoll(fc) ||
5cf121c3 1358 !(rx->flags & IEEE80211_RX_RA_MATCH)))
9ae54c84 1359 return RX_CONTINUE;
571ecf67 1360
05c914fe
JB
1361 if ((sdata->vif.type != NL80211_IFTYPE_AP) &&
1362 (sdata->vif.type != NL80211_IFTYPE_AP_VLAN))
e4c26add 1363 return RX_DROP_UNUSABLE;
98f0b0a3 1364
af818581
JB
1365 if (!test_sta_flags(rx->sta, WLAN_STA_PS_DRIVER))
1366 ieee80211_sta_ps_deliver_poll_response(rx->sta);
1367 else
1368 set_sta_flags(rx->sta, WLAN_STA_PSPOLL);
571ecf67 1369
9ae54c84 1370 /* Free PS Poll skb here instead of returning RX_DROP that would
571ecf67
JB
1371 * count as an dropped frame. */
1372 dev_kfree_skb(rx->skb);
1373
9ae54c84 1374 return RX_QUEUED;
571ecf67
JB
1375}
1376
49461622 1377static ieee80211_rx_result debug_noinline
5cf121c3 1378ieee80211_rx_h_remove_qos_control(struct ieee80211_rx_data *rx)
6e0d114d 1379{
6e0d114d 1380 u8 *data = rx->skb->data;
238f74a2 1381 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)data;
6e0d114d 1382
238f74a2 1383 if (!ieee80211_is_data_qos(hdr->frame_control))
9ae54c84 1384 return RX_CONTINUE;
6e0d114d
JB
1385
1386 /* remove the qos control field, update frame type and meta-data */
238f74a2
HH
1387 memmove(data + IEEE80211_QOS_CTL_LEN, data,
1388 ieee80211_hdrlen(hdr->frame_control) - IEEE80211_QOS_CTL_LEN);
1389 hdr = (struct ieee80211_hdr *)skb_pull(rx->skb, IEEE80211_QOS_CTL_LEN);
6e0d114d 1390 /* change frame type to non QOS */
238f74a2 1391 hdr->frame_control &= ~cpu_to_le16(IEEE80211_STYPE_QOS_DATA);
6e0d114d 1392
9ae54c84 1393 return RX_CONTINUE;
6e0d114d
JB
1394}
1395
76ee65bf 1396static int
5cf121c3 1397ieee80211_802_1x_port_control(struct ieee80211_rx_data *rx)
571ecf67 1398{
07346f81 1399 if (unlikely(!rx->sta ||
f4ea83dd 1400 !test_sta_flags(rx->sta, WLAN_STA_AUTHORIZED)))
76ee65bf 1401 return -EACCES;
571ecf67 1402
76ee65bf 1403 return 0;
571ecf67
JB
1404}
1405
76ee65bf 1406static int
358c8d9d 1407ieee80211_drop_unencrypted(struct ieee80211_rx_data *rx, __le16 fc)
571ecf67 1408{
eb9fb5b8
JB
1409 struct sk_buff *skb = rx->skb;
1410 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
1411
3017b80b 1412 /*
7848ba7d
JB
1413 * Pass through unencrypted frames if the hardware has
1414 * decrypted them already.
3017b80b 1415 */
eb9fb5b8 1416 if (status->flag & RX_FLAG_DECRYPTED)
76ee65bf 1417 return 0;
571ecf67
JB
1418
1419 /* Drop unencrypted frames if key is set. */
358c8d9d
HH
1420 if (unlikely(!ieee80211_has_protected(fc) &&
1421 !ieee80211_is_nullfunc(fc) &&
f2ca3ea4 1422 ieee80211_is_data(fc) &&
b3fc9c6c 1423 (rx->key || rx->sdata->drop_unencrypted)))
76ee65bf 1424 return -EACCES;
bef5d1c7
JB
1425
1426 return 0;
1427}
1428
1429static int
1430ieee80211_drop_unencrypted_mgmt(struct ieee80211_rx_data *rx)
1431{
1432 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
e3efca0a 1433 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(rx->skb);
bef5d1c7 1434 __le16 fc = hdr->frame_control;
bef5d1c7 1435
e3efca0a
JM
1436 /*
1437 * Pass through unencrypted frames if the hardware has
1438 * decrypted them already.
1439 */
1440 if (status->flag & RX_FLAG_DECRYPTED)
1441 return 0;
bef5d1c7 1442
f2ca3ea4 1443 if (rx->sta && test_sta_flags(rx->sta, WLAN_STA_MFP)) {
d211e90e
JM
1444 if (unlikely(!ieee80211_has_protected(fc) &&
1445 ieee80211_is_unicast_robust_mgmt_frame(rx->skb) &&
f2ca3ea4
JM
1446 rx->key))
1447 return -EACCES;
1448 /* BIP does not use Protected field, so need to check MMIE */
f64f9e71 1449 if (unlikely(ieee80211_is_multicast_robust_mgmt_frame(rx->skb) &&
fa83a218 1450 ieee80211_get_mmie_keyidx(rx->skb) < 0))
f2ca3ea4
JM
1451 return -EACCES;
1452 /*
1453 * When using MFP, Action frames are not allowed prior to
1454 * having configured keys.
1455 */
1456 if (unlikely(ieee80211_is_action(fc) && !rx->key &&
1457 ieee80211_is_robust_mgmt_frame(
1458 (struct ieee80211_hdr *) rx->skb->data)))
1459 return -EACCES;
1460 }
b3fc9c6c 1461
76ee65bf 1462 return 0;
571ecf67
JB
1463}
1464
76ee65bf 1465static int
e31a16d6 1466__ieee80211_data_to_8023(struct ieee80211_rx_data *rx)
571ecf67 1467{
eb9fb5b8 1468 struct ieee80211_sub_if_data *sdata = rx->sdata;
f14543ee
FF
1469 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
1470
9bc383de
JB
1471 if (ieee80211_has_a4(hdr->frame_control) &&
1472 sdata->vif.type == NL80211_IFTYPE_AP_VLAN && !sdata->u.vlan.sta)
f14543ee 1473 return -1;
9bc383de
JB
1474
1475 if (is_multicast_ether_addr(hdr->addr1) &&
1476 ((sdata->vif.type == NL80211_IFTYPE_AP_VLAN && sdata->u.vlan.sta) ||
1477 (sdata->vif.type == NL80211_IFTYPE_STATION && sdata->u.mgd.use_4addr)))
f14543ee 1478 return -1;
571ecf67 1479
47846c9b 1480 return ieee80211_data_to_8023(rx->skb, sdata->vif.addr, sdata->vif.type);
76ee65bf 1481}
571ecf67 1482
ce3edf6d
JB
1483/*
1484 * requires that rx->skb is a frame with ethernet header
1485 */
358c8d9d 1486static bool ieee80211_frame_allowed(struct ieee80211_rx_data *rx, __le16 fc)
ce3edf6d 1487{
c97c23e3 1488 static const u8 pae_group_addr[ETH_ALEN] __aligned(2)
ce3edf6d
JB
1489 = { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x03 };
1490 struct ethhdr *ehdr = (struct ethhdr *) rx->skb->data;
1491
1492 /*
1493 * Allow EAPOL frames to us/the PAE group address regardless
1494 * of whether the frame was encrypted or not.
1495 */
1496 if (ehdr->h_proto == htons(ETH_P_PAE) &&
47846c9b 1497 (compare_ether_addr(ehdr->h_dest, rx->sdata->vif.addr) == 0 ||
ce3edf6d
JB
1498 compare_ether_addr(ehdr->h_dest, pae_group_addr) == 0))
1499 return true;
1500
1501 if (ieee80211_802_1x_port_control(rx) ||
358c8d9d 1502 ieee80211_drop_unencrypted(rx, fc))
ce3edf6d
JB
1503 return false;
1504
1505 return true;
1506}
1507
1508/*
1509 * requires that rx->skb is a frame with ethernet header
1510 */
76ee65bf 1511static void
5cf121c3 1512ieee80211_deliver_skb(struct ieee80211_rx_data *rx)
76ee65bf 1513{
eb9fb5b8
JB
1514 struct ieee80211_sub_if_data *sdata = rx->sdata;
1515 struct net_device *dev = sdata->dev;
76ee65bf 1516 struct sk_buff *skb, *xmit_skb;
ce3edf6d
JB
1517 struct ethhdr *ehdr = (struct ethhdr *) rx->skb->data;
1518 struct sta_info *dsta;
571ecf67 1519
76ee65bf
RR
1520 skb = rx->skb;
1521 xmit_skb = NULL;
571ecf67 1522
05c914fe
JB
1523 if ((sdata->vif.type == NL80211_IFTYPE_AP ||
1524 sdata->vif.type == NL80211_IFTYPE_AP_VLAN) &&
213cd118 1525 !(sdata->flags & IEEE80211_SDATA_DONT_BRIDGE_PACKETS) &&
9bc383de
JB
1526 (rx->flags & IEEE80211_RX_RA_MATCH) &&
1527 (sdata->vif.type != NL80211_IFTYPE_AP_VLAN || !sdata->u.vlan.sta)) {
ce3edf6d
JB
1528 if (is_multicast_ether_addr(ehdr->h_dest)) {
1529 /*
1530 * send multicast frames both to higher layers in
1531 * local net stack and back to the wireless medium
1532 */
76ee65bf
RR
1533 xmit_skb = skb_copy(skb, GFP_ATOMIC);
1534 if (!xmit_skb && net_ratelimit())
571ecf67
JB
1535 printk(KERN_DEBUG "%s: failed to clone "
1536 "multicast frame\n", dev->name);
1537 } else {
abe60632
JB
1538 dsta = sta_info_get(sdata, skb->data);
1539 if (dsta) {
ce3edf6d
JB
1540 /*
1541 * The destination station is associated to
1542 * this AP (in this VLAN), so send the frame
1543 * directly to it and do not pass it to local
1544 * net stack.
571ecf67 1545 */
76ee65bf 1546 xmit_skb = skb;
571ecf67
JB
1547 skb = NULL;
1548 }
571ecf67
JB
1549 }
1550 }
1551
1552 if (skb) {
d1c3a37c
JB
1553 int align __maybe_unused;
1554
59d9cb07 1555#ifndef CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS
d1c3a37c
JB
1556 /*
1557 * 'align' will only take the values 0 or 2 here
1558 * since all frames are required to be aligned
1559 * to 2-byte boundaries when being passed to
1560 * mac80211. That also explains the __skb_push()
1561 * below.
1562 */
dacb6f1d 1563 align = ((unsigned long)(skb->data + sizeof(struct ethhdr))) & 3;
d1c3a37c
JB
1564 if (align) {
1565 if (WARN_ON(skb_headroom(skb) < 3)) {
1566 dev_kfree_skb(skb);
1567 skb = NULL;
1568 } else {
1569 u8 *data = skb->data;
8ce0b589
ZY
1570 size_t len = skb_headlen(skb);
1571 skb->data -= align;
1572 memmove(skb->data, data, len);
1573 skb_set_tail_pointer(skb, len);
d1c3a37c
JB
1574 }
1575 }
1576#endif
1577
1578 if (skb) {
1579 /* deliver to local stack */
1580 skb->protocol = eth_type_trans(skb, dev);
1581 memset(skb->cb, 0, sizeof(skb->cb));
5548a8a1 1582 netif_receive_skb(skb);
d1c3a37c 1583 }
571ecf67
JB
1584 }
1585
76ee65bf 1586 if (xmit_skb) {
571ecf67 1587 /* send to wireless media */
f831e909 1588 xmit_skb->protocol = htons(ETH_P_802_3);
ce3edf6d
JB
1589 skb_reset_network_header(xmit_skb);
1590 skb_reset_mac_header(xmit_skb);
76ee65bf 1591 dev_queue_xmit(xmit_skb);
571ecf67 1592 }
76ee65bf
RR
1593}
1594
49461622 1595static ieee80211_rx_result debug_noinline
5cf121c3 1596ieee80211_rx_h_amsdu(struct ieee80211_rx_data *rx)
fd4c7f2f 1597{
eb9fb5b8 1598 struct net_device *dev = rx->sdata->dev;
eaf85ca7 1599 struct sk_buff *skb = rx->skb;
358c8d9d
HH
1600 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data;
1601 __le16 fc = hdr->frame_control;
eaf85ca7 1602 struct sk_buff_head frame_list;
fd4c7f2f 1603
358c8d9d 1604 if (unlikely(!ieee80211_is_data(fc)))
9ae54c84 1605 return RX_CONTINUE;
fd4c7f2f 1606
358c8d9d 1607 if (unlikely(!ieee80211_is_data_present(fc)))
e4c26add 1608 return RX_DROP_MONITOR;
fd4c7f2f 1609
5cf121c3 1610 if (!(rx->flags & IEEE80211_RX_AMSDU))
9ae54c84 1611 return RX_CONTINUE;
fd4c7f2f 1612
eaf85ca7
ZY
1613 if (ieee80211_has_a4(hdr->frame_control) &&
1614 rx->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
1615 !rx->sdata->u.vlan.sta)
e4c26add 1616 return RX_DROP_UNUSABLE;
fd4c7f2f 1617
eaf85ca7
ZY
1618 if (is_multicast_ether_addr(hdr->addr1) &&
1619 ((rx->sdata->vif.type == NL80211_IFTYPE_AP_VLAN &&
1620 rx->sdata->u.vlan.sta) ||
1621 (rx->sdata->vif.type == NL80211_IFTYPE_STATION &&
1622 rx->sdata->u.mgd.use_4addr)))
e4c26add 1623 return RX_DROP_UNUSABLE;
fd4c7f2f 1624
eaf85ca7
ZY
1625 skb->dev = dev;
1626 __skb_queue_head_init(&frame_list);
fd4c7f2f 1627
e3cf8b3f
ZY
1628 if (skb_linearize(skb))
1629 return RX_DROP_UNUSABLE;
1630
eaf85ca7
ZY
1631 ieee80211_amsdu_to_8023s(skb, &frame_list, dev->dev_addr,
1632 rx->sdata->vif.type,
1633 rx->local->hw.extra_tx_headroom);
fd4c7f2f 1634
eaf85ca7
ZY
1635 while (!skb_queue_empty(&frame_list)) {
1636 rx->skb = __skb_dequeue(&frame_list);
fd4c7f2f 1637
358c8d9d 1638 if (!ieee80211_frame_allowed(rx, fc)) {
eaf85ca7 1639 dev_kfree_skb(rx->skb);
ce3edf6d
JB
1640 continue;
1641 }
eaf85ca7
ZY
1642 dev->stats.rx_packets++;
1643 dev->stats.rx_bytes += rx->skb->len;
fd4c7f2f
RR
1644
1645 ieee80211_deliver_skb(rx);
1646 }
1647
9ae54c84 1648 return RX_QUEUED;
fd4c7f2f
RR
1649}
1650
bf94e17b 1651#ifdef CONFIG_MAC80211_MESH
b0dee578 1652static ieee80211_rx_result
e32f85f7
LCC
1653ieee80211_rx_h_mesh_fwding(struct ieee80211_rx_data *rx)
1654{
1655 struct ieee80211_hdr *hdr;
1656 struct ieee80211s_hdr *mesh_hdr;
1657 unsigned int hdrlen;
1658 struct sk_buff *skb = rx->skb, *fwd_skb;
3b8d81e0 1659 struct ieee80211_local *local = rx->local;
eb9fb5b8 1660 struct ieee80211_sub_if_data *sdata = rx->sdata;
e32f85f7
LCC
1661
1662 hdr = (struct ieee80211_hdr *) skb->data;
1663 hdrlen = ieee80211_hdrlen(hdr->frame_control);
1664 mesh_hdr = (struct ieee80211s_hdr *) (skb->data + hdrlen);
1665
1666 if (!ieee80211_is_data(hdr->frame_control))
1667 return RX_CONTINUE;
1668
1669 if (!mesh_hdr->ttl)
1670 /* illegal frame */
1671 return RX_DROP_MONITOR;
1672
43b7b314 1673 if (mesh_hdr->flags & MESH_FLAGS_AE) {
79617dee 1674 struct mesh_path *mppath;
43b7b314
JC
1675 char *proxied_addr;
1676 char *mpp_addr;
1677
1678 if (is_multicast_ether_addr(hdr->addr1)) {
1679 mpp_addr = hdr->addr3;
1680 proxied_addr = mesh_hdr->eaddr1;
1681 } else {
1682 mpp_addr = hdr->addr4;
1683 proxied_addr = mesh_hdr->eaddr2;
1684 }
79617dee 1685
79617dee 1686 rcu_read_lock();
43b7b314 1687 mppath = mpp_path_lookup(proxied_addr, sdata);
79617dee 1688 if (!mppath) {
43b7b314 1689 mpp_path_add(proxied_addr, mpp_addr, sdata);
79617dee
Y
1690 } else {
1691 spin_lock_bh(&mppath->state_lock);
43b7b314
JC
1692 if (compare_ether_addr(mppath->mpp, mpp_addr) != 0)
1693 memcpy(mppath->mpp, mpp_addr, ETH_ALEN);
79617dee
Y
1694 spin_unlock_bh(&mppath->state_lock);
1695 }
1696 rcu_read_unlock();
1697 }
1698
3c5772a5
JC
1699 /* Frame has reached destination. Don't forward */
1700 if (!is_multicast_ether_addr(hdr->addr1) &&
47846c9b 1701 compare_ether_addr(sdata->vif.addr, hdr->addr3) == 0)
e32f85f7
LCC
1702 return RX_CONTINUE;
1703
1704 mesh_hdr->ttl--;
1705
1706 if (rx->flags & IEEE80211_RX_RA_MATCH) {
1707 if (!mesh_hdr->ttl)
472dbc45 1708 IEEE80211_IFSTA_MESH_CTR_INC(&rx->sdata->u.mesh,
e32f85f7
LCC
1709 dropped_frames_ttl);
1710 else {
1711 struct ieee80211_hdr *fwd_hdr;
3b8d81e0
JB
1712 struct ieee80211_tx_info *info;
1713
e32f85f7
LCC
1714 fwd_skb = skb_copy(skb, GFP_ATOMIC);
1715
1716 if (!fwd_skb && net_ratelimit())
1717 printk(KERN_DEBUG "%s: failed to clone mesh frame\n",
47846c9b 1718 sdata->name);
e32f85f7
LCC
1719
1720 fwd_hdr = (struct ieee80211_hdr *) fwd_skb->data;
47846c9b 1721 memcpy(fwd_hdr->addr2, sdata->vif.addr, ETH_ALEN);
3b8d81e0
JB
1722 info = IEEE80211_SKB_CB(fwd_skb);
1723 memset(info, 0, sizeof(*info));
1724 info->flags |= IEEE80211_TX_INTFL_NEED_TXPROCESSING;
5061b0c2 1725 info->control.vif = &rx->sdata->vif;
cf0277e7
JB
1726 skb_set_queue_mapping(skb,
1727 ieee80211_select_queue(rx->sdata, fwd_skb));
1728 ieee80211_set_qos_hdr(local, skb);
c8a61a7d
DW
1729 if (is_multicast_ether_addr(fwd_hdr->addr1))
1730 IEEE80211_IFSTA_MESH_CTR_INC(&sdata->u.mesh,
1731 fwded_mcast);
1732 else {
3c5772a5
JC
1733 int err;
1734 /*
1735 * Save TA to addr1 to send TA a path error if a
1736 * suitable next hop is not found
1737 */
1738 memcpy(fwd_hdr->addr1, fwd_hdr->addr2,
249b405c 1739 ETH_ALEN);
3c5772a5 1740 err = mesh_nexthop_lookup(fwd_skb, sdata);
249b405c
JC
1741 /* Failed to immediately resolve next hop:
1742 * fwded frame was dropped or will be added
1743 * later to the pending skb queue. */
1744 if (err)
1745 return RX_DROP_MONITOR;
c8a61a7d
DW
1746
1747 IEEE80211_IFSTA_MESH_CTR_INC(&sdata->u.mesh,
1748 fwded_unicast);
249b405c
JC
1749 }
1750 IEEE80211_IFSTA_MESH_CTR_INC(&sdata->u.mesh,
1751 fwded_frames);
3b8d81e0 1752 ieee80211_add_pending_skb(local, fwd_skb);
e32f85f7
LCC
1753 }
1754 }
1755
3c5772a5 1756 if (is_multicast_ether_addr(hdr->addr1) ||
eb9fb5b8 1757 sdata->dev->flags & IFF_PROMISC)
e32f85f7
LCC
1758 return RX_CONTINUE;
1759 else
1760 return RX_DROP_MONITOR;
1761}
bf94e17b 1762#endif
e32f85f7 1763
49461622 1764static ieee80211_rx_result debug_noinline
5cf121c3 1765ieee80211_rx_h_data(struct ieee80211_rx_data *rx)
76ee65bf 1766{
eb9fb5b8 1767 struct ieee80211_sub_if_data *sdata = rx->sdata;
e15276a4 1768 struct ieee80211_local *local = rx->local;
eb9fb5b8 1769 struct net_device *dev = sdata->dev;
358c8d9d
HH
1770 struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)rx->skb->data;
1771 __le16 fc = hdr->frame_control;
ce3edf6d 1772 int err;
76ee65bf 1773
358c8d9d 1774 if (unlikely(!ieee80211_is_data(hdr->frame_control)))
9ae54c84 1775 return RX_CONTINUE;
76ee65bf 1776
358c8d9d 1777 if (unlikely(!ieee80211_is_data_present(hdr->frame_control)))
e4c26add 1778 return RX_DROP_MONITOR;
76ee65bf 1779
f14543ee
FF
1780 /*
1781 * Allow the cooked monitor interface of an AP to see 4-addr frames so
1782 * that a 4-addr station can be detected and moved into a separate VLAN
1783 */
1784 if (ieee80211_has_a4(hdr->frame_control) &&
1785 sdata->vif.type == NL80211_IFTYPE_AP)
1786 return RX_DROP_MONITOR;
1787
e31a16d6 1788 err = __ieee80211_data_to_8023(rx);
76ee65bf 1789 if (unlikely(err))
e4c26add 1790 return RX_DROP_UNUSABLE;
76ee65bf 1791
358c8d9d 1792 if (!ieee80211_frame_allowed(rx, fc))
e4c26add 1793 return RX_DROP_MONITOR;
ce3edf6d 1794
76ee65bf
RR
1795 rx->skb->dev = dev;
1796
1797 dev->stats.rx_packets++;
1798 dev->stats.rx_bytes += rx->skb->len;
1799
e15276a4
VN
1800 if (ieee80211_is_data(hdr->frame_control) &&
1801 !is_multicast_ether_addr(hdr->addr1) &&
1802 local->hw.conf.dynamic_ps_timeout > 0 && local->ps_sdata) {
1803 mod_timer(&local->dynamic_ps_timer, jiffies +
1804 msecs_to_jiffies(local->hw.conf.dynamic_ps_timeout));
1805 }
1806
76ee65bf 1807 ieee80211_deliver_skb(rx);
571ecf67 1808
9ae54c84 1809 return RX_QUEUED;
571ecf67
JB
1810}
1811
49461622 1812static ieee80211_rx_result debug_noinline
2569a826 1813ieee80211_rx_h_ctrl(struct ieee80211_rx_data *rx, struct sk_buff_head *frames)
71364716
RR
1814{
1815 struct ieee80211_local *local = rx->local;
1816 struct ieee80211_hw *hw = &local->hw;
1817 struct sk_buff *skb = rx->skb;
a7767f95 1818 struct ieee80211_bar *bar = (struct ieee80211_bar *)skb->data;
71364716
RR
1819 struct tid_ampdu_rx *tid_agg_rx;
1820 u16 start_seq_num;
1821 u16 tid;
1822
a7767f95 1823 if (likely(!ieee80211_is_ctl(bar->frame_control)))
9ae54c84 1824 return RX_CONTINUE;
71364716 1825
a7767f95 1826 if (ieee80211_is_back_req(bar->frame_control)) {
8ae5977f
JB
1827 struct {
1828 __le16 control, start_seq_num;
1829 } __packed bar_data;
1830
71364716 1831 if (!rx->sta)
a02ae758 1832 return RX_DROP_MONITOR;
8ae5977f
JB
1833
1834 if (skb_copy_bits(skb, offsetof(struct ieee80211_bar, control),
1835 &bar_data, sizeof(bar_data)))
1836 return RX_DROP_MONITOR;
1837
8ae5977f 1838 tid = le16_to_cpu(bar_data.control) >> 12;
a87f736d
JB
1839
1840 tid_agg_rx = rcu_dereference(rx->sta->ampdu_mlme.tid_rx[tid]);
1841 if (!tid_agg_rx)
a02ae758 1842 return RX_DROP_MONITOR;
71364716 1843
8ae5977f 1844 start_seq_num = le16_to_cpu(bar_data.start_seq_num) >> 4;
71364716
RR
1845
1846 /* reset session timer */
20ad19d0
JB
1847 if (tid_agg_rx->timeout)
1848 mod_timer(&tid_agg_rx->session_timer,
1849 TU_TO_EXP_TIME(tid_agg_rx->timeout));
71364716 1850
a02ae758 1851 /* release stored frames up to start of BAR */
2569a826
JB
1852 ieee80211_release_reorder_frames(hw, tid_agg_rx, start_seq_num,
1853 frames);
a02ae758
JB
1854 kfree_skb(skb);
1855 return RX_QUEUED;
71364716
RR
1856 }
1857
08daecae
JB
1858 /*
1859 * After this point, we only want management frames,
1860 * so we can drop all remaining control frames to
1861 * cooked monitor interfaces.
1862 */
1863 return RX_DROP_MONITOR;
71364716
RR
1864}
1865
f4f727a6
JM
1866static void ieee80211_process_sa_query_req(struct ieee80211_sub_if_data *sdata,
1867 struct ieee80211_mgmt *mgmt,
1868 size_t len)
fea14732
JM
1869{
1870 struct ieee80211_local *local = sdata->local;
1871 struct sk_buff *skb;
1872 struct ieee80211_mgmt *resp;
1873
47846c9b 1874 if (compare_ether_addr(mgmt->da, sdata->vif.addr) != 0) {
fea14732
JM
1875 /* Not to own unicast address */
1876 return;
1877 }
1878
46900298
JB
1879 if (compare_ether_addr(mgmt->sa, sdata->u.mgd.bssid) != 0 ||
1880 compare_ether_addr(mgmt->bssid, sdata->u.mgd.bssid) != 0) {
77fdaa12 1881 /* Not from the current AP or not associated yet. */
fea14732
JM
1882 return;
1883 }
1884
1885 if (len < 24 + 1 + sizeof(resp->u.action.u.sa_query)) {
1886 /* Too short SA Query request frame */
1887 return;
1888 }
1889
1890 skb = dev_alloc_skb(sizeof(*resp) + local->hw.extra_tx_headroom);
1891 if (skb == NULL)
1892 return;
1893
1894 skb_reserve(skb, local->hw.extra_tx_headroom);
1895 resp = (struct ieee80211_mgmt *) skb_put(skb, 24);
1896 memset(resp, 0, 24);
1897 memcpy(resp->da, mgmt->sa, ETH_ALEN);
47846c9b 1898 memcpy(resp->sa, sdata->vif.addr, ETH_ALEN);
46900298 1899 memcpy(resp->bssid, sdata->u.mgd.bssid, ETH_ALEN);
fea14732
JM
1900 resp->frame_control = cpu_to_le16(IEEE80211_FTYPE_MGMT |
1901 IEEE80211_STYPE_ACTION);
1902 skb_put(skb, 1 + sizeof(resp->u.action.u.sa_query));
1903 resp->u.action.category = WLAN_CATEGORY_SA_QUERY;
1904 resp->u.action.u.sa_query.action = WLAN_ACTION_SA_QUERY_RESPONSE;
1905 memcpy(resp->u.action.u.sa_query.trans_id,
1906 mgmt->u.action.u.sa_query.trans_id,
1907 WLAN_SA_QUERY_TR_ID_LEN);
1908
62ae67be 1909 ieee80211_tx_skb(sdata, skb);
fea14732
JM
1910}
1911
de1ede7a
JB
1912static ieee80211_rx_result debug_noinline
1913ieee80211_rx_h_action(struct ieee80211_rx_data *rx)
1914{
1915 struct ieee80211_local *local = rx->local;
eb9fb5b8 1916 struct ieee80211_sub_if_data *sdata = rx->sdata;
de1ede7a 1917 struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *) rx->skb->data;
84040805 1918 struct sk_buff *nskb;
026331c4 1919 struct ieee80211_rx_status *status;
de1ede7a
JB
1920 int len = rx->skb->len;
1921
1922 if (!ieee80211_is_action(mgmt->frame_control))
1923 return RX_CONTINUE;
1924
026331c4
JM
1925 /* drop too small frames */
1926 if (len < IEEE80211_MIN_ACTION_SIZE)
84040805 1927 return RX_DROP_UNUSABLE;
de1ede7a 1928
026331c4 1929 if (!rx->sta && mgmt->u.action.category != WLAN_CATEGORY_PUBLIC)
84040805 1930 return RX_DROP_UNUSABLE;
de1ede7a 1931
026331c4 1932 if (!(rx->flags & IEEE80211_RX_RA_MATCH))
84040805 1933 return RX_DROP_UNUSABLE;
97ebe12a 1934
bef5d1c7 1935 if (ieee80211_drop_unencrypted_mgmt(rx))
84040805
JB
1936 return RX_DROP_UNUSABLE;
1937
de1ede7a
JB
1938 switch (mgmt->u.action.category) {
1939 case WLAN_CATEGORY_BACK:
8abd3f9b
JB
1940 /*
1941 * The aggregation code is not prepared to handle
1942 * anything but STA/AP due to the BSSID handling;
1943 * IBSS could work in the code but isn't supported
1944 * by drivers or the standard.
1945 */
1946 if (sdata->vif.type != NL80211_IFTYPE_STATION &&
1947 sdata->vif.type != NL80211_IFTYPE_AP_VLAN &&
1948 sdata->vif.type != NL80211_IFTYPE_AP)
84040805 1949 break;
8abd3f9b 1950
026331c4
JM
1951 /* verify action_code is present */
1952 if (len < IEEE80211_MIN_ACTION_SIZE + 1)
1953 break;
1954
de1ede7a
JB
1955 switch (mgmt->u.action.u.addba_req.action_code) {
1956 case WLAN_ACTION_ADDBA_REQ:
1957 if (len < (IEEE80211_MIN_ACTION_SIZE +
1958 sizeof(mgmt->u.action.u.addba_req)))
bed7ee6e
JB
1959 goto invalid;
1960 break;
de1ede7a
JB
1961 case WLAN_ACTION_ADDBA_RESP:
1962 if (len < (IEEE80211_MIN_ACTION_SIZE +
1963 sizeof(mgmt->u.action.u.addba_resp)))
bed7ee6e
JB
1964 goto invalid;
1965 break;
de1ede7a
JB
1966 case WLAN_ACTION_DELBA:
1967 if (len < (IEEE80211_MIN_ACTION_SIZE +
1968 sizeof(mgmt->u.action.u.delba)))
bed7ee6e
JB
1969 goto invalid;
1970 break;
1971 default:
1972 goto invalid;
de1ede7a 1973 }
bed7ee6e 1974
8b58ff83 1975 goto queue;
39192c0b
JB
1976 case WLAN_CATEGORY_SPECTRUM_MGMT:
1977 if (local->hw.conf.channel->band != IEEE80211_BAND_5GHZ)
84040805 1978 break;
46900298
JB
1979
1980 if (sdata->vif.type != NL80211_IFTYPE_STATION)
84040805 1981 break;
46900298 1982
026331c4
JM
1983 /* verify action_code is present */
1984 if (len < IEEE80211_MIN_ACTION_SIZE + 1)
1985 break;
1986
39192c0b
JB
1987 switch (mgmt->u.action.u.measurement.action_code) {
1988 case WLAN_ACTION_SPCT_MSR_REQ:
1989 if (len < (IEEE80211_MIN_ACTION_SIZE +
1990 sizeof(mgmt->u.action.u.measurement)))
84040805 1991 break;
39192c0b 1992 ieee80211_process_measurement_req(sdata, mgmt, len);
84040805 1993 goto handled;
c481ec97
S
1994 case WLAN_ACTION_SPCT_CHL_SWITCH:
1995 if (len < (IEEE80211_MIN_ACTION_SIZE +
1996 sizeof(mgmt->u.action.u.chan_switch)))
84040805 1997 break;
c481ec97 1998
cc32abd4 1999 if (sdata->vif.type != NL80211_IFTYPE_STATION)
84040805 2000 break;
cc32abd4 2001
46900298 2002 if (memcmp(mgmt->bssid, sdata->u.mgd.bssid, ETH_ALEN))
84040805 2003 break;
c481ec97 2004
8b58ff83 2005 goto queue;
39192c0b
JB
2006 }
2007 break;
fea14732
JM
2008 case WLAN_CATEGORY_SA_QUERY:
2009 if (len < (IEEE80211_MIN_ACTION_SIZE +
2010 sizeof(mgmt->u.action.u.sa_query)))
84040805
JB
2011 break;
2012
fea14732
JM
2013 switch (mgmt->u.action.u.sa_query.action) {
2014 case WLAN_ACTION_SA_QUERY_REQUEST:
2015 if (sdata->vif.type != NL80211_IFTYPE_STATION)
84040805 2016 break;
fea14732 2017 ieee80211_process_sa_query_req(sdata, mgmt, len);
84040805 2018 goto handled;
fea14732
JM
2019 }
2020 break;
97ad9139
JC
2021 case WLAN_CATEGORY_MESH_PLINK:
2022 case WLAN_CATEGORY_MESH_PATH_SEL:
77a121c3
JB
2023 if (!ieee80211_vif_is_mesh(&sdata->vif))
2024 break;
8b58ff83 2025 goto queue;
84040805 2026 }
026331c4 2027
bed7ee6e 2028 invalid:
84040805
JB
2029 /*
2030 * For AP mode, hostapd is responsible for handling any action
2031 * frames that we didn't handle, including returning unknown
2032 * ones. For all other modes we will return them to the sender,
2033 * setting the 0x80 bit in the action category, as required by
2034 * 802.11-2007 7.3.1.11.
2035 */
2036 if (sdata->vif.type == NL80211_IFTYPE_AP ||
2037 sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
2038 return RX_DROP_MONITOR;
d7907448 2039
026331c4
JM
2040 /*
2041 * Getting here means the kernel doesn't know how to handle
2042 * it, but maybe userspace does ... include returned frames
2043 * so userspace can register for those to know whether ones
2044 * it transmitted were processed or returned.
2045 */
2046 status = IEEE80211_SKB_RXCB(rx->skb);
2047
9d38d85d 2048 if (cfg80211_rx_action(rx->sdata->dev, status->freq,
026331c4
JM
2049 rx->skb->data, rx->skb->len,
2050 GFP_ATOMIC))
2051 goto handled;
2052
84040805
JB
2053 /* do not return rejected action frames */
2054 if (mgmt->u.action.category & 0x80)
2055 return RX_DROP_UNUSABLE;
2056
2057 nskb = skb_copy_expand(rx->skb, local->hw.extra_tx_headroom, 0,
2058 GFP_ATOMIC);
2059 if (nskb) {
292b4df6 2060 struct ieee80211_mgmt *nmgmt = (void *)nskb->data;
84040805 2061
292b4df6
JL
2062 nmgmt->u.action.category |= 0x80;
2063 memcpy(nmgmt->da, nmgmt->sa, ETH_ALEN);
2064 memcpy(nmgmt->sa, rx->sdata->vif.addr, ETH_ALEN);
84040805
JB
2065
2066 memset(nskb->cb, 0, sizeof(nskb->cb));
2067
2068 ieee80211_tx_skb(rx->sdata, nskb);
de1ede7a
JB
2069 }
2070
84040805 2071 handled:
026331c4
JM
2072 if (rx->sta)
2073 rx->sta->rx_packets++;
39192c0b
JB
2074 dev_kfree_skb(rx->skb);
2075 return RX_QUEUED;
8b58ff83
JB
2076
2077 queue:
2078 rx->skb->pkt_type = IEEE80211_SDATA_QUEUE_TYPE_FRAME;
2079 skb_queue_tail(&sdata->skb_queue, rx->skb);
2080 ieee80211_queue_work(&local->hw, &sdata->work);
2081 if (rx->sta)
2082 rx->sta->rx_packets++;
2083 return RX_QUEUED;
de1ede7a
JB
2084}
2085
49461622 2086static ieee80211_rx_result debug_noinline
5cf121c3 2087ieee80211_rx_h_mgmt(struct ieee80211_rx_data *rx)
571ecf67 2088{
eb9fb5b8 2089 struct ieee80211_sub_if_data *sdata = rx->sdata;
af6b6374 2090 ieee80211_rx_result rxs;
77a121c3
JB
2091 struct ieee80211_mgmt *mgmt = (void *)rx->skb->data;
2092 __le16 stype;
571ecf67 2093
5cf121c3 2094 if (!(rx->flags & IEEE80211_RX_RA_MATCH))
e4c26add 2095 return RX_DROP_MONITOR;
571ecf67 2096
77a121c3
JB
2097 if (rx->skb->len < 24)
2098 return RX_DROP_MONITOR;
2099
bef5d1c7
JB
2100 if (ieee80211_drop_unencrypted_mgmt(rx))
2101 return RX_DROP_UNUSABLE;
97ebe12a 2102
af6b6374
JB
2103 rxs = ieee80211_work_rx_mgmt(rx->sdata, rx->skb);
2104 if (rxs != RX_CONTINUE)
2105 return rxs;
2106
77a121c3 2107 stype = mgmt->frame_control & cpu_to_le16(IEEE80211_FCTL_STYPE);
472dbc45 2108
77a121c3
JB
2109 if (!ieee80211_vif_is_mesh(&sdata->vif) &&
2110 sdata->vif.type != NL80211_IFTYPE_ADHOC &&
2111 sdata->vif.type != NL80211_IFTYPE_STATION)
2112 return RX_DROP_MONITOR;
472dbc45 2113
77a121c3
JB
2114 switch (stype) {
2115 case cpu_to_le16(IEEE80211_STYPE_BEACON):
2116 case cpu_to_le16(IEEE80211_STYPE_PROBE_RESP):
2117 /* process for all: mesh, mlme, ibss */
2118 break;
2119 case cpu_to_le16(IEEE80211_STYPE_DEAUTH):
2120 case cpu_to_le16(IEEE80211_STYPE_DISASSOC):
2121 /* process only for station */
2122 if (sdata->vif.type != NL80211_IFTYPE_STATION)
2123 return RX_DROP_MONITOR;
2124 break;
2125 case cpu_to_le16(IEEE80211_STYPE_PROBE_REQ):
2126 case cpu_to_le16(IEEE80211_STYPE_AUTH):
2127 /* process only for ibss */
2128 if (sdata->vif.type != NL80211_IFTYPE_ADHOC)
2129 return RX_DROP_MONITOR;
2130 break;
2131 default:
2132 return RX_DROP_MONITOR;
2133 }
f9d540ee 2134
77a121c3 2135 /* queue up frame and kick off work to process it */
c1475ca9 2136 rx->skb->pkt_type = IEEE80211_SDATA_QUEUE_TYPE_FRAME;
77a121c3
JB
2137 skb_queue_tail(&sdata->skb_queue, rx->skb);
2138 ieee80211_queue_work(&rx->local->hw, &sdata->work);
8b58ff83
JB
2139 if (rx->sta)
2140 rx->sta->rx_packets++;
46900298 2141
77a121c3 2142 return RX_QUEUED;
571ecf67
JB
2143}
2144
3b8d81e0 2145static void ieee80211_rx_michael_mic_report(struct ieee80211_hdr *hdr,
5cf121c3 2146 struct ieee80211_rx_data *rx)
571ecf67 2147{
a7767f95
HH
2148 int keyidx;
2149 unsigned int hdrlen;
571ecf67 2150
a7767f95 2151 hdrlen = ieee80211_hdrlen(hdr->frame_control);
571ecf67
JB
2152 if (rx->skb->len >= hdrlen + 4)
2153 keyidx = rx->skb->data[hdrlen + 3] >> 6;
2154 else
2155 keyidx = -1;
2156
8944b79f 2157 if (!rx->sta) {
aa0daf0e
JB
2158 /*
2159 * Some hardware seem to generate incorrect Michael MIC
2160 * reports; ignore them to avoid triggering countermeasures.
2161 */
af2ced6a 2162 return;
571ecf67
JB
2163 }
2164
a7767f95 2165 if (!ieee80211_has_protected(hdr->frame_control))
af2ced6a 2166 return;
571ecf67 2167
05c914fe 2168 if (rx->sdata->vif.type == NL80211_IFTYPE_AP && keyidx) {
aa0daf0e
JB
2169 /*
2170 * APs with pairwise keys should never receive Michael MIC
2171 * errors for non-zero keyidx because these are reserved for
2172 * group keys and only the AP is sending real multicast
2173 * frames in the BSS.
2174 */
af2ced6a 2175 return;
571ecf67
JB
2176 }
2177
a7767f95
HH
2178 if (!ieee80211_is_data(hdr->frame_control) &&
2179 !ieee80211_is_auth(hdr->frame_control))
af2ced6a 2180 return;
571ecf67 2181
e6d6e342
JB
2182 mac80211_ev_michael_mic_failure(rx->sdata, keyidx, hdr, NULL,
2183 GFP_ATOMIC);
571ecf67
JB
2184}
2185
5cf121c3 2186/* TODO: use IEEE80211_RX_FRAGMENTED */
5f0b7de5
JB
2187static void ieee80211_rx_cooked_monitor(struct ieee80211_rx_data *rx,
2188 struct ieee80211_rate *rate)
3d30d949
MW
2189{
2190 struct ieee80211_sub_if_data *sdata;
2191 struct ieee80211_local *local = rx->local;
2192 struct ieee80211_rtap_hdr {
2193 struct ieee80211_radiotap_header hdr;
2194 u8 flags;
5f0b7de5 2195 u8 rate_or_pad;
3d30d949
MW
2196 __le16 chan_freq;
2197 __le16 chan_flags;
bc10502d 2198 } __packed *rthdr;
3d30d949
MW
2199 struct sk_buff *skb = rx->skb, *skb2;
2200 struct net_device *prev_dev = NULL;
eb9fb5b8 2201 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
3d30d949 2202
8c0c709e 2203 if (status->flag & RX_FLAG_INTERNAL_CMTR)
3d30d949
MW
2204 goto out_free_skb;
2205
2206 if (skb_headroom(skb) < sizeof(*rthdr) &&
2207 pskb_expand_head(skb, sizeof(*rthdr), 0, GFP_ATOMIC))
2208 goto out_free_skb;
2209
2210 rthdr = (void *)skb_push(skb, sizeof(*rthdr));
2211 memset(rthdr, 0, sizeof(*rthdr));
2212 rthdr->hdr.it_len = cpu_to_le16(sizeof(*rthdr));
2213 rthdr->hdr.it_present =
2214 cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS) |
3d30d949
MW
2215 (1 << IEEE80211_RADIOTAP_CHANNEL));
2216
5f0b7de5
JB
2217 if (rate) {
2218 rthdr->rate_or_pad = rate->bitrate / 5;
2219 rthdr->hdr.it_present |=
2220 cpu_to_le32(1 << IEEE80211_RADIOTAP_RATE);
2221 }
3d30d949
MW
2222 rthdr->chan_freq = cpu_to_le16(status->freq);
2223
2224 if (status->band == IEEE80211_BAND_5GHZ)
2225 rthdr->chan_flags = cpu_to_le16(IEEE80211_CHAN_OFDM |
2226 IEEE80211_CHAN_5GHZ);
2227 else
2228 rthdr->chan_flags = cpu_to_le16(IEEE80211_CHAN_DYN |
2229 IEEE80211_CHAN_2GHZ);
2230
2231 skb_set_mac_header(skb, 0);
2232 skb->ip_summed = CHECKSUM_UNNECESSARY;
2233 skb->pkt_type = PACKET_OTHERHOST;
2234 skb->protocol = htons(ETH_P_802_2);
2235
2236 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
9607e6b6 2237 if (!ieee80211_sdata_running(sdata))
3d30d949
MW
2238 continue;
2239
05c914fe 2240 if (sdata->vif.type != NL80211_IFTYPE_MONITOR ||
3d30d949
MW
2241 !(sdata->u.mntr_flags & MONITOR_FLAG_COOK_FRAMES))
2242 continue;
2243
2244 if (prev_dev) {
2245 skb2 = skb_clone(skb, GFP_ATOMIC);
2246 if (skb2) {
2247 skb2->dev = prev_dev;
5548a8a1 2248 netif_receive_skb(skb2);
3d30d949
MW
2249 }
2250 }
2251
2252 prev_dev = sdata->dev;
2253 sdata->dev->stats.rx_packets++;
2254 sdata->dev->stats.rx_bytes += skb->len;
2255 }
2256
2257 if (prev_dev) {
2258 skb->dev = prev_dev;
5548a8a1 2259 netif_receive_skb(skb);
3d30d949
MW
2260 skb = NULL;
2261 } else
2262 goto out_free_skb;
2263
8c0c709e 2264 status->flag |= RX_FLAG_INTERNAL_CMTR;
3d30d949
MW
2265 return;
2266
2267 out_free_skb:
2268 dev_kfree_skb(skb);
2269}
2270
aa0c8636
CL
2271static void ieee80211_rx_handlers_result(struct ieee80211_rx_data *rx,
2272 ieee80211_rx_result res)
2273{
2274 switch (res) {
2275 case RX_DROP_MONITOR:
2276 I802_DEBUG_INC(rx->sdata->local->rx_handlers_drop);
2277 if (rx->sta)
2278 rx->sta->rx_dropped++;
2279 /* fall through */
2280 case RX_CONTINUE: {
2281 struct ieee80211_rate *rate = NULL;
2282 struct ieee80211_supported_band *sband;
2283 struct ieee80211_rx_status *status;
2284
2285 status = IEEE80211_SKB_RXCB((rx->skb));
2286
2287 sband = rx->local->hw.wiphy->bands[status->band];
2288 if (!(status->flag & RX_FLAG_HT))
2289 rate = &sband->bitrates[status->rate_idx];
2290
2291 ieee80211_rx_cooked_monitor(rx, rate);
2292 break;
2293 }
2294 case RX_DROP_UNUSABLE:
2295 I802_DEBUG_INC(rx->sdata->local->rx_handlers_drop);
2296 if (rx->sta)
2297 rx->sta->rx_dropped++;
2298 dev_kfree_skb(rx->skb);
2299 break;
2300 case RX_QUEUED:
2301 I802_DEBUG_INC(rx->sdata->local->rx_handlers_queued);
2302 break;
2303 }
2304}
571ecf67 2305
aa0c8636
CL
2306static void ieee80211_rx_handlers(struct ieee80211_rx_data *rx,
2307 struct sk_buff_head *frames)
58905290 2308{
58905290 2309 ieee80211_rx_result res = RX_DROP_MONITOR;
aa0c8636 2310 struct sk_buff *skb;
8944b79f 2311
e32f85f7
LCC
2312#define CALL_RXH(rxh) \
2313 do { \
2314 res = rxh(rx); \
2315 if (res != RX_CONTINUE) \
2569a826 2316 goto rxh_next; \
e32f85f7 2317 } while (0);
49461622 2318
aa0c8636 2319 while ((skb = __skb_dequeue(frames))) {
2569a826
JB
2320 /*
2321 * all the other fields are valid across frames
2322 * that belong to an aMPDU since they are on the
2323 * same TID from the same station
2324 */
2325 rx->skb = skb;
2326
2327 CALL_RXH(ieee80211_rx_h_decrypt)
2328 CALL_RXH(ieee80211_rx_h_check_more_data)
2329 CALL_RXH(ieee80211_rx_h_sta_process)
2330 CALL_RXH(ieee80211_rx_h_defragment)
2331 CALL_RXH(ieee80211_rx_h_ps_poll)
2332 CALL_RXH(ieee80211_rx_h_michael_mic_verify)
2333 /* must be after MMIC verify so header is counted in MPDU mic */
2334 CALL_RXH(ieee80211_rx_h_remove_qos_control)
2335 CALL_RXH(ieee80211_rx_h_amsdu)
bf94e17b 2336#ifdef CONFIG_MAC80211_MESH
aa0c8636 2337 if (ieee80211_vif_is_mesh(&rx->sdata->vif))
2569a826 2338 CALL_RXH(ieee80211_rx_h_mesh_fwding);
bf94e17b 2339#endif
2569a826
JB
2340 CALL_RXH(ieee80211_rx_h_data)
2341
2342 /* special treatment -- needs the queue */
aa0c8636 2343 res = ieee80211_rx_h_ctrl(rx, frames);
2569a826
JB
2344 if (res != RX_CONTINUE)
2345 goto rxh_next;
2346
2347 CALL_RXH(ieee80211_rx_h_action)
2348 CALL_RXH(ieee80211_rx_h_mgmt)
49461622 2349
aa0c8636
CL
2350 rxh_next:
2351 ieee80211_rx_handlers_result(rx, res);
2352
49461622 2353#undef CALL_RXH
aa0c8636
CL
2354 }
2355}
2356
2357static void ieee80211_invoke_rx_handlers(struct ieee80211_sub_if_data *sdata,
2358 struct ieee80211_rx_data *rx,
071d9ac2 2359 struct sk_buff *skb)
aa0c8636
CL
2360{
2361 struct sk_buff_head reorder_release;
2362 ieee80211_rx_result res = RX_DROP_MONITOR;
2363
2364 __skb_queue_head_init(&reorder_release);
2365
2366 rx->skb = skb;
2367 rx->sdata = sdata;
2368
2369#define CALL_RXH(rxh) \
2370 do { \
2371 res = rxh(rx); \
2372 if (res != RX_CONTINUE) \
2373 goto rxh_next; \
2374 } while (0);
2375
2376 CALL_RXH(ieee80211_rx_h_passive_scan)
2377 CALL_RXH(ieee80211_rx_h_check)
2378
2379 ieee80211_rx_reorder_ampdu(rx, &reorder_release);
2380
2381 ieee80211_rx_handlers(rx, &reorder_release);
2382 return;
49461622 2383
2569a826 2384 rxh_next:
aa0c8636
CL
2385 ieee80211_rx_handlers_result(rx, res);
2386
2387#undef CALL_RXH
58905290
JB
2388}
2389
571ecf67
JB
2390/* main receive path */
2391
23a24def 2392static int prepare_for_handlers(struct ieee80211_sub_if_data *sdata,
7ab17c45 2393 struct ieee80211_rx_data *rx,
23a24def
JB
2394 struct ieee80211_hdr *hdr)
2395{
eb9fb5b8
JB
2396 struct sk_buff *skb = rx->skb;
2397 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
2398 u8 *bssid = ieee80211_get_bssid(hdr, skb->len, sdata->vif.type);
23a24def
JB
2399 int multicast = is_multicast_ether_addr(hdr->addr1);
2400
51fb61e7 2401 switch (sdata->vif.type) {
05c914fe 2402 case NL80211_IFTYPE_STATION:
9bc383de 2403 if (!bssid && !sdata->u.mgd.use_4addr)
23a24def 2404 return 0;
77fdaa12 2405 if (!multicast &&
47846c9b 2406 compare_ether_addr(sdata->vif.addr, hdr->addr1) != 0) {
4150c572 2407 if (!(sdata->dev->flags & IFF_PROMISC))
23a24def 2408 return 0;
5cf121c3 2409 rx->flags &= ~IEEE80211_RX_RA_MATCH;
23a24def
JB
2410 }
2411 break;
05c914fe 2412 case NL80211_IFTYPE_ADHOC:
23a24def
JB
2413 if (!bssid)
2414 return 0;
a7767f95 2415 if (ieee80211_is_beacon(hdr->frame_control)) {
9d9bf77d 2416 return 1;
87291c02 2417 }
46900298 2418 else if (!ieee80211_bssid_match(bssid, sdata->u.ibss.bssid)) {
5cf121c3 2419 if (!(rx->flags & IEEE80211_RX_IN_SCAN))
23a24def 2420 return 0;
5cf121c3 2421 rx->flags &= ~IEEE80211_RX_RA_MATCH;
23a24def 2422 } else if (!multicast &&
47846c9b 2423 compare_ether_addr(sdata->vif.addr,
23a24def 2424 hdr->addr1) != 0) {
4150c572 2425 if (!(sdata->dev->flags & IFF_PROMISC))
23a24def 2426 return 0;
5cf121c3 2427 rx->flags &= ~IEEE80211_RX_RA_MATCH;
0fb8ca45
JM
2428 } else if (!rx->sta) {
2429 int rate_idx;
eb9fb5b8 2430 if (status->flag & RX_FLAG_HT)
0fb8ca45
JM
2431 rate_idx = 0; /* TODO: HT rates */
2432 else
eb9fb5b8 2433 rate_idx = status->rate_idx;
34e89507
JB
2434 rx->sta = ieee80211_ibss_add_sta(sdata, bssid,
2435 hdr->addr2, BIT(rate_idx), GFP_ATOMIC);
0fb8ca45 2436 }
23a24def 2437 break;
05c914fe 2438 case NL80211_IFTYPE_MESH_POINT:
6032f934 2439 if (!multicast &&
47846c9b 2440 compare_ether_addr(sdata->vif.addr,
6032f934
JB
2441 hdr->addr1) != 0) {
2442 if (!(sdata->dev->flags & IFF_PROMISC))
2443 return 0;
2444
5cf121c3 2445 rx->flags &= ~IEEE80211_RX_RA_MATCH;
6032f934
JB
2446 }
2447 break;
05c914fe
JB
2448 case NL80211_IFTYPE_AP_VLAN:
2449 case NL80211_IFTYPE_AP:
23a24def 2450 if (!bssid) {
47846c9b 2451 if (compare_ether_addr(sdata->vif.addr,
23a24def
JB
2452 hdr->addr1))
2453 return 0;
2454 } else if (!ieee80211_bssid_match(bssid,
47846c9b 2455 sdata->vif.addr)) {
5cf121c3 2456 if (!(rx->flags & IEEE80211_RX_IN_SCAN))
23a24def 2457 return 0;
5cf121c3 2458 rx->flags &= ~IEEE80211_RX_RA_MATCH;
23a24def 2459 }
23a24def 2460 break;
05c914fe 2461 case NL80211_IFTYPE_WDS:
a7767f95 2462 if (bssid || !ieee80211_is_data(hdr->frame_control))
23a24def
JB
2463 return 0;
2464 if (compare_ether_addr(sdata->u.wds.remote_addr, hdr->addr2))
2465 return 0;
2466 break;
05c914fe 2467 case NL80211_IFTYPE_MONITOR:
05c914fe
JB
2468 case NL80211_IFTYPE_UNSPECIFIED:
2469 case __NL80211_IFTYPE_AFTER_LAST:
fb1c1cd6
JB
2470 /* should never get here */
2471 WARN_ON(1);
2472 break;
23a24def
JB
2473 }
2474
2475 return 1;
2476}
2477
571ecf67 2478/*
6368e4b1
RR
2479 * This is the actual Rx frames handler. as it blongs to Rx path it must
2480 * be called with rcu_read_lock protection.
571ecf67 2481 */
71ebb4aa 2482static void __ieee80211_rx_handle_packet(struct ieee80211_hw *hw,
071d9ac2 2483 struct sk_buff *skb)
571ecf67 2484{
f1d58c25 2485 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
571ecf67
JB
2486 struct ieee80211_local *local = hw_to_local(hw);
2487 struct ieee80211_sub_if_data *sdata;
571ecf67 2488 struct ieee80211_hdr *hdr;
e3cf8b3f 2489 __le16 fc;
5cf121c3 2490 struct ieee80211_rx_data rx;
6368e4b1 2491 int prepares;
8e6f0032
JB
2492 struct ieee80211_sub_if_data *prev = NULL;
2493 struct sk_buff *skb_new;
abe60632
JB
2494 struct sta_info *sta, *tmp;
2495 bool found_sta = false;
e3cf8b3f 2496 int err = 0;
571ecf67 2497
e3cf8b3f 2498 fc = ((struct ieee80211_hdr *)skb->data)->frame_control;
571ecf67
JB
2499 memset(&rx, 0, sizeof(rx));
2500 rx.skb = skb;
2501 rx.local = local;
72abd81b 2502
e3cf8b3f 2503 if (ieee80211_is_data(fc) || ieee80211_is_mgmt(fc))
571ecf67 2504 local->dot11ReceivedFragmentCount++;
571ecf67 2505
142b9f50
HS
2506 if (unlikely(test_bit(SCAN_HW_SCANNING, &local->scanning) ||
2507 test_bit(SCAN_OFF_CHANNEL, &local->scanning)))
5cf121c3 2508 rx.flags |= IEEE80211_RX_IN_SCAN;
571ecf67 2509
e3cf8b3f
ZY
2510 if (ieee80211_is_mgmt(fc))
2511 err = skb_linearize(skb);
2512 else
2513 err = !pskb_may_pull(skb, ieee80211_hdrlen(fc));
2514
2515 if (err) {
2516 dev_kfree_skb(skb);
2517 return;
2518 }
2519
2520 hdr = (struct ieee80211_hdr *)skb->data;
38f3714d 2521 ieee80211_parse_qos(&rx);
d1c3a37c 2522 ieee80211_verify_alignment(&rx);
38f3714d 2523
e3cf8b3f 2524 if (ieee80211_is_data(fc)) {
abe60632
JB
2525 for_each_sta_info(local, hdr->addr2, sta, tmp) {
2526 rx.sta = sta;
2527 found_sta = true;
2528 rx.sdata = sta->sdata;
2529
2530 rx.flags |= IEEE80211_RX_RA_MATCH;
2531 prepares = prepare_for_handlers(rx.sdata, &rx, hdr);
2532 if (prepares) {
2533 if (status->flag & RX_FLAG_MMIC_ERROR) {
2534 if (rx.flags & IEEE80211_RX_RA_MATCH)
2535 ieee80211_rx_michael_mic_report(hdr, &rx);
2536 } else
2537 prev = rx.sdata;
2538 }
af2ced6a 2539 }
abe60632
JB
2540 }
2541 if (!found_sta) {
2542 list_for_each_entry_rcu(sdata, &local->interfaces, list) {
9607e6b6 2543 if (!ieee80211_sdata_running(sdata))
abe60632 2544 continue;
2a8a9a88 2545
abe60632
JB
2546 if (sdata->vif.type == NL80211_IFTYPE_MONITOR ||
2547 sdata->vif.type == NL80211_IFTYPE_AP_VLAN)
2548 continue;
b2e7771e 2549
abe60632
JB
2550 /*
2551 * frame is destined for this interface, but if it's
2552 * not also for the previous one we handle that after
2553 * the loop to avoid copying the SKB once too much
2554 */
340e11f3 2555
abe60632
JB
2556 if (!prev) {
2557 prev = sdata;
2558 continue;
2559 }
340e11f3 2560
4754ffd6 2561 rx.sta = sta_info_get_bss(prev, hdr->addr2);
4bb29f8c
FF
2562
2563 rx.flags |= IEEE80211_RX_RA_MATCH;
2564 prepares = prepare_for_handlers(prev, &rx, hdr);
2565
2566 if (!prepares)
2567 goto next;
2568
2569 if (status->flag & RX_FLAG_MMIC_ERROR) {
2570 rx.sdata = prev;
2571 if (rx.flags & IEEE80211_RX_RA_MATCH)
2572 ieee80211_rx_michael_mic_report(hdr,
2573 &rx);
2574 goto next;
2575 }
2576
abe60632
JB
2577 /*
2578 * frame was destined for the previous interface
2579 * so invoke RX handlers for it
2580 */
2581
2582 skb_new = skb_copy(skb, GFP_ATOMIC);
2583 if (!skb_new) {
2584 if (net_ratelimit())
2585 printk(KERN_DEBUG "%s: failed to copy "
2586 "multicast frame for %s\n",
2587 wiphy_name(local->hw.wiphy),
47846c9b 2588 prev->name);
4bb29f8c 2589 goto next;
abe60632 2590 }
071d9ac2 2591 ieee80211_invoke_rx_handlers(prev, &rx, skb_new);
4bb29f8c 2592next:
abe60632 2593 prev = sdata;
340e11f3 2594 }
4bb29f8c
FF
2595
2596 if (prev) {
4754ffd6 2597 rx.sta = sta_info_get_bss(prev, hdr->addr2);
4bb29f8c
FF
2598
2599 rx.flags |= IEEE80211_RX_RA_MATCH;
2600 prepares = prepare_for_handlers(prev, &rx, hdr);
2601
2602 if (!prepares)
2603 prev = NULL;
2604 }
571ecf67 2605 }
a4b7d7bd 2606 if (prev)
071d9ac2 2607 ieee80211_invoke_rx_handlers(prev, &rx, skb);
a4b7d7bd 2608 else
8e6f0032 2609 dev_kfree_skb(skb);
571ecf67 2610}
6368e4b1
RR
2611
2612/*
2613 * This is the receive path handler. It is called by a low level driver when an
2614 * 802.11 MPDU is received from the hardware.
2615 */
103bf9f7 2616void ieee80211_rx(struct ieee80211_hw *hw, struct sk_buff *skb)
6368e4b1
RR
2617{
2618 struct ieee80211_local *local = hw_to_local(hw);
8318d78a
JB
2619 struct ieee80211_rate *rate = NULL;
2620 struct ieee80211_supported_band *sband;
f1d58c25 2621 struct ieee80211_rx_status *status = IEEE80211_SKB_RXCB(skb);
8318d78a 2622
d20ef63d
JB
2623 WARN_ON_ONCE(softirq_count() == 0);
2624
77a980dc
JB
2625 if (WARN_ON(status->band < 0 ||
2626 status->band >= IEEE80211_NUM_BANDS))
2627 goto drop;
8318d78a
JB
2628
2629 sband = local->hw.wiphy->bands[status->band];
77a980dc
JB
2630 if (WARN_ON(!sband))
2631 goto drop;
8318d78a 2632
89c3a8ac
JB
2633 /*
2634 * If we're suspending, it is possible although not too likely
2635 * that we'd be receiving frames after having already partially
2636 * quiesced the stack. We can't process such frames then since
2637 * that might, for example, cause stations to be added or other
2638 * driver callbacks be invoked.
2639 */
77a980dc
JB
2640 if (unlikely(local->quiescing || local->suspended))
2641 goto drop;
89c3a8ac 2642
ea77f12f
JB
2643 /*
2644 * The same happens when we're not even started,
2645 * but that's worth a warning.
2646 */
77a980dc
JB
2647 if (WARN_ON(!local->started))
2648 goto drop;
ea77f12f 2649
fc885189 2650 if (likely(!(status->flag & RX_FLAG_FAILED_PLCP_CRC))) {
e5d6eb83 2651 /*
fc885189
JB
2652 * Validate the rate, unless a PLCP error means that
2653 * we probably can't have a valid rate here anyway.
e5d6eb83 2654 */
fc885189
JB
2655
2656 if (status->flag & RX_FLAG_HT) {
2657 /*
2658 * rate_idx is MCS index, which can be [0-76]
2659 * as documented on:
2660 *
2661 * http://wireless.kernel.org/en/developers/Documentation/ieee80211/802.11n
2662 *
2663 * Anything else would be some sort of driver or
2664 * hardware error. The driver should catch hardware
2665 * errors.
2666 */
2667 if (WARN((status->rate_idx < 0 ||
2668 status->rate_idx > 76),
2669 "Rate marked as an HT rate but passed "
2670 "status->rate_idx is not "
2671 "an MCS index [0-76]: %d (0x%02x)\n",
2672 status->rate_idx,
2673 status->rate_idx))
2674 goto drop;
2675 } else {
2676 if (WARN_ON(status->rate_idx < 0 ||
2677 status->rate_idx >= sband->n_bitrates))
2678 goto drop;
2679 rate = &sband->bitrates[status->rate_idx];
2680 }
0fb8ca45 2681 }
6368e4b1
RR
2682
2683 /*
2684 * key references and virtual interfaces are protected using RCU
2685 * and this requires that we are in a read-side RCU section during
2686 * receive processing
2687 */
2688 rcu_read_lock();
2689
2690 /*
2691 * Frames with failed FCS/PLCP checksum are not returned,
2692 * all other frames are returned without radiotap header
2693 * if it was previously present.
2694 * Also, frames with less than 16 bytes are dropped.
2695 */
f1d58c25 2696 skb = ieee80211_rx_monitor(local, skb, rate);
6368e4b1
RR
2697 if (!skb) {
2698 rcu_read_unlock();
2699 return;
2700 }
2701
071d9ac2 2702 __ieee80211_rx_handle_packet(hw, skb);
6368e4b1
RR
2703
2704 rcu_read_unlock();
77a980dc
JB
2705
2706 return;
2707 drop:
2708 kfree_skb(skb);
6368e4b1 2709}
103bf9f7 2710EXPORT_SYMBOL(ieee80211_rx);
571ecf67
JB
2711
2712/* This is a version of the rx handler that can be called from hard irq
2713 * context. Post the skb on the queue and schedule the tasklet */
f1d58c25 2714void ieee80211_rx_irqsafe(struct ieee80211_hw *hw, struct sk_buff *skb)
571ecf67
JB
2715{
2716 struct ieee80211_local *local = hw_to_local(hw);
2717
2718 BUILD_BUG_ON(sizeof(struct ieee80211_rx_status) > sizeof(skb->cb));
2719
571ecf67
JB
2720 skb->pkt_type = IEEE80211_RX_MSG;
2721 skb_queue_tail(&local->skb_queue, skb);
2722 tasklet_schedule(&local->tasklet);
2723}
2724EXPORT_SYMBOL(ieee80211_rx_irqsafe);