2 * Received Data frame processing
3 * Copyright (c) 2010-2015, Jouni Malinen <j@w1.fi>
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
9 #include "utils/includes.h"
11 #include "utils/common.h"
12 #include "common/defs.h"
13 #include "common/ieee802_11_defs.h"
17 static const char * data_stype(u16 stype
)
20 case WLAN_FC_STYPE_DATA
:
22 case WLAN_FC_STYPE_DATA_CFACK
:
24 case WLAN_FC_STYPE_DATA_CFPOLL
:
26 case WLAN_FC_STYPE_DATA_CFACKPOLL
:
27 return "DATA-CFACKPOLL";
28 case WLAN_FC_STYPE_NULLFUNC
:
30 case WLAN_FC_STYPE_CFACK
:
32 case WLAN_FC_STYPE_CFPOLL
:
34 case WLAN_FC_STYPE_CFACKPOLL
:
36 case WLAN_FC_STYPE_QOS_DATA
:
38 case WLAN_FC_STYPE_QOS_DATA_CFACK
:
39 return "QOSDATA-CFACK";
40 case WLAN_FC_STYPE_QOS_DATA_CFPOLL
:
41 return "QOSDATA-CFPOLL";
42 case WLAN_FC_STYPE_QOS_DATA_CFACKPOLL
:
43 return "QOSDATA-CFACKPOLL";
44 case WLAN_FC_STYPE_QOS_NULL
:
46 case WLAN_FC_STYPE_QOS_CFPOLL
:
48 case WLAN_FC_STYPE_QOS_CFACKPOLL
:
49 return "QOS-CFACKPOLL";
55 static void rx_data_eth(struct wlantest
*wt
, const u8
*bssid
,
56 const u8
*sta_addr
, const u8
*dst
, const u8
*src
,
57 u16 ethertype
, const u8
*data
, size_t len
, int prot
,
60 static void rx_data_vlan(struct wlantest
*wt
, const u8
*bssid
,
61 const u8
*sta_addr
, const u8
*dst
, const u8
*src
,
62 const u8
*data
, size_t len
, int prot
,
69 tag
= WPA_GET_BE16(data
);
70 wpa_printf(MSG_MSGDUMP
, "VLAN tag: Priority=%u ID=%u",
71 tag
>> 12, tag
& 0x0ffff);
72 /* ignore VLAN information and process the original frame */
73 rx_data_eth(wt
, bssid
, sta_addr
, dst
, src
, WPA_GET_BE16(data
+ 2),
74 data
+ 4, len
- 4, prot
, peer_addr
);
78 static void rx_data_eth(struct wlantest
*wt
, const u8
*bssid
,
79 const u8
*sta_addr
, const u8
*dst
, const u8
*src
,
80 u16 ethertype
, const u8
*data
, size_t len
, int prot
,
85 rx_data_eapol(wt
, bssid
, sta_addr
, dst
, src
, data
, len
, prot
);
88 rx_data_ip(wt
, bssid
, sta_addr
, dst
, src
, data
, len
,
92 rx_data_80211_encap(wt
, bssid
, sta_addr
, dst
, src
, data
, len
);
95 rx_data_vlan(wt
, bssid
, sta_addr
, dst
, src
, data
, len
, prot
,
102 static void rx_data_process(struct wlantest
*wt
, const u8
*bssid
,
104 const u8
*dst
, const u8
*src
,
105 const u8
*data
, size_t len
, int prot
,
111 if (len
>= 8 && os_memcmp(data
, "\xaa\xaa\x03\x00\x00\x00", 6) == 0) {
112 rx_data_eth(wt
, bssid
, sta_addr
, dst
, src
,
113 WPA_GET_BE16(data
+ 6), data
+ 8, len
- 8, prot
,
118 wpa_hexdump(MSG_DEBUG
, "Unrecognized LLC", data
, len
> 8 ? 8 : len
);
122 static void write_decrypted_note(struct wlantest
*wt
, const u8
*decrypted
,
123 const u8
*tk
, size_t tk_len
, int keyid
)
130 wpa_snprintf_hex(tk_hex
, sizeof(tk_hex
), tk
, tk_len
);
131 add_note(wt
, MSG_EXCESSIVE
, "TK[%d] %s", keyid
, tk_hex
);
135 static u8
* try_ptk(int pairwise_cipher
, struct wpa_ptk
*ptk
,
136 const struct ieee80211_hdr
*hdr
,
137 const u8
*data
, size_t data_len
, size_t *decrypted_len
)
140 unsigned int tk_len
= ptk
->tk_len
;
143 if ((pairwise_cipher
== WPA_CIPHER_CCMP
||
144 pairwise_cipher
== 0) && tk_len
== 16) {
145 decrypted
= ccmp_decrypt(ptk
->tk
, hdr
, data
,
146 data_len
, decrypted_len
);
147 } else if ((pairwise_cipher
== WPA_CIPHER_CCMP_256
||
148 pairwise_cipher
== 0) && tk_len
== 32) {
149 decrypted
= ccmp_256_decrypt(ptk
->tk
, hdr
, data
,
150 data_len
, decrypted_len
);
151 } else if ((pairwise_cipher
== WPA_CIPHER_GCMP
||
152 pairwise_cipher
== WPA_CIPHER_GCMP_256
||
153 pairwise_cipher
== 0) &&
154 (tk_len
== 16 || tk_len
== 32)) {
155 decrypted
= gcmp_decrypt(ptk
->tk
, tk_len
, hdr
,
156 data
, data_len
, decrypted_len
);
157 } else if ((pairwise_cipher
== WPA_CIPHER_TKIP
||
158 pairwise_cipher
== 0) && tk_len
== 32) {
159 decrypted
= tkip_decrypt(ptk
->tk
, hdr
, data
, data_len
,
167 static u8
* try_all_ptk(struct wlantest
*wt
, int pairwise_cipher
,
168 const struct ieee80211_hdr
*hdr
, int keyid
,
169 const u8
*data
, size_t data_len
, size_t *decrypted_len
)
171 struct wlantest_ptk
*ptk
;
173 int prev_level
= wpa_debug_level
;
175 wpa_debug_level
= MSG_WARNING
;
176 dl_list_for_each(ptk
, &wt
->ptk
, struct wlantest_ptk
, list
) {
177 decrypted
= try_ptk(pairwise_cipher
, &ptk
->ptk
, hdr
,
178 data
, data_len
, decrypted_len
);
180 wpa_debug_level
= prev_level
;
181 add_note(wt
, MSG_DEBUG
,
182 "Found PTK match from list of all known PTKs");
183 write_decrypted_note(wt
, decrypted
, ptk
->ptk
.tk
,
184 ptk
->ptk
.tk_len
, keyid
);
188 wpa_debug_level
= prev_level
;
194 static void check_plaintext_prot(struct wlantest
*wt
,
195 const struct ieee80211_hdr
*hdr
,
196 const u8
*data
, size_t len
)
198 if (len
< 8 + 3 || data
[8] != 0xaa || data
[9] != 0xaa ||
202 add_note(wt
, MSG_DEBUG
,
203 "Plaintext payload in protected frame");
204 wpa_printf(MSG_INFO
, "Plaintext payload in protected frame #%u: A2="
206 wt
->frame_num
, MAC2STR(hdr
->addr2
),
207 WLAN_GET_SEQ_SEQ(le_to_host16(hdr
->seq_ctrl
)));
211 static void rx_data_bss_prot_group(struct wlantest
*wt
,
212 const struct ieee80211_hdr
*hdr
,
214 const u8
*qos
, const u8
*dst
, const u8
*src
,
215 const u8
*data
, size_t len
)
217 struct wlantest_bss
*bss
;
219 u8
*decrypted
= NULL
;
224 bss
= bss_get(wt
, hdr
->addr2
);
228 add_note(wt
, MSG_INFO
, "Too short group addressed data frame");
232 if (bss
->group_cipher
& (WPA_CIPHER_TKIP
| WPA_CIPHER_CCMP
) &&
234 add_note(wt
, MSG_INFO
, "Expected TKIP/CCMP frame from "
235 MACSTR
" did not have ExtIV bit set to 1",
236 MAC2STR(bss
->bssid
));
240 if (bss
->group_cipher
== WPA_CIPHER_TKIP
) {
241 if (data
[3] & 0x1f) {
242 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
243 " used non-zero reserved bit",
244 MAC2STR(bss
->bssid
));
246 if (data
[1] != ((data
[0] | 0x20) & 0x7f)) {
247 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
248 " used incorrect WEPSeed[1] (was 0x%x, "
250 MAC2STR(bss
->bssid
), data
[1],
251 (data
[0] | 0x20) & 0x7f);
253 } else if (bss
->group_cipher
== WPA_CIPHER_CCMP
) {
254 if (data
[2] != 0 || (data
[3] & 0x1f) != 0) {
255 add_note(wt
, MSG_INFO
, "CCMP frame from " MACSTR
256 " used non-zero reserved bit",
257 MAC2STR(bss
->bssid
));
261 check_plaintext_prot(wt
, hdr
, data
, len
);
262 keyid
= data
[3] >> 6;
263 if (bss
->gtk_len
[keyid
] == 0 && bss
->group_cipher
!= WPA_CIPHER_WEP40
)
265 add_note(wt
, MSG_MSGDUMP
, "No GTK known to decrypt the frame "
266 "(A2=" MACSTR
" KeyID=%d)",
267 MAC2STR(hdr
->addr2
), keyid
);
271 if (bss
->group_cipher
== WPA_CIPHER_TKIP
)
272 tkip_get_pn(pn
, data
);
273 else if (bss
->group_cipher
== WPA_CIPHER_WEP40
)
274 goto skip_replay_det
;
276 ccmp_get_pn(pn
, data
);
277 if (os_memcmp(pn
, bss
->rsc
[keyid
], 6) <= 0) {
278 u16 seq_ctrl
= le_to_host16(hdr
->seq_ctrl
);
279 char pn_hex
[6 * 2 + 1], rsc_hex
[6 * 2 + 1];
281 wpa_snprintf_hex(pn_hex
, sizeof(pn_hex
), pn
, 6);
282 wpa_snprintf_hex(rsc_hex
, sizeof(rsc_hex
), bss
->rsc
[keyid
], 6);
283 add_note(wt
, MSG_INFO
, "replay detected: A1=" MACSTR
284 " A2=" MACSTR
" A3=" MACSTR
285 " seq=%u frag=%u%s keyid=%d %s<=%s",
286 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
288 WLAN_GET_SEQ_SEQ(seq_ctrl
),
289 WLAN_GET_SEQ_FRAG(seq_ctrl
),
290 (le_to_host16(hdr
->frame_control
) & WLAN_FC_RETRY
) ?
292 keyid
, pn_hex
, rsc_hex
);
293 wpa_hexdump(MSG_INFO
, "RX PN", pn
, 6);
294 wpa_hexdump(MSG_INFO
, "RSC", bss
->rsc
[keyid
], 6);
299 if (bss
->group_cipher
== WPA_CIPHER_TKIP
)
300 decrypted
= tkip_decrypt(bss
->gtk
[keyid
], hdr
, data
, len
,
302 else if (bss
->group_cipher
== WPA_CIPHER_WEP40
)
303 decrypted
= wep_decrypt(wt
, hdr
, data
, len
, &dlen
);
304 else if (bss
->group_cipher
== WPA_CIPHER_CCMP
)
305 decrypted
= ccmp_decrypt(bss
->gtk
[keyid
], hdr
, data
, len
,
307 else if (bss
->group_cipher
== WPA_CIPHER_CCMP_256
)
308 decrypted
= ccmp_256_decrypt(bss
->gtk
[keyid
], hdr
, data
, len
,
310 else if (bss
->group_cipher
== WPA_CIPHER_GCMP
||
311 bss
->group_cipher
== WPA_CIPHER_GCMP_256
)
312 decrypted
= gcmp_decrypt(bss
->gtk
[keyid
], bss
->gtk_len
[keyid
],
313 hdr
, data
, len
, &dlen
);
318 wpa_snprintf_hex(gtk
, sizeof(gtk
), bss
->gtk
[keyid
],
319 bss
->gtk_len
[keyid
]);
320 add_note(wt
, MSG_EXCESSIVE
, "GTK[%d] %s", keyid
, gtk
);
321 rx_data_process(wt
, bss
->bssid
, NULL
, dst
, src
, decrypted
,
324 os_memcpy(bss
->rsc
[keyid
], pn
, 6);
325 write_pcap_decrypted(wt
, (const u8
*) hdr
, hdrlen
,
328 add_note(wt
, MSG_DEBUG
, "Failed to decrypt frame (group)");
333 static void rx_data_bss_prot(struct wlantest
*wt
,
334 const struct ieee80211_hdr
*hdr
, size_t hdrlen
,
335 const u8
*qos
, const u8
*dst
, const u8
*src
,
336 const u8
*data
, size_t len
)
338 struct wlantest_bss
*bss
, *bss2
;
339 struct wlantest_sta
*sta
, *sta2
;
341 u16 fc
= le_to_host16(hdr
->frame_control
);
342 u8
*decrypted
= NULL
;
345 u8 pn
[6], *rsc
= NULL
;
346 struct wlantest_tdls
*tdls
= NULL
, *found
;
348 int ptk_iter_done
= 0;
349 int try_ptk_iter
= 0;
351 int only_zero_tk
= 0;
353 if (hdr
->addr1
[0] & 0x01) {
354 rx_data_bss_prot_group(wt
, hdr
, hdrlen
, qos
, dst
, src
,
359 if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
360 (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
361 bss
= bss_find(wt
, hdr
->addr1
);
363 sta
= sta_find(bss
, hdr
->addr2
);
366 WLANTEST_STA_COUNTER_PROT_DATA_TX
]++;
368 if (!sta
|| !sta
->ptk_set
) {
369 bss2
= bss_find(wt
, hdr
->addr2
);
371 sta2
= sta_find(bss2
, hdr
->addr1
);
372 if (sta2
&& (!sta
|| sta2
->ptk_set
)) {
379 bss
= bss_find(wt
, hdr
->addr2
);
382 sta
= sta_find(bss
, hdr
->addr1
);
384 } else if (fc
& WLAN_FC_TODS
) {
385 bss
= bss_get(wt
, hdr
->addr1
);
388 sta
= sta_get(bss
, hdr
->addr2
);
390 sta
->counters
[WLANTEST_STA_COUNTER_PROT_DATA_TX
]++;
391 } else if (fc
& WLAN_FC_FROMDS
) {
392 bss
= bss_get(wt
, hdr
->addr2
);
395 sta
= sta_get(bss
, hdr
->addr1
);
397 bss
= bss_get(wt
, hdr
->addr3
);
400 sta
= sta_find(bss
, hdr
->addr2
);
401 sta2
= sta_find(bss
, hdr
->addr1
);
402 if (sta
== NULL
|| sta2
== NULL
)
405 dl_list_for_each(tdls
, &bss
->tdls
, struct wlantest_tdls
, list
)
407 if ((tdls
->init
== sta
&& tdls
->resp
== sta2
) ||
408 (tdls
->init
== sta2
&& tdls
->resp
== sta
)) {
416 add_note(wt
, MSG_DEBUG
,
417 "TDLS: Link not up, but Data "
423 check_plaintext_prot(wt
, hdr
, data
, len
);
425 (!sta
->ptk_set
&& sta
->pairwise_cipher
!= WPA_CIPHER_WEP40
)) &&
427 add_note(wt
, MSG_MSGDUMP
, "No PTK known to decrypt the frame");
428 if (dl_list_empty(&wt
->ptk
)) {
429 if (len
>= 4 && sta
) {
430 keyid
= data
[3] >> 6;
441 add_note(wt
, MSG_INFO
, "Too short encrypted data frame");
447 if (sta
->pairwise_cipher
& (WPA_CIPHER_TKIP
| WPA_CIPHER_CCMP
) &&
449 add_note(wt
, MSG_INFO
, "Expected TKIP/CCMP frame from "
450 MACSTR
" did not have ExtIV bit set to 1",
455 if (tk
== NULL
&& sta
->pairwise_cipher
== WPA_CIPHER_TKIP
) {
456 if (data
[3] & 0x1f) {
457 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
458 " used non-zero reserved bit",
459 MAC2STR(hdr
->addr2
));
461 if (data
[1] != ((data
[0] | 0x20) & 0x7f)) {
462 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
463 " used incorrect WEPSeed[1] (was 0x%x, "
465 MAC2STR(hdr
->addr2
), data
[1],
466 (data
[0] | 0x20) & 0x7f);
468 } else if (tk
|| sta
->pairwise_cipher
== WPA_CIPHER_CCMP
) {
469 if (data
[2] != 0 || (data
[3] & 0x1f) != 0) {
470 add_note(wt
, MSG_INFO
, "CCMP frame from " MACSTR
471 " used non-zero reserved bit",
472 MAC2STR(hdr
->addr2
));
476 keyid
= data
[3] >> 6;
478 (!(sta
->rsn_capab
& WPA_CAPABILITY_EXT_KEY_ID_FOR_UNICAST
) ||
479 !(bss
->rsn_capab
& WPA_CAPABILITY_EXT_KEY_ID_FOR_UNICAST
) ||
481 add_note(wt
, MSG_INFO
,
482 "Unexpected KeyID %d in individually addressed Data frame from "
484 keyid
, MAC2STR(hdr
->addr2
));
489 if (fc
& WLAN_FC_TODS
)
495 if (fc
& WLAN_FC_TODS
)
501 if (os_memcmp(hdr
->addr2
, tdls
->init
->addr
, ETH_ALEN
) == 0)
502 rsc
= tdls
->rsc_init
[tid
];
504 rsc
= tdls
->rsc_resp
[tid
];
505 } else if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
506 (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
507 if (os_memcmp(sta
->addr
, hdr
->addr2
, ETH_ALEN
) == 0)
508 rsc
= sta
->rsc_tods
[tid
];
510 rsc
= sta
->rsc_fromds
[tid
];
511 } else if (fc
& WLAN_FC_TODS
)
512 rsc
= sta
->rsc_tods
[tid
];
514 rsc
= sta
->rsc_fromds
[tid
];
517 if (tk
== NULL
&& sta
->pairwise_cipher
== WPA_CIPHER_TKIP
)
518 tkip_get_pn(pn
, data
);
519 else if (sta
->pairwise_cipher
== WPA_CIPHER_WEP40
)
520 goto skip_replay_det
;
522 ccmp_get_pn(pn
, data
);
523 if (os_memcmp(pn
, rsc
, 6) <= 0) {
524 u16 seq_ctrl
= le_to_host16(hdr
->seq_ctrl
);
525 char pn_hex
[6 * 2 + 1], rsc_hex
[6 * 2 + 1];
527 wpa_snprintf_hex(pn_hex
, sizeof(pn_hex
), pn
, 6);
528 wpa_snprintf_hex(rsc_hex
, sizeof(rsc_hex
), rsc
, 6);
529 add_note(wt
, MSG_INFO
, "replay detected: A1=" MACSTR
530 " A2=" MACSTR
" A3=" MACSTR
531 " seq=%u frag=%u%s keyid=%d tid=%d %s<=%s",
532 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
534 WLAN_GET_SEQ_SEQ(seq_ctrl
),
535 WLAN_GET_SEQ_FRAG(seq_ctrl
),
536 (le_to_host16(hdr
->frame_control
) & WLAN_FC_RETRY
) ?
538 keyid
, tid
, pn_hex
, rsc_hex
);
539 wpa_hexdump(MSG_INFO
, "RX PN", pn
, 6);
540 wpa_hexdump(MSG_INFO
, "RSC", rsc
, 6);
546 if (sta
->pairwise_cipher
== WPA_CIPHER_CCMP_256
) {
547 decrypted
= ccmp_256_decrypt(tk
, hdr
, data
, len
, &dlen
);
548 write_decrypted_note(wt
, decrypted
, tk
, 32, keyid
);
549 } else if (sta
->pairwise_cipher
== WPA_CIPHER_GCMP
||
550 sta
->pairwise_cipher
== WPA_CIPHER_GCMP_256
) {
551 decrypted
= gcmp_decrypt(tk
, sta
->ptk
.tk_len
, hdr
, data
,
553 write_decrypted_note(wt
, decrypted
, tk
, sta
->ptk
.tk_len
,
556 decrypted
= ccmp_decrypt(tk
, hdr
, data
, len
, &dlen
);
557 write_decrypted_note(wt
, decrypted
, tk
, 16, keyid
);
559 } else if (sta
->pairwise_cipher
== WPA_CIPHER_TKIP
) {
560 decrypted
= tkip_decrypt(sta
->ptk
.tk
, hdr
, data
, len
, &dlen
);
561 write_decrypted_note(wt
, decrypted
, sta
->ptk
.tk
, 32, keyid
);
562 } else if (sta
->pairwise_cipher
== WPA_CIPHER_WEP40
) {
563 decrypted
= wep_decrypt(wt
, hdr
, data
, len
, &dlen
);
564 } else if (sta
->ptk_set
) {
565 if (sta
->pairwise_cipher
== WPA_CIPHER_CCMP_256
)
566 decrypted
= ccmp_256_decrypt(sta
->ptk
.tk
, hdr
, data
,
568 else if (sta
->pairwise_cipher
== WPA_CIPHER_GCMP
||
569 sta
->pairwise_cipher
== WPA_CIPHER_GCMP_256
)
570 decrypted
= gcmp_decrypt(sta
->ptk
.tk
, sta
->ptk
.tk_len
,
571 hdr
, data
, len
, &dlen
);
573 decrypted
= ccmp_decrypt(sta
->ptk
.tk
, hdr
, data
, len
,
575 write_decrypted_note(wt
, decrypted
, sta
->ptk
.tk
,
576 sta
->ptk
.tk_len
, keyid
);
578 decrypted
= try_all_ptk(wt
, sta
->pairwise_cipher
, hdr
, keyid
,
582 if (!decrypted
&& !ptk_iter_done
) {
583 decrypted
= try_all_ptk(wt
, sta
->pairwise_cipher
, hdr
, keyid
,
586 add_note(wt
, MSG_DEBUG
, "Current PTK did not work, but found a match from all known PTKs");
591 struct wpa_ptk zero_ptk
;
592 int old_debug_level
= wpa_debug_level
;
594 os_memset(&zero_ptk
, 0, sizeof(zero_ptk
));
595 zero_ptk
.tk_len
= wpa_cipher_key_len(sta
->pairwise_cipher
);
596 wpa_debug_level
= MSG_ERROR
;
597 decrypted
= try_ptk(sta
->pairwise_cipher
, &zero_ptk
, hdr
,
599 wpa_debug_level
= old_debug_level
;
601 add_note(wt
, MSG_DEBUG
,
602 "Frame was encrypted with zero TK");
603 wpa_printf(MSG_INFO
, "Zero TK used in frame #%u: A2="
605 wt
->frame_num
, MAC2STR(hdr
->addr2
),
607 le_to_host16(hdr
->seq_ctrl
)));
608 write_decrypted_note(wt
, decrypted
, zero_ptk
.tk
,
609 zero_ptk
.tk_len
, keyid
);
613 u16 fc
= le_to_host16(hdr
->frame_control
);
614 const u8
*peer_addr
= NULL
;
615 if (!(fc
& (WLAN_FC_FROMDS
| WLAN_FC_TODS
)))
616 peer_addr
= hdr
->addr1
;
618 os_memcpy(rsc
, pn
, 6);
619 rx_data_process(wt
, bss
->bssid
, sta
->addr
, dst
, src
, decrypted
,
621 write_pcap_decrypted(wt
, (const u8
*) hdr
, hdrlen
,
624 if (!try_ptk_iter
&& !only_zero_tk
)
625 add_note(wt
, MSG_DEBUG
, "Failed to decrypt frame");
627 /* Assume the frame was corrupted and there was no FCS to check.
628 * Allow retry of this particular frame to be processed so that
629 * it could end up getting decrypted if it was received without
631 sta
->allow_duplicate
= 1;
637 static void rx_data_bss(struct wlantest
*wt
, const struct ieee80211_hdr
*hdr
,
638 size_t hdrlen
, const u8
*qos
, const u8
*dst
,
639 const u8
*src
, const u8
*data
, size_t len
)
641 u16 fc
= le_to_host16(hdr
->frame_control
);
642 int prot
= !!(fc
& WLAN_FC_ISWEP
);
645 u8 ack
= (qos
[0] & 0x60) >> 5;
646 wpa_printf(MSG_MSGDUMP
, "BSS DATA: " MACSTR
" -> " MACSTR
647 " len=%u%s tid=%u%s%s",
648 MAC2STR(src
), MAC2STR(dst
), (unsigned int) len
,
649 prot
? " Prot" : "", qos
[0] & 0x0f,
650 (qos
[0] & 0x10) ? " EOSP" : "",
652 (ack
== 1 ? " NoAck" :
653 (ack
== 2 ? " NoExpAck" : " BA")));
655 wpa_printf(MSG_MSGDUMP
, "BSS DATA: " MACSTR
" -> " MACSTR
657 MAC2STR(src
), MAC2STR(dst
), (unsigned int) len
,
658 prot
? " Prot" : "");
662 rx_data_bss_prot(wt
, hdr
, hdrlen
, qos
, dst
, src
, data
, len
);
664 const u8
*bssid
, *sta_addr
, *peer_addr
;
665 struct wlantest_bss
*bss
;
667 if (fc
& WLAN_FC_TODS
) {
669 sta_addr
= hdr
->addr2
;
671 } else if (fc
& WLAN_FC_FROMDS
) {
673 sta_addr
= hdr
->addr1
;
677 sta_addr
= hdr
->addr2
;
678 peer_addr
= hdr
->addr1
;
681 bss
= bss_get(wt
, bssid
);
683 struct wlantest_sta
*sta
= sta_get(bss
, sta_addr
);
687 int tid
= qos
[0] & 0x0f;
688 if (fc
& WLAN_FC_TODS
)
693 if (fc
& WLAN_FC_TODS
)
701 rx_data_process(wt
, bssid
, sta_addr
, dst
, src
, data
, len
, 0,
707 static struct wlantest_tdls
* get_tdls(struct wlantest
*wt
, const u8
*bssid
,
711 struct wlantest_bss
*bss
;
712 struct wlantest_sta
*sta1
, *sta2
;
713 struct wlantest_tdls
*tdls
, *found
= NULL
;
715 bss
= bss_find(wt
, bssid
);
718 sta1
= sta_find(bss
, sta1_addr
);
721 sta2
= sta_find(bss
, sta2_addr
);
725 dl_list_for_each(tdls
, &bss
->tdls
, struct wlantest_tdls
, list
) {
726 if ((tdls
->init
== sta1
&& tdls
->resp
== sta2
) ||
727 (tdls
->init
== sta2
&& tdls
->resp
== sta1
)) {
738 static void add_direct_link(struct wlantest
*wt
, const u8
*bssid
,
739 const u8
*sta1_addr
, const u8
*sta2_addr
)
741 struct wlantest_tdls
*tdls
;
743 tdls
= get_tdls(wt
, bssid
, sta1_addr
, sta2_addr
);
748 tdls
->counters
[WLANTEST_TDLS_COUNTER_VALID_DIRECT_LINK
]++;
750 tdls
->counters
[WLANTEST_TDLS_COUNTER_INVALID_DIRECT_LINK
]++;
754 static void add_ap_path(struct wlantest
*wt
, const u8
*bssid
,
755 const u8
*sta1_addr
, const u8
*sta2_addr
)
757 struct wlantest_tdls
*tdls
;
759 tdls
= get_tdls(wt
, bssid
, sta1_addr
, sta2_addr
);
764 tdls
->counters
[WLANTEST_TDLS_COUNTER_INVALID_AP_PATH
]++;
766 tdls
->counters
[WLANTEST_TDLS_COUNTER_VALID_AP_PATH
]++;
770 void rx_data(struct wlantest
*wt
, const u8
*data
, size_t len
)
772 const struct ieee80211_hdr
*hdr
;
775 const u8
*qos
= NULL
;
780 hdr
= (const struct ieee80211_hdr
*) data
;
781 fc
= le_to_host16(hdr
->frame_control
);
782 stype
= WLAN_FC_GET_STYPE(fc
);
784 if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
785 (WLAN_FC_TODS
| WLAN_FC_FROMDS
))
795 switch (fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
797 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s IBSS DA=" MACSTR
" SA="
798 MACSTR
" BSSID=" MACSTR
,
799 data_stype(WLAN_FC_GET_STYPE(fc
)),
800 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
801 fc
& WLAN_FC_ISWEP
? " Prot" : "",
802 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
803 MAC2STR(hdr
->addr3
));
804 add_direct_link(wt
, hdr
->addr3
, hdr
->addr1
, hdr
->addr2
);
805 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr2
,
806 data
+ hdrlen
, len
- hdrlen
);
809 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s FromDS DA=" MACSTR
810 " BSSID=" MACSTR
" SA=" MACSTR
,
811 data_stype(WLAN_FC_GET_STYPE(fc
)),
812 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
813 fc
& WLAN_FC_ISWEP
? " Prot" : "",
814 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
815 MAC2STR(hdr
->addr3
));
816 add_ap_path(wt
, hdr
->addr2
, hdr
->addr1
, hdr
->addr3
);
817 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr3
,
818 data
+ hdrlen
, len
- hdrlen
);
821 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s ToDS BSSID=" MACSTR
822 " SA=" MACSTR
" DA=" MACSTR
,
823 data_stype(WLAN_FC_GET_STYPE(fc
)),
824 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
825 fc
& WLAN_FC_ISWEP
? " Prot" : "",
826 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
827 MAC2STR(hdr
->addr3
));
828 add_ap_path(wt
, hdr
->addr1
, hdr
->addr3
, hdr
->addr2
);
829 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr3
, hdr
->addr2
,
830 data
+ hdrlen
, len
- hdrlen
);
832 case WLAN_FC_TODS
| WLAN_FC_FROMDS
:
833 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s WDS RA=" MACSTR
" TA="
834 MACSTR
" DA=" MACSTR
" SA=" MACSTR
,
835 data_stype(WLAN_FC_GET_STYPE(fc
)),
836 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
837 fc
& WLAN_FC_ISWEP
? " Prot" : "",
838 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
840 MAC2STR((const u8
*) (hdr
+ 1)));
841 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr2
,
842 data
+ hdrlen
, len
- hdrlen
);