2 * Copyright 2002-2005, Instant802 Networks, Inc.
3 * Copyright 2005-2006, Devicescape Software, Inc.
4 * Copyright 2006-2007 Jiri Benc <jbenc@suse.cz>
5 * Copyright 2007 Johannes Berg <johannes@sipsolutions.net>
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.
12 #include <linux/jiffies.h>
13 #include <linux/kernel.h>
14 #include <linux/skbuff.h>
15 #include <linux/netdevice.h>
16 #include <linux/etherdevice.h>
17 #include <linux/rcupdate.h>
18 #include <net/mac80211.h>
19 #include <net/ieee80211_radiotap.h>
21 #include "ieee80211_i.h"
29 u8
ieee80211_sta_manage_reorder_buf(struct ieee80211_hw
*hw
,
30 struct tid_ampdu_rx
*tid_agg_rx
,
31 struct sk_buff
*skb
, u16 mpdu_seq_num
,
34 * monitor mode reception
36 * This function cleans up the SKB, i.e. it removes all the stuff
37 * only useful for monitoring.
39 static struct sk_buff
*remove_monitor_info(struct ieee80211_local
*local
,
43 skb_pull(skb
, rtap_len
);
45 if (local
->hw
.flags
& IEEE80211_HW_RX_INCLUDES_FCS
) {
46 if (likely(skb
->len
> FCS_LEN
))
47 skb_trim(skb
, skb
->len
- FCS_LEN
);
59 static inline int should_drop_frame(struct ieee80211_rx_status
*status
,
64 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)skb
->data
;
66 if (status
->flag
& (RX_FLAG_FAILED_FCS_CRC
| RX_FLAG_FAILED_PLCP_CRC
))
68 if (unlikely(skb
->len
< 16 + present_fcs_len
+ radiotap_len
))
70 if (ieee80211_is_ctl(hdr
->frame_control
) &&
71 !ieee80211_is_pspoll(hdr
->frame_control
) &&
72 !ieee80211_is_back_req(hdr
->frame_control
))
78 ieee80211_rx_radiotap_len(struct ieee80211_local
*local
,
79 struct ieee80211_rx_status
*status
)
83 /* always present fields */
84 len
= sizeof(struct ieee80211_radiotap_header
) + 9;
86 if (status
->flag
& RX_FLAG_TSFT
)
88 if (local
->hw
.flags
& IEEE80211_HW_SIGNAL_DB
||
89 local
->hw
.flags
& IEEE80211_HW_SIGNAL_DBM
)
91 if (local
->hw
.flags
& IEEE80211_HW_NOISE_DBM
)
94 if (len
& 1) /* padding for RX_FLAGS if necessary */
97 /* make sure radiotap starts at a naturally aligned address */
99 len
= roundup(len
, 8);
105 * ieee80211_add_rx_radiotap_header - add radiotap header
107 * add a radiotap header containing all the fields which the hardware provided.
110 ieee80211_add_rx_radiotap_header(struct ieee80211_local
*local
,
112 struct ieee80211_rx_status
*status
,
113 struct ieee80211_rate
*rate
,
116 struct ieee80211_radiotap_header
*rthdr
;
119 rthdr
= (struct ieee80211_radiotap_header
*)skb_push(skb
, rtap_len
);
120 memset(rthdr
, 0, rtap_len
);
122 /* radiotap header, set always present flags */
124 cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS
) |
125 (1 << IEEE80211_RADIOTAP_RATE
) |
126 (1 << IEEE80211_RADIOTAP_CHANNEL
) |
127 (1 << IEEE80211_RADIOTAP_ANTENNA
) |
128 (1 << IEEE80211_RADIOTAP_RX_FLAGS
));
129 rthdr
->it_len
= cpu_to_le16(rtap_len
);
131 pos
= (unsigned char *)(rthdr
+1);
133 /* the order of the following fields is important */
135 /* IEEE80211_RADIOTAP_TSFT */
136 if (status
->flag
& RX_FLAG_TSFT
) {
137 *(__le64
*)pos
= cpu_to_le64(status
->mactime
);
139 cpu_to_le32(1 << IEEE80211_RADIOTAP_TSFT
);
143 /* IEEE80211_RADIOTAP_FLAGS */
144 if (local
->hw
.flags
& IEEE80211_HW_RX_INCLUDES_FCS
)
145 *pos
|= IEEE80211_RADIOTAP_F_FCS
;
146 if (status
->flag
& RX_FLAG_SHORTPRE
)
147 *pos
|= IEEE80211_RADIOTAP_F_SHORTPRE
;
150 /* IEEE80211_RADIOTAP_RATE */
151 *pos
= rate
->bitrate
/ 5;
154 /* IEEE80211_RADIOTAP_CHANNEL */
155 *(__le16
*)pos
= cpu_to_le16(status
->freq
);
157 if (status
->band
== IEEE80211_BAND_5GHZ
)
158 *(__le16
*)pos
= cpu_to_le16(IEEE80211_CHAN_OFDM
|
159 IEEE80211_CHAN_5GHZ
);
160 else if (rate
->flags
& IEEE80211_RATE_ERP_G
)
161 *(__le16
*)pos
= cpu_to_le16(IEEE80211_CHAN_OFDM
|
162 IEEE80211_CHAN_2GHZ
);
164 *(__le16
*)pos
= cpu_to_le16(IEEE80211_CHAN_CCK
|
165 IEEE80211_CHAN_2GHZ
);
168 /* IEEE80211_RADIOTAP_DBM_ANTSIGNAL */
169 if (local
->hw
.flags
& IEEE80211_HW_SIGNAL_DBM
) {
170 *pos
= status
->signal
;
172 cpu_to_le32(1 << IEEE80211_RADIOTAP_DBM_ANTSIGNAL
);
176 /* IEEE80211_RADIOTAP_DBM_ANTNOISE */
177 if (local
->hw
.flags
& IEEE80211_HW_NOISE_DBM
) {
178 *pos
= status
->noise
;
180 cpu_to_le32(1 << IEEE80211_RADIOTAP_DBM_ANTNOISE
);
184 /* IEEE80211_RADIOTAP_LOCK_QUALITY is missing */
186 /* IEEE80211_RADIOTAP_ANTENNA */
187 *pos
= status
->antenna
;
190 /* IEEE80211_RADIOTAP_DB_ANTSIGNAL */
191 if (local
->hw
.flags
& IEEE80211_HW_SIGNAL_DB
) {
192 *pos
= status
->signal
;
194 cpu_to_le32(1 << IEEE80211_RADIOTAP_DB_ANTSIGNAL
);
198 /* IEEE80211_RADIOTAP_DB_ANTNOISE is not used */
200 /* IEEE80211_RADIOTAP_RX_FLAGS */
201 /* ensure 2 byte alignment for the 2 byte field as required */
202 if ((pos
- (unsigned char *)rthdr
) & 1)
204 /* FIXME: when radiotap gets a 'bad PLCP' flag use it here */
205 if (status
->flag
& (RX_FLAG_FAILED_FCS_CRC
| RX_FLAG_FAILED_PLCP_CRC
))
206 *(__le16
*)pos
|= cpu_to_le16(IEEE80211_RADIOTAP_F_RX_BADFCS
);
211 * This function copies a received frame to all monitor interfaces and
212 * returns a cleaned-up SKB that no longer includes the FCS nor the
213 * radiotap header the driver might have added.
215 static struct sk_buff
*
216 ieee80211_rx_monitor(struct ieee80211_local
*local
, struct sk_buff
*origskb
,
217 struct ieee80211_rx_status
*status
,
218 struct ieee80211_rate
*rate
)
220 struct ieee80211_sub_if_data
*sdata
;
221 int needed_headroom
= 0;
222 struct sk_buff
*skb
, *skb2
;
223 struct net_device
*prev_dev
= NULL
;
224 int present_fcs_len
= 0;
228 * First, we may need to make a copy of the skb because
229 * (1) we need to modify it for radiotap (if not present), and
230 * (2) the other RX handlers will modify the skb we got.
232 * We don't need to, of course, if we aren't going to return
233 * the SKB because it has a bad FCS/PLCP checksum.
235 if (status
->flag
& RX_FLAG_RADIOTAP
)
236 rtap_len
= ieee80211_get_radiotap_len(origskb
->data
);
238 /* room for the radiotap header based on driver features */
239 needed_headroom
= ieee80211_rx_radiotap_len(local
, status
);
241 if (local
->hw
.flags
& IEEE80211_HW_RX_INCLUDES_FCS
)
242 present_fcs_len
= FCS_LEN
;
244 if (!local
->monitors
) {
245 if (should_drop_frame(status
, origskb
, present_fcs_len
,
247 dev_kfree_skb(origskb
);
251 return remove_monitor_info(local
, origskb
, rtap_len
);
254 if (should_drop_frame(status
, origskb
, present_fcs_len
, rtap_len
)) {
255 /* only need to expand headroom if necessary */
260 * This shouldn't trigger often because most devices have an
261 * RX header they pull before we get here, and that should
262 * be big enough for our radiotap information. We should
263 * probably export the length to drivers so that we can have
264 * them allocate enough headroom to start with.
266 if (skb_headroom(skb
) < needed_headroom
&&
267 pskb_expand_head(skb
, needed_headroom
, 0, GFP_ATOMIC
)) {
273 * Need to make a copy and possibly remove radiotap header
274 * and FCS from the original.
276 skb
= skb_copy_expand(origskb
, needed_headroom
, 0, GFP_ATOMIC
);
278 origskb
= remove_monitor_info(local
, origskb
, rtap_len
);
284 /* if necessary, prepend radiotap information */
285 if (!(status
->flag
& RX_FLAG_RADIOTAP
))
286 ieee80211_add_rx_radiotap_header(local
, skb
, status
, rate
,
289 skb_reset_mac_header(skb
);
290 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
291 skb
->pkt_type
= PACKET_OTHERHOST
;
292 skb
->protocol
= htons(ETH_P_802_2
);
294 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
295 if (!netif_running(sdata
->dev
))
298 if (sdata
->vif
.type
!= NL80211_IFTYPE_MONITOR
)
301 if (sdata
->u
.mntr_flags
& MONITOR_FLAG_COOK_FRAMES
)
305 skb2
= skb_clone(skb
, GFP_ATOMIC
);
307 skb2
->dev
= prev_dev
;
312 prev_dev
= sdata
->dev
;
313 sdata
->dev
->stats
.rx_packets
++;
314 sdata
->dev
->stats
.rx_bytes
+= skb
->len
;
327 static void ieee80211_parse_qos(struct ieee80211_rx_data
*rx
)
329 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
332 /* does the frame have a qos control field? */
333 if (ieee80211_is_data_qos(hdr
->frame_control
)) {
334 u8
*qc
= ieee80211_get_qos_ctl(hdr
);
335 /* frame has qos control */
336 tid
= *qc
& IEEE80211_QOS_CTL_TID_MASK
;
337 if (*qc
& IEEE80211_QOS_CONTROL_A_MSDU_PRESENT
)
338 rx
->flags
|= IEEE80211_RX_AMSDU
;
340 rx
->flags
&= ~IEEE80211_RX_AMSDU
;
343 * IEEE 802.11-2007, 7.1.3.4.1 ("Sequence Number field"):
345 * Sequence numbers for management frames, QoS data
346 * frames with a broadcast/multicast address in the
347 * Address 1 field, and all non-QoS data frames sent
348 * by QoS STAs are assigned using an additional single
349 * modulo-4096 counter, [...]
351 * We also use that counter for non-QoS STAs.
353 tid
= NUM_RX_DATA_QUEUES
- 1;
357 /* Set skb->priority to 1d tag if highest order bit of TID is not set.
358 * For now, set skb->priority to 0 for other cases. */
359 rx
->skb
->priority
= (tid
> 7) ? 0 : tid
;
362 static void ieee80211_verify_ip_alignment(struct ieee80211_rx_data
*rx
)
364 #ifdef CONFIG_MAC80211_DEBUG_PACKET_ALIGNMENT
365 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
368 if (!ieee80211_is_data_present(hdr
->frame_control
))
372 * Drivers are required to align the payload data in a way that
373 * guarantees that the contained IP header is aligned to a four-
374 * byte boundary. In the case of regular frames, this simply means
375 * aligning the payload to a four-byte boundary (because either
376 * the IP header is directly contained, or IV/RFC1042 headers that
377 * have a length divisible by four are in front of it.
379 * With A-MSDU frames, however, the payload data address must
380 * yield two modulo four because there are 14-byte 802.3 headers
381 * within the A-MSDU frames that push the IP header further back
382 * to a multiple of four again. Thankfully, the specs were sane
383 * enough this time around to require padding each A-MSDU subframe
384 * to a length that is a multiple of four.
386 * Padding like atheros hardware adds which is inbetween the 802.11
387 * header and the payload is not supported, the driver is required
388 * to move the 802.11 header further back in that case.
390 hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
391 if (rx
->flags
& IEEE80211_RX_AMSDU
)
393 WARN_ON_ONCE(((unsigned long)(rx
->skb
->data
+ hdrlen
)) & 3);
400 static ieee80211_rx_result debug_noinline
401 ieee80211_rx_h_passive_scan(struct ieee80211_rx_data
*rx
)
403 struct ieee80211_local
*local
= rx
->local
;
404 struct sk_buff
*skb
= rx
->skb
;
406 if (unlikely(local
->hw_scanning
))
407 return ieee80211_scan_rx(rx
->sdata
, skb
, rx
->status
);
409 if (unlikely(local
->sw_scanning
)) {
410 /* drop all the other packets during a software scan anyway */
411 if (ieee80211_scan_rx(rx
->sdata
, skb
, rx
->status
)
417 if (unlikely(rx
->flags
& IEEE80211_RX_IN_SCAN
)) {
418 /* scanning finished during invoking of handlers */
419 I802_DEBUG_INC(local
->rx_handlers_drop_passive_scan
);
420 return RX_DROP_UNUSABLE
;
426 static ieee80211_rx_result
427 ieee80211_rx_mesh_check(struct ieee80211_rx_data
*rx
)
429 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
430 unsigned int hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
432 if (ieee80211_is_data(hdr
->frame_control
)) {
433 if (!ieee80211_has_a4(hdr
->frame_control
))
434 return RX_DROP_MONITOR
;
435 if (memcmp(hdr
->addr4
, rx
->dev
->dev_addr
, ETH_ALEN
) == 0)
436 return RX_DROP_MONITOR
;
439 /* If there is not an established peer link and this is not a peer link
440 * establisment frame, beacon or probe, drop the frame.
443 if (!rx
->sta
|| sta_plink_state(rx
->sta
) != PLINK_ESTAB
) {
444 struct ieee80211_mgmt
*mgmt
;
446 if (!ieee80211_is_mgmt(hdr
->frame_control
))
447 return RX_DROP_MONITOR
;
449 if (ieee80211_is_action(hdr
->frame_control
)) {
450 mgmt
= (struct ieee80211_mgmt
*)hdr
;
451 if (mgmt
->u
.action
.category
!= PLINK_CATEGORY
)
452 return RX_DROP_MONITOR
;
456 if (ieee80211_is_probe_req(hdr
->frame_control
) ||
457 ieee80211_is_probe_resp(hdr
->frame_control
) ||
458 ieee80211_is_beacon(hdr
->frame_control
))
461 return RX_DROP_MONITOR
;
465 #define msh_h_get(h, l) ((struct ieee80211s_hdr *) ((u8 *)h + l))
467 if (ieee80211_is_data(hdr
->frame_control
) &&
468 is_multicast_ether_addr(hdr
->addr1
) &&
469 mesh_rmc_check(hdr
->addr4
, msh_h_get(hdr
, hdrlen
), rx
->sdata
))
470 return RX_DROP_MONITOR
;
477 static ieee80211_rx_result debug_noinline
478 ieee80211_rx_h_check(struct ieee80211_rx_data
*rx
)
480 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
482 /* Drop duplicate 802.11 retransmissions (IEEE 802.11 Chap. 9.2.9) */
483 if (rx
->sta
&& !is_multicast_ether_addr(hdr
->addr1
)) {
484 if (unlikely(ieee80211_has_retry(hdr
->frame_control
) &&
485 rx
->sta
->last_seq_ctrl
[rx
->queue
] ==
487 if (rx
->flags
& IEEE80211_RX_RA_MATCH
) {
488 rx
->local
->dot11FrameDuplicateCount
++;
489 rx
->sta
->num_duplicates
++;
491 return RX_DROP_MONITOR
;
493 rx
->sta
->last_seq_ctrl
[rx
->queue
] = hdr
->seq_ctrl
;
496 if (unlikely(rx
->skb
->len
< 16)) {
497 I802_DEBUG_INC(rx
->local
->rx_handlers_drop_short
);
498 return RX_DROP_MONITOR
;
501 /* Drop disallowed frame classes based on STA auth/assoc state;
502 * IEEE 802.11, Chap 5.5.
504 * mac80211 filters only based on association state, i.e. it drops
505 * Class 3 frames from not associated stations. hostapd sends
506 * deauth/disassoc frames when needed. In addition, hostapd is
507 * responsible for filtering on both auth and assoc states.
510 if (ieee80211_vif_is_mesh(&rx
->sdata
->vif
))
511 return ieee80211_rx_mesh_check(rx
);
513 if (unlikely((ieee80211_is_data(hdr
->frame_control
) ||
514 ieee80211_is_pspoll(hdr
->frame_control
)) &&
515 rx
->sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
&&
516 (!rx
->sta
|| !test_sta_flags(rx
->sta
, WLAN_STA_ASSOC
)))) {
517 if ((!ieee80211_has_fromds(hdr
->frame_control
) &&
518 !ieee80211_has_tods(hdr
->frame_control
) &&
519 ieee80211_is_data(hdr
->frame_control
)) ||
520 !(rx
->flags
& IEEE80211_RX_RA_MATCH
)) {
521 /* Drop IBSS frames and frames for other hosts
523 return RX_DROP_MONITOR
;
526 return RX_DROP_MONITOR
;
533 static ieee80211_rx_result debug_noinline
534 ieee80211_rx_h_decrypt(struct ieee80211_rx_data
*rx
)
536 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
539 ieee80211_rx_result result
= RX_DROP_UNUSABLE
;
540 struct ieee80211_key
*stakey
= NULL
;
545 * There are three types of keys:
547 * - PTK (pairwise keys)
548 * - STK (station-to-station pairwise keys)
550 * When selecting a key, we have to distinguish between multicast
551 * (including broadcast) and unicast frames, the latter can only
552 * use PTKs and STKs while the former always use GTKs. Unless, of
553 * course, actual WEP keys ("pre-RSNA") are used, then unicast
554 * frames can also use key indizes like GTKs. Hence, if we don't
555 * have a PTK/STK we check the key index for a WEP key.
557 * Note that in a regular BSS, multicast frames are sent by the
558 * AP only, associated stations unicast the frame to the AP first
559 * which then multicasts it on their behalf.
561 * There is also a slight problem in IBSS mode: GTKs are negotiated
562 * with each station, that is something we don't currently handle.
563 * The spec seems to expect that one negotiates the same key with
564 * every station but there's no such requirement; VLANs could be
568 if (!ieee80211_has_protected(hdr
->frame_control
))
572 * No point in finding a key and decrypting if the frame is neither
573 * addressed to us nor a multicast frame.
575 if (!(rx
->flags
& IEEE80211_RX_RA_MATCH
))
579 stakey
= rcu_dereference(rx
->sta
->key
);
581 if (!is_multicast_ether_addr(hdr
->addr1
) && stakey
) {
585 * The device doesn't give us the IV so we won't be
586 * able to look up the key. That's ok though, we
587 * don't need to decrypt the frame, we just won't
588 * be able to keep statistics accurate.
589 * Except for key threshold notifications, should
590 * we somehow allow the driver to tell us which key
591 * the hardware used if this flag is set?
593 if ((rx
->status
->flag
& RX_FLAG_DECRYPTED
) &&
594 (rx
->status
->flag
& RX_FLAG_IV_STRIPPED
))
597 hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
599 if (rx
->skb
->len
< 8 + hdrlen
)
600 return RX_DROP_UNUSABLE
; /* TODO: count this? */
603 * no need to call ieee80211_wep_get_keyidx,
604 * it verifies a bunch of things we've done already
606 keyidx
= rx
->skb
->data
[hdrlen
+ 3] >> 6;
608 rx
->key
= rcu_dereference(rx
->sdata
->keys
[keyidx
]);
611 * RSNA-protected unicast frames should always be sent with
612 * pairwise or station-to-station keys, but for WEP we allow
613 * using a key index as well.
615 if (rx
->key
&& rx
->key
->conf
.alg
!= ALG_WEP
&&
616 !is_multicast_ether_addr(hdr
->addr1
))
621 rx
->key
->tx_rx_count
++;
622 /* TODO: add threshold stuff again */
624 return RX_DROP_MONITOR
;
627 /* Check for weak IVs if possible */
628 if (rx
->sta
&& rx
->key
->conf
.alg
== ALG_WEP
&&
629 ieee80211_is_data(hdr
->frame_control
) &&
630 (!(rx
->status
->flag
& RX_FLAG_IV_STRIPPED
) ||
631 !(rx
->status
->flag
& RX_FLAG_DECRYPTED
)) &&
632 ieee80211_wep_is_weak_iv(rx
->skb
, rx
->key
))
633 rx
->sta
->wep_weak_iv_count
++;
635 switch (rx
->key
->conf
.alg
) {
637 result
= ieee80211_crypto_wep_decrypt(rx
);
640 result
= ieee80211_crypto_tkip_decrypt(rx
);
643 result
= ieee80211_crypto_ccmp_decrypt(rx
);
647 /* either the frame has been decrypted or will be dropped */
648 rx
->status
->flag
|= RX_FLAG_DECRYPTED
;
653 static void ap_sta_ps_start(struct sta_info
*sta
)
655 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
657 atomic_inc(&sdata
->bss
->num_sta_ps
);
658 set_and_clear_sta_flags(sta
, WLAN_STA_PS
, WLAN_STA_PSPOLL
);
659 #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
660 printk(KERN_DEBUG
"%s: STA %pM aid %d enters power save mode\n",
661 sdata
->dev
->name
, sta
->sta
.addr
, sta
->sta
.aid
);
662 #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
665 static int ap_sta_ps_end(struct sta_info
*sta
)
667 struct ieee80211_sub_if_data
*sdata
= sta
->sdata
;
668 struct ieee80211_local
*local
= sdata
->local
;
671 struct ieee80211_tx_info
*info
;
673 atomic_dec(&sdata
->bss
->num_sta_ps
);
675 clear_sta_flags(sta
, WLAN_STA_PS
| WLAN_STA_PSPOLL
);
677 if (!skb_queue_empty(&sta
->ps_tx_buf
))
678 sta_info_clear_tim_bit(sta
);
680 #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
681 printk(KERN_DEBUG
"%s: STA %pM aid %d exits power save mode\n",
682 sdata
->dev
->name
, sta
->sta
.addr
, sta
->sta
.aid
);
683 #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
685 /* Send all buffered frames to the station */
686 while ((skb
= skb_dequeue(&sta
->tx_filtered
)) != NULL
) {
687 info
= IEEE80211_SKB_CB(skb
);
689 info
->flags
|= IEEE80211_TX_CTL_REQUEUE
;
692 while ((skb
= skb_dequeue(&sta
->ps_tx_buf
)) != NULL
) {
693 info
= IEEE80211_SKB_CB(skb
);
694 local
->total_ps_buffered
--;
696 #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
697 printk(KERN_DEBUG
"%s: STA %pM aid %d send PS frame "
698 "since STA not sleeping anymore\n", sdata
->dev
->name
,
699 sta
->sta
.addr
, sta
->sta
.aid
);
700 #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
701 info
->flags
|= IEEE80211_TX_CTL_REQUEUE
;
708 static ieee80211_rx_result debug_noinline
709 ieee80211_rx_h_sta_process(struct ieee80211_rx_data
*rx
)
711 struct sta_info
*sta
= rx
->sta
;
712 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
717 /* Update last_rx only for IBSS packets which are for the current
718 * BSSID to avoid keeping the current IBSS network alive in cases where
719 * other STAs are using different BSSID. */
720 if (rx
->sdata
->vif
.type
== NL80211_IFTYPE_ADHOC
) {
721 u8
*bssid
= ieee80211_get_bssid(hdr
, rx
->skb
->len
,
722 NL80211_IFTYPE_ADHOC
);
723 if (compare_ether_addr(bssid
, rx
->sdata
->u
.sta
.bssid
) == 0)
724 sta
->last_rx
= jiffies
;
726 if (!is_multicast_ether_addr(hdr
->addr1
) ||
727 rx
->sdata
->vif
.type
== NL80211_IFTYPE_STATION
) {
728 /* Update last_rx only for unicast frames in order to prevent
729 * the Probe Request frames (the only broadcast frames from a
730 * STA in infrastructure mode) from keeping a connection alive.
731 * Mesh beacons will update last_rx when if they are found to
732 * match the current local configuration when processed.
734 sta
->last_rx
= jiffies
;
737 if (!(rx
->flags
& IEEE80211_RX_RA_MATCH
))
741 sta
->rx_bytes
+= rx
->skb
->len
;
742 sta
->last_signal
= rx
->status
->signal
;
743 sta
->last_qual
= rx
->status
->qual
;
744 sta
->last_noise
= rx
->status
->noise
;
746 if (!ieee80211_has_morefrags(hdr
->frame_control
) &&
747 (rx
->sdata
->vif
.type
== NL80211_IFTYPE_AP
||
748 rx
->sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
)) {
749 /* Change STA power saving mode only in the end of a frame
750 * exchange sequence */
751 if (test_sta_flags(sta
, WLAN_STA_PS
) &&
752 !ieee80211_has_pm(hdr
->frame_control
))
753 rx
->sent_ps_buffered
+= ap_sta_ps_end(sta
);
754 else if (!test_sta_flags(sta
, WLAN_STA_PS
) &&
755 ieee80211_has_pm(hdr
->frame_control
))
756 ap_sta_ps_start(sta
);
759 /* Drop data::nullfunc frames silently, since they are used only to
760 * control station power saving mode. */
761 if (ieee80211_is_nullfunc(hdr
->frame_control
)) {
762 I802_DEBUG_INC(rx
->local
->rx_handlers_drop_nullfunc
);
763 /* Update counter and free packet here to avoid counting this
764 * as a dropped packed. */
766 dev_kfree_skb(rx
->skb
);
771 } /* ieee80211_rx_h_sta_process */
773 static inline struct ieee80211_fragment_entry
*
774 ieee80211_reassemble_add(struct ieee80211_sub_if_data
*sdata
,
775 unsigned int frag
, unsigned int seq
, int rx_queue
,
776 struct sk_buff
**skb
)
778 struct ieee80211_fragment_entry
*entry
;
781 idx
= sdata
->fragment_next
;
782 entry
= &sdata
->fragments
[sdata
->fragment_next
++];
783 if (sdata
->fragment_next
>= IEEE80211_FRAGMENT_MAX
)
784 sdata
->fragment_next
= 0;
786 if (!skb_queue_empty(&entry
->skb_list
)) {
787 #ifdef CONFIG_MAC80211_VERBOSE_DEBUG
788 struct ieee80211_hdr
*hdr
=
789 (struct ieee80211_hdr
*) entry
->skb_list
.next
->data
;
790 printk(KERN_DEBUG
"%s: RX reassembly removed oldest "
791 "fragment entry (idx=%d age=%lu seq=%d last_frag=%d "
792 "addr1=%pM addr2=%pM\n",
793 sdata
->dev
->name
, idx
,
794 jiffies
- entry
->first_frag_time
, entry
->seq
,
795 entry
->last_frag
, hdr
->addr1
, hdr
->addr2
);
797 __skb_queue_purge(&entry
->skb_list
);
800 __skb_queue_tail(&entry
->skb_list
, *skb
); /* no need for locking */
802 entry
->first_frag_time
= jiffies
;
804 entry
->rx_queue
= rx_queue
;
805 entry
->last_frag
= frag
;
807 entry
->extra_len
= 0;
812 static inline struct ieee80211_fragment_entry
*
813 ieee80211_reassemble_find(struct ieee80211_sub_if_data
*sdata
,
814 unsigned int frag
, unsigned int seq
,
815 int rx_queue
, struct ieee80211_hdr
*hdr
)
817 struct ieee80211_fragment_entry
*entry
;
820 idx
= sdata
->fragment_next
;
821 for (i
= 0; i
< IEEE80211_FRAGMENT_MAX
; i
++) {
822 struct ieee80211_hdr
*f_hdr
;
826 idx
= IEEE80211_FRAGMENT_MAX
- 1;
828 entry
= &sdata
->fragments
[idx
];
829 if (skb_queue_empty(&entry
->skb_list
) || entry
->seq
!= seq
||
830 entry
->rx_queue
!= rx_queue
||
831 entry
->last_frag
+ 1 != frag
)
834 f_hdr
= (struct ieee80211_hdr
*)entry
->skb_list
.next
->data
;
837 * Check ftype and addresses are equal, else check next fragment
839 if (((hdr
->frame_control
^ f_hdr
->frame_control
) &
840 cpu_to_le16(IEEE80211_FCTL_FTYPE
)) ||
841 compare_ether_addr(hdr
->addr1
, f_hdr
->addr1
) != 0 ||
842 compare_ether_addr(hdr
->addr2
, f_hdr
->addr2
) != 0)
845 if (time_after(jiffies
, entry
->first_frag_time
+ 2 * HZ
)) {
846 __skb_queue_purge(&entry
->skb_list
);
855 static ieee80211_rx_result debug_noinline
856 ieee80211_rx_h_defragment(struct ieee80211_rx_data
*rx
)
858 struct ieee80211_hdr
*hdr
;
861 unsigned int frag
, seq
;
862 struct ieee80211_fragment_entry
*entry
;
865 hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
866 fc
= hdr
->frame_control
;
867 sc
= le16_to_cpu(hdr
->seq_ctrl
);
868 frag
= sc
& IEEE80211_SCTL_FRAG
;
870 if (likely((!ieee80211_has_morefrags(fc
) && frag
== 0) ||
871 (rx
->skb
)->len
< 24 ||
872 is_multicast_ether_addr(hdr
->addr1
))) {
876 I802_DEBUG_INC(rx
->local
->rx_handlers_fragments
);
878 seq
= (sc
& IEEE80211_SCTL_SEQ
) >> 4;
881 /* This is the first fragment of a new frame. */
882 entry
= ieee80211_reassemble_add(rx
->sdata
, frag
, seq
,
883 rx
->queue
, &(rx
->skb
));
884 if (rx
->key
&& rx
->key
->conf
.alg
== ALG_CCMP
&&
885 ieee80211_has_protected(fc
)) {
886 /* Store CCMP PN so that we can verify that the next
887 * fragment has a sequential PN value. */
889 memcpy(entry
->last_pn
,
890 rx
->key
->u
.ccmp
.rx_pn
[rx
->queue
],
896 /* This is a fragment for a frame that should already be pending in
897 * fragment cache. Add this fragment to the end of the pending entry.
899 entry
= ieee80211_reassemble_find(rx
->sdata
, frag
, seq
, rx
->queue
, hdr
);
901 I802_DEBUG_INC(rx
->local
->rx_handlers_drop_defrag
);
902 return RX_DROP_MONITOR
;
905 /* Verify that MPDUs within one MSDU have sequential PN values.
906 * (IEEE 802.11i, 8.3.3.4.5) */
909 u8 pn
[CCMP_PN_LEN
], *rpn
;
910 if (!rx
->key
|| rx
->key
->conf
.alg
!= ALG_CCMP
)
911 return RX_DROP_UNUSABLE
;
912 memcpy(pn
, entry
->last_pn
, CCMP_PN_LEN
);
913 for (i
= CCMP_PN_LEN
- 1; i
>= 0; i
--) {
918 rpn
= rx
->key
->u
.ccmp
.rx_pn
[rx
->queue
];
919 if (memcmp(pn
, rpn
, CCMP_PN_LEN
))
920 return RX_DROP_UNUSABLE
;
921 memcpy(entry
->last_pn
, pn
, CCMP_PN_LEN
);
924 skb_pull(rx
->skb
, ieee80211_hdrlen(fc
));
925 __skb_queue_tail(&entry
->skb_list
, rx
->skb
);
926 entry
->last_frag
= frag
;
927 entry
->extra_len
+= rx
->skb
->len
;
928 if (ieee80211_has_morefrags(fc
)) {
933 rx
->skb
= __skb_dequeue(&entry
->skb_list
);
934 if (skb_tailroom(rx
->skb
) < entry
->extra_len
) {
935 I802_DEBUG_INC(rx
->local
->rx_expand_skb_head2
);
936 if (unlikely(pskb_expand_head(rx
->skb
, 0, entry
->extra_len
,
938 I802_DEBUG_INC(rx
->local
->rx_handlers_drop_defrag
);
939 __skb_queue_purge(&entry
->skb_list
);
940 return RX_DROP_UNUSABLE
;
943 while ((skb
= __skb_dequeue(&entry
->skb_list
))) {
944 memcpy(skb_put(rx
->skb
, skb
->len
), skb
->data
, skb
->len
);
948 /* Complete frame has been reassembled - process it now */
949 rx
->flags
|= IEEE80211_RX_FRAGMENTED
;
953 rx
->sta
->rx_packets
++;
954 if (is_multicast_ether_addr(hdr
->addr1
))
955 rx
->local
->dot11MulticastReceivedFrameCount
++;
957 ieee80211_led_rx(rx
->local
);
961 static ieee80211_rx_result debug_noinline
962 ieee80211_rx_h_ps_poll(struct ieee80211_rx_data
*rx
)
964 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(rx
->dev
);
967 __le16 fc
= ((struct ieee80211_hdr
*)rx
->skb
->data
)->frame_control
;
969 if (likely(!rx
->sta
|| !ieee80211_is_pspoll(fc
) ||
970 !(rx
->flags
& IEEE80211_RX_RA_MATCH
)))
973 if ((sdata
->vif
.type
!= NL80211_IFTYPE_AP
) &&
974 (sdata
->vif
.type
!= NL80211_IFTYPE_AP_VLAN
))
975 return RX_DROP_UNUSABLE
;
977 skb
= skb_dequeue(&rx
->sta
->tx_filtered
);
979 skb
= skb_dequeue(&rx
->sta
->ps_tx_buf
);
981 rx
->local
->total_ps_buffered
--;
983 no_pending_pkts
= skb_queue_empty(&rx
->sta
->tx_filtered
) &&
984 skb_queue_empty(&rx
->sta
->ps_tx_buf
);
987 struct ieee80211_hdr
*hdr
=
988 (struct ieee80211_hdr
*) skb
->data
;
991 * Tell TX path to send one frame even though the STA may
992 * still remain is PS mode after this frame exchange.
994 set_sta_flags(rx
->sta
, WLAN_STA_PSPOLL
);
996 #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
997 printk(KERN_DEBUG
"STA %pM aid %d: PS Poll (entries after %d)\n",
998 rx
->sta
->sta
.addr
, rx
->sta
->sta
.aid
,
999 skb_queue_len(&rx
->sta
->ps_tx_buf
));
1000 #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
1002 /* Use MoreData flag to indicate whether there are more
1003 * buffered frames for this STA */
1004 if (no_pending_pkts
)
1005 hdr
->frame_control
&= cpu_to_le16(~IEEE80211_FCTL_MOREDATA
);
1007 hdr
->frame_control
|= cpu_to_le16(IEEE80211_FCTL_MOREDATA
);
1009 dev_queue_xmit(skb
);
1011 if (no_pending_pkts
)
1012 sta_info_clear_tim_bit(rx
->sta
);
1013 #ifdef CONFIG_MAC80211_VERBOSE_PS_DEBUG
1014 } else if (!rx
->sent_ps_buffered
) {
1016 * FIXME: This can be the result of a race condition between
1017 * us expiring a frame and the station polling for it.
1018 * Should we send it a null-func frame indicating we
1019 * have nothing buffered for it?
1021 printk(KERN_DEBUG
"%s: STA %pM sent PS Poll even "
1022 "though there are no buffered frames for it\n",
1023 rx
->dev
->name
, rx
->sta
->sta
.addr
);
1024 #endif /* CONFIG_MAC80211_VERBOSE_PS_DEBUG */
1027 /* Free PS Poll skb here instead of returning RX_DROP that would
1028 * count as an dropped frame. */
1029 dev_kfree_skb(rx
->skb
);
1034 static ieee80211_rx_result debug_noinline
1035 ieee80211_rx_h_remove_qos_control(struct ieee80211_rx_data
*rx
)
1037 u8
*data
= rx
->skb
->data
;
1038 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)data
;
1040 if (!ieee80211_is_data_qos(hdr
->frame_control
))
1043 /* remove the qos control field, update frame type and meta-data */
1044 memmove(data
+ IEEE80211_QOS_CTL_LEN
, data
,
1045 ieee80211_hdrlen(hdr
->frame_control
) - IEEE80211_QOS_CTL_LEN
);
1046 hdr
= (struct ieee80211_hdr
*)skb_pull(rx
->skb
, IEEE80211_QOS_CTL_LEN
);
1047 /* change frame type to non QOS */
1048 hdr
->frame_control
&= ~cpu_to_le16(IEEE80211_STYPE_QOS_DATA
);
1054 ieee80211_802_1x_port_control(struct ieee80211_rx_data
*rx
)
1056 if (unlikely(!rx
->sta
||
1057 !test_sta_flags(rx
->sta
, WLAN_STA_AUTHORIZED
)))
1064 ieee80211_drop_unencrypted(struct ieee80211_rx_data
*rx
, __le16 fc
)
1067 * Pass through unencrypted frames if the hardware has
1068 * decrypted them already.
1070 if (rx
->status
->flag
& RX_FLAG_DECRYPTED
)
1073 /* Drop unencrypted frames if key is set. */
1074 if (unlikely(!ieee80211_has_protected(fc
) &&
1075 !ieee80211_is_nullfunc(fc
) &&
1076 (rx
->key
|| rx
->sdata
->drop_unencrypted
)))
1083 ieee80211_data_to_8023(struct ieee80211_rx_data
*rx
)
1085 struct net_device
*dev
= rx
->dev
;
1086 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) rx
->skb
->data
;
1087 u16 hdrlen
, ethertype
;
1090 u8 src
[ETH_ALEN
] __aligned(2);
1091 struct sk_buff
*skb
= rx
->skb
;
1092 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
1094 if (unlikely(!ieee80211_is_data_present(hdr
->frame_control
)))
1097 hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
1099 /* convert IEEE 802.11 header + possible LLC headers into Ethernet
1101 * IEEE 802.11 address fields:
1102 * ToDS FromDS Addr1 Addr2 Addr3 Addr4
1103 * 0 0 DA SA BSSID n/a
1104 * 0 1 DA BSSID SA n/a
1105 * 1 0 BSSID SA DA n/a
1108 memcpy(dst
, ieee80211_get_DA(hdr
), ETH_ALEN
);
1109 memcpy(src
, ieee80211_get_SA(hdr
), ETH_ALEN
);
1111 switch (hdr
->frame_control
&
1112 cpu_to_le16(IEEE80211_FCTL_TODS
| IEEE80211_FCTL_FROMDS
)) {
1113 case __constant_cpu_to_le16(IEEE80211_FCTL_TODS
):
1114 if (unlikely(sdata
->vif
.type
!= NL80211_IFTYPE_AP
&&
1115 sdata
->vif
.type
!= NL80211_IFTYPE_AP_VLAN
))
1118 case __constant_cpu_to_le16(IEEE80211_FCTL_TODS
| IEEE80211_FCTL_FROMDS
):
1119 if (unlikely(sdata
->vif
.type
!= NL80211_IFTYPE_WDS
&&
1120 sdata
->vif
.type
!= NL80211_IFTYPE_MESH_POINT
))
1122 if (ieee80211_vif_is_mesh(&sdata
->vif
)) {
1123 struct ieee80211s_hdr
*meshdr
= (struct ieee80211s_hdr
*)
1124 (skb
->data
+ hdrlen
);
1125 hdrlen
+= ieee80211_get_mesh_hdrlen(meshdr
);
1126 if (meshdr
->flags
& MESH_FLAGS_AE_A5_A6
) {
1127 memcpy(dst
, meshdr
->eaddr1
, ETH_ALEN
);
1128 memcpy(src
, meshdr
->eaddr2
, ETH_ALEN
);
1132 case __constant_cpu_to_le16(IEEE80211_FCTL_FROMDS
):
1133 if (sdata
->vif
.type
!= NL80211_IFTYPE_STATION
||
1134 (is_multicast_ether_addr(dst
) &&
1135 !compare_ether_addr(src
, dev
->dev_addr
)))
1138 case __constant_cpu_to_le16(0):
1139 if (sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1144 if (unlikely(skb
->len
- hdrlen
< 8))
1147 payload
= skb
->data
+ hdrlen
;
1148 ethertype
= (payload
[6] << 8) | payload
[7];
1150 if (likely((compare_ether_addr(payload
, rfc1042_header
) == 0 &&
1151 ethertype
!= ETH_P_AARP
&& ethertype
!= ETH_P_IPX
) ||
1152 compare_ether_addr(payload
, bridge_tunnel_header
) == 0)) {
1153 /* remove RFC1042 or Bridge-Tunnel encapsulation and
1154 * replace EtherType */
1155 skb_pull(skb
, hdrlen
+ 6);
1156 memcpy(skb_push(skb
, ETH_ALEN
), src
, ETH_ALEN
);
1157 memcpy(skb_push(skb
, ETH_ALEN
), dst
, ETH_ALEN
);
1159 struct ethhdr
*ehdr
;
1162 skb_pull(skb
, hdrlen
);
1163 len
= htons(skb
->len
);
1164 ehdr
= (struct ethhdr
*) skb_push(skb
, sizeof(struct ethhdr
));
1165 memcpy(ehdr
->h_dest
, dst
, ETH_ALEN
);
1166 memcpy(ehdr
->h_source
, src
, ETH_ALEN
);
1167 ehdr
->h_proto
= len
;
1173 * requires that rx->skb is a frame with ethernet header
1175 static bool ieee80211_frame_allowed(struct ieee80211_rx_data
*rx
, __le16 fc
)
1177 static const u8 pae_group_addr
[ETH_ALEN
] __aligned(2)
1178 = { 0x01, 0x80, 0xC2, 0x00, 0x00, 0x03 };
1179 struct ethhdr
*ehdr
= (struct ethhdr
*) rx
->skb
->data
;
1182 * Allow EAPOL frames to us/the PAE group address regardless
1183 * of whether the frame was encrypted or not.
1185 if (ehdr
->h_proto
== htons(ETH_P_PAE
) &&
1186 (compare_ether_addr(ehdr
->h_dest
, rx
->dev
->dev_addr
) == 0 ||
1187 compare_ether_addr(ehdr
->h_dest
, pae_group_addr
) == 0))
1190 if (ieee80211_802_1x_port_control(rx
) ||
1191 ieee80211_drop_unencrypted(rx
, fc
))
1198 * requires that rx->skb is a frame with ethernet header
1201 ieee80211_deliver_skb(struct ieee80211_rx_data
*rx
)
1203 struct net_device
*dev
= rx
->dev
;
1204 struct ieee80211_local
*local
= rx
->local
;
1205 struct sk_buff
*skb
, *xmit_skb
;
1206 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(dev
);
1207 struct ethhdr
*ehdr
= (struct ethhdr
*) rx
->skb
->data
;
1208 struct sta_info
*dsta
;
1213 if ((sdata
->vif
.type
== NL80211_IFTYPE_AP
||
1214 sdata
->vif
.type
== NL80211_IFTYPE_AP_VLAN
) &&
1215 !(sdata
->flags
& IEEE80211_SDATA_DONT_BRIDGE_PACKETS
) &&
1216 (rx
->flags
& IEEE80211_RX_RA_MATCH
)) {
1217 if (is_multicast_ether_addr(ehdr
->h_dest
)) {
1219 * send multicast frames both to higher layers in
1220 * local net stack and back to the wireless medium
1222 xmit_skb
= skb_copy(skb
, GFP_ATOMIC
);
1223 if (!xmit_skb
&& net_ratelimit())
1224 printk(KERN_DEBUG
"%s: failed to clone "
1225 "multicast frame\n", dev
->name
);
1227 dsta
= sta_info_get(local
, skb
->data
);
1228 if (dsta
&& dsta
->sdata
->dev
== dev
) {
1230 * The destination station is associated to
1231 * this AP (in this VLAN), so send the frame
1232 * directly to it and do not pass it to local
1242 /* deliver to local stack */
1243 skb
->protocol
= eth_type_trans(skb
, dev
);
1244 memset(skb
->cb
, 0, sizeof(skb
->cb
));
1249 /* send to wireless media */
1250 xmit_skb
->protocol
= htons(ETH_P_802_3
);
1251 skb_reset_network_header(xmit_skb
);
1252 skb_reset_mac_header(xmit_skb
);
1253 dev_queue_xmit(xmit_skb
);
1257 static ieee80211_rx_result debug_noinline
1258 ieee80211_rx_h_amsdu(struct ieee80211_rx_data
*rx
)
1260 struct net_device
*dev
= rx
->dev
;
1261 struct ieee80211_local
*local
= rx
->local
;
1264 struct sk_buff
*skb
= rx
->skb
, *frame
= NULL
;
1265 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)skb
->data
;
1266 __le16 fc
= hdr
->frame_control
;
1267 const struct ethhdr
*eth
;
1272 if (unlikely(!ieee80211_is_data(fc
)))
1275 if (unlikely(!ieee80211_is_data_present(fc
)))
1276 return RX_DROP_MONITOR
;
1278 if (!(rx
->flags
& IEEE80211_RX_AMSDU
))
1281 err
= ieee80211_data_to_8023(rx
);
1283 return RX_DROP_UNUSABLE
;
1287 dev
->stats
.rx_packets
++;
1288 dev
->stats
.rx_bytes
+= skb
->len
;
1290 /* skip the wrapping header */
1291 eth
= (struct ethhdr
*) skb_pull(skb
, sizeof(struct ethhdr
));
1293 return RX_DROP_UNUSABLE
;
1295 while (skb
!= frame
) {
1297 __be16 len
= eth
->h_proto
;
1298 unsigned int subframe_len
= sizeof(struct ethhdr
) + ntohs(len
);
1300 remaining
= skb
->len
;
1301 memcpy(dst
, eth
->h_dest
, ETH_ALEN
);
1302 memcpy(src
, eth
->h_source
, ETH_ALEN
);
1304 padding
= ((4 - subframe_len
) & 0x3);
1305 /* the last MSDU has no padding */
1306 if (subframe_len
> remaining
)
1307 return RX_DROP_UNUSABLE
;
1309 skb_pull(skb
, sizeof(struct ethhdr
));
1310 /* if last subframe reuse skb */
1311 if (remaining
<= subframe_len
+ padding
)
1314 frame
= dev_alloc_skb(local
->hw
.extra_tx_headroom
+
1318 return RX_DROP_UNUSABLE
;
1320 skb_reserve(frame
, local
->hw
.extra_tx_headroom
+
1321 sizeof(struct ethhdr
));
1322 memcpy(skb_put(frame
, ntohs(len
)), skb
->data
,
1325 eth
= (struct ethhdr
*) skb_pull(skb
, ntohs(len
) +
1328 dev_kfree_skb(frame
);
1329 return RX_DROP_UNUSABLE
;
1333 skb_reset_network_header(frame
);
1335 frame
->priority
= skb
->priority
;
1338 payload
= frame
->data
;
1339 ethertype
= (payload
[6] << 8) | payload
[7];
1341 if (likely((compare_ether_addr(payload
, rfc1042_header
) == 0 &&
1342 ethertype
!= ETH_P_AARP
&& ethertype
!= ETH_P_IPX
) ||
1343 compare_ether_addr(payload
,
1344 bridge_tunnel_header
) == 0)) {
1345 /* remove RFC1042 or Bridge-Tunnel
1346 * encapsulation and replace EtherType */
1348 memcpy(skb_push(frame
, ETH_ALEN
), src
, ETH_ALEN
);
1349 memcpy(skb_push(frame
, ETH_ALEN
), dst
, ETH_ALEN
);
1351 memcpy(skb_push(frame
, sizeof(__be16
)),
1352 &len
, sizeof(__be16
));
1353 memcpy(skb_push(frame
, ETH_ALEN
), src
, ETH_ALEN
);
1354 memcpy(skb_push(frame
, ETH_ALEN
), dst
, ETH_ALEN
);
1357 if (!ieee80211_frame_allowed(rx
, fc
)) {
1358 if (skb
== frame
) /* last frame */
1359 return RX_DROP_UNUSABLE
;
1360 dev_kfree_skb(frame
);
1364 ieee80211_deliver_skb(rx
);
1370 #ifdef CONFIG_MAC80211_MESH
1371 static ieee80211_rx_result
1372 ieee80211_rx_h_mesh_fwding(struct ieee80211_rx_data
*rx
)
1374 struct ieee80211_hdr
*hdr
;
1375 struct ieee80211s_hdr
*mesh_hdr
;
1376 unsigned int hdrlen
;
1377 struct sk_buff
*skb
= rx
->skb
, *fwd_skb
;
1379 hdr
= (struct ieee80211_hdr
*) skb
->data
;
1380 hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
1381 mesh_hdr
= (struct ieee80211s_hdr
*) (skb
->data
+ hdrlen
);
1383 if (!ieee80211_is_data(hdr
->frame_control
))
1388 return RX_DROP_MONITOR
;
1390 if (mesh_hdr
->flags
& MESH_FLAGS_AE_A5_A6
){
1391 struct ieee80211_sub_if_data
*sdata
;
1392 struct mesh_path
*mppath
;
1394 sdata
= IEEE80211_DEV_TO_SUB_IF(rx
->dev
);
1396 mppath
= mpp_path_lookup(mesh_hdr
->eaddr2
, sdata
);
1398 mpp_path_add(mesh_hdr
->eaddr2
, hdr
->addr4
, sdata
);
1400 spin_lock_bh(&mppath
->state_lock
);
1401 mppath
->exp_time
= jiffies
;
1402 if (compare_ether_addr(mppath
->mpp
, hdr
->addr4
) != 0)
1403 memcpy(mppath
->mpp
, hdr
->addr4
, ETH_ALEN
);
1404 spin_unlock_bh(&mppath
->state_lock
);
1409 if (compare_ether_addr(rx
->dev
->dev_addr
, hdr
->addr3
) == 0)
1414 if (rx
->flags
& IEEE80211_RX_RA_MATCH
) {
1416 IEEE80211_IFSTA_MESH_CTR_INC(&rx
->sdata
->u
.mesh
,
1417 dropped_frames_ttl
);
1419 struct ieee80211_hdr
*fwd_hdr
;
1420 fwd_skb
= skb_copy(skb
, GFP_ATOMIC
);
1422 if (!fwd_skb
&& net_ratelimit())
1423 printk(KERN_DEBUG
"%s: failed to clone mesh frame\n",
1426 fwd_hdr
= (struct ieee80211_hdr
*) fwd_skb
->data
;
1428 * Save TA to addr1 to send TA a path error if a
1429 * suitable next hop is not found
1431 memcpy(fwd_hdr
->addr1
, fwd_hdr
->addr2
, ETH_ALEN
);
1432 memcpy(fwd_hdr
->addr2
, rx
->dev
->dev_addr
, ETH_ALEN
);
1433 fwd_skb
->dev
= rx
->local
->mdev
;
1434 fwd_skb
->iif
= rx
->dev
->ifindex
;
1435 dev_queue_xmit(fwd_skb
);
1439 if (is_multicast_ether_addr(hdr
->addr3
) ||
1440 rx
->dev
->flags
& IFF_PROMISC
)
1443 return RX_DROP_MONITOR
;
1447 static ieee80211_rx_result debug_noinline
1448 ieee80211_rx_h_data(struct ieee80211_rx_data
*rx
)
1450 struct net_device
*dev
= rx
->dev
;
1451 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*)rx
->skb
->data
;
1452 __le16 fc
= hdr
->frame_control
;
1455 if (unlikely(!ieee80211_is_data(hdr
->frame_control
)))
1458 if (unlikely(!ieee80211_is_data_present(hdr
->frame_control
)))
1459 return RX_DROP_MONITOR
;
1461 err
= ieee80211_data_to_8023(rx
);
1463 return RX_DROP_UNUSABLE
;
1465 if (!ieee80211_frame_allowed(rx
, fc
))
1466 return RX_DROP_MONITOR
;
1470 dev
->stats
.rx_packets
++;
1471 dev
->stats
.rx_bytes
+= rx
->skb
->len
;
1473 ieee80211_deliver_skb(rx
);
1478 static ieee80211_rx_result debug_noinline
1479 ieee80211_rx_h_ctrl(struct ieee80211_rx_data
*rx
)
1481 struct ieee80211_local
*local
= rx
->local
;
1482 struct ieee80211_hw
*hw
= &local
->hw
;
1483 struct sk_buff
*skb
= rx
->skb
;
1484 struct ieee80211_bar
*bar
= (struct ieee80211_bar
*)skb
->data
;
1485 struct tid_ampdu_rx
*tid_agg_rx
;
1489 if (likely(!ieee80211_is_ctl(bar
->frame_control
)))
1492 if (ieee80211_is_back_req(bar
->frame_control
)) {
1495 tid
= le16_to_cpu(bar
->control
) >> 12;
1496 if (rx
->sta
->ampdu_mlme
.tid_state_rx
[tid
]
1497 != HT_AGG_STATE_OPERATIONAL
)
1499 tid_agg_rx
= rx
->sta
->ampdu_mlme
.tid_rx
[tid
];
1501 start_seq_num
= le16_to_cpu(bar
->start_seq_num
) >> 4;
1503 /* reset session timer */
1504 if (tid_agg_rx
->timeout
) {
1505 unsigned long expires
=
1506 jiffies
+ (tid_agg_rx
->timeout
/ 1000) * HZ
;
1507 mod_timer(&tid_agg_rx
->session_timer
, expires
);
1510 /* manage reordering buffer according to requested */
1511 /* sequence number */
1513 ieee80211_sta_manage_reorder_buf(hw
, tid_agg_rx
, NULL
,
1516 return RX_DROP_UNUSABLE
;
1522 static ieee80211_rx_result debug_noinline
1523 ieee80211_rx_h_action(struct ieee80211_rx_data
*rx
)
1525 struct ieee80211_local
*local
= rx
->local
;
1526 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(rx
->dev
);
1527 struct ieee80211_mgmt
*mgmt
= (struct ieee80211_mgmt
*) rx
->skb
->data
;
1528 int len
= rx
->skb
->len
;
1530 if (!ieee80211_is_action(mgmt
->frame_control
))
1534 return RX_DROP_MONITOR
;
1536 if (!(rx
->flags
& IEEE80211_RX_RA_MATCH
))
1537 return RX_DROP_MONITOR
;
1539 /* all categories we currently handle have action_code */
1540 if (len
< IEEE80211_MIN_ACTION_SIZE
+ 1)
1541 return RX_DROP_MONITOR
;
1544 * FIXME: revisit this, I'm sure we should handle most
1545 * of these frames in other modes as well!
1547 if (sdata
->vif
.type
!= NL80211_IFTYPE_STATION
&&
1548 sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1551 switch (mgmt
->u
.action
.category
) {
1552 case WLAN_CATEGORY_BACK
:
1553 switch (mgmt
->u
.action
.u
.addba_req
.action_code
) {
1554 case WLAN_ACTION_ADDBA_REQ
:
1555 if (len
< (IEEE80211_MIN_ACTION_SIZE
+
1556 sizeof(mgmt
->u
.action
.u
.addba_req
)))
1557 return RX_DROP_MONITOR
;
1558 ieee80211_process_addba_request(local
, rx
->sta
, mgmt
, len
);
1560 case WLAN_ACTION_ADDBA_RESP
:
1561 if (len
< (IEEE80211_MIN_ACTION_SIZE
+
1562 sizeof(mgmt
->u
.action
.u
.addba_resp
)))
1563 return RX_DROP_MONITOR
;
1564 ieee80211_process_addba_resp(local
, rx
->sta
, mgmt
, len
);
1566 case WLAN_ACTION_DELBA
:
1567 if (len
< (IEEE80211_MIN_ACTION_SIZE
+
1568 sizeof(mgmt
->u
.action
.u
.delba
)))
1569 return RX_DROP_MONITOR
;
1570 ieee80211_process_delba(sdata
, rx
->sta
, mgmt
, len
);
1574 case WLAN_CATEGORY_SPECTRUM_MGMT
:
1575 if (local
->hw
.conf
.channel
->band
!= IEEE80211_BAND_5GHZ
)
1576 return RX_DROP_MONITOR
;
1577 switch (mgmt
->u
.action
.u
.measurement
.action_code
) {
1578 case WLAN_ACTION_SPCT_MSR_REQ
:
1579 if (len
< (IEEE80211_MIN_ACTION_SIZE
+
1580 sizeof(mgmt
->u
.action
.u
.measurement
)))
1581 return RX_DROP_MONITOR
;
1582 ieee80211_process_measurement_req(sdata
, mgmt
, len
);
1590 rx
->sta
->rx_packets
++;
1591 dev_kfree_skb(rx
->skb
);
1595 static ieee80211_rx_result debug_noinline
1596 ieee80211_rx_h_mgmt(struct ieee80211_rx_data
*rx
)
1598 struct ieee80211_sub_if_data
*sdata
= IEEE80211_DEV_TO_SUB_IF(rx
->dev
);
1600 if (!(rx
->flags
& IEEE80211_RX_RA_MATCH
))
1601 return RX_DROP_MONITOR
;
1603 if (ieee80211_vif_is_mesh(&sdata
->vif
))
1604 return ieee80211_mesh_rx_mgmt(sdata
, rx
->skb
, rx
->status
);
1606 if (sdata
->vif
.type
!= NL80211_IFTYPE_STATION
&&
1607 sdata
->vif
.type
!= NL80211_IFTYPE_ADHOC
)
1608 return RX_DROP_MONITOR
;
1610 if (sdata
->flags
& IEEE80211_SDATA_USERSPACE_MLME
)
1611 return RX_DROP_MONITOR
;
1613 ieee80211_sta_rx_mgmt(sdata
, rx
->skb
, rx
->status
);
1617 static void ieee80211_rx_michael_mic_report(struct net_device
*dev
,
1618 struct ieee80211_hdr
*hdr
,
1619 struct ieee80211_rx_data
*rx
)
1622 unsigned int hdrlen
;
1624 hdrlen
= ieee80211_hdrlen(hdr
->frame_control
);
1625 if (rx
->skb
->len
>= hdrlen
+ 4)
1626 keyidx
= rx
->skb
->data
[hdrlen
+ 3] >> 6;
1632 * Some hardware seem to generate incorrect Michael MIC
1633 * reports; ignore them to avoid triggering countermeasures.
1638 if (!ieee80211_has_protected(hdr
->frame_control
))
1641 if (rx
->sdata
->vif
.type
== NL80211_IFTYPE_AP
&& keyidx
) {
1643 * APs with pairwise keys should never receive Michael MIC
1644 * errors for non-zero keyidx because these are reserved for
1645 * group keys and only the AP is sending real multicast
1646 * frames in the BSS.
1651 if (!ieee80211_is_data(hdr
->frame_control
) &&
1652 !ieee80211_is_auth(hdr
->frame_control
))
1655 mac80211_ev_michael_mic_failure(rx
->sdata
, keyidx
, hdr
);
1657 dev_kfree_skb(rx
->skb
);
1661 /* TODO: use IEEE80211_RX_FRAGMENTED */
1662 static void ieee80211_rx_cooked_monitor(struct ieee80211_rx_data
*rx
)
1664 struct ieee80211_sub_if_data
*sdata
;
1665 struct ieee80211_local
*local
= rx
->local
;
1666 struct ieee80211_rtap_hdr
{
1667 struct ieee80211_radiotap_header hdr
;
1672 } __attribute__ ((packed
)) *rthdr
;
1673 struct sk_buff
*skb
= rx
->skb
, *skb2
;
1674 struct net_device
*prev_dev
= NULL
;
1675 struct ieee80211_rx_status
*status
= rx
->status
;
1677 if (rx
->flags
& IEEE80211_RX_CMNTR_REPORTED
)
1680 if (skb_headroom(skb
) < sizeof(*rthdr
) &&
1681 pskb_expand_head(skb
, sizeof(*rthdr
), 0, GFP_ATOMIC
))
1684 rthdr
= (void *)skb_push(skb
, sizeof(*rthdr
));
1685 memset(rthdr
, 0, sizeof(*rthdr
));
1686 rthdr
->hdr
.it_len
= cpu_to_le16(sizeof(*rthdr
));
1687 rthdr
->hdr
.it_present
=
1688 cpu_to_le32((1 << IEEE80211_RADIOTAP_FLAGS
) |
1689 (1 << IEEE80211_RADIOTAP_RATE
) |
1690 (1 << IEEE80211_RADIOTAP_CHANNEL
));
1692 rthdr
->rate
= rx
->rate
->bitrate
/ 5;
1693 rthdr
->chan_freq
= cpu_to_le16(status
->freq
);
1695 if (status
->band
== IEEE80211_BAND_5GHZ
)
1696 rthdr
->chan_flags
= cpu_to_le16(IEEE80211_CHAN_OFDM
|
1697 IEEE80211_CHAN_5GHZ
);
1699 rthdr
->chan_flags
= cpu_to_le16(IEEE80211_CHAN_DYN
|
1700 IEEE80211_CHAN_2GHZ
);
1702 skb_set_mac_header(skb
, 0);
1703 skb
->ip_summed
= CHECKSUM_UNNECESSARY
;
1704 skb
->pkt_type
= PACKET_OTHERHOST
;
1705 skb
->protocol
= htons(ETH_P_802_2
);
1707 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
1708 if (!netif_running(sdata
->dev
))
1711 if (sdata
->vif
.type
!= NL80211_IFTYPE_MONITOR
||
1712 !(sdata
->u
.mntr_flags
& MONITOR_FLAG_COOK_FRAMES
))
1716 skb2
= skb_clone(skb
, GFP_ATOMIC
);
1718 skb2
->dev
= prev_dev
;
1723 prev_dev
= sdata
->dev
;
1724 sdata
->dev
->stats
.rx_packets
++;
1725 sdata
->dev
->stats
.rx_bytes
+= skb
->len
;
1729 skb
->dev
= prev_dev
;
1735 rx
->flags
|= IEEE80211_RX_CMNTR_REPORTED
;
1743 static void ieee80211_invoke_rx_handlers(struct ieee80211_sub_if_data
*sdata
,
1744 struct ieee80211_rx_data
*rx
,
1745 struct sk_buff
*skb
)
1747 ieee80211_rx_result res
= RX_DROP_MONITOR
;
1751 rx
->dev
= sdata
->dev
;
1753 #define CALL_RXH(rxh) \
1756 if (res != RX_CONTINUE) \
1760 CALL_RXH(ieee80211_rx_h_passive_scan
)
1761 CALL_RXH(ieee80211_rx_h_check
)
1762 CALL_RXH(ieee80211_rx_h_decrypt
)
1763 CALL_RXH(ieee80211_rx_h_sta_process
)
1764 CALL_RXH(ieee80211_rx_h_defragment
)
1765 CALL_RXH(ieee80211_rx_h_ps_poll
)
1766 CALL_RXH(ieee80211_rx_h_michael_mic_verify
)
1767 /* must be after MMIC verify so header is counted in MPDU mic */
1768 CALL_RXH(ieee80211_rx_h_remove_qos_control
)
1769 CALL_RXH(ieee80211_rx_h_amsdu
)
1770 #ifdef CONFIG_MAC80211_MESH
1771 if (ieee80211_vif_is_mesh(&sdata
->vif
))
1772 CALL_RXH(ieee80211_rx_h_mesh_fwding
);
1774 CALL_RXH(ieee80211_rx_h_data
)
1775 CALL_RXH(ieee80211_rx_h_ctrl
)
1776 CALL_RXH(ieee80211_rx_h_action
)
1777 CALL_RXH(ieee80211_rx_h_mgmt
)
1783 case RX_DROP_MONITOR
:
1784 I802_DEBUG_INC(sdata
->local
->rx_handlers_drop
);
1786 rx
->sta
->rx_dropped
++;
1789 ieee80211_rx_cooked_monitor(rx
);
1791 case RX_DROP_UNUSABLE
:
1792 I802_DEBUG_INC(sdata
->local
->rx_handlers_drop
);
1794 rx
->sta
->rx_dropped
++;
1795 dev_kfree_skb(rx
->skb
);
1798 I802_DEBUG_INC(sdata
->local
->rx_handlers_queued
);
1803 /* main receive path */
1805 static int prepare_for_handlers(struct ieee80211_sub_if_data
*sdata
,
1806 u8
*bssid
, struct ieee80211_rx_data
*rx
,
1807 struct ieee80211_hdr
*hdr
)
1809 int multicast
= is_multicast_ether_addr(hdr
->addr1
);
1811 switch (sdata
->vif
.type
) {
1812 case NL80211_IFTYPE_STATION
:
1815 if (!ieee80211_bssid_match(bssid
, sdata
->u
.sta
.bssid
)) {
1816 if (!(rx
->flags
& IEEE80211_RX_IN_SCAN
))
1818 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1819 } else if (!multicast
&&
1820 compare_ether_addr(sdata
->dev
->dev_addr
,
1822 if (!(sdata
->dev
->flags
& IFF_PROMISC
))
1824 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1827 case NL80211_IFTYPE_ADHOC
:
1830 if (ieee80211_is_beacon(hdr
->frame_control
)) {
1833 else if (!ieee80211_bssid_match(bssid
, sdata
->u
.sta
.bssid
)) {
1834 if (!(rx
->flags
& IEEE80211_RX_IN_SCAN
))
1836 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1837 } else if (!multicast
&&
1838 compare_ether_addr(sdata
->dev
->dev_addr
,
1840 if (!(sdata
->dev
->flags
& IFF_PROMISC
))
1842 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1843 } else if (!rx
->sta
)
1844 rx
->sta
= ieee80211_ibss_add_sta(sdata
, rx
->skb
,
1846 BIT(rx
->status
->rate_idx
));
1848 case NL80211_IFTYPE_MESH_POINT
:
1850 compare_ether_addr(sdata
->dev
->dev_addr
,
1852 if (!(sdata
->dev
->flags
& IFF_PROMISC
))
1855 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1858 case NL80211_IFTYPE_AP_VLAN
:
1859 case NL80211_IFTYPE_AP
:
1861 if (compare_ether_addr(sdata
->dev
->dev_addr
,
1864 } else if (!ieee80211_bssid_match(bssid
,
1865 sdata
->dev
->dev_addr
)) {
1866 if (!(rx
->flags
& IEEE80211_RX_IN_SCAN
))
1868 rx
->flags
&= ~IEEE80211_RX_RA_MATCH
;
1871 case NL80211_IFTYPE_WDS
:
1872 if (bssid
|| !ieee80211_is_data(hdr
->frame_control
))
1874 if (compare_ether_addr(sdata
->u
.wds
.remote_addr
, hdr
->addr2
))
1877 case NL80211_IFTYPE_MONITOR
:
1878 /* take everything */
1880 case NL80211_IFTYPE_UNSPECIFIED
:
1881 case __NL80211_IFTYPE_AFTER_LAST
:
1882 /* should never get here */
1891 * This is the actual Rx frames handler. as it blongs to Rx path it must
1892 * be called with rcu_read_lock protection.
1894 static void __ieee80211_rx_handle_packet(struct ieee80211_hw
*hw
,
1895 struct sk_buff
*skb
,
1896 struct ieee80211_rx_status
*status
,
1897 struct ieee80211_rate
*rate
)
1899 struct ieee80211_local
*local
= hw_to_local(hw
);
1900 struct ieee80211_sub_if_data
*sdata
;
1901 struct ieee80211_hdr
*hdr
;
1902 struct ieee80211_rx_data rx
;
1904 struct ieee80211_sub_if_data
*prev
= NULL
;
1905 struct sk_buff
*skb_new
;
1908 hdr
= (struct ieee80211_hdr
*)skb
->data
;
1909 memset(&rx
, 0, sizeof(rx
));
1916 if (ieee80211_is_data(hdr
->frame_control
) || ieee80211_is_mgmt(hdr
->frame_control
))
1917 local
->dot11ReceivedFragmentCount
++;
1919 rx
.sta
= sta_info_get(local
, hdr
->addr2
);
1921 rx
.sdata
= rx
.sta
->sdata
;
1922 rx
.dev
= rx
.sta
->sdata
->dev
;
1925 if ((status
->flag
& RX_FLAG_MMIC_ERROR
)) {
1926 ieee80211_rx_michael_mic_report(local
->mdev
, hdr
, &rx
);
1930 if (unlikely(local
->sw_scanning
|| local
->hw_scanning
))
1931 rx
.flags
|= IEEE80211_RX_IN_SCAN
;
1933 ieee80211_parse_qos(&rx
);
1934 ieee80211_verify_ip_alignment(&rx
);
1938 list_for_each_entry_rcu(sdata
, &local
->interfaces
, list
) {
1939 if (!netif_running(sdata
->dev
))
1942 if (sdata
->vif
.type
== NL80211_IFTYPE_MONITOR
)
1945 bssid
= ieee80211_get_bssid(hdr
, skb
->len
, sdata
->vif
.type
);
1946 rx
.flags
|= IEEE80211_RX_RA_MATCH
;
1947 prepares
= prepare_for_handlers(sdata
, bssid
, &rx
, hdr
);
1953 * frame is destined for this interface, but if it's not
1954 * also for the previous one we handle that after the
1955 * loop to avoid copying the SKB once too much
1964 * frame was destined for the previous interface
1965 * so invoke RX handlers for it
1968 skb_new
= skb_copy(skb
, GFP_ATOMIC
);
1970 if (net_ratelimit())
1971 printk(KERN_DEBUG
"%s: failed to copy "
1972 "multicast frame for %s\n",
1973 wiphy_name(local
->hw
.wiphy
),
1977 ieee80211_invoke_rx_handlers(prev
, &rx
, skb_new
);
1981 ieee80211_invoke_rx_handlers(prev
, &rx
, skb
);
1986 #define SEQ_MODULO 0x1000
1987 #define SEQ_MASK 0xfff
1989 static inline int seq_less(u16 sq1
, u16 sq2
)
1991 return (((sq1
- sq2
) & SEQ_MASK
) > (SEQ_MODULO
>> 1));
1994 static inline u16
seq_inc(u16 sq
)
1996 return ((sq
+ 1) & SEQ_MASK
);
1999 static inline u16
seq_sub(u16 sq1
, u16 sq2
)
2001 return ((sq1
- sq2
) & SEQ_MASK
);
2006 * As it function blongs to Rx path it must be called with
2007 * the proper rcu_read_lock protection for its flow.
2009 u8
ieee80211_sta_manage_reorder_buf(struct ieee80211_hw
*hw
,
2010 struct tid_ampdu_rx
*tid_agg_rx
,
2011 struct sk_buff
*skb
, u16 mpdu_seq_num
,
2014 struct ieee80211_local
*local
= hw_to_local(hw
);
2015 struct ieee80211_rx_status status
;
2016 u16 head_seq_num
, buf_size
;
2018 struct ieee80211_supported_band
*sband
;
2019 struct ieee80211_rate
*rate
;
2021 buf_size
= tid_agg_rx
->buf_size
;
2022 head_seq_num
= tid_agg_rx
->head_seq_num
;
2024 /* frame with out of date sequence number */
2025 if (seq_less(mpdu_seq_num
, head_seq_num
)) {
2030 /* if frame sequence number exceeds our buffering window size or
2031 * block Ack Request arrived - release stored frames */
2032 if ((!seq_less(mpdu_seq_num
, head_seq_num
+ buf_size
)) || (bar_req
)) {
2033 /* new head to the ordering buffer */
2035 head_seq_num
= mpdu_seq_num
;
2038 seq_inc(seq_sub(mpdu_seq_num
, buf_size
));
2039 /* release stored frames up to new head to stack */
2040 while (seq_less(tid_agg_rx
->head_seq_num
, head_seq_num
)) {
2041 index
= seq_sub(tid_agg_rx
->head_seq_num
,
2043 % tid_agg_rx
->buf_size
;
2045 if (tid_agg_rx
->reorder_buf
[index
]) {
2046 /* release the reordered frames to stack */
2048 tid_agg_rx
->reorder_buf
[index
]->cb
,
2050 sband
= local
->hw
.wiphy
->bands
[status
.band
];
2051 rate
= &sband
->bitrates
[status
.rate_idx
];
2052 __ieee80211_rx_handle_packet(hw
,
2053 tid_agg_rx
->reorder_buf
[index
],
2055 tid_agg_rx
->stored_mpdu_num
--;
2056 tid_agg_rx
->reorder_buf
[index
] = NULL
;
2058 tid_agg_rx
->head_seq_num
=
2059 seq_inc(tid_agg_rx
->head_seq_num
);
2065 /* now the new frame is always in the range of the reordering */
2067 index
= seq_sub(mpdu_seq_num
, tid_agg_rx
->ssn
)
2068 % tid_agg_rx
->buf_size
;
2069 /* check if we already stored this frame */
2070 if (tid_agg_rx
->reorder_buf
[index
]) {
2075 /* if arrived mpdu is in the right order and nothing else stored */
2076 /* release it immediately */
2077 if (mpdu_seq_num
== tid_agg_rx
->head_seq_num
&&
2078 tid_agg_rx
->stored_mpdu_num
== 0) {
2079 tid_agg_rx
->head_seq_num
=
2080 seq_inc(tid_agg_rx
->head_seq_num
);
2084 /* put the frame in the reordering buffer */
2085 tid_agg_rx
->reorder_buf
[index
] = skb
;
2086 tid_agg_rx
->stored_mpdu_num
++;
2087 /* release the buffer until next missing frame */
2088 index
= seq_sub(tid_agg_rx
->head_seq_num
, tid_agg_rx
->ssn
)
2089 % tid_agg_rx
->buf_size
;
2090 while (tid_agg_rx
->reorder_buf
[index
]) {
2091 /* release the reordered frame back to stack */
2092 memcpy(&status
, tid_agg_rx
->reorder_buf
[index
]->cb
,
2094 sband
= local
->hw
.wiphy
->bands
[status
.band
];
2095 rate
= &sband
->bitrates
[status
.rate_idx
];
2096 __ieee80211_rx_handle_packet(hw
, tid_agg_rx
->reorder_buf
[index
],
2098 tid_agg_rx
->stored_mpdu_num
--;
2099 tid_agg_rx
->reorder_buf
[index
] = NULL
;
2100 tid_agg_rx
->head_seq_num
= seq_inc(tid_agg_rx
->head_seq_num
);
2101 index
= seq_sub(tid_agg_rx
->head_seq_num
,
2102 tid_agg_rx
->ssn
) % tid_agg_rx
->buf_size
;
2107 static u8
ieee80211_rx_reorder_ampdu(struct ieee80211_local
*local
,
2108 struct sk_buff
*skb
)
2110 struct ieee80211_hw
*hw
= &local
->hw
;
2111 struct ieee80211_hdr
*hdr
= (struct ieee80211_hdr
*) skb
->data
;
2112 struct sta_info
*sta
;
2113 struct tid_ampdu_rx
*tid_agg_rx
;
2119 sta
= sta_info_get(local
, hdr
->addr2
);
2123 /* filter the QoS data rx stream according to
2124 * STA/TID and check if this STA/TID is on aggregation */
2125 if (!ieee80211_is_data_qos(hdr
->frame_control
))
2128 tid
= *ieee80211_get_qos_ctl(hdr
) & IEEE80211_QOS_CTL_TID_MASK
;
2130 if (sta
->ampdu_mlme
.tid_state_rx
[tid
] != HT_AGG_STATE_OPERATIONAL
)
2133 tid_agg_rx
= sta
->ampdu_mlme
.tid_rx
[tid
];
2135 /* qos null data frames are excluded */
2136 if (unlikely(hdr
->frame_control
& cpu_to_le16(IEEE80211_STYPE_NULLFUNC
)))
2139 /* new un-ordered ampdu frame - process it */
2141 /* reset session timer */
2142 if (tid_agg_rx
->timeout
) {
2143 unsigned long expires
=
2144 jiffies
+ (tid_agg_rx
->timeout
/ 1000) * HZ
;
2145 mod_timer(&tid_agg_rx
->session_timer
, expires
);
2148 /* if this mpdu is fragmented - terminate rx aggregation session */
2149 sc
= le16_to_cpu(hdr
->seq_ctrl
);
2150 if (sc
& IEEE80211_SCTL_FRAG
) {
2151 ieee80211_sta_stop_rx_ba_session(sta
->sdata
, sta
->sta
.addr
,
2152 tid
, 0, WLAN_REASON_QSTA_REQUIRE_SETUP
);
2157 /* according to mpdu sequence number deal with reordering buffer */
2158 mpdu_seq_num
= (sc
& IEEE80211_SCTL_SEQ
) >> 4;
2159 ret
= ieee80211_sta_manage_reorder_buf(hw
, tid_agg_rx
, skb
,
2166 * This is the receive path handler. It is called by a low level driver when an
2167 * 802.11 MPDU is received from the hardware.
2169 void __ieee80211_rx(struct ieee80211_hw
*hw
, struct sk_buff
*skb
,
2170 struct ieee80211_rx_status
*status
)
2172 struct ieee80211_local
*local
= hw_to_local(hw
);
2173 struct ieee80211_rate
*rate
= NULL
;
2174 struct ieee80211_supported_band
*sband
;
2176 if (status
->band
< 0 ||
2177 status
->band
>= IEEE80211_NUM_BANDS
) {
2182 sband
= local
->hw
.wiphy
->bands
[status
->band
];
2185 status
->rate_idx
< 0 ||
2186 status
->rate_idx
>= sband
->n_bitrates
) {
2191 rate
= &sband
->bitrates
[status
->rate_idx
];
2194 * key references and virtual interfaces are protected using RCU
2195 * and this requires that we are in a read-side RCU section during
2196 * receive processing
2201 * Frames with failed FCS/PLCP checksum are not returned,
2202 * all other frames are returned without radiotap header
2203 * if it was previously present.
2204 * Also, frames with less than 16 bytes are dropped.
2206 skb
= ieee80211_rx_monitor(local
, skb
, status
, rate
);
2212 if (!ieee80211_rx_reorder_ampdu(local
, skb
))
2213 __ieee80211_rx_handle_packet(hw
, skb
, status
, rate
);
2217 EXPORT_SYMBOL(__ieee80211_rx
);
2219 /* This is a version of the rx handler that can be called from hard irq
2220 * context. Post the skb on the queue and schedule the tasklet */
2221 void ieee80211_rx_irqsafe(struct ieee80211_hw
*hw
, struct sk_buff
*skb
,
2222 struct ieee80211_rx_status
*status
)
2224 struct ieee80211_local
*local
= hw_to_local(hw
);
2226 BUILD_BUG_ON(sizeof(struct ieee80211_rx_status
) > sizeof(skb
->cb
));
2228 skb
->dev
= local
->mdev
;
2229 /* copy status into skb->cb for use by tasklet */
2230 memcpy(skb
->cb
, status
, sizeof(*status
));
2231 skb
->pkt_type
= IEEE80211_RX_MSG
;
2232 skb_queue_tail(&local
->skb_queue
, skb
);
2233 tasklet_schedule(&local
->tasklet
);
2235 EXPORT_SYMBOL(ieee80211_rx_irqsafe
);