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");
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;
352 if (hdr
->addr1
[0] & 0x01) {
353 rx_data_bss_prot_group(wt
, hdr
, hdrlen
, qos
, dst
, src
,
358 if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
359 (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
360 bss
= bss_find(wt
, hdr
->addr1
);
362 sta
= sta_find(bss
, hdr
->addr2
);
365 WLANTEST_STA_COUNTER_PROT_DATA_TX
]++;
367 if (!sta
|| !sta
->ptk_set
) {
368 bss2
= bss_find(wt
, hdr
->addr2
);
370 sta2
= sta_find(bss2
, hdr
->addr1
);
371 if (sta2
&& (!sta
|| sta2
->ptk_set
)) {
378 bss
= bss_find(wt
, hdr
->addr2
);
381 sta
= sta_find(bss
, hdr
->addr1
);
383 } else if (fc
& WLAN_FC_TODS
) {
384 bss
= bss_get(wt
, hdr
->addr1
);
387 sta
= sta_get(bss
, hdr
->addr2
);
389 sta
->counters
[WLANTEST_STA_COUNTER_PROT_DATA_TX
]++;
390 } else if (fc
& WLAN_FC_FROMDS
) {
391 bss
= bss_get(wt
, hdr
->addr2
);
394 sta
= sta_get(bss
, hdr
->addr1
);
396 bss
= bss_get(wt
, hdr
->addr3
);
399 sta
= sta_find(bss
, hdr
->addr2
);
400 sta2
= sta_find(bss
, hdr
->addr1
);
401 if (sta
== NULL
|| sta2
== NULL
)
404 dl_list_for_each(tdls
, &bss
->tdls
, struct wlantest_tdls
, list
)
406 if ((tdls
->init
== sta
&& tdls
->resp
== sta2
) ||
407 (tdls
->init
== sta2
&& tdls
->resp
== sta
)) {
415 add_note(wt
, MSG_DEBUG
,
416 "TDLS: Link not up, but Data "
422 check_plaintext_prot(wt
, hdr
, data
, len
);
424 (!sta
->ptk_set
&& sta
->pairwise_cipher
!= WPA_CIPHER_WEP40
)) &&
426 add_note(wt
, MSG_MSGDUMP
, "No PTK known to decrypt the frame");
427 if (dl_list_empty(&wt
->ptk
)) {
428 if (len
>= 4 && sta
) {
429 keyid
= data
[3] >> 6;
439 add_note(wt
, MSG_INFO
, "Too short encrypted data frame");
445 if (sta
->pairwise_cipher
& (WPA_CIPHER_TKIP
| WPA_CIPHER_CCMP
) &&
447 add_note(wt
, MSG_INFO
, "Expected TKIP/CCMP frame from "
448 MACSTR
" did not have ExtIV bit set to 1",
453 if (tk
== NULL
&& sta
->pairwise_cipher
== WPA_CIPHER_TKIP
) {
454 if (data
[3] & 0x1f) {
455 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
456 " used non-zero reserved bit",
457 MAC2STR(hdr
->addr2
));
459 if (data
[1] != ((data
[0] | 0x20) & 0x7f)) {
460 add_note(wt
, MSG_INFO
, "TKIP frame from " MACSTR
461 " used incorrect WEPSeed[1] (was 0x%x, "
463 MAC2STR(hdr
->addr2
), data
[1],
464 (data
[0] | 0x20) & 0x7f);
466 } else if (tk
|| sta
->pairwise_cipher
== WPA_CIPHER_CCMP
) {
467 if (data
[2] != 0 || (data
[3] & 0x1f) != 0) {
468 add_note(wt
, MSG_INFO
, "CCMP frame from " MACSTR
469 " used non-zero reserved bit",
470 MAC2STR(hdr
->addr2
));
474 keyid
= data
[3] >> 6;
476 (!(sta
->rsn_capab
& WPA_CAPABILITY_EXT_KEY_ID_FOR_UNICAST
) ||
477 !(bss
->rsn_capab
& WPA_CAPABILITY_EXT_KEY_ID_FOR_UNICAST
) ||
479 add_note(wt
, MSG_INFO
,
480 "Unexpected KeyID %d in individually addressed Data frame from "
482 keyid
, MAC2STR(hdr
->addr2
));
487 if (fc
& WLAN_FC_TODS
)
493 if (fc
& WLAN_FC_TODS
)
499 if (os_memcmp(hdr
->addr2
, tdls
->init
->addr
, ETH_ALEN
) == 0)
500 rsc
= tdls
->rsc_init
[tid
];
502 rsc
= tdls
->rsc_resp
[tid
];
503 } else if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
504 (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
505 if (os_memcmp(sta
->addr
, hdr
->addr2
, ETH_ALEN
) == 0)
506 rsc
= sta
->rsc_tods
[tid
];
508 rsc
= sta
->rsc_fromds
[tid
];
509 } else if (fc
& WLAN_FC_TODS
)
510 rsc
= sta
->rsc_tods
[tid
];
512 rsc
= sta
->rsc_fromds
[tid
];
515 if (tk
== NULL
&& sta
->pairwise_cipher
== WPA_CIPHER_TKIP
)
516 tkip_get_pn(pn
, data
);
517 else if (sta
->pairwise_cipher
== WPA_CIPHER_WEP40
)
518 goto skip_replay_det
;
520 ccmp_get_pn(pn
, data
);
521 if (os_memcmp(pn
, rsc
, 6) <= 0) {
522 u16 seq_ctrl
= le_to_host16(hdr
->seq_ctrl
);
523 char pn_hex
[6 * 2 + 1], rsc_hex
[6 * 2 + 1];
525 wpa_snprintf_hex(pn_hex
, sizeof(pn_hex
), pn
, 6);
526 wpa_snprintf_hex(rsc_hex
, sizeof(rsc_hex
), rsc
, 6);
527 add_note(wt
, MSG_INFO
, "replay detected: A1=" MACSTR
528 " A2=" MACSTR
" A3=" MACSTR
529 " seq=%u frag=%u%s keyid=%d tid=%d %s<=%s",
530 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
532 WLAN_GET_SEQ_SEQ(seq_ctrl
),
533 WLAN_GET_SEQ_FRAG(seq_ctrl
),
534 (le_to_host16(hdr
->frame_control
) & WLAN_FC_RETRY
) ?
536 keyid
, tid
, pn_hex
, rsc_hex
);
537 wpa_hexdump(MSG_INFO
, "RX PN", pn
, 6);
538 wpa_hexdump(MSG_INFO
, "RSC", rsc
, 6);
544 if (sta
->pairwise_cipher
== WPA_CIPHER_CCMP_256
) {
545 decrypted
= ccmp_256_decrypt(tk
, hdr
, data
, len
, &dlen
);
546 write_decrypted_note(wt
, decrypted
, tk
, 32, keyid
);
547 } else if (sta
->pairwise_cipher
== WPA_CIPHER_GCMP
||
548 sta
->pairwise_cipher
== WPA_CIPHER_GCMP_256
) {
549 decrypted
= gcmp_decrypt(tk
, sta
->ptk
.tk_len
, hdr
, data
,
551 write_decrypted_note(wt
, decrypted
, tk
, sta
->ptk
.tk_len
,
554 decrypted
= ccmp_decrypt(tk
, hdr
, data
, len
, &dlen
);
555 write_decrypted_note(wt
, decrypted
, tk
, 16, keyid
);
557 } else if (sta
->pairwise_cipher
== WPA_CIPHER_TKIP
) {
558 decrypted
= tkip_decrypt(sta
->ptk
.tk
, hdr
, data
, len
, &dlen
);
559 write_decrypted_note(wt
, decrypted
, sta
->ptk
.tk
, 32, keyid
);
560 } else if (sta
->pairwise_cipher
== WPA_CIPHER_WEP40
) {
561 decrypted
= wep_decrypt(wt
, hdr
, data
, len
, &dlen
);
562 } else if (sta
->ptk_set
) {
563 if (sta
->pairwise_cipher
== WPA_CIPHER_CCMP_256
)
564 decrypted
= ccmp_256_decrypt(sta
->ptk
.tk
, hdr
, data
,
566 else if (sta
->pairwise_cipher
== WPA_CIPHER_GCMP
||
567 sta
->pairwise_cipher
== WPA_CIPHER_GCMP_256
)
568 decrypted
= gcmp_decrypt(sta
->ptk
.tk
, sta
->ptk
.tk_len
,
569 hdr
, data
, len
, &dlen
);
571 decrypted
= ccmp_decrypt(sta
->ptk
.tk
, hdr
, data
, len
,
573 write_decrypted_note(wt
, decrypted
, sta
->ptk
.tk
,
574 sta
->ptk
.tk_len
, keyid
);
576 decrypted
= try_all_ptk(wt
, sta
->pairwise_cipher
, hdr
, keyid
,
580 if (!decrypted
&& !ptk_iter_done
) {
581 decrypted
= try_all_ptk(wt
, sta
->pairwise_cipher
, hdr
, keyid
,
584 add_note(wt
, MSG_DEBUG
, "Current PTK did not work, but found a match from all known PTKs");
589 struct wpa_ptk zero_ptk
;
590 int old_debug_level
= wpa_debug_level
;
592 os_memset(&zero_ptk
, 0, sizeof(zero_ptk
));
593 zero_ptk
.tk_len
= wpa_cipher_key_len(sta
->pairwise_cipher
);
594 wpa_debug_level
= MSG_ERROR
;
595 decrypted
= try_ptk(sta
->pairwise_cipher
, &zero_ptk
, hdr
,
597 wpa_debug_level
= old_debug_level
;
599 add_note(wt
, MSG_DEBUG
,
600 "Frame was encrypted with zero TK");
601 wpa_printf(MSG_INFO
, "Zero TK used in frame #%u: A2="
603 wt
->frame_num
, MAC2STR(hdr
->addr2
),
605 le_to_host16(hdr
->seq_ctrl
)));
606 write_decrypted_note(wt
, decrypted
, zero_ptk
.tk
,
607 zero_ptk
.tk_len
, keyid
);
611 u16 fc
= le_to_host16(hdr
->frame_control
);
612 const u8
*peer_addr
= NULL
;
613 if (!(fc
& (WLAN_FC_FROMDS
| WLAN_FC_TODS
)))
614 peer_addr
= hdr
->addr1
;
616 os_memcpy(rsc
, pn
, 6);
617 rx_data_process(wt
, bss
->bssid
, sta
->addr
, dst
, src
, decrypted
,
619 write_pcap_decrypted(wt
, (const u8
*) hdr
, hdrlen
,
623 add_note(wt
, MSG_DEBUG
, "Failed to decrypt frame");
625 /* Assume the frame was corrupted and there was no FCS to check.
626 * Allow retry of this particular frame to be processed so that
627 * it could end up getting decrypted if it was received without
629 sta
->allow_duplicate
= 1;
635 static void rx_data_bss(struct wlantest
*wt
, const struct ieee80211_hdr
*hdr
,
636 size_t hdrlen
, const u8
*qos
, const u8
*dst
,
637 const u8
*src
, const u8
*data
, size_t len
)
639 u16 fc
= le_to_host16(hdr
->frame_control
);
640 int prot
= !!(fc
& WLAN_FC_ISWEP
);
643 u8 ack
= (qos
[0] & 0x60) >> 5;
644 wpa_printf(MSG_MSGDUMP
, "BSS DATA: " MACSTR
" -> " MACSTR
645 " len=%u%s tid=%u%s%s",
646 MAC2STR(src
), MAC2STR(dst
), (unsigned int) len
,
647 prot
? " Prot" : "", qos
[0] & 0x0f,
648 (qos
[0] & 0x10) ? " EOSP" : "",
650 (ack
== 1 ? " NoAck" :
651 (ack
== 2 ? " NoExpAck" : " BA")));
653 wpa_printf(MSG_MSGDUMP
, "BSS DATA: " MACSTR
" -> " MACSTR
655 MAC2STR(src
), MAC2STR(dst
), (unsigned int) len
,
656 prot
? " Prot" : "");
660 rx_data_bss_prot(wt
, hdr
, hdrlen
, qos
, dst
, src
, data
, len
);
662 const u8
*bssid
, *sta_addr
, *peer_addr
;
663 struct wlantest_bss
*bss
;
665 if (fc
& WLAN_FC_TODS
) {
667 sta_addr
= hdr
->addr2
;
669 } else if (fc
& WLAN_FC_FROMDS
) {
671 sta_addr
= hdr
->addr1
;
675 sta_addr
= hdr
->addr2
;
676 peer_addr
= hdr
->addr1
;
679 bss
= bss_get(wt
, bssid
);
681 struct wlantest_sta
*sta
= sta_get(bss
, sta_addr
);
685 int tid
= qos
[0] & 0x0f;
686 if (fc
& WLAN_FC_TODS
)
691 if (fc
& WLAN_FC_TODS
)
699 rx_data_process(wt
, bssid
, sta_addr
, dst
, src
, data
, len
, 0,
705 static struct wlantest_tdls
* get_tdls(struct wlantest
*wt
, const u8
*bssid
,
709 struct wlantest_bss
*bss
;
710 struct wlantest_sta
*sta1
, *sta2
;
711 struct wlantest_tdls
*tdls
, *found
= NULL
;
713 bss
= bss_find(wt
, bssid
);
716 sta1
= sta_find(bss
, sta1_addr
);
719 sta2
= sta_find(bss
, sta2_addr
);
723 dl_list_for_each(tdls
, &bss
->tdls
, struct wlantest_tdls
, list
) {
724 if ((tdls
->init
== sta1
&& tdls
->resp
== sta2
) ||
725 (tdls
->init
== sta2
&& tdls
->resp
== sta1
)) {
736 static void add_direct_link(struct wlantest
*wt
, const u8
*bssid
,
737 const u8
*sta1_addr
, const u8
*sta2_addr
)
739 struct wlantest_tdls
*tdls
;
741 tdls
= get_tdls(wt
, bssid
, sta1_addr
, sta2_addr
);
746 tdls
->counters
[WLANTEST_TDLS_COUNTER_VALID_DIRECT_LINK
]++;
748 tdls
->counters
[WLANTEST_TDLS_COUNTER_INVALID_DIRECT_LINK
]++;
752 static void add_ap_path(struct wlantest
*wt
, const u8
*bssid
,
753 const u8
*sta1_addr
, const u8
*sta2_addr
)
755 struct wlantest_tdls
*tdls
;
757 tdls
= get_tdls(wt
, bssid
, sta1_addr
, sta2_addr
);
762 tdls
->counters
[WLANTEST_TDLS_COUNTER_INVALID_AP_PATH
]++;
764 tdls
->counters
[WLANTEST_TDLS_COUNTER_VALID_AP_PATH
]++;
768 void rx_data(struct wlantest
*wt
, const u8
*data
, size_t len
)
770 const struct ieee80211_hdr
*hdr
;
773 const u8
*qos
= NULL
;
778 hdr
= (const struct ieee80211_hdr
*) data
;
779 fc
= le_to_host16(hdr
->frame_control
);
780 stype
= WLAN_FC_GET_STYPE(fc
);
782 if ((fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) ==
783 (WLAN_FC_TODS
| WLAN_FC_FROMDS
))
793 switch (fc
& (WLAN_FC_TODS
| WLAN_FC_FROMDS
)) {
795 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s IBSS DA=" MACSTR
" SA="
796 MACSTR
" BSSID=" MACSTR
,
797 data_stype(WLAN_FC_GET_STYPE(fc
)),
798 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
799 fc
& WLAN_FC_ISWEP
? " Prot" : "",
800 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
801 MAC2STR(hdr
->addr3
));
802 add_direct_link(wt
, hdr
->addr3
, hdr
->addr1
, hdr
->addr2
);
803 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr2
,
804 data
+ hdrlen
, len
- hdrlen
);
807 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s FromDS DA=" MACSTR
808 " BSSID=" MACSTR
" SA=" MACSTR
,
809 data_stype(WLAN_FC_GET_STYPE(fc
)),
810 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
811 fc
& WLAN_FC_ISWEP
? " Prot" : "",
812 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
813 MAC2STR(hdr
->addr3
));
814 add_ap_path(wt
, hdr
->addr2
, hdr
->addr1
, hdr
->addr3
);
815 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr3
,
816 data
+ hdrlen
, len
- hdrlen
);
819 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s ToDS BSSID=" MACSTR
820 " SA=" MACSTR
" DA=" MACSTR
,
821 data_stype(WLAN_FC_GET_STYPE(fc
)),
822 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
823 fc
& WLAN_FC_ISWEP
? " Prot" : "",
824 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
825 MAC2STR(hdr
->addr3
));
826 add_ap_path(wt
, hdr
->addr1
, hdr
->addr3
, hdr
->addr2
);
827 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr3
, hdr
->addr2
,
828 data
+ hdrlen
, len
- hdrlen
);
830 case WLAN_FC_TODS
| WLAN_FC_FROMDS
:
831 wpa_printf(MSG_EXCESSIVE
, "DATA %s%s%s WDS RA=" MACSTR
" TA="
832 MACSTR
" DA=" MACSTR
" SA=" MACSTR
,
833 data_stype(WLAN_FC_GET_STYPE(fc
)),
834 fc
& WLAN_FC_PWRMGT
? " PwrMgt" : "",
835 fc
& WLAN_FC_ISWEP
? " Prot" : "",
836 MAC2STR(hdr
->addr1
), MAC2STR(hdr
->addr2
),
838 MAC2STR((const u8
*) (hdr
+ 1)));
839 rx_data_bss(wt
, hdr
, hdrlen
, qos
, hdr
->addr1
, hdr
->addr2
,
840 data
+ hdrlen
, len
- hdrlen
);