X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/15b5a0ab52d63d8edfef74a140096bb4ed744e60..ffa1470e5c7ff0e50028d085a481dc797b0b51ed:/print-802_11.c diff --git a/print-802_11.c b/print-802_11.c index f468c3d9..891439e0 100644 --- a/print-802_11.c +++ b/print-802_11.c @@ -1,5 +1,5 @@ /* - * Copyright (c) 2001 + * Copyright (c) 2001 * Fortress Technologies, Inc. All rights reserved. * Charlie Lenahan (clenahan@fortresstech.com) * @@ -21,19 +21,15 @@ */ #ifndef lint -static const char rcsid[] = - "@(#) $Header: /tcpdump/master/tcpdump/print-802_11.c,v 1.1 2001-06-12 05:17:17 guy Exp $ (LBL)"; +static const char rcsid[] _U_ = + "@(#) $Header: /tcpdump/master/tcpdump/print-802_11.c,v 1.31.2.10 2005-11-13 20:23:09 guy Exp $ (LBL)"; #endif #ifdef HAVE_CONFIG_H #include "config.h" #endif -#include -#include -#include - -#include +#include #include #include @@ -45,129 +41,250 @@ static const char rcsid[] = #include "extract.h" +#include "cpack.h" + #include "ieee802_11.h" +#include "ieee802_11_radio.h" + +#define PRINT_SSID(p) \ + switch (p.ssid_status) { \ + case TRUNCATED: \ + return 0; \ + case PRESENT: \ + printf(" ("); \ + fn_print(p.ssid.ssid, NULL); \ + printf(")"); \ + break; \ + case NOT_PRESENT: \ + break; \ + } + +#define PRINT_RATE(_sep, _r, _suf) \ + printf("%s%2.1f%s", _sep, (.5 * ((_r) & 0x7f)), _suf) +#define PRINT_RATES(p) \ + switch (p.rates_status) { \ + case TRUNCATED: \ + return 0; \ + case PRESENT: \ + do { \ + int z; \ + const char *sep = " ["; \ + for (z = 0; z < p.rates.length ; z++) { \ + PRINT_RATE(sep, p.rates.rate[z], \ + (p.rates.rate[z] & 0x80 ? "*" : "")); \ + sep = " "; \ + } \ + if (p.rates.length != 0) \ + printf(" Mbit]"); \ + } while (0); \ + break; \ + case NOT_PRESENT: \ + break; \ + } -#define RATEStoBUF(p,buf) { int z=0; for (z=0 ; z < p.rates.length ; z++) \ - sprintf(buf,"%s %2.1f",buf, (.5 * (p.rates.rate[z] & 0x7f))); } +#define PRINT_DS_CHANNEL(p) \ + switch (p.ds_status) { \ + case TRUNCATED: \ + return 0; \ + case PRESENT: \ + printf(" CH: %u", p.ds.channel); \ + break; \ + case NOT_PRESENT: \ + break; \ + } \ + printf("%s", \ + CAPABILITY_PRIVACY(p.capability_info) ? ", PRIVACY" : "" ); static const char *auth_alg_text[]={"Open System","Shared Key","EAP"}; -static const char *subtype_text[]={ - "Assoc Request", - "Assoc Response", - "ReAssoc Request", - "ReAssoc Response", - "Probe Request", - "Probe Response", - "RESERVED", - "RESERVED", - "Beacon", - "ATIM", - "Disassociation", - "Authentication", - "DeAuthentication", - "RESERVED", - "RESERVED" +#define NUM_AUTH_ALGS (sizeof auth_alg_text / sizeof auth_alg_text[0]) + +static const char *status_text[] = { + "Succesful", /* 0 */ + "Unspecified failure", /* 1 */ + "Reserved", /* 2 */ + "Reserved", /* 3 */ + "Reserved", /* 4 */ + "Reserved", /* 5 */ + "Reserved", /* 6 */ + "Reserved", /* 7 */ + "Reserved", /* 8 */ + "Reserved", /* 9 */ + "Cannot Support all requested capabilities in the Capability Information field", /* 10 */ + "Reassociation denied due to inability to confirm that association exists", /* 11 */ + "Association denied due to reason outside the scope of the standard", /* 12 */ + "Responding station does not support the specified authentication algorithm ", /* 13 */ + "Received an Authentication frame with authentication transaction " \ + "sequence number out of expected sequence", /* 14 */ + "Authentication rejected because of challenge failure", /* 15 */ + "Authentication rejected due to timeout waiting for next frame in sequence", /* 16 */ + "Association denied because AP is unable to handle additional associated stations", /* 17 */ + "Association denied due to requesting station not supporting all of the " \ + "data rates in BSSBasicRateSet parameter", /* 18 */ }; +#define NUM_STATUSES (sizeof status_text / sizeof status_text[0]) + +static const char *reason_text[] = { + "Reserved", /* 0 */ + "Unspecified reason", /* 1 */ + "Previous authentication no longer valid", /* 2 */ + "Deauthenticated because sending station is leaving (or has left) IBSS or ESS", /* 3 */ + "Disassociated due to inactivity", /* 4 */ + "Disassociated because AP is unable to handle all currently associated stations", /* 5 */ + "Class 2 frame received from nonauthenticated station", /* 6 */ + "Class 3 frame received from nonassociated station", /* 7 */ + "Disassociated because sending station is leaving (or has left) BSS", /* 8 */ + "Station requesting (re)association is not authenticated with responding station", /* 9 */ +}; +#define NUM_REASONS (sizeof reason_text / sizeof reason_text[0]) -static const char *status_text[]={"Succesful", /* 0 */ - "Unspecified failure", /* 1 */ - "Reserved", /* 2 */ - "Reserved", /* 3 */ - "Reserved", /* 4 */ - "Reserved", /* 5 */ - "Reserved", /* 6 */ - "Reserved", /* 7 */ - "Reserved", /* 8 */ - "Reserved", /* 9 */ - "Cannot Support all requested capabilities in the Capability Information field", /* 10 */ - "Reassociation denied due to inability to confirm that association exists", /* 11 */ - "Association denied due to reason outside the scope of the standard", /* 12 */ - "Responding station does not support the specified authentication algorithm ", /* 13 */ - "Received an Authentication frame with authentication transaction " \ - "sequence number out of expected sequence", /* 14 */ - "Authentication rejected because of challenge failure", /* 15 */ - "Authentication rejected due to timeout waiting for next frame in sequence", /* 16 */ - "Association denied because AP is unable to handle additional associated stations", /* 17 */ - "Association denied due to requesting station not supporting all of the " \ - "data rates in BSSBasicRateSet parameter", /* 18 */ - NULL }; - -static const char *reason_text[]= { "Reserved", /* 0 */ - "Unspecified reason", /* 1 */ - "Previous authentication no longer valid", /* 2 */ - "Deauthenticated because sending station is leaving (or has left) IBSS or ESS", /* 3 */ - "Disassociated due to inactivity", /* 4 */ - "Disassociated because AP is unable to handle all currently associated stations", /* 5 */ - "Class 2 frame receivedfrom nonauthenticated station", /* 6 */ - "Class 3 frame received from nonassociated station", /* 7 */ - "Disassociated because sending station is leaving (or has left) BSS", /* 8 */ - "Station requesting (re)association is not authenticated with responding station", /* 9 */ - NULL }; - -static void wep_print(const u_char *p,u_int length) +static int +wep_print(const u_char *p) { u_int32_t iv; + if (!TTEST2(*p, IEEE802_11_IV_LEN + IEEE802_11_KID_LEN)) + return 0; iv = EXTRACT_LE_32BITS(p); printf("Data IV:%3x Pad %x KeyID %x", IV_IV(iv), IV_PAD(iv), IV_KEYID(iv)); - return; + return 1; } - -static void parse_elements(struct mgmt_body_t *pbody,const u_char *p,int offset) -{ - while ( *(p+offset) != 0xff ) - { - switch (*(p+offset)) - { - case E_SSID: - memcpy(&(pbody->ssid),p+offset,2); offset += 2; - if (pbody->ssid.length > 0) - { - memcpy(&(pbody->ssid.ssid),p+offset,pbody->ssid.length); offset += pbody->ssid.length; - pbody->ssid.ssid[pbody->ssid.length]='\0'; - } - break; - case E_CHALLENGE: - memcpy(&(pbody->challenge),p+offset,2); offset += 2; - if (pbody->challenge.length > 0) - { - memcpy(&(pbody->challenge.text),p+offset,pbody->challenge.length); offset += pbody->challenge.length; - pbody->challenge.text[pbody->challenge.length]='\0'; - } - break; - - case E_RATES: - memcpy(&(pbody->rates),p+offset,2); offset += 2; - if (pbody->rates.length > 0) - memcpy(&(pbody->rates.rate),p+offset,pbody->rates.length); offset += pbody->rates.length; - break; - case E_DS: - memcpy(&(pbody->ds),p+offset,3); offset +=3; - break; - case E_CF: - memcpy(&(pbody->cf),p+offset,8); offset +=8; - break; - case E_TIM: - memcpy(&(pbody->tim),p+offset,2); offset +=2; - memcpy(&(pbody->tim.count),p+offset,3); offset +=3; - - if ((pbody->tim.length -3) > 0) - { - memcpy((pbody->tim.bitmap),p+(pbody->tim.length -3),(pbody->tim.length -3)); - offset += pbody->tim.length -3; - } - +static void +parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset) +{ + /* + * We haven't seen any elements yet. + */ + pbody->challenge_status = NOT_PRESENT; + pbody->ssid_status = NOT_PRESENT; + pbody->rates_status = NOT_PRESENT; + pbody->ds_status = NOT_PRESENT; + pbody->cf_status = NOT_PRESENT; + pbody->tim_status = NOT_PRESENT; + + for (;;) { + if (!TTEST2(*(p + offset), 1)) + return; + switch (*(p + offset)) { + case E_SSID: + /* Present, possibly truncated */ + pbody->ssid_status = TRUNCATED; + if (!TTEST2(*(p + offset), 2)) + return; + memcpy(&pbody->ssid, p + offset, 2); + offset += 2; + if (pbody->ssid.length != 0) { + if (pbody->ssid.length > + sizeof(pbody->ssid.ssid) - 1) + return; + if (!TTEST2(*(p + offset), pbody->ssid.length)) + return; + memcpy(&pbody->ssid.ssid, p + offset, + pbody->ssid.length); + offset += pbody->ssid.length; + } + pbody->ssid.ssid[pbody->ssid.length] = '\0'; + /* Present and not truncated */ + pbody->ssid_status = PRESENT; + break; + case E_CHALLENGE: + /* Present, possibly truncated */ + pbody->challenge_status = TRUNCATED; + if (!TTEST2(*(p + offset), 2)) + return; + memcpy(&pbody->challenge, p + offset, 2); + offset += 2; + if (pbody->challenge.length != 0) { + if (pbody->challenge.length > + sizeof(pbody->challenge.text) - 1) + return; + if (!TTEST2(*(p + offset), pbody->challenge.length)) + return; + memcpy(&pbody->challenge.text, p + offset, + pbody->challenge.length); + offset += pbody->challenge.length; + } + pbody->challenge.text[pbody->challenge.length] = '\0'; + /* Present and not truncated */ + pbody->challenge_status = PRESENT; + break; + case E_RATES: + /* Present, possibly truncated */ + pbody->rates_status = TRUNCATED; + if (!TTEST2(*(p + offset), 2)) + return; + memcpy(&(pbody->rates), p + offset, 2); + offset += 2; + if (pbody->rates.length != 0) { + if (pbody->rates.length > sizeof pbody->rates.rate) + return; + if (!TTEST2(*(p + offset), pbody->rates.length)) + return; + memcpy(&pbody->rates.rate, p + offset, + pbody->rates.length); + offset += pbody->rates.length; + } + /* Present and not truncated */ + pbody->rates_status = PRESENT; + break; + case E_DS: + /* Present, possibly truncated */ + pbody->ds_status = TRUNCATED; + if (!TTEST2(*(p + offset), 3)) + return; + memcpy(&pbody->ds, p + offset, 3); + offset += 3; + /* Present and not truncated */ + pbody->ds_status = PRESENT; + break; + case E_CF: + /* Present, possibly truncated */ + pbody->cf_status = TRUNCATED; + if (!TTEST2(*(p + offset), 8)) + return; + memcpy(&pbody->cf, p + offset, 8); + offset += 8; + /* Present and not truncated */ + pbody->cf_status = PRESENT; + break; + case E_TIM: + /* Present, possibly truncated */ + pbody->tim_status = TRUNCATED; + if (!TTEST2(*(p + offset), 2)) + return; + memcpy(&pbody->tim, p + offset, 2); + offset += 2; + if (!TTEST2(*(p + offset), 3)) + return; + memcpy(&pbody->tim.count, p + offset, 3); + offset += 3; + + if (pbody->tim.length <= 3) break; - default: + if (pbody->rates.length > sizeof pbody->tim.bitmap) + return; + if (!TTEST2(*(p + offset), pbody->tim.length - 3)) + return; + memcpy(pbody->tim.bitmap, p + (pbody->tim.length - 3), + (pbody->tim.length - 3)); + offset += pbody->tim.length - 3; + /* Present and not truncated */ + pbody->tim_status = PRESENT; + break; + default: #if 0 - printf("(1) unhandled element_id (%d) ", *(p+offset) ); + printf("(1) unhandled element_id (%d) ", + *(p + offset) ); #endif - offset+= *(p+offset+1) + 2; - break; + if (!TTEST2(*(p + offset), 2)) + return; + if (!TTEST2(*(p + offset + 2), *(p + offset + 1))) + return; + offset += *(p + offset + 1) + 2; + break; } } } @@ -176,255 +293,260 @@ static void parse_elements(struct mgmt_body_t *pbody,const u_char *p,int offset) * Print Handle functions for the management frame types *********************************************************************************/ -static void handle_beacon(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_beacon(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - char buf[128]; + int offset = 0; - memset(buf,0,128); - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); - memcpy(&pbody.timestamp,p,8); - offset += 8; + if (!TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + + IEEE802_11_CAPINFO_LEN)) + return 0; + memcpy(&pbody.timestamp, p, IEEE802_11_TSTAMP_LEN); + offset += IEEE802_11_TSTAMP_LEN; pbody.beacon_interval = EXTRACT_LE_16BITS(p+offset); - offset += 2; + offset += IEEE802_11_BCNINT_LEN; pbody.capability_info = EXTRACT_LE_16BITS(p+offset); - offset += 2; + offset += IEEE802_11_CAPINFO_LEN; - parse_elements(&pbody,p,offset); + parse_elements(&pbody, p, offset); - RATEStoBUF(pbody,buf); + PRINT_SSID(pbody); + PRINT_RATES(pbody); + printf(" %s", + CAPABILITY_ESS(pbody.capability_info) ? "ESS" : "IBSS"); + PRINT_DS_CHANNEL(pbody); - printf("%s (%s) [%s Mbit] %s CH: %x %s", - subtype_text[FC_SUBTYPE(fc)], - pbody.ssid.ssid,buf,CAPABILITY_ESS(pbody.capability_info) ? "ESS" : "IBSS" ,pbody.ds.channel, - CAPABILITY_PRIVACY(pbody.capability_info) ? ", PRIVACY" : "" ); - - return ; + return 1; } -static void handle_assoc_request(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_assoc_request(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - char buf[128]; + int offset = 0; - memset(buf,0,128); - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN)) + return 0; pbody.capability_info = EXTRACT_LE_16BITS(p); - offset += 2; + offset += IEEE802_11_CAPINFO_LEN; pbody.listen_interval = EXTRACT_LE_16BITS(p+offset); - offset += 2; - - parse_elements(&pbody,p,offset); + offset += IEEE802_11_LISTENINT_LEN; - RATEStoBUF(pbody,buf); + parse_elements(&pbody, p, offset); - printf("%s (%s) [%s Mbit] ", subtype_text[FC_SUBTYPE(fc)], pbody.ssid.ssid,buf); - return; + PRINT_SSID(pbody); + PRINT_RATES(pbody); + return 1; } -static void handle_assoc_response(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_assoc_response(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; + int offset = 0; - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_STATUS_LEN + + IEEE802_11_AID_LEN)) + return 0; pbody.capability_info = EXTRACT_LE_16BITS(p); - offset += 2; + offset += IEEE802_11_CAPINFO_LEN; pbody.status_code = EXTRACT_LE_16BITS(p+offset); - offset += 2; + offset += IEEE802_11_STATUS_LEN; pbody.aid = EXTRACT_LE_16BITS(p+offset); - offset += 2; + offset += IEEE802_11_AID_LEN; - parse_elements(&pbody,p,offset); + parse_elements(&pbody, p, offset); - printf("%s AID(%x) :%s: %s ",subtype_text[FC_SUBTYPE(fc)], - ((u_int16_t)( pbody.aid << 2 )) >> 2 , - CAPABILITY_PRIVACY(pbody.capability_info) ? " PRIVACY " : "" , - (pbody.status_code < 19 ? status_text[pbody.status_code] : "n/a") ); + printf(" AID(%x) :%s: %s", ((u_int16_t)(pbody.aid << 2 )) >> 2 , + CAPABILITY_PRIVACY(pbody.capability_info) ? " PRIVACY " : "", + (pbody.status_code < NUM_STATUSES + ? status_text[pbody.status_code] + : "n/a")); - return; + return 1; } - -static void handle_reassoc_request(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_reassoc_request(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; + int offset = 0; - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN + + IEEE802_11_AP_LEN)) + return 0; pbody.capability_info = EXTRACT_LE_16BITS(p); - offset += 2; + offset += IEEE802_11_CAPINFO_LEN; pbody.listen_interval = EXTRACT_LE_16BITS(p+offset); - offset += 2; - memcpy(&pbody.ap,p+offset,6); - offset += 6; + offset += IEEE802_11_LISTENINT_LEN; + memcpy(&pbody.ap, p+offset, IEEE802_11_AP_LEN); + offset += IEEE802_11_AP_LEN; + + parse_elements(&pbody, p, offset); - parse_elements(&pbody,p,offset); + PRINT_SSID(pbody); + printf(" AP : %s", etheraddr_string( pbody.ap )); - printf("%s (%s) AP : %s",subtype_text[FC_SUBTYPE(fc)], pbody.ssid.ssid, etheraddr_string( pbody.ap )); - - return; + return 1; } -static void handle_reassoc_response(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_reassoc_response(const u_char *p) { /* Same as a Association Reponse */ - return handle_assoc_response(fc,pmh,p); + return handle_assoc_response(p); } -static void handle_probe_request(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_probe_request(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - char buf[128]; + int offset = 0; - memset(buf,0,128); + memset(&pbody, 0, sizeof(pbody)); - memset(&pbody,0,sizeof(struct mgmt_body_t)); + parse_elements(&pbody, p, offset); - parse_elements(&pbody,p,offset); - - RATEStoBUF(pbody,buf); + PRINT_SSID(pbody); + PRINT_RATES(pbody); - printf("%s (%s) [%s Mbit] ",subtype_text[FC_SUBTYPE(fc)], pbody.ssid.ssid,buf); - - return; + return 1; } -static void handle_probe_response(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_probe_response(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - char buf[128]; + int offset = 0; - memset(buf,0,128); + memset(&pbody, 0, sizeof(pbody)); - memset(&pbody,0,sizeof(struct mgmt_body_t)); + if (!TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + + IEEE802_11_CAPINFO_LEN)) + return 0; - memcpy(&pbody.timestamp,p,8); - offset += 8; + memcpy(&pbody.timestamp, p, IEEE802_11_TSTAMP_LEN); + offset += IEEE802_11_TSTAMP_LEN; pbody.beacon_interval = EXTRACT_LE_16BITS(p+offset); - offset += 2; + offset += IEEE802_11_BCNINT_LEN; pbody.capability_info = EXTRACT_LE_16BITS(p+offset); - offset += 2; - - parse_elements(&pbody,p,offset); + offset += IEEE802_11_CAPINFO_LEN; - printf("%s (%s) CH: %x %s",subtype_text[FC_SUBTYPE(fc)], pbody.ssid.ssid,pbody.ds.channel, - CAPABILITY_PRIVACY(pbody.capability_info) ? ",PRIVACY " : "" ); + parse_elements(&pbody, p, offset); - return; + PRINT_SSID(pbody); + PRINT_RATES(pbody); + PRINT_DS_CHANNEL(pbody); + + return 1; } -static void handle_atim(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_atim(void) { /* the frame body for ATIM is null. */ - printf("ATIM"); - return; + return 1; } -static void handle_disassoc(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_disassoc(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, IEEE802_11_REASON_LEN)) + return 0; pbody.reason_code = EXTRACT_LE_16BITS(p); - offset += 2; - printf("%s: %s ", subtype_text[FC_SUBTYPE(fc)], - pbody.reason_code < 10 ? reason_text[pbody.reason_code] : "Reserved" ); + printf(": %s", + (pbody.reason_code < NUM_REASONS) + ? reason_text[pbody.reason_code] + : "Reserved" ); - return; + return 1; } -static void handle_auth(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_auth(const u_char *p) { struct mgmt_body_t pbody; - int offset=0; - - memset(&pbody,0,sizeof(struct mgmt_body_t)); + int offset = 0; + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, 6)) + return 0; pbody.auth_alg = EXTRACT_LE_16BITS(p); offset += 2; - pbody.auth_trans_seq_num = EXTRACT_LE_16BITS(p+offset); + pbody.auth_trans_seq_num = EXTRACT_LE_16BITS(p + offset); offset += 2; - pbody.status_code = EXTRACT_LE_16BITS(p+offset); + pbody.status_code = EXTRACT_LE_16BITS(p + offset); offset += 2; - parse_elements(&pbody,p,offset); - - - if (( pbody.auth_alg == 1) && - ( ( pbody.auth_trans_seq_num == 2) || (pbody.auth_trans_seq_num == 3) )) - { - printf("%s (%s)-%x [Challenge Text] %s", - subtype_text[FC_SUBTYPE(fc)], - pbody.auth_alg < 4 ? auth_alg_text[pbody.auth_alg] : "Reserved" , - pbody.auth_trans_seq_num, - ((pbody.auth_trans_seq_num % 2) ? - (pbody.status_code < 19 ? status_text[pbody.status_code] : "n/a") : "" ) - ); + parse_elements(&pbody, p, offset); + + if ((pbody.auth_alg == 1) && + ((pbody.auth_trans_seq_num == 2) || + (pbody.auth_trans_seq_num == 3))) { + printf(" (%s)-%x [Challenge Text] %s", + (pbody.auth_alg < NUM_AUTH_ALGS) + ? auth_alg_text[pbody.auth_alg] + : "Reserved", + pbody.auth_trans_seq_num, + ((pbody.auth_trans_seq_num % 2) + ? ((pbody.status_code < NUM_STATUSES) + ? status_text[pbody.status_code] + : "n/a") : "")); + return 1; } - else - { - printf("%s (%s)-%x: %s", - subtype_text[FC_SUBTYPE(fc)], - pbody.auth_alg < 4 ? auth_alg_text[pbody.auth_alg] : "Reserved" , - pbody.auth_trans_seq_num, - ( (pbody.auth_trans_seq_num % 2) ? - (pbody.status_code < 19 ? status_text[pbody.status_code] : "n/a") : "") - ); - } - - - return; + printf(" (%s)-%x: %s", + (pbody.auth_alg < NUM_AUTH_ALGS) + ? auth_alg_text[pbody.auth_alg] + : "Reserved", + pbody.auth_trans_seq_num, + (pbody.auth_trans_seq_num % 2) + ? ((pbody.status_code < NUM_STATUSES) + ? status_text[pbody.status_code] + : "n/a") + : ""); + + return 1; } -static void handle_deauth(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p) +static int +handle_deauth(const struct mgmt_header_t *pmh, const u_char *p) { struct mgmt_body_t pbody; - int offset=0; + int offset = 0; + const char *reason = NULL; - memset(&pbody,0,sizeof(struct mgmt_body_t)); + memset(&pbody, 0, sizeof(pbody)); + if (!TTEST2(*p, IEEE802_11_REASON_LEN)) + return 0; pbody.reason_code = EXTRACT_LE_16BITS(p); - offset += 2; - - if (eflag) - { - printf("%s: %s", - subtype_text[FC_SUBTYPE(fc)], - pbody.reason_code < 10 ? reason_text[pbody.reason_code] : "Reserved" ); - } - else - { - printf("%s (%s): %s", - subtype_text[FC_SUBTYPE(fc)], - etheraddr_string(pmh->sa), - pbody.reason_code < 10 ? reason_text[pbody.reason_code] : "Reserved" ); + offset += IEEE802_11_REASON_LEN; + + reason = (pbody.reason_code < NUM_REASONS) + ? reason_text[pbody.reason_code] + : "Reserved"; + + if (eflag) { + printf(": %s", reason); + } else { + printf(" (%s): %s", etheraddr_string(pmh->sa), reason); } - - return; + return 1; } @@ -433,53 +555,55 @@ static void handle_deauth(u_int16_t fc, const struct mgmt_header_t *pmh, *********************************************************************************/ -static void mgmt_body_print(u_int16_t fc, const struct mgmt_header_t *pmh, - const u_char *p, u_int length) +static int +mgmt_body_print(u_int16_t fc, const struct mgmt_header_t *pmh, + const u_char *p) { - switch (FC_SUBTYPE(fc)) - { - case ST_ASSOC_REQUEST: - handle_assoc_request(fc,pmh,p); - break; - case ST_ASSOC_RESPONSE: - handle_assoc_response(fc,pmh,p); - break; - case ST_REASSOC_REQUEST: - handle_reassoc_request(fc,pmh,p); - break; - case ST_REASSOC_RESPONSE: - handle_reassoc_response(fc,pmh,p); - break; - case ST_PROBE_REQUEST: - handle_probe_request(fc,pmh,p); - break; - case ST_PROBE_RESPONSE: - handle_probe_response(fc,pmh,p); - break; - case ST_BEACON: - handle_beacon(fc,pmh,p); - break; - case ST_ATIM: - handle_atim(fc,pmh,p); - break; - case ST_DISASSOC: - handle_disassoc(fc,pmh,p); - break; - case ST_AUTH: - if ((p[0] == 0 ) && (p[1] == 0) && (p[2] == 0)) - { - printf("Authentication (Shared-Key)-3 "); - wep_print(p,length); - } - else - handle_auth(fc,pmh,p); - break; - case ST_DEAUTH: - handle_deauth(fc,pmh,p); - break; - default: - printf("Unhandled Managment subtype(%x)", - FC_SUBTYPE(fc)); + switch (FC_SUBTYPE(fc)) { + case ST_ASSOC_REQUEST: + printf("Assoc Request"); + return handle_assoc_request(p); + case ST_ASSOC_RESPONSE: + printf("Assoc Response"); + return handle_assoc_response(p); + case ST_REASSOC_REQUEST: + printf("ReAssoc Request"); + return handle_reassoc_request(p); + case ST_REASSOC_RESPONSE: + printf("ReAssoc Response"); + return handle_reassoc_response(p); + case ST_PROBE_REQUEST: + printf("Probe Request"); + return handle_probe_request(p); + case ST_PROBE_RESPONSE: + printf("Probe Response"); + return handle_probe_response(p); + case ST_BEACON: + printf("Beacon"); + return handle_beacon(p); + case ST_ATIM: + printf("ATIM"); + return handle_atim(); + case ST_DISASSOC: + printf("Disassociation"); + return handle_disassoc(p); + case ST_AUTH: + printf("Authentication"); + if (!TTEST2(*p, 3)) + return 0; + if ((p[0] == 0 ) && (p[1] == 0) && (p[2] == 0)) { + printf("Authentication (Shared-Key)-3 "); + return wep_print(p); + } + return handle_auth(p); + case ST_DEAUTH: + printf("DeAuthentication"); + return handle_deauth(pmh, p); + break; + default: + printf("Unhandled Management subtype(%x)", + FC_SUBTYPE(fc)); + return 1; } } @@ -488,55 +612,68 @@ static void mgmt_body_print(u_int16_t fc, const struct mgmt_header_t *pmh, * Handles printing all the control frame types *********************************************************************************/ -static void ctrl_body_print(u_int16_t fc,const u_char *p, u_int length) +static int +ctrl_body_print(u_int16_t fc, const u_char *p) { - switch (FC_SUBTYPE(fc)) - { - case CTRL_PS_POLL: - printf("Power Save-Poll AID(%x)",((u_int16_t)( ((struct ctrl_ps_poll_t *)p)->aid << 2 )) >> 2 ); - break; - case CTRL_RTS: - if (eflag) - printf("Request-To-Send"); - else - printf("Request-To-Send TA:%s ", etheraddr_string( ((struct ctrl_rts_t *)p)->ta)); - break; - case CTRL_CTS: - if (eflag) - printf("Clear-To-Send"); - else - printf("Clear-To-Send RA:%s ", etheraddr_string( ((struct ctrl_cts_t *)p)->ra)); - break; - case CTRL_ACK: - if (eflag) - printf("Acknowledgment"); - else - printf("Acknowledgment RA:%s ", etheraddr_string( ((struct ctrl_ack_t *)p)->ra)); - break; - case CTRL_CF_END: - if (eflag) - printf("CF-End"); - else - printf("CF-End RA:%s ", etheraddr_string( ((struct ctrl_end_t *)p)->ra)); - break; - case CTRL_END_ACK: - if (eflag) - printf("CF-End+CF-Ack"); - else - printf("CF-End+CF-Ack RA:%s ", etheraddr_string( ((struct ctrl_end_ack_t *)p)->ra)); - break; - default: - printf("(B) Unknown Ctrl Subtype"); + switch (FC_SUBTYPE(fc)) { + case CTRL_PS_POLL: + printf("Power Save-Poll"); + if (!TTEST2(*p, CTRL_PS_POLL_HDRLEN)) + return 0; + printf(" AID(%x)", + EXTRACT_LE_16BITS(&(((const struct ctrl_ps_poll_t *)p)->aid))); + break; + case CTRL_RTS: + printf("Request-To-Send"); + if (!TTEST2(*p, CTRL_RTS_HDRLEN)) + return 0; + if (!eflag) + printf(" TA:%s ", + etheraddr_string(((const struct ctrl_rts_t *)p)->ta)); + break; + case CTRL_CTS: + printf("Clear-To-Send"); + if (!TTEST2(*p, CTRL_CTS_HDRLEN)) + return 0; + if (!eflag) + printf(" RA:%s ", + etheraddr_string(((const struct ctrl_cts_t *)p)->ra)); + break; + case CTRL_ACK: + printf("Acknowledgment"); + if (!TTEST2(*p, CTRL_ACK_HDRLEN)) + return 0; + if (!eflag) + printf(" RA:%s ", + etheraddr_string(((const struct ctrl_ack_t *)p)->ra)); + break; + case CTRL_CF_END: + printf("CF-End"); + if (!TTEST2(*p, CTRL_END_HDRLEN)) + return 0; + if (!eflag) + printf(" RA:%s ", + etheraddr_string(((const struct ctrl_end_t *)p)->ra)); + break; + case CTRL_END_ACK: + printf("CF-End+CF-Ack"); + if (!TTEST2(*p, CTRL_END_ACK_HDRLEN)) + return 0; + if (!eflag) + printf(" RA:%s ", + etheraddr_string(((const struct ctrl_end_ack_t *)p)->ra)); + break; + default: + printf("Unknown Ctrl Subtype"); } + return 1; } - - -/********************************************************************************* +/* * Print Header funcs - *********************************************************************************/ + */ -/********************************************************************************* +/* * Data Frame - Address field contents * * To Ds | From DS | Addr 1 | Addr 2 | Addr 3 | Addr 4 @@ -544,238 +681,585 @@ static void ctrl_body_print(u_int16_t fc,const u_char *p, u_int length) * 0 | 1 | DA | BSSID | SA | n/a * 1 | 0 | BSSID | SA | DA | n/a * 1 | 1 | RA | TA | DA | SA - *********************************************************************************/ - -#define ADDR1 p+4 -#define ADDR2 p+10 -#define ADDR3 p+16 -#define ADDR4 p+24 + */ -static void data_header_print(u_int16_t fc,const u_char *p, u_int length) +static void +data_header_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, + const u_int8_t **dstp) { - if (!FC_TO_DS(fc)) - { - if (!FC_FROM_DS(fc)) - printf("DA:%s SA:%s BSSID:%s ", etheraddr_string( ADDR1), - etheraddr_string( ADDR2), etheraddr_string( ADDR3)); - else - printf("DA:%s BSSID:%s SA:%s ", etheraddr_string( ADDR1), - etheraddr_string( ADDR2), etheraddr_string( ADDR3)); + switch (FC_SUBTYPE(fc)) { + case DATA_DATA: + case DATA_NODATA: + break; + case DATA_DATA_CF_ACK: + case DATA_NODATA_CF_ACK: + printf("CF Ack "); + break; + case DATA_DATA_CF_POLL: + case DATA_NODATA_CF_POLL: + printf("CF Poll "); + break; + case DATA_DATA_CF_ACK_POLL: + case DATA_NODATA_CF_ACK_POLL: + printf("CF Ack/Poll "); + break; } - else - { - if (!FC_FROM_DS(fc)) - printf("BSSID:%s SA:%s DA:%s ", etheraddr_string( ADDR1), - etheraddr_string( ADDR2), etheraddr_string( ADDR3)); - else - printf("RA:%s TA:%s DA:%s SA:%s ", etheraddr_string( ADDR1), - etheraddr_string( ADDR2), etheraddr_string( ADDR3), - etheraddr_string( ADDR4)); + +#define ADDR1 (p + 4) +#define ADDR2 (p + 10) +#define ADDR3 (p + 16) +#define ADDR4 (p + 24) + + if (!FC_TO_DS(fc) && !FC_FROM_DS(fc)) { + if (srcp != NULL) + *srcp = ADDR2; + if (dstp != NULL) + *dstp = ADDR1; + if (!eflag) + return; + printf("DA:%s SA:%s BSSID:%s ", + etheraddr_string(ADDR1), etheraddr_string(ADDR2), + etheraddr_string(ADDR3)); + } else if (!FC_TO_DS(fc) && FC_FROM_DS(fc)) { + if (srcp != NULL) + *srcp = ADDR3; + if (dstp != NULL) + *dstp = ADDR1; + if (!eflag) + return; + printf("DA:%s BSSID:%s SA:%s ", + etheraddr_string(ADDR1), etheraddr_string(ADDR2), + etheraddr_string(ADDR3)); + } else if (FC_TO_DS(fc) && !FC_FROM_DS(fc)) { + if (srcp != NULL) + *srcp = ADDR2; + if (dstp != NULL) + *dstp = ADDR3; + if (!eflag) + return; + printf("BSSID:%s SA:%s DA:%s ", + etheraddr_string(ADDR1), etheraddr_string(ADDR2), + etheraddr_string(ADDR3)); + } else if (FC_TO_DS(fc) && FC_FROM_DS(fc)) { + if (srcp != NULL) + *srcp = ADDR4; + if (dstp != NULL) + *dstp = ADDR3; + if (!eflag) + return; + printf("RA:%s TA:%s DA:%s SA:%s ", + etheraddr_string(ADDR1), etheraddr_string(ADDR2), + etheraddr_string(ADDR3), etheraddr_string(ADDR4)); } - -} +#undef ADDR1 +#undef ADDR2 +#undef ADDR3 +#undef ADDR4 +} -static void mgmt_header_print(const u_char *p, u_int length) +static void +mgmt_header_print(const u_char *p, const u_int8_t **srcp, + const u_int8_t **dstp) { - const struct mgmt_header_t *hp=(const struct mgmt_header_t *) p; + const struct mgmt_header_t *hp = (const struct mgmt_header_t *) p; + + if (srcp != NULL) + *srcp = hp->sa; + if (dstp != NULL) + *dstp = hp->da; + if (!eflag) + return; + + printf("BSSID:%s DA:%s SA:%s ", + etheraddr_string((hp)->bssid), etheraddr_string((hp)->da), + etheraddr_string((hp)->sa)); +} - printf("BSSID:%s DA:%s SA:%s ", etheraddr_string( (hp)->bssid), - etheraddr_string( (hp)->da), - etheraddr_string( (hp)->sa)); +static void +ctrl_header_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, + const u_int8_t **dstp) +{ + if (srcp != NULL) + *srcp = NULL; + if (dstp != NULL) + *dstp = NULL; + if (!eflag) + return; + + switch (FC_SUBTYPE(fc)) { + case CTRL_PS_POLL: + printf("BSSID:%s TA:%s ", + etheraddr_string(((const struct ctrl_ps_poll_t *)p)->bssid), + etheraddr_string(((const struct ctrl_ps_poll_t *)p)->ta)); + break; + case CTRL_RTS: + printf("RA:%s TA:%s ", + etheraddr_string(((const struct ctrl_rts_t *)p)->ra), + etheraddr_string(((const struct ctrl_rts_t *)p)->ta)); + break; + case CTRL_CTS: + printf("RA:%s ", + etheraddr_string(((const struct ctrl_cts_t *)p)->ra)); + break; + case CTRL_ACK: + printf("RA:%s ", + etheraddr_string(((const struct ctrl_ack_t *)p)->ra)); + break; + case CTRL_CF_END: + printf("RA:%s BSSID:%s ", + etheraddr_string(((const struct ctrl_end_t *)p)->ra), + etheraddr_string(((const struct ctrl_end_t *)p)->bssid)); + break; + case CTRL_END_ACK: + printf("RA:%s BSSID:%s ", + etheraddr_string(((const struct ctrl_end_ack_t *)p)->ra), + etheraddr_string(((const struct ctrl_end_ack_t *)p)->bssid)); + break; + default: + printf("(H) Unknown Ctrl Subtype"); + break; + } } -static void ctrl_header_print(u_int16_t fc,const u_char *p, u_int length) +static int +extract_header_length(u_int16_t fc) { - switch (FC_SUBTYPE(fc)) - { + switch (FC_TYPE(fc)) { + case T_MGMT: + return MGMT_HDRLEN; + case T_CTRL: + switch (FC_SUBTYPE(fc)) { case CTRL_PS_POLL: - printf("BSSID:%s TA:%s ", etheraddr_string( ((struct ctrl_ps_poll_t *)p)->bssid), - etheraddr_string( ((struct ctrl_ps_poll_t *)p)->ta)); - break; + return CTRL_PS_POLL_HDRLEN; case CTRL_RTS: - printf("RA:%s TA:%s ", etheraddr_string( ((struct ctrl_rts_t *)p)->ra), - etheraddr_string( ((struct ctrl_rts_t *)p)->ta)); - break; + return CTRL_RTS_HDRLEN; case CTRL_CTS: - printf("RA:%s ", etheraddr_string( ((struct ctrl_cts_t *)p)->ra)); - break; + return CTRL_CTS_HDRLEN; case CTRL_ACK: - printf("RA:%s ", etheraddr_string( ((struct ctrl_ack_t *)p)->ra)); - break; + return CTRL_ACK_HDRLEN; case CTRL_CF_END: - printf("RA:%s BSSID:%s ", etheraddr_string( ((struct ctrl_end_t *)p)->ra), - etheraddr_string( ((struct ctrl_end_t *)p)->bssid)); - break; + return CTRL_END_HDRLEN; case CTRL_END_ACK: - printf("RA:%s BSSID:%s ", etheraddr_string( ((struct ctrl_end_ack_t *)p)->ra), - etheraddr_string( ((struct ctrl_end_ack_t *)p)->bssid)); - break; - default: - printf("(H) Unknown Ctrl Subtype"); - } -} - -static int GetHeaderLength(u_int16_t fc) -{ - int iLength=0; - - switch (FC_TYPE(fc)) - { - case T_MGMT: - iLength=sizeof(struct mgmt_header_t); - break; - case T_CTRL: - switch (FC_SUBTYPE(fc)) - { - case CTRL_PS_POLL: - iLength=sizeof(struct ctrl_ps_poll_t); - break; - case CTRL_RTS: - iLength=sizeof(struct ctrl_rts_t); - break; - case CTRL_CTS: - iLength=sizeof(struct ctrl_cts_t); - break; - case CTRL_ACK: - iLength=sizeof(struct ctrl_ack_t); - break; - case CTRL_CF_END: - iLength=sizeof(struct ctrl_end_t); - break; - case CTRL_END_ACK: - iLength=sizeof(struct ctrl_end_ack_t); - break; - default: - iLength=0; - break; - } - break; - case T_DATA: - if (FC_TO_DS(fc) && FC_FROM_DS(fc)) - iLength=30; - else - iLength=24; - break; + return CTRL_END_ACK_HDRLEN; default: - printf("unknown IEEE802.11 frame type (%d)", - FC_TYPE(fc)); - break; + return 0; + } + case T_DATA: + return (FC_TO_DS(fc) && FC_FROM_DS(fc)) ? 30 : 24; + default: + printf("unknown IEEE802.11 frame type (%d)", FC_TYPE(fc)); + return 0; } - - return iLength; } /* - * Print the 802.11 MAC header + * Print the 802.11 MAC header if eflag is set, and set "*srcp" and "*dstp" + * to point to the source and destination MAC addresses in any case if + * "srcp" and "dstp" aren't null. */ static inline void -ieee_802_11_print(u_int16_t fc, const u_char *p, u_int length) +ieee_802_11_hdr_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, + const u_int8_t **dstp) { - switch (FC_TYPE(fc)) { + if (vflag) { + if (FC_MORE_DATA(fc)) + printf("More Data "); + if (FC_MORE_FLAG(fc)) + printf("More Fragments "); + if (FC_POWER_MGMT(fc)) + printf("Pwr Mgmt "); + if (FC_RETRY(fc)) + printf("Retry "); + if (FC_ORDER(fc)) + printf("Strictly Ordered "); + if (FC_WEP(fc)) + printf("WEP Encrypted "); + if (FC_TYPE(fc) != T_CTRL || FC_SUBTYPE(fc) != CTRL_PS_POLL) + printf("%dus ", + EXTRACT_LE_16BITS( + &((const struct mgmt_header_t *)p)->duration)); + } + switch (FC_TYPE(fc)) { case T_MGMT: - mgmt_header_print(p,length); + mgmt_header_print(p, srcp, dstp); break; - case T_CTRL: - ctrl_header_print(fc,p,length); + ctrl_header_print(fc, p, srcp, dstp); break; - case T_DATA: - data_header_print(fc,p,length); + data_header_print(fc, p, srcp, dstp); break; - default: printf("(header) unknown IEEE802.11 frame type (%d)", FC_TYPE(fc)); + *srcp = NULL; + *dstp = NULL; break; } } -/* - * This is the top level routine of the printer. 'p' is the points - * to the ether header of the packet, 'h->tv' is the timestamp, - * 'h->length' is the length of the packet off the wire, and 'h->caplen' - * is the number of bytes actually captured. - */ -void -ieee802_11_if_print(u_char *user, const struct pcap_pkthdr *h, const u_char *p) +static u_int +ieee802_11_print(const u_char *p, u_int length, u_int caplen) { - u_int caplen = h->caplen; - u_int length = h->len; u_int16_t fc; - u_int HEADER_LENGTH; + u_int hdrlen; + const u_int8_t *src, *dst; u_short extracted_ethertype; - ts_print(&h->ts); - if (caplen < IEEE802_11_FC_LEN) { printf("[|802.11]"); - goto out; + return caplen; } - fc=EXTRACT_LE_16BITS(p); + fc = EXTRACT_LE_16BITS(p); + hdrlen = extract_header_length(fc); + + if (caplen < hdrlen) { + printf("[|802.11]"); + return hdrlen; + } - if (eflag) - ieee_802_11_print(fc,p,length); + ieee_802_11_hdr_print(fc, p, &src, &dst); /* - * Some printers want to get back at the ethernet addresses, - * and/or check that they're not walking off the end of the packet. - * Rather than pass them all the way down, we set these globals. + * Go past the 802.11 header. */ - packetp = p; - snapend = p + caplen; - - HEADER_LENGTH=GetHeaderLength(fc); - - length -= HEADER_LENGTH; - caplen -= HEADER_LENGTH; - p += HEADER_LENGTH; + length -= hdrlen; + caplen -= hdrlen; + p += hdrlen; switch (FC_TYPE(fc)) { - case T_MGMT: - mgmt_body_print(fc,(const struct mgmt_header_t *)packetp,p,length); + if (!mgmt_body_print(fc, + (const struct mgmt_header_t *)(p - hdrlen), p)) { + printf("[|802.11]"); + return hdrlen; + } break; - case T_CTRL: - ctrl_body_print(fc,p,length); + if (!ctrl_body_print(fc, p - hdrlen)) { + printf("[|802.11]"); + return hdrlen; + } break; - case T_DATA: /* There may be a problem w/ AP not having this bit set */ - if (FC_WEP(fc)) - wep_print(p,length); - else { - if (llc_print(p, length, caplen, packetp+10, - packetp+4, &extracted_ethertype) == 0) { - /* - * Some kinds of LLC packet we cannot - * handle intelligently - */ - if (!eflag) - ieee_802_11_print(fc, p - HEADER_LENGTH, - length + HEADER_LENGTH); - if (extracted_ethertype) { - printf("(LLC %s) ", - etherproto_string(htons(extracted_ethertype))); - } - if (!xflag && !qflag) - default_print(p, caplen); + if (FC_WEP(fc)) { + if (!wep_print(p)) { + printf("[|802.11]"); + return hdrlen; } + } else if (llc_print(p, length, caplen, dst, src, + &extracted_ethertype) == 0) { + /* + * Some kinds of LLC packet we cannot + * handle intelligently + */ + if (!eflag) + ieee_802_11_hdr_print(fc, p - hdrlen, NULL, + NULL); + if (extracted_ethertype) + printf("(LLC %s) ", + etherproto_string( + htons(extracted_ethertype))); + if (!suppress_default_print) + default_print(p, caplen); } break; + default: + printf("unknown 802.11 frame type (%d)", FC_TYPE(fc)); + break; + } + + return hdrlen; +} +/* + * This is the top level routine of the printer. 'p' points + * to the 802.11 header of the packet, 'h->ts' is the timestamp, + * 'h->len' is the length of the packet off the wire, and 'h->caplen' + * is the number of bytes actually captured. + */ +u_int +ieee802_11_if_print(const struct pcap_pkthdr *h, const u_char *p) +{ + return ieee802_11_print(p, h->len, h->caplen); +} + +static int +print_radiotap_field(struct cpack_state *s, u_int32_t bit) +{ + union { + int8_t i8; + u_int8_t u8; + int16_t i16; + u_int16_t u16; + u_int32_t u32; + u_int64_t u64; + } u, u2; + int rc; + + switch (bit) { + case IEEE80211_RADIOTAP_FLAGS: + case IEEE80211_RADIOTAP_RATE: + case IEEE80211_RADIOTAP_DB_ANTSIGNAL: + case IEEE80211_RADIOTAP_DB_ANTNOISE: + case IEEE80211_RADIOTAP_ANTENNA: + rc = cpack_uint8(s, &u.u8); + break; + case IEEE80211_RADIOTAP_DBM_ANTSIGNAL: + case IEEE80211_RADIOTAP_DBM_ANTNOISE: + rc = cpack_int8(s, &u.i8); + break; + case IEEE80211_RADIOTAP_CHANNEL: + rc = cpack_uint16(s, &u.u16); + if (rc != 0) + break; + rc = cpack_uint16(s, &u2.u16); + break; + case IEEE80211_RADIOTAP_FHSS: + case IEEE80211_RADIOTAP_LOCK_QUALITY: + case IEEE80211_RADIOTAP_TX_ATTENUATION: + rc = cpack_uint16(s, &u.u16); + break; + case IEEE80211_RADIOTAP_DB_TX_ATTENUATION: + rc = cpack_uint8(s, &u.u8); + break; + case IEEE80211_RADIOTAP_DBM_TX_POWER: + rc = cpack_int8(s, &u.i8); + break; + case IEEE80211_RADIOTAP_TSFT: + rc = cpack_uint64(s, &u.u64); + break; default: - printf("(body) unhandled IEEE802.11 frame type (%d)", - FC_TYPE(fc)); + /* this bit indicates a field whose + * size we do not know, so we cannot + * proceed. + */ + printf("[0x%08x] ", bit); + return -1; + } + + if (rc != 0) { + printf("[|802.11]"); + return rc; + } + + switch (bit) { + case IEEE80211_RADIOTAP_CHANNEL: + printf("%u MHz ", u.u16); + if (u2.u16 != 0) + printf("(0x%04x) ", u2.u16); + break; + case IEEE80211_RADIOTAP_FHSS: + printf("fhset %d fhpat %d ", u.u16 & 0xff, (u.u16 >> 8) & 0xff); + break; + case IEEE80211_RADIOTAP_RATE: + PRINT_RATE("", u.u8, " Mb/s "); + break; + case IEEE80211_RADIOTAP_DBM_ANTSIGNAL: + printf("%ddB signal ", u.i8); + break; + case IEEE80211_RADIOTAP_DBM_ANTNOISE: + printf("%ddB noise ", u.i8); break; + case IEEE80211_RADIOTAP_DB_ANTSIGNAL: + printf("%ddB signal ", u.u8); + break; + case IEEE80211_RADIOTAP_DB_ANTNOISE: + printf("%ddB noise ", u.u8); + break; + case IEEE80211_RADIOTAP_LOCK_QUALITY: + printf("%u sq ", u.u16); + break; + case IEEE80211_RADIOTAP_TX_ATTENUATION: + printf("%d tx power ", -(int)u.u16); + break; + case IEEE80211_RADIOTAP_DB_TX_ATTENUATION: + printf("%ddB tx power ", -(int)u.u8); + break; + case IEEE80211_RADIOTAP_DBM_TX_POWER: + printf("%ddBm tx power ", u.i8); + break; + case IEEE80211_RADIOTAP_FLAGS: + if (u.u8 & IEEE80211_RADIOTAP_F_CFP) + printf("cfp "); + if (u.u8 & IEEE80211_RADIOTAP_F_SHORTPRE) + printf("short preamble "); + if (u.u8 & IEEE80211_RADIOTAP_F_WEP) + printf("wep "); + if (u.u8 & IEEE80211_RADIOTAP_F_FRAG) + printf("fragmented "); + break; + case IEEE80211_RADIOTAP_ANTENNA: + printf("antenna %d ", u.u8); + break; + case IEEE80211_RADIOTAP_TSFT: + printf("%" PRIu64 "us tsft ", u.u64); + break; + } + return 0; +} + +static u_int +ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) +{ +#define BITNO_32(x) (((x) >> 16) ? 16 + BITNO_16((x) >> 16) : BITNO_16((x))) +#define BITNO_16(x) (((x) >> 8) ? 8 + BITNO_8((x) >> 8) : BITNO_8((x))) +#define BITNO_8(x) (((x) >> 4) ? 4 + BITNO_4((x) >> 4) : BITNO_4((x))) +#define BITNO_4(x) (((x) >> 2) ? 2 + BITNO_2((x) >> 2) : BITNO_2((x))) +#define BITNO_2(x) (((x) & 2) ? 1 : 0) +#define BIT(n) (1 << n) +#define IS_EXTENDED(__p) \ + (EXTRACT_LE_32BITS(__p) & BIT(IEEE80211_RADIOTAP_EXT)) != 0 + + struct cpack_state cpacker; + struct ieee80211_radiotap_header *hdr; + u_int32_t present, next_present; + u_int32_t *presentp, *last_presentp; + enum ieee80211_radiotap_type bit; + int bit0; + const u_char *iter; + u_int len; + + if (caplen < sizeof(*hdr)) { + printf("[|802.11]"); + return caplen; + } + + hdr = (struct ieee80211_radiotap_header *)p; + + len = EXTRACT_LE_16BITS(&hdr->it_len); + + if (caplen < len) { + printf("[|802.11]"); + return caplen; + } + for (last_presentp = &hdr->it_present; + IS_EXTENDED(last_presentp) && + (u_char*)(last_presentp + 1) <= p + len; + last_presentp++); + + /* are there more bitmap extensions than bytes in header? */ + if (IS_EXTENDED(last_presentp)) { + printf("[|802.11]"); + return caplen; + } + + iter = (u_char*)(last_presentp + 1); + + if (cpack_init(&cpacker, (u_int8_t*)iter, len - (iter - p)) != 0) { + /* XXX */ + printf("[|802.11]"); + return caplen; + } + + for (bit0 = 0, presentp = &hdr->it_present; presentp <= last_presentp; + presentp++, bit0 += 32) { + for (present = EXTRACT_LE_32BITS(presentp); present; + present = next_present) { + /* clear the least significant bit that is set */ + next_present = present & (present - 1); + + /* extract the least significant bit that is set */ + bit = (enum ieee80211_radiotap_type) + (bit0 + BITNO_32(present ^ next_present)); + + if (print_radiotap_field(&cpacker, bit) != 0) + goto out; + } + } +out: + return len + ieee802_11_print(p + len, length - len, caplen - len); +#undef BITNO_32 +#undef BITNO_16 +#undef BITNO_8 +#undef BITNO_4 +#undef BITNO_2 +#undef BIT +} + +static u_int +ieee802_11_avs_radio_print(const u_char *p, u_int length, u_int caplen) +{ + u_int32_t caphdr_len; + + caphdr_len = EXTRACT_32BITS(p + 4); + if (caphdr_len < 8) { + /* + * Yow! The capture header length is claimed not + * to be large enough to include even the version + * cookie or capture header length! + */ + printf("[|802.11]"); + return caplen; + } + + if (caplen < caphdr_len) { + printf("[|802.11]"); + return caplen; + } + + return caphdr_len + ieee802_11_print(p + caphdr_len, + length - caphdr_len, caplen - caphdr_len); +} + +#define PRISM_HDR_LEN 144 + +#define WLANCAP_MAGIC_COOKIE_V1 0x80211001 + +/* + * For DLT_PRISM_HEADER; like DLT_IEEE802_11, but with an extra header, + * containing information such as radio information, which we + * currently ignore. + * + * If, however, the packet begins with WLANCAP_MAGIC_COOKIE_V1, it's + * really DLT_IEEE802_11_RADIO (currently, on Linux, there's no + * ARPHRD_ type for DLT_IEEE802_11_RADIO, as there is a + * ARPHRD_IEEE80211_PRISM for DLT_PRISM_HEADER, so + * ARPHRD_IEEE80211_PRISM is used for DLT_IEEE802_11_RADIO, and + * the first 4 bytes of the header are used to indicate which it is). + */ +u_int +prism_if_print(const struct pcap_pkthdr *h, const u_char *p) +{ + u_int caplen = h->caplen; + u_int length = h->len; + + if (caplen < 4) { + printf("[|802.11]"); + return caplen; + } + + if (EXTRACT_32BITS(p) == WLANCAP_MAGIC_COOKIE_V1) + return ieee802_11_avs_radio_print(p, length, caplen); + + if (caplen < PRISM_HDR_LEN) { + printf("[|802.11]"); + return caplen; + } + + return PRISM_HDR_LEN + ieee802_11_print(p + PRISM_HDR_LEN, + length - PRISM_HDR_LEN, caplen - PRISM_HDR_LEN); +} + +/* + * For DLT_IEEE802_11_RADIO; like DLT_IEEE802_11, but with an extra + * header, containing information such as radio information, which we + * currently ignore. + */ +u_int +ieee802_11_radio_if_print(const struct pcap_pkthdr *h, const u_char *p) +{ + u_int caplen = h->caplen; + u_int length = h->len; + + if (caplen < 8) { + printf("[|802.11]"); + return caplen; } - if (xflag) - default_print(p, caplen); - out: - putchar('\n'); + return ieee802_11_radio_print(p, length, caplen); }