X-Git-Url: https://git.tcpdump.org/tcpdump/blobdiff_plain/ec799d60f6cd3f41041b57efe3963c28dda94d4a..bd00116d80c18b782f4cb15dfc90cd5bf993d4f5:/print-802_11.c diff --git a/print-802_11.c b/print-802_11.c index 088840ab..2b4463ec 100644 --- a/print-802_11.c +++ b/print-802_11.c @@ -20,41 +20,696 @@ * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. */ -#ifndef lint -static const char rcsid[] _U_ = - "@(#) $Header: /tcpdump/master/tcpdump/print-802_11.c,v 1.49 2007-12-29 23:25:02 guy Exp $ (LBL)"; -#endif - #ifdef HAVE_CONFIG_H #include "config.h" #endif #include -#include -#include #include #include "interface.h" #include "addrtoname.h" -#include "ethertype.h" #include "extract.h" #include "cpack.h" -#include "ieee802_11.h" -#include "ieee802_11_radio.h" + +/* Lengths of 802.11 header components. */ +#define IEEE802_11_FC_LEN 2 +#define IEEE802_11_DUR_LEN 2 +#define IEEE802_11_DA_LEN 6 +#define IEEE802_11_SA_LEN 6 +#define IEEE802_11_BSSID_LEN 6 +#define IEEE802_11_RA_LEN 6 +#define IEEE802_11_TA_LEN 6 +#define IEEE802_11_ADDR1_LEN 6 +#define IEEE802_11_SEQ_LEN 2 +#define IEEE802_11_CTL_LEN 2 +#define IEEE802_11_CARRIED_FC_LEN 2 +#define IEEE802_11_HT_CONTROL_LEN 4 +#define IEEE802_11_IV_LEN 3 +#define IEEE802_11_KID_LEN 1 + +/* Frame check sequence length. */ +#define IEEE802_11_FCS_LEN 4 + +/* Lengths of beacon components. */ +#define IEEE802_11_TSTAMP_LEN 8 +#define IEEE802_11_BCNINT_LEN 2 +#define IEEE802_11_CAPINFO_LEN 2 +#define IEEE802_11_LISTENINT_LEN 2 + +#define IEEE802_11_AID_LEN 2 +#define IEEE802_11_STATUS_LEN 2 +#define IEEE802_11_REASON_LEN 2 + +/* Length of previous AP in reassocation frame */ +#define IEEE802_11_AP_LEN 6 + +#define T_MGMT 0x0 /* management */ +#define T_CTRL 0x1 /* control */ +#define T_DATA 0x2 /* data */ +#define T_RESV 0x3 /* reserved */ + +#define ST_ASSOC_REQUEST 0x0 +#define ST_ASSOC_RESPONSE 0x1 +#define ST_REASSOC_REQUEST 0x2 +#define ST_REASSOC_RESPONSE 0x3 +#define ST_PROBE_REQUEST 0x4 +#define ST_PROBE_RESPONSE 0x5 +/* RESERVED 0x6 */ +/* RESERVED 0x7 */ +#define ST_BEACON 0x8 +#define ST_ATIM 0x9 +#define ST_DISASSOC 0xA +#define ST_AUTH 0xB +#define ST_DEAUTH 0xC +#define ST_ACTION 0xD +/* RESERVED 0xE */ +/* RESERVED 0xF */ + +static const struct tok st_str[] = { + { ST_ASSOC_REQUEST, "Assoc Request" }, + { ST_ASSOC_RESPONSE, "Assoc Response" }, + { ST_REASSOC_REQUEST, "ReAssoc Request" }, + { ST_REASSOC_RESPONSE, "ReAssoc Response" }, + { ST_PROBE_REQUEST, "Probe Request" }, + { ST_PROBE_RESPONSE, "Probe Response" }, + { ST_BEACON, "Beacon" }, + { ST_ATIM, "ATIM" }, + { ST_DISASSOC, "Disassociation" }, + { ST_AUTH, "Authentication" }, + { ST_DEAUTH, "DeAuthentication" }, + { ST_ACTION, "Action" }, + { 0, NULL } +}; + +#define CTRL_CONTROL_WRAPPER 0x7 +#define CTRL_BAR 0x8 +#define CTRL_BA 0x9 +#define CTRL_PS_POLL 0xA +#define CTRL_RTS 0xB +#define CTRL_CTS 0xC +#define CTRL_ACK 0xD +#define CTRL_CF_END 0xE +#define CTRL_END_ACK 0xF + +static const struct tok ctrl_str[] = { + { CTRL_CONTROL_WRAPPER, "Control Wrapper" }, + { CTRL_BAR, "BAR" }, + { CTRL_BA, "BA" }, + { CTRL_PS_POLL, "Power Save-Poll" }, + { CTRL_RTS, "Request-To-Send" }, + { CTRL_CTS, "Clear-To-Send" }, + { CTRL_ACK, "Acknowledgment" }, + { CTRL_CF_END, "CF-End" }, + { CTRL_END_ACK, "CF-End+CF-Ack" }, + { 0, NULL } +}; + +#define DATA_DATA 0x0 +#define DATA_DATA_CF_ACK 0x1 +#define DATA_DATA_CF_POLL 0x2 +#define DATA_DATA_CF_ACK_POLL 0x3 +#define DATA_NODATA 0x4 +#define DATA_NODATA_CF_ACK 0x5 +#define DATA_NODATA_CF_POLL 0x6 +#define DATA_NODATA_CF_ACK_POLL 0x7 + +#define DATA_QOS_DATA 0x8 +#define DATA_QOS_DATA_CF_ACK 0x9 +#define DATA_QOS_DATA_CF_POLL 0xA +#define DATA_QOS_DATA_CF_ACK_POLL 0xB +#define DATA_QOS_NODATA 0xC +#define DATA_QOS_CF_POLL_NODATA 0xE +#define DATA_QOS_CF_ACK_POLL_NODATA 0xF + +/* + * The subtype field of a data frame is, in effect, composed of 4 flag + * bits - CF-Ack, CF-Poll, Null (means the frame doesn't actually have + * any data), and QoS. + */ +#define DATA_FRAME_IS_CF_ACK(x) ((x) & 0x01) +#define DATA_FRAME_IS_CF_POLL(x) ((x) & 0x02) +#define DATA_FRAME_IS_NULL(x) ((x) & 0x04) +#define DATA_FRAME_IS_QOS(x) ((x) & 0x08) + +/* + * Bits in the frame control field. + */ +#define FC_VERSION(fc) ((fc) & 0x3) +#define FC_TYPE(fc) (((fc) >> 2) & 0x3) +#define FC_SUBTYPE(fc) (((fc) >> 4) & 0xF) +#define FC_TO_DS(fc) ((fc) & 0x0100) +#define FC_FROM_DS(fc) ((fc) & 0x0200) +#define FC_MORE_FLAG(fc) ((fc) & 0x0400) +#define FC_RETRY(fc) ((fc) & 0x0800) +#define FC_POWER_MGMT(fc) ((fc) & 0x1000) +#define FC_MORE_DATA(fc) ((fc) & 0x2000) +#define FC_PROTECTED(fc) ((fc) & 0x4000) +#define FC_ORDER(fc) ((fc) & 0x8000) + +struct mgmt_header_t { + uint16_t fc; + uint16_t duration; + uint8_t da[IEEE802_11_DA_LEN]; + uint8_t sa[IEEE802_11_SA_LEN]; + uint8_t bssid[IEEE802_11_BSSID_LEN]; + uint16_t seq_ctrl; +}; + +#define MGMT_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_DA_LEN+IEEE802_11_SA_LEN+\ + IEEE802_11_BSSID_LEN+IEEE802_11_SEQ_LEN) + +#define CAPABILITY_ESS(cap) ((cap) & 0x0001) +#define CAPABILITY_IBSS(cap) ((cap) & 0x0002) +#define CAPABILITY_CFP(cap) ((cap) & 0x0004) +#define CAPABILITY_CFP_REQ(cap) ((cap) & 0x0008) +#define CAPABILITY_PRIVACY(cap) ((cap) & 0x0010) + +struct ssid_t { + uint8_t element_id; + uint8_t length; + u_char ssid[33]; /* 32 + 1 for null */ +}; + +struct rates_t { + uint8_t element_id; + uint8_t length; + uint8_t rate[16]; +}; + +struct challenge_t { + uint8_t element_id; + uint8_t length; + uint8_t text[254]; /* 1-253 + 1 for null */ +}; + +struct fh_t { + uint8_t element_id; + uint8_t length; + uint16_t dwell_time; + uint8_t hop_set; + uint8_t hop_pattern; + uint8_t hop_index; +}; + +struct ds_t { + uint8_t element_id; + uint8_t length; + uint8_t channel; +}; + +struct cf_t { + uint8_t element_id; + uint8_t length; + uint8_t count; + uint8_t period; + uint16_t max_duration; + uint16_t dur_remaing; +}; + +struct tim_t { + uint8_t element_id; + uint8_t length; + uint8_t count; + uint8_t period; + uint8_t bitmap_control; + uint8_t bitmap[251]; +}; + +#define E_SSID 0 +#define E_RATES 1 +#define E_FH 2 +#define E_DS 3 +#define E_CF 4 +#define E_TIM 5 +#define E_IBSS 6 +/* reserved 7 */ +/* reserved 8 */ +/* reserved 9 */ +/* reserved 10 */ +/* reserved 11 */ +/* reserved 12 */ +/* reserved 13 */ +/* reserved 14 */ +/* reserved 15 */ +/* reserved 16 */ + +#define E_CHALLENGE 16 +/* reserved 17 */ +/* reserved 18 */ +/* reserved 19 */ +/* reserved 16 */ +/* reserved 16 */ + + +struct mgmt_body_t { + uint8_t timestamp[IEEE802_11_TSTAMP_LEN]; + uint16_t beacon_interval; + uint16_t listen_interval; + uint16_t status_code; + uint16_t aid; + u_char ap[IEEE802_11_AP_LEN]; + uint16_t reason_code; + uint16_t auth_alg; + uint16_t auth_trans_seq_num; + int challenge_present; + struct challenge_t challenge; + uint16_t capability_info; + int ssid_present; + struct ssid_t ssid; + int rates_present; + struct rates_t rates; + int ds_present; + struct ds_t ds; + int cf_present; + struct cf_t cf; + int fh_present; + struct fh_t fh; + int tim_present; + struct tim_t tim; +}; + +struct ctrl_control_wrapper_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t addr1[IEEE802_11_ADDR1_LEN]; + uint16_t carried_fc[IEEE802_11_CARRIED_FC_LEN]; + uint16_t ht_control[IEEE802_11_HT_CONTROL_LEN]; +}; + +#define CTRL_CONTROL_WRAPPER_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_ADDR1_LEN+\ + IEEE802_11_CARRIED_FC_LEN+\ + IEEE802_11_HT_CONTROL_LEN) + +struct ctrl_rts_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; + uint8_t ta[IEEE802_11_TA_LEN]; +}; + +#define CTRL_RTS_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_RA_LEN+IEEE802_11_TA_LEN) + +struct ctrl_cts_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; +}; + +#define CTRL_CTS_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+IEEE802_11_RA_LEN) + +struct ctrl_ack_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; +}; + +#define CTRL_ACK_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+IEEE802_11_RA_LEN) + +struct ctrl_ps_poll_hdr_t { + uint16_t fc; + uint16_t aid; + uint8_t bssid[IEEE802_11_BSSID_LEN]; + uint8_t ta[IEEE802_11_TA_LEN]; +}; + +#define CTRL_PS_POLL_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_AID_LEN+\ + IEEE802_11_BSSID_LEN+IEEE802_11_TA_LEN) + +struct ctrl_end_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; + uint8_t bssid[IEEE802_11_BSSID_LEN]; +}; + +#define CTRL_END_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_RA_LEN+IEEE802_11_BSSID_LEN) + +struct ctrl_end_ack_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; + uint8_t bssid[IEEE802_11_BSSID_LEN]; +}; + +#define CTRL_END_ACK_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_RA_LEN+IEEE802_11_BSSID_LEN) + +struct ctrl_ba_hdr_t { + uint16_t fc; + uint16_t duration; + uint8_t ra[IEEE802_11_RA_LEN]; +}; + +#define CTRL_BA_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+IEEE802_11_RA_LEN) + +struct ctrl_bar_hdr_t { + uint16_t fc; + uint16_t dur; + uint8_t ra[IEEE802_11_RA_LEN]; + uint8_t ta[IEEE802_11_TA_LEN]; + uint16_t ctl; + uint16_t seq; +}; + +#define CTRL_BAR_HDRLEN (IEEE802_11_FC_LEN+IEEE802_11_DUR_LEN+\ + IEEE802_11_RA_LEN+IEEE802_11_TA_LEN+\ + IEEE802_11_CTL_LEN+IEEE802_11_SEQ_LEN) + +struct meshcntl_t { + uint8_t flags; + uint8_t ttl; + uint8_t seq[4]; + uint8_t addr4[6]; + uint8_t addr5[6]; + uint8_t addr6[6]; +}; + +#define IV_IV(iv) ((iv) & 0xFFFFFF) +#define IV_PAD(iv) (((iv) >> 24) & 0x3F) +#define IV_KEYID(iv) (((iv) >> 30) & 0x03) + +/* $FreeBSD: src/sys/net80211/ieee80211_radiotap.h,v 1.5 2005/01/22 20:12:05 sam Exp $ */ +/* NetBSD: ieee802_11_radio.h,v 1.2 2006/02/26 03:04:03 dyoung Exp */ + +/*- + * Copyright (c) 2003, 2004 David Young. All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * 1. Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * 2. Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * 3. The name of David Young may not be used to endorse or promote + * products derived from this software without specific prior + * written permission. + * + * THIS SOFTWARE IS PROVIDED BY DAVID YOUNG ``AS IS'' AND ANY + * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, + * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A + * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL DAVID + * YOUNG BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, + * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED + * TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, + * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND + * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, + * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY + * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY + * OF SUCH DAMAGE. + */ + +/* A generic radio capture format is desirable. It must be + * rigidly defined (e.g., units for fields should be given), + * and easily extensible. + * + * The following is an extensible radio capture format. It is + * based on a bitmap indicating which fields are present. + * + * I am trying to describe precisely what the application programmer + * should expect in the following, and for that reason I tell the + * units and origin of each measurement (where it applies), or else I + * use sufficiently weaselly language ("is a monotonically nondecreasing + * function of...") that I cannot set false expectations for lawyerly + * readers. + */ + +/* + * The radio capture header precedes the 802.11 header. + * + * Note well: all radiotap fields are little-endian. + */ +struct ieee80211_radiotap_header { + uint8_t it_version; /* Version 0. Only increases + * for drastic changes, + * introduction of compatible + * new fields does not count. + */ + uint8_t it_pad; + uint16_t it_len; /* length of the whole + * header in bytes, including + * it_version, it_pad, + * it_len, and data fields. + */ + uint32_t it_present; /* A bitmap telling which + * fields are present. Set bit 31 + * (0x80000000) to extend the + * bitmap by another 32 bits. + * Additional extensions are made + * by setting bit 31. + */ +}; + +/* Name Data type Units + * ---- --------- ----- + * + * IEEE80211_RADIOTAP_TSFT uint64_t microseconds + * + * Value in microseconds of the MAC's 64-bit 802.11 Time + * Synchronization Function timer when the first bit of the + * MPDU arrived at the MAC. For received frames, only. + * + * IEEE80211_RADIOTAP_CHANNEL 2 x uint16_t MHz, bitmap + * + * Tx/Rx frequency in MHz, followed by flags (see below). + * Note that IEEE80211_RADIOTAP_XCHANNEL must be used to + * represent an HT channel as there is not enough room in + * the flags word. + * + * IEEE80211_RADIOTAP_FHSS uint16_t see below + * + * For frequency-hopping radios, the hop set (first byte) + * and pattern (second byte). + * + * IEEE80211_RADIOTAP_RATE uint8_t 500kb/s or index + * + * Tx/Rx data rate. If bit 0x80 is set then it represents an + * an MCS index and not an IEEE rate. + * + * IEEE80211_RADIOTAP_DBM_ANTSIGNAL int8_t decibels from + * one milliwatt (dBm) + * + * RF signal power at the antenna, decibel difference from + * one milliwatt. + * + * IEEE80211_RADIOTAP_DBM_ANTNOISE int8_t decibels from + * one milliwatt (dBm) + * + * RF noise power at the antenna, decibel difference from one + * milliwatt. + * + * IEEE80211_RADIOTAP_DB_ANTSIGNAL uint8_t decibel (dB) + * + * RF signal power at the antenna, decibel difference from an + * arbitrary, fixed reference. + * + * IEEE80211_RADIOTAP_DB_ANTNOISE uint8_t decibel (dB) + * + * RF noise power at the antenna, decibel difference from an + * arbitrary, fixed reference point. + * + * IEEE80211_RADIOTAP_LOCK_QUALITY uint16_t unitless + * + * Quality of Barker code lock. Unitless. Monotonically + * nondecreasing with "better" lock strength. Called "Signal + * Quality" in datasheets. (Is there a standard way to measure + * this?) + * + * IEEE80211_RADIOTAP_TX_ATTENUATION uint16_t unitless + * + * Transmit power expressed as unitless distance from max + * power set at factory calibration. 0 is max power. + * Monotonically nondecreasing with lower power levels. + * + * IEEE80211_RADIOTAP_DB_TX_ATTENUATION uint16_t decibels (dB) + * + * Transmit power expressed as decibel distance from max power + * set at factory calibration. 0 is max power. Monotonically + * nondecreasing with lower power levels. + * + * IEEE80211_RADIOTAP_DBM_TX_POWER int8_t decibels from + * one milliwatt (dBm) + * + * Transmit power expressed as dBm (decibels from a 1 milliwatt + * reference). This is the absolute power level measured at + * the antenna port. + * + * IEEE80211_RADIOTAP_FLAGS uint8_t bitmap + * + * Properties of transmitted and received frames. See flags + * defined below. + * + * IEEE80211_RADIOTAP_ANTENNA uint8_t antenna index + * + * Unitless indication of the Rx/Tx antenna for this packet. + * The first antenna is antenna 0. + * + * IEEE80211_RADIOTAP_RX_FLAGS uint16_t bitmap + * + * Properties of received frames. See flags defined below. + * + * IEEE80211_RADIOTAP_XCHANNEL uint32_t bitmap + * uint16_t MHz + * uint8_t channel number + * uint8_t .5 dBm + * + * Extended channel specification: flags (see below) followed by + * frequency in MHz, the corresponding IEEE channel number, and + * finally the maximum regulatory transmit power cap in .5 dBm + * units. This property supersedes IEEE80211_RADIOTAP_CHANNEL + * and only one of the two should be present. + * + * IEEE80211_RADIOTAP_MCS uint8_t known + * uint8_t flags + * uint8_t mcs + * + * Bitset indicating which fields have known values, followed + * by bitset of flag values, followed by the MCS rate index as + * in IEEE 802.11n. + * + * IEEE80211_RADIOTAP_VENDOR_NAMESPACE + * uint8_t OUI[3] + * uint8_t subspace + * uint16_t length + * + * The Vendor Namespace Field contains three sub-fields. The first + * sub-field is 3 bytes long. It contains the vendor's IEEE 802 + * Organizationally Unique Identifier (OUI). The fourth byte is a + * vendor-specific "namespace selector." + * + */ +enum ieee80211_radiotap_type { + IEEE80211_RADIOTAP_TSFT = 0, + IEEE80211_RADIOTAP_FLAGS = 1, + IEEE80211_RADIOTAP_RATE = 2, + IEEE80211_RADIOTAP_CHANNEL = 3, + IEEE80211_RADIOTAP_FHSS = 4, + IEEE80211_RADIOTAP_DBM_ANTSIGNAL = 5, + IEEE80211_RADIOTAP_DBM_ANTNOISE = 6, + IEEE80211_RADIOTAP_LOCK_QUALITY = 7, + IEEE80211_RADIOTAP_TX_ATTENUATION = 8, + IEEE80211_RADIOTAP_DB_TX_ATTENUATION = 9, + IEEE80211_RADIOTAP_DBM_TX_POWER = 10, + IEEE80211_RADIOTAP_ANTENNA = 11, + IEEE80211_RADIOTAP_DB_ANTSIGNAL = 12, + IEEE80211_RADIOTAP_DB_ANTNOISE = 13, + IEEE80211_RADIOTAP_RX_FLAGS = 14, + /* NB: gap for netbsd definitions */ + IEEE80211_RADIOTAP_XCHANNEL = 18, + IEEE80211_RADIOTAP_MCS = 19, + IEEE80211_RADIOTAP_NAMESPACE = 29, + IEEE80211_RADIOTAP_VENDOR_NAMESPACE = 30, + IEEE80211_RADIOTAP_EXT = 31 +}; + +/* channel attributes */ +#define IEEE80211_CHAN_TURBO 0x00010 /* Turbo channel */ +#define IEEE80211_CHAN_CCK 0x00020 /* CCK channel */ +#define IEEE80211_CHAN_OFDM 0x00040 /* OFDM channel */ +#define IEEE80211_CHAN_2GHZ 0x00080 /* 2 GHz spectrum channel. */ +#define IEEE80211_CHAN_5GHZ 0x00100 /* 5 GHz spectrum channel */ +#define IEEE80211_CHAN_PASSIVE 0x00200 /* Only passive scan allowed */ +#define IEEE80211_CHAN_DYN 0x00400 /* Dynamic CCK-OFDM channel */ +#define IEEE80211_CHAN_GFSK 0x00800 /* GFSK channel (FHSS PHY) */ +#define IEEE80211_CHAN_GSM 0x01000 /* 900 MHz spectrum channel */ +#define IEEE80211_CHAN_STURBO 0x02000 /* 11a static turbo channel only */ +#define IEEE80211_CHAN_HALF 0x04000 /* Half rate channel */ +#define IEEE80211_CHAN_QUARTER 0x08000 /* Quarter rate channel */ +#define IEEE80211_CHAN_HT20 0x10000 /* HT 20 channel */ +#define IEEE80211_CHAN_HT40U 0x20000 /* HT 40 channel w/ ext above */ +#define IEEE80211_CHAN_HT40D 0x40000 /* HT 40 channel w/ ext below */ + +/* Useful combinations of channel characteristics, borrowed from Ethereal */ +#define IEEE80211_CHAN_A \ + (IEEE80211_CHAN_5GHZ | IEEE80211_CHAN_OFDM) +#define IEEE80211_CHAN_B \ + (IEEE80211_CHAN_2GHZ | IEEE80211_CHAN_CCK) +#define IEEE80211_CHAN_G \ + (IEEE80211_CHAN_2GHZ | IEEE80211_CHAN_DYN) +#define IEEE80211_CHAN_TA \ + (IEEE80211_CHAN_5GHZ | IEEE80211_CHAN_OFDM | IEEE80211_CHAN_TURBO) +#define IEEE80211_CHAN_TG \ + (IEEE80211_CHAN_2GHZ | IEEE80211_CHAN_DYN | IEEE80211_CHAN_TURBO) + + +/* For IEEE80211_RADIOTAP_FLAGS */ +#define IEEE80211_RADIOTAP_F_CFP 0x01 /* sent/received + * during CFP + */ +#define IEEE80211_RADIOTAP_F_SHORTPRE 0x02 /* sent/received + * with short + * preamble + */ +#define IEEE80211_RADIOTAP_F_WEP 0x04 /* sent/received + * with WEP encryption + */ +#define IEEE80211_RADIOTAP_F_FRAG 0x08 /* sent/received + * with fragmentation + */ +#define IEEE80211_RADIOTAP_F_FCS 0x10 /* frame includes FCS */ +#define IEEE80211_RADIOTAP_F_DATAPAD 0x20 /* frame has padding between + * 802.11 header and payload + * (to 32-bit boundary) + */ +#define IEEE80211_RADIOTAP_F_BADFCS 0x40 /* does not pass FCS check */ + +/* For IEEE80211_RADIOTAP_RX_FLAGS */ +#define IEEE80211_RADIOTAP_F_RX_BADFCS 0x0001 /* frame failed crc check */ +#define IEEE80211_RADIOTAP_F_RX_PLCP_CRC 0x0002 /* frame failed PLCP CRC check */ + +/* For IEEE80211_RADIOTAP_MCS known */ +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_KNOWN 0x01 +#define IEEE80211_RADIOTAP_MCS_MCS_INDEX_KNOWN 0x02 /* MCS index field */ +#define IEEE80211_RADIOTAP_MCS_GUARD_INTERVAL_KNOWN 0x04 +#define IEEE80211_RADIOTAP_MCS_HT_FORMAT_KNOWN 0x08 +#define IEEE80211_RADIOTAP_MCS_FEC_TYPE_KNOWN 0x10 +#define IEEE80211_RADIOTAP_MCS_STBC_KNOWN 0x20 + +/* For IEEE80211_RADIOTAP_MCS flags */ +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_MASK 0x03 +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_20 0 +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_40 1 +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_20L 2 +#define IEEE80211_RADIOTAP_MCS_BANDWIDTH_20U 3 +#define IEEE80211_RADIOTAP_MCS_SHORT_GI 0x04 /* short guard interval */ +#define IEEE80211_RADIOTAP_MCS_HT_GREENFIELD 0x08 +#define IEEE80211_RADIOTAP_MCS_FEC_LDPC 0x10 +#define IEEE80211_RADIOTAP_MCS_STBC_MASK 0x60 +#define IEEE80211_RADIOTAP_MCS_STBC_1 1 +#define IEEE80211_RADIOTAP_MCS_STBC_2 2 +#define IEEE80211_RADIOTAP_MCS_STBC_3 3 +#define IEEE80211_RADIOTAP_MCS_STBC_SHIFT 5 + +static const char tstr[] = "[|802.11]"; + +/* Radiotap state */ +/* This is used to save state when parsing/processing parameters */ +struct radiotap_state +{ + uint32_t present; + + uint8_t rate; +}; #define PRINT_SSID(p) \ if (p.ssid_present) { \ - printf(" ("); \ - fn_print(p.ssid.ssid, NULL); \ - printf(")"); \ + ND_PRINT((ndo, " (")); \ + fn_print(ndo, p.ssid.ssid, NULL); \ + ND_PRINT((ndo, ")")); \ } #define PRINT_RATE(_sep, _r, _suf) \ - printf("%s%2.1f%s", _sep, (.5 * ((_r) & 0x7f)), _suf) + ND_PRINT((ndo, "%s%2.1f%s", _sep, (.5 * ((_r) & 0x7f)), _suf)) #define PRINT_RATES(p) \ if (p.rates_present) { \ int z; \ @@ -65,41 +720,418 @@ static const char rcsid[] _U_ = sep = " "; \ } \ if (p.rates.length != 0) \ - printf(" Mbit]"); \ + ND_PRINT((ndo, " Mbit]")); \ } #define PRINT_DS_CHANNEL(p) \ if (p.ds_present) \ - printf(" CH: %u", p.ds.channel); \ - printf("%s", \ - CAPABILITY_PRIVACY(p.capability_info) ? ", PRIVACY" : "" ); - -static const int ieee80211_htrates[16] = { - 13, /* IFM_IEEE80211_MCS0 */ - 26, /* IFM_IEEE80211_MCS1 */ - 39, /* IFM_IEEE80211_MCS2 */ - 52, /* IFM_IEEE80211_MCS3 */ - 78, /* IFM_IEEE80211_MCS4 */ - 104, /* IFM_IEEE80211_MCS5 */ - 117, /* IFM_IEEE80211_MCS6 */ - 130, /* IFM_IEEE80211_MCS7 */ - 26, /* IFM_IEEE80211_MCS8 */ - 52, /* IFM_IEEE80211_MCS9 */ - 78, /* IFM_IEEE80211_MCS10 */ - 104, /* IFM_IEEE80211_MCS11 */ - 156, /* IFM_IEEE80211_MCS12 */ - 208, /* IFM_IEEE80211_MCS13 */ - 234, /* IFM_IEEE80211_MCS14 */ - 260, /* IFM_IEEE80211_MCS15 */ + ND_PRINT((ndo, " CH: %u", p.ds.channel)); \ + ND_PRINT((ndo, "%s", \ + CAPABILITY_PRIVACY(p.capability_info) ? ", PRIVACY" : "")); + +#define MAX_MCS_INDEX 76 + +/* + * Indices are: + * + * the MCS index (0-76); + * + * 0 for 20 MHz, 1 for 40 MHz; + * + * 0 for a long guard interval, 1 for a short guard interval. + */ +static const float ieee80211_float_htrates[MAX_MCS_INDEX+1][2][2] = { + /* MCS 0 */ + { /* 20 Mhz */ { 6.5, /* SGI */ 7.2, }, + /* 40 Mhz */ { 13.5, /* SGI */ 15.0, }, + }, + + /* MCS 1 */ + { /* 20 Mhz */ { 13.0, /* SGI */ 14.4, }, + /* 40 Mhz */ { 27.0, /* SGI */ 30.0, }, + }, + + /* MCS 2 */ + { /* 20 Mhz */ { 19.5, /* SGI */ 21.7, }, + /* 40 Mhz */ { 40.5, /* SGI */ 45.0, }, + }, + + /* MCS 3 */ + { /* 20 Mhz */ { 26.0, /* SGI */ 28.9, }, + /* 40 Mhz */ { 54.0, /* SGI */ 60.0, }, + }, + + /* MCS 4 */ + { /* 20 Mhz */ { 39.0, /* SGI */ 43.3, }, + /* 40 Mhz */ { 81.0, /* SGI */ 90.0, }, + }, + + /* MCS 5 */ + { /* 20 Mhz */ { 52.0, /* SGI */ 57.8, }, + /* 40 Mhz */ { 108.0, /* SGI */ 120.0, }, + }, + + /* MCS 6 */ + { /* 20 Mhz */ { 58.5, /* SGI */ 65.0, }, + /* 40 Mhz */ { 121.5, /* SGI */ 135.0, }, + }, + + /* MCS 7 */ + { /* 20 Mhz */ { 65.0, /* SGI */ 72.2, }, + /* 40 Mhz */ { 135.0, /* SGI */ 150.0, }, + }, + + /* MCS 8 */ + { /* 20 Mhz */ { 13.0, /* SGI */ 14.4, }, + /* 40 Mhz */ { 27.0, /* SGI */ 30.0, }, + }, + + /* MCS 9 */ + { /* 20 Mhz */ { 26.0, /* SGI */ 28.9, }, + /* 40 Mhz */ { 54.0, /* SGI */ 60.0, }, + }, + + /* MCS 10 */ + { /* 20 Mhz */ { 39.0, /* SGI */ 43.3, }, + /* 40 Mhz */ { 81.0, /* SGI */ 90.0, }, + }, + + /* MCS 11 */ + { /* 20 Mhz */ { 52.0, /* SGI */ 57.8, }, + /* 40 Mhz */ { 108.0, /* SGI */ 120.0, }, + }, + + /* MCS 12 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 13 */ + { /* 20 Mhz */ { 104.0, /* SGI */ 115.6, }, + /* 40 Mhz */ { 216.0, /* SGI */ 240.0, }, + }, + + /* MCS 14 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 15 */ + { /* 20 Mhz */ { 130.0, /* SGI */ 144.4, }, + /* 40 Mhz */ { 270.0, /* SGI */ 300.0, }, + }, + + /* MCS 16 */ + { /* 20 Mhz */ { 19.5, /* SGI */ 21.7, }, + /* 40 Mhz */ { 40.5, /* SGI */ 45.0, }, + }, + + /* MCS 17 */ + { /* 20 Mhz */ { 39.0, /* SGI */ 43.3, }, + /* 40 Mhz */ { 81.0, /* SGI */ 90.0, }, + }, + + /* MCS 18 */ + { /* 20 Mhz */ { 58.5, /* SGI */ 65.0, }, + /* 40 Mhz */ { 121.5, /* SGI */ 135.0, }, + }, + + /* MCS 19 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 20 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 21 */ + { /* 20 Mhz */ { 156.0, /* SGI */ 173.3, }, + /* 40 Mhz */ { 324.0, /* SGI */ 360.0, }, + }, + + /* MCS 22 */ + { /* 20 Mhz */ { 175.5, /* SGI */ 195.0, }, + /* 40 Mhz */ { 364.5, /* SGI */ 405.0, }, + }, + + /* MCS 23 */ + { /* 20 Mhz */ { 195.0, /* SGI */ 216.7, }, + /* 40 Mhz */ { 405.0, /* SGI */ 450.0, }, + }, + + /* MCS 24 */ + { /* 20 Mhz */ { 26.0, /* SGI */ 28.9, }, + /* 40 Mhz */ { 54.0, /* SGI */ 60.0, }, + }, + + /* MCS 25 */ + { /* 20 Mhz */ { 52.0, /* SGI */ 57.8, }, + /* 40 Mhz */ { 108.0, /* SGI */ 120.0, }, + }, + + /* MCS 26 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 27 */ + { /* 20 Mhz */ { 104.0, /* SGI */ 115.6, }, + /* 40 Mhz */ { 216.0, /* SGI */ 240.0, }, + }, + + /* MCS 28 */ + { /* 20 Mhz */ { 156.0, /* SGI */ 173.3, }, + /* 40 Mhz */ { 324.0, /* SGI */ 360.0, }, + }, + + /* MCS 29 */ + { /* 20 Mhz */ { 208.0, /* SGI */ 231.1, }, + /* 40 Mhz */ { 432.0, /* SGI */ 480.0, }, + }, + + /* MCS 30 */ + { /* 20 Mhz */ { 234.0, /* SGI */ 260.0, }, + /* 40 Mhz */ { 486.0, /* SGI */ 540.0, }, + }, + + /* MCS 31 */ + { /* 20 Mhz */ { 260.0, /* SGI */ 288.9, }, + /* 40 Mhz */ { 540.0, /* SGI */ 600.0, }, + }, + + /* MCS 32 */ + { /* 20 Mhz */ { 0.0, /* SGI */ 0.0, }, /* not valid */ + /* 40 Mhz */ { 6.0, /* SGI */ 6.7, }, + }, + + /* MCS 33 */ + { /* 20 Mhz */ { 39.0, /* SGI */ 43.3, }, + /* 40 Mhz */ { 81.0, /* SGI */ 90.0, }, + }, + + /* MCS 34 */ + { /* 20 Mhz */ { 52.0, /* SGI */ 57.8, }, + /* 40 Mhz */ { 108.0, /* SGI */ 120.0, }, + }, + + /* MCS 35 */ + { /* 20 Mhz */ { 65.0, /* SGI */ 72.2, }, + /* 40 Mhz */ { 135.0, /* SGI */ 150.0, }, + }, + + /* MCS 36 */ + { /* 20 Mhz */ { 58.5, /* SGI */ 65.0, }, + /* 40 Mhz */ { 121.5, /* SGI */ 135.0, }, + }, + + /* MCS 37 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 38 */ + { /* 20 Mhz */ { 97.5, /* SGI */ 108.3, }, + /* 40 Mhz */ { 202.5, /* SGI */ 225.0, }, + }, + + /* MCS 39 */ + { /* 20 Mhz */ { 52.0, /* SGI */ 57.8, }, + /* 40 Mhz */ { 108.0, /* SGI */ 120.0, }, + }, + + /* MCS 40 */ + { /* 20 Mhz */ { 65.0, /* SGI */ 72.2, }, + /* 40 Mhz */ { 135.0, /* SGI */ 150.0, }, + }, + + /* MCS 41 */ + { /* 20 Mhz */ { 65.0, /* SGI */ 72.2, }, + /* 40 Mhz */ { 135.0, /* SGI */ 150.0, }, + }, + + /* MCS 42 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 43 */ + { /* 20 Mhz */ { 91.0, /* SGI */ 101.1, }, + /* 40 Mhz */ { 189.0, /* SGI */ 210.0, }, + }, + + /* MCS 44 */ + { /* 20 Mhz */ { 91.0, /* SGI */ 101.1, }, + /* 40 Mhz */ { 189.0, /* SGI */ 210.0, }, + }, + + /* MCS 45 */ + { /* 20 Mhz */ { 104.0, /* SGI */ 115.6, }, + /* 40 Mhz */ { 216.0, /* SGI */ 240.0, }, + }, + + /* MCS 46 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 47 */ + { /* 20 Mhz */ { 97.5, /* SGI */ 108.3, }, + /* 40 Mhz */ { 202.5, /* SGI */ 225.0, }, + }, + + /* MCS 48 */ + { /* 20 Mhz */ { 97.5, /* SGI */ 108.3, }, + /* 40 Mhz */ { 202.5, /* SGI */ 225.0, }, + }, + + /* MCS 49 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 50 */ + { /* 20 Mhz */ { 136.5, /* SGI */ 151.7, }, + /* 40 Mhz */ { 283.5, /* SGI */ 315.0, }, + }, + + /* MCS 51 */ + { /* 20 Mhz */ { 136.5, /* SGI */ 151.7, }, + /* 40 Mhz */ { 283.5, /* SGI */ 315.0, }, + }, + + /* MCS 52 */ + { /* 20 Mhz */ { 156.0, /* SGI */ 173.3, }, + /* 40 Mhz */ { 324.0, /* SGI */ 360.0, }, + }, + + /* MCS 53 */ + { /* 20 Mhz */ { 65.0, /* SGI */ 72.2, }, + /* 40 Mhz */ { 135.0, /* SGI */ 150.0, }, + }, + + /* MCS 54 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 55 */ + { /* 20 Mhz */ { 91.0, /* SGI */ 101.1, }, + /* 40 Mhz */ { 189.0, /* SGI */ 210.0, }, + }, + + /* MCS 56 */ + { /* 20 Mhz */ { 78.0, /* SGI */ 86.7, }, + /* 40 Mhz */ { 162.0, /* SGI */ 180.0, }, + }, + + /* MCS 57 */ + { /* 20 Mhz */ { 91.0, /* SGI */ 101.1, }, + /* 40 Mhz */ { 189.0, /* SGI */ 210.0, }, + }, + + /* MCS 58 */ + { /* 20 Mhz */ { 104.0, /* SGI */ 115.6, }, + /* 40 Mhz */ { 216.0, /* SGI */ 240.0, }, + }, + + /* MCS 59 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 60 */ + { /* 20 Mhz */ { 104.0, /* SGI */ 115.6, }, + /* 40 Mhz */ { 216.0, /* SGI */ 240.0, }, + }, + + /* MCS 61 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 62 */ + { /* 20 Mhz */ { 130.0, /* SGI */ 144.4, }, + /* 40 Mhz */ { 270.0, /* SGI */ 300.0, }, + }, + + /* MCS 63 */ + { /* 20 Mhz */ { 130.0, /* SGI */ 144.4, }, + /* 40 Mhz */ { 270.0, /* SGI */ 300.0, }, + }, + + /* MCS 64 */ + { /* 20 Mhz */ { 143.0, /* SGI */ 158.9, }, + /* 40 Mhz */ { 297.0, /* SGI */ 330.0, }, + }, + + /* MCS 65 */ + { /* 20 Mhz */ { 97.5, /* SGI */ 108.3, }, + /* 40 Mhz */ { 202.5, /* SGI */ 225.0, }, + }, + + /* MCS 66 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 67 */ + { /* 20 Mhz */ { 136.5, /* SGI */ 151.7, }, + /* 40 Mhz */ { 283.5, /* SGI */ 315.0, }, + }, + + /* MCS 68 */ + { /* 20 Mhz */ { 117.0, /* SGI */ 130.0, }, + /* 40 Mhz */ { 243.0, /* SGI */ 270.0, }, + }, + + /* MCS 69 */ + { /* 20 Mhz */ { 136.5, /* SGI */ 151.7, }, + /* 40 Mhz */ { 283.5, /* SGI */ 315.0, }, + }, + + /* MCS 70 */ + { /* 20 Mhz */ { 156.0, /* SGI */ 173.3, }, + /* 40 Mhz */ { 324.0, /* SGI */ 360.0, }, + }, + + /* MCS 71 */ + { /* 20 Mhz */ { 175.5, /* SGI */ 195.0, }, + /* 40 Mhz */ { 364.5, /* SGI */ 405.0, }, + }, + + /* MCS 72 */ + { /* 20 Mhz */ { 156.0, /* SGI */ 173.3, }, + /* 40 Mhz */ { 324.0, /* SGI */ 360.0, }, + }, + + /* MCS 73 */ + { /* 20 Mhz */ { 175.5, /* SGI */ 195.0, }, + /* 40 Mhz */ { 364.5, /* SGI */ 405.0, }, + }, + + /* MCS 74 */ + { /* 20 Mhz */ { 195.0, /* SGI */ 216.7, }, + /* 40 Mhz */ { 405.0, /* SGI */ 450.0, }, + }, + + /* MCS 75 */ + { /* 20 Mhz */ { 195.0, /* SGI */ 216.7, }, + /* 40 Mhz */ { 405.0, /* SGI */ 450.0, }, + }, + + /* MCS 76 */ + { /* 20 Mhz */ { 214.5, /* SGI */ 238.3, }, + /* 40 Mhz */ { 445.5, /* SGI */ 495.0, }, + }, }; -#define PRINT_HT_RATE(_sep, _r, _suf) \ - printf("%s%.1f%s", _sep, (.5 * ieee80211_htrates[(_r) & 0xf]), _suf) static const char *auth_alg_text[]={"Open System","Shared Key","EAP"}; #define NUM_AUTH_ALGS (sizeof auth_alg_text / sizeof auth_alg_text[0]) static const char *status_text[] = { - "Succesful", /* 0 */ + "Successful", /* 0 */ "Unspecified failure", /* 1 */ "Reserved", /* 2 */ "Reserved", /* 3 */ @@ -162,9 +1194,7 @@ static const char *status_text[] = { "The request has not been successful as one or more parameters " "have invalid values", /* 38 */ "The TS has not been created because the request cannot be honored. " - "However, a suggested TSPEC is provided so that the initiating QSTA" - "may attempt to set another TS with the suggested changes to the " - "TSPEC", /* 39 */ + "Try again with the suggested changes to the TSPEC", /* 39 */ "Invalid Information Element", /* 40 */ "Group Cipher is not valid", /* 41 */ "Pairwise Cipher is not valid", /* 42 */ @@ -251,24 +1281,27 @@ static const char *reason_text[] = { #define NUM_REASONS (sizeof reason_text / sizeof reason_text[0]) static int -wep_print(const u_char *p) +wep_print(netdissect_options *ndo, + const u_char *p) { - u_int32_t iv; + uint32_t iv; - if (!TTEST2(*p, IEEE802_11_IV_LEN + IEEE802_11_KID_LEN)) + if (!ND_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)); + ND_PRINT((ndo, " IV:%3x Pad %x KeyID %x", IV_IV(iv), IV_PAD(iv), + IV_KEYID(iv))); return 1; } static int -parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, - u_int length) +parse_elements(netdissect_options *ndo, + struct mgmt_body_t *pbody, const u_char *p, int offset, + u_int length) { + u_int elementlen; struct ssid_t ssid; struct challenge_t challenge; struct rates_t rates; @@ -287,23 +1320,28 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, pbody->tim_present = 0; while (length != 0) { - if (!TTEST2(*(p + offset), 1)) + /* Make sure we at least have the element ID and length. */ + if (!ND_TTEST2(*(p + offset), 2)) + return 0; + if (length < 2) + return 0; + elementlen = *(p + offset + 1); + + /* Make sure we have the entire element. */ + if (!ND_TTEST2(*(p + offset + 2), elementlen)) return 0; - if (length < 1) + if (length < elementlen + 2) return 0; + switch (*(p + offset)) { case E_SSID: - if (!TTEST2(*(p + offset), 2)) - return 0; - if (length < 2) - return 0; memcpy(&ssid, p + offset, 2); offset += 2; length -= 2; if (ssid.length != 0) { if (ssid.length > sizeof(ssid.ssid) - 1) return 0; - if (!TTEST2(*(p + offset), ssid.length)) + if (!ND_TTEST2(*(p + offset), ssid.length)) return 0; if (length < ssid.length) return 0; @@ -325,10 +1363,6 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, } break; case E_CHALLENGE: - if (!TTEST2(*(p + offset), 2)) - return 0; - if (length < 2) - return 0; memcpy(&challenge, p + offset, 2); offset += 2; length -= 2; @@ -336,7 +1370,7 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, if (challenge.length > sizeof(challenge.text) - 1) return 0; - if (!TTEST2(*(p + offset), challenge.length)) + if (!ND_TTEST2(*(p + offset), challenge.length)) return 0; if (length < challenge.length) return 0; @@ -359,17 +1393,13 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, } break; case E_RATES: - if (!TTEST2(*(p + offset), 2)) - return 0; - if (length < 2) - return 0; memcpy(&rates, p + offset, 2); offset += 2; length -= 2; if (rates.length != 0) { if (rates.length > sizeof rates.rate) return 0; - if (!TTEST2(*(p + offset), rates.length)) + if (!ND_TTEST2(*(p + offset), rates.length)) return 0; if (length < rates.length) return 0; @@ -399,13 +1429,17 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, } break; case E_DS: - if (!TTEST2(*(p + offset), 3)) - return 0; - if (length < 3) - return 0; - memcpy(&ds, p + offset, 3); - offset += 3; - length -= 3; + memcpy(&ds, p + offset, 2); + offset += 2; + length -= 2; + if (ds.length != 1) { + offset += ds.length; + length -= ds.length; + break; + } + ds.channel = *(p + offset); + offset += 1; + length -= 1; /* * Present and not truncated. * @@ -419,13 +1453,17 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, } break; case E_CF: - if (!TTEST2(*(p + offset), 8)) - return 0; - if (length < 8) - return 0; - memcpy(&cf, p + offset, 8); - offset += 8; - length -= 8; + memcpy(&cf, p + offset, 2); + offset += 2; + length -= 2; + if (cf.length != 6) { + offset += cf.length; + length -= cf.length; + break; + } + memcpy(&cf.count, p + offset, 6); + offset += 6; + length -= 6; /* * Present and not truncated. * @@ -439,29 +1477,20 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, } break; case E_TIM: - if (!TTEST2(*(p + offset), 2)) - return 0; - if (length < 2) - return 0; memcpy(&tim, p + offset, 2); offset += 2; length -= 2; - if (!TTEST2(*(p + offset), 3)) - return 0; - if (length < 3) + if (tim.length <= 3) { + offset += tim.length; + length -= tim.length; + break; + } + if (tim.length - 3 > (int)sizeof tim.bitmap) return 0; memcpy(&tim.count, p + offset, 3); offset += 3; length -= 3; - if (tim.length <= 3) - break; - if (tim.length - 3 > (int)sizeof tim.bitmap) - return 0; - if (!TTEST2(*(p + offset), tim.length - 3)) - return 0; - if (length < (u_int)(tim.length - 3)) - return 0; memcpy(tim.bitmap, p + (tim.length - 3), (tim.length - 3)); offset += tim.length - 3; @@ -480,19 +1509,11 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, break; default: #if 0 - printf("(1) unhandled element_id (%d) ", - *(p + offset)); + ND_PRINT((ndo, "(1) unhandled element_id (%d) ", + *(p + offset))); #endif - if (!TTEST2(*(p + offset), 2)) - return 0; - if (length < 2) - return 0; - if (!TTEST2(*(p + offset + 2), *(p + offset + 1))) - return 0; - if (length < (u_int)(*(p + offset + 1) + 2)) - return 0; - offset += *(p + offset + 1) + 2; - length -= *(p + offset + 1) + 2; + offset += 2 + elementlen; + length -= 2 + elementlen; break; } } @@ -506,7 +1527,8 @@ parse_elements(struct mgmt_body_t *pbody, const u_char *p, int offset, *********************************************************************************/ static int -handle_beacon(const u_char *p, u_int length) +handle_beacon(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -514,7 +1536,7 @@ handle_beacon(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + + if (!ND_TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + IEEE802_11_CAPINFO_LEN)) return 0; if (length < IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + @@ -530,19 +1552,20 @@ handle_beacon(const u_char *p, u_int length) offset += IEEE802_11_CAPINFO_LEN; length -= IEEE802_11_CAPINFO_LEN; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); PRINT_SSID(pbody); PRINT_RATES(pbody); - printf(" %s", - CAPABILITY_ESS(pbody.capability_info) ? "ESS" : "IBSS"); + ND_PRINT((ndo, " %s", + CAPABILITY_ESS(pbody.capability_info) ? "ESS" : "IBSS")); PRINT_DS_CHANNEL(pbody); return ret; } static int -handle_assoc_request(const u_char *p, u_int length) +handle_assoc_request(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -550,7 +1573,7 @@ handle_assoc_request(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN)) + if (!ND_TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN)) return 0; if (length < IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN) return 0; @@ -561,7 +1584,7 @@ handle_assoc_request(const u_char *p, u_int length) offset += IEEE802_11_LISTENINT_LEN; length -= IEEE802_11_LISTENINT_LEN; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); PRINT_SSID(pbody); PRINT_RATES(pbody); @@ -569,7 +1592,8 @@ handle_assoc_request(const u_char *p, u_int length) } static int -handle_assoc_response(const u_char *p, u_int length) +handle_assoc_response(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -577,7 +1601,7 @@ handle_assoc_response(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_STATUS_LEN + + if (!ND_TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_STATUS_LEN + IEEE802_11_AID_LEN)) return 0; if (length < IEEE802_11_CAPINFO_LEN + IEEE802_11_STATUS_LEN + @@ -593,19 +1617,20 @@ handle_assoc_response(const u_char *p, u_int length) offset += IEEE802_11_AID_LEN; length -= IEEE802_11_AID_LEN; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); - printf(" AID(%x) :%s: %s", ((u_int16_t)(pbody.aid << 2 )) >> 2 , + ND_PRINT((ndo, " AID(%x) :%s: %s", ((uint16_t)(pbody.aid << 2 )) >> 2 , CAPABILITY_PRIVACY(pbody.capability_info) ? " PRIVACY " : "", (pbody.status_code < NUM_STATUSES ? status_text[pbody.status_code] - : "n/a")); + : "n/a"))); return ret; } static int -handle_reassoc_request(const u_char *p, u_int length) +handle_reassoc_request(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -613,7 +1638,7 @@ handle_reassoc_request(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN + + if (!ND_TTEST2(*p, IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN + IEEE802_11_AP_LEN)) return 0; if (length < IEEE802_11_CAPINFO_LEN + IEEE802_11_LISTENINT_LEN + @@ -629,23 +1654,25 @@ handle_reassoc_request(const u_char *p, u_int length) offset += IEEE802_11_AP_LEN; length -= IEEE802_11_AP_LEN; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); PRINT_SSID(pbody); - printf(" AP : %s", etheraddr_string( pbody.ap )); + ND_PRINT((ndo, " AP : %s", etheraddr_string(ndo, pbody.ap ))); return ret; } static int -handle_reassoc_response(const u_char *p, u_int length) +handle_reassoc_response(netdissect_options *ndo, + const u_char *p, u_int length) { /* Same as a Association Reponse */ - return handle_assoc_response(p, length); + return handle_assoc_response(ndo, p, length); } static int -handle_probe_request(const u_char *p, u_int length) +handle_probe_request(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -653,7 +1680,7 @@ handle_probe_request(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); PRINT_SSID(pbody); PRINT_RATES(pbody); @@ -662,7 +1689,8 @@ handle_probe_request(const u_char *p, u_int length) } static int -handle_probe_response(const u_char *p, u_int length) +handle_probe_response(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -670,7 +1698,7 @@ handle_probe_response(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + + if (!ND_TTEST2(*p, IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + IEEE802_11_CAPINFO_LEN)) return 0; if (length < IEEE802_11_TSTAMP_LEN + IEEE802_11_BCNINT_LEN + @@ -686,7 +1714,7 @@ handle_probe_response(const u_char *p, u_int length) offset += IEEE802_11_CAPINFO_LEN; length -= IEEE802_11_CAPINFO_LEN; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); PRINT_SSID(pbody); PRINT_RATES(pbody); @@ -703,28 +1731,30 @@ handle_atim(void) } static int -handle_disassoc(const u_char *p, u_int length) +handle_disassoc(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_REASON_LEN)) + if (!ND_TTEST2(*p, IEEE802_11_REASON_LEN)) return 0; if (length < IEEE802_11_REASON_LEN) return 0; pbody.reason_code = EXTRACT_LE_16BITS(p); - printf(": %s", + ND_PRINT((ndo, ": %s", (pbody.reason_code < NUM_REASONS) ? reason_text[pbody.reason_code] - : "Reserved" ); + : "Reserved")); return 1; } static int -handle_auth(const u_char *p, u_int length) +handle_auth(netdissect_options *ndo, + const u_char *p, u_int length) { struct mgmt_body_t pbody; int offset = 0; @@ -732,7 +1762,7 @@ handle_auth(const u_char *p, u_int length) memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, 6)) + if (!ND_TTEST2(*p, 6)) return 0; if (length < 6) return 0; @@ -746,12 +1776,12 @@ handle_auth(const u_char *p, u_int length) offset += 2; length -= 2; - ret = parse_elements(&pbody, p, offset, length); + ret = parse_elements(ndo, &pbody, p, offset, length); if ((pbody.auth_alg == 1) && ((pbody.auth_trans_seq_num == 2) || (pbody.auth_trans_seq_num == 3))) { - printf(" (%s)-%x [Challenge Text] %s", + ND_PRINT((ndo, " (%s)-%x [Challenge Text] %s", (pbody.auth_alg < NUM_AUTH_ALGS) ? auth_alg_text[pbody.auth_alg] : "Reserved", @@ -759,10 +1789,10 @@ handle_auth(const u_char *p, u_int length) ((pbody.auth_trans_seq_num % 2) ? ((pbody.status_code < NUM_STATUSES) ? status_text[pbody.status_code] - : "n/a") : "")); + : "n/a") : ""))); return ret; } - printf(" (%s)-%x: %s", + ND_PRINT((ndo, " (%s)-%x: %s", (pbody.auth_alg < NUM_AUTH_ALGS) ? auth_alg_text[pbody.auth_alg] : "Reserved", @@ -771,97 +1801,125 @@ handle_auth(const u_char *p, u_int length) ? ((pbody.status_code < NUM_STATUSES) ? status_text[pbody.status_code] : "n/a") - : ""); + : "")); return ret; } static int -handle_deauth(const struct mgmt_header_t *pmh, const u_char *p, u_int length) +handle_deauth(netdissect_options *ndo, + const uint8_t *src, const u_char *p, u_int length) { struct mgmt_body_t pbody; - int offset = 0; const char *reason = NULL; memset(&pbody, 0, sizeof(pbody)); - if (!TTEST2(*p, IEEE802_11_REASON_LEN)) + if (!ND_TTEST2(*p, IEEE802_11_REASON_LEN)) return 0; if (length < IEEE802_11_REASON_LEN) return 0; pbody.reason_code = EXTRACT_LE_16BITS(p); - offset += IEEE802_11_REASON_LEN; - length -= IEEE802_11_REASON_LEN; reason = (pbody.reason_code < NUM_REASONS) ? reason_text[pbody.reason_code] : "Reserved"; - if (eflag) { - printf(": %s", reason); + if (ndo->ndo_eflag) { + ND_PRINT((ndo, ": %s", reason)); } else { - printf(" (%s): %s", etheraddr_string(pmh->sa), reason); + ND_PRINT((ndo, " (%s): %s", etheraddr_string(ndo, src), reason)); } return 1; } #define PRINT_HT_ACTION(v) (\ - (v) == 0 ? printf("TxChWidth") : \ - (v) == 1 ? printf("MIMOPwrSave") : \ - printf("Act#%d", (v)) \ + (v) == 0 ? ND_PRINT((ndo, "TxChWidth")) : \ + (v) == 1 ? ND_PRINT((ndo, "MIMOPwrSave")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ ) #define PRINT_BA_ACTION(v) (\ - (v) == 0 ? printf("ADDBA Request") : \ - (v) == 1 ? printf("ADDBA Response") : \ - (v) == 2 ? printf("DELBA") : \ - printf("Act#%d", (v)) \ + (v) == 0 ? ND_PRINT((ndo, "ADDBA Request")) : \ + (v) == 1 ? ND_PRINT((ndo, "ADDBA Response")) : \ + (v) == 2 ? ND_PRINT((ndo, "DELBA")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ ) #define PRINT_MESHLINK_ACTION(v) (\ - (v) == 0 ? printf("Request") : \ - (v) == 1 ? printf("Report") : \ - printf("Act#%d", (v)) \ + (v) == 0 ? ND_PRINT((ndo, "Request")) : \ + (v) == 1 ? ND_PRINT((ndo, "Report")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ ) #define PRINT_MESHPEERING_ACTION(v) (\ - (v) == 0 ? printf("Open") : \ - (v) == 1 ? printf("Confirm") : \ - (v) == 2 ? printf("Close") : \ - printf("Act#%d", (v)) \ + (v) == 0 ? ND_PRINT((ndo, "Open")) : \ + (v) == 1 ? ND_PRINT((ndo, "Confirm")) : \ + (v) == 2 ? ND_PRINT((ndo, "Close")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ ) #define PRINT_MESHPATH_ACTION(v) (\ - (v) == 0 ? printf("Request") : \ - (v) == 1 ? printf("Report") : \ - (v) == 2 ? printf("Error") : \ - (v) == 3 ? printf("RootAnnouncement") : \ - printf("Act#%d", (v)) \ + (v) == 0 ? ND_PRINT((ndo, "Request")) : \ + (v) == 1 ? ND_PRINT((ndo, "Report")) : \ + (v) == 2 ? ND_PRINT((ndo, "Error")) : \ + (v) == 3 ? ND_PRINT((ndo, "RootAnnouncement")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ +) + +#define PRINT_MESH_ACTION(v) (\ + (v) == 0 ? ND_PRINT((ndo, "MeshLink")) : \ + (v) == 1 ? ND_PRINT((ndo, "HWMP")) : \ + (v) == 2 ? ND_PRINT((ndo, "Gate Announcement")) : \ + (v) == 3 ? ND_PRINT((ndo, "Congestion Control")) : \ + (v) == 4 ? ND_PRINT((ndo, "MCCA Setup Request")) : \ + (v) == 5 ? ND_PRINT((ndo, "MCCA Setup Reply")) : \ + (v) == 6 ? ND_PRINT((ndo, "MCCA Advertisement Request")) : \ + (v) == 7 ? ND_PRINT((ndo, "MCCA Advertisement")) : \ + (v) == 8 ? ND_PRINT((ndo, "MCCA Teardown")) : \ + (v) == 9 ? ND_PRINT((ndo, "TBTT Adjustment Request")) : \ + (v) == 10 ? ND_PRINT((ndo, "TBTT Adjustment Response")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ +) +#define PRINT_MULTIHOP_ACTION(v) (\ + (v) == 0 ? ND_PRINT((ndo, "Proxy Update")) : \ + (v) == 1 ? ND_PRINT((ndo, "Proxy Update Confirmation")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ +) +#define PRINT_SELFPROT_ACTION(v) (\ + (v) == 1 ? ND_PRINT((ndo, "Peering Open")) : \ + (v) == 2 ? ND_PRINT((ndo, "Peering Confirm")) : \ + (v) == 3 ? ND_PRINT((ndo, "Peering Close")) : \ + (v) == 4 ? ND_PRINT((ndo, "Group Key Inform")) : \ + (v) == 5 ? ND_PRINT((ndo, "Group Key Acknowledge")) : \ + ND_PRINT((ndo, "Act#%d", (v))) \ ) static int -handle_action(const struct mgmt_header_t *pmh, const u_char *p, u_int length) +handle_action(netdissect_options *ndo, + const uint8_t *src, const u_char *p, u_int length) { - if (!TTEST2(*p, 2)) + if (!ND_TTEST2(*p, 2)) return 0; if (length < 2) return 0; - if (eflag) { - printf(": "); + if (ndo->ndo_eflag) { + ND_PRINT((ndo, ": ")); } else { - printf(" (%s): ", etheraddr_string(pmh->sa)); + ND_PRINT((ndo, " (%s): ", etheraddr_string(ndo, src))); } switch (p[0]) { - case 0: printf("Spectrum Management Act#%d", p[1]); break; - case 1: printf("QoS Act#%d", p[1]); break; - case 2: printf("DLS Act#%d", p[1]); break; - case 3: printf("BA "); PRINT_BA_ACTION(p[1]); break; - case 7: printf("HT "); PRINT_HT_ACTION(p[1]); break; - case 13: printf("MeshLMetric "); PRINT_MESHLINK_ACTION(p[1]); break; - case 15: printf("Interwork Act#%d", p[1]); break; - case 16: printf("Resource Act#%d", p[1]); break; - case 17: printf("Proxy Act#%d", p[1]); break; - case 30: printf("MeshPeering "); PRINT_MESHPEERING_ACTION(p[1]); break; - case 32: printf("MeshPath "); PRINT_MESHPATH_ACTION(p[1]); break; - case 127: printf("Vendor Act#%d", p[1]); break; + case 0: ND_PRINT((ndo, "Spectrum Management Act#%d", p[1])); break; + case 1: ND_PRINT((ndo, "QoS Act#%d", p[1])); break; + case 2: ND_PRINT((ndo, "DLS Act#%d", p[1])); break; + case 3: ND_PRINT((ndo, "BA ")); PRINT_BA_ACTION(p[1]); break; + case 7: ND_PRINT((ndo, "HT ")); PRINT_HT_ACTION(p[1]); break; + case 13: ND_PRINT((ndo, "MeshAction ")); PRINT_MESH_ACTION(p[1]); break; + case 14: + ND_PRINT((ndo, "MultiohopAction ")); + PRINT_MULTIHOP_ACTION(p[1]); break; + case 15: + ND_PRINT((ndo, "SelfprotectAction ")); + PRINT_SELFPROT_ACTION(p[1]); break; + case 127: ND_PRINT((ndo, "Vendor Act#%d", p[1])); break; default: - printf("Reserved(%d) Act#%d", p[0], p[1]); + ND_PRINT((ndo, "Reserved(%d) Act#%d", p[0], p[1])); break; } return 1; @@ -874,57 +1932,40 @@ handle_action(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, u_int length) +mgmt_body_print(netdissect_options *ndo, + uint16_t fc, const uint8_t *src, const u_char *p, u_int length) { + ND_PRINT((ndo, "%s", tok2str(st_str, "Unhandled Management subtype(%x)", FC_SUBTYPE(fc)))); + + /* There may be a problem w/ AP not having this bit set */ + if (FC_PROTECTED(fc)) + return wep_print(ndo, p); switch (FC_SUBTYPE(fc)) { case ST_ASSOC_REQUEST: - printf("Assoc Request"); - return handle_assoc_request(p, length); + return handle_assoc_request(ndo, p, length); case ST_ASSOC_RESPONSE: - printf("Assoc Response"); - return handle_assoc_response(p, length); + return handle_assoc_response(ndo, p, length); case ST_REASSOC_REQUEST: - printf("ReAssoc Request"); - return handle_reassoc_request(p, length); + return handle_reassoc_request(ndo, p, length); case ST_REASSOC_RESPONSE: - printf("ReAssoc Response"); - return handle_reassoc_response(p, length); + return handle_reassoc_response(ndo, p, length); case ST_PROBE_REQUEST: - printf("Probe Request"); - return handle_probe_request(p, length); + return handle_probe_request(ndo, p, length); case ST_PROBE_RESPONSE: - printf("Probe Response"); - return handle_probe_response(p, length); + return handle_probe_response(ndo, p, length); case ST_BEACON: - printf("Beacon"); - return handle_beacon(p, length); + return handle_beacon(ndo, p, length); case ST_ATIM: - printf("ATIM"); return handle_atim(); case ST_DISASSOC: - printf("Disassociation"); - return handle_disassoc(p, length); + return handle_disassoc(ndo, p, length); 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, length); + return handle_auth(ndo, p, length); case ST_DEAUTH: - printf("DeAuthentication"); - return handle_deauth(pmh, p, length); - break; + return handle_deauth(ndo, src, p, length); case ST_ACTION: - printf("Action"); - return handle_action(pmh, p, length); - break; + return handle_action(ndo, src, p, length); default: - printf("Unhandled Management subtype(%x)", - FC_SUBTYPE(fc)); return 1; } } @@ -935,89 +1976,76 @@ mgmt_body_print(u_int16_t fc, const struct mgmt_header_t *pmh, *********************************************************************************/ static int -ctrl_body_print(u_int16_t fc, const u_char *p) +ctrl_body_print(netdissect_options *ndo, + uint16_t fc, const u_char *p) { + ND_PRINT((ndo, "%s", tok2str(ctrl_str, "Unknown Ctrl Subtype", FC_SUBTYPE(fc)))); switch (FC_SUBTYPE(fc)) { case CTRL_CONTROL_WRAPPER: - printf("Control Wrapper"); /* XXX - requires special handling */ break; case CTRL_BAR: - printf("BAR"); - if (!TTEST2(*p, CTRL_BAR_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_BAR_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s TA:%s CTL(%x) SEQ(%u) ", - etheraddr_string(((const struct ctrl_bar_t *)p)->ra), - etheraddr_string(((const struct ctrl_bar_t *)p)->ta), - EXTRACT_LE_16BITS(&(((const struct ctrl_bar_t *)p)->ctl)), - EXTRACT_LE_16BITS(&(((const struct ctrl_bar_t *)p)->seq))); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s TA:%s CTL(%x) SEQ(%u) ", + etheraddr_string(ndo, ((const struct ctrl_bar_hdr_t *)p)->ra), + etheraddr_string(ndo, ((const struct ctrl_bar_hdr_t *)p)->ta), + EXTRACT_LE_16BITS(&(((const struct ctrl_bar_hdr_t *)p)->ctl)), + EXTRACT_LE_16BITS(&(((const struct ctrl_bar_hdr_t *)p)->seq)))); break; case CTRL_BA: - printf("BA"); - if (!TTEST2(*p, CTRL_BA_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_BA_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s ", - etheraddr_string(((const struct ctrl_ba_t *)p)->ra)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_ba_hdr_t *)p)->ra))); break; case CTRL_PS_POLL: - printf("Power Save-Poll"); - if (!TTEST2(*p, CTRL_PS_POLL_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_PS_POLL_HDRLEN)) return 0; - printf(" AID(%x)", - EXTRACT_LE_16BITS(&(((const struct ctrl_ps_poll_t *)p)->aid))); + ND_PRINT((ndo, " AID(%x)", + EXTRACT_LE_16BITS(&(((const struct ctrl_ps_poll_hdr_t *)p)->aid)))); break; case CTRL_RTS: - printf("Request-To-Send"); - if (!TTEST2(*p, CTRL_RTS_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_RTS_HDRLEN)) return 0; - if (!eflag) - printf(" TA:%s ", - etheraddr_string(((const struct ctrl_rts_t *)p)->ta)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " TA:%s ", + etheraddr_string(ndo, ((const struct ctrl_rts_hdr_t *)p)->ta))); break; case CTRL_CTS: - printf("Clear-To-Send"); - if (!TTEST2(*p, CTRL_CTS_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_CTS_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s ", - etheraddr_string(((const struct ctrl_cts_t *)p)->ra)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_cts_hdr_t *)p)->ra))); break; case CTRL_ACK: - printf("Acknowledgment"); - if (!TTEST2(*p, CTRL_ACK_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_ACK_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s ", - etheraddr_string(((const struct ctrl_ack_t *)p)->ra)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_ack_hdr_t *)p)->ra))); break; case CTRL_CF_END: - printf("CF-End"); - if (!TTEST2(*p, CTRL_END_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_END_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s ", - etheraddr_string(((const struct ctrl_end_t *)p)->ra)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_end_hdr_t *)p)->ra))); break; case CTRL_END_ACK: - printf("CF-End+CF-Ack"); - if (!TTEST2(*p, CTRL_END_ACK_HDRLEN)) + if (!ND_TTEST2(*p, CTRL_END_ACK_HDRLEN)) return 0; - if (!eflag) - printf(" RA:%s ", - etheraddr_string(((const struct ctrl_end_ack_t *)p)->ra)); + if (!ndo->ndo_eflag) + ND_PRINT((ndo, " RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_end_ack_hdr_t *)p)->ra))); break; - default: - printf("Unknown Ctrl Subtype"); } return 1; } -/* - * Print Header funcs - */ - /* * Data Frame - Address field contents * @@ -1028,27 +2056,73 @@ ctrl_body_print(u_int16_t fc, const u_char *p) * 1 | 1 | RA | TA | DA | SA */ +/* + * Function to get source and destination MAC addresses for a data frame. + */ +static void +get_data_src_dst_mac(uint16_t fc, const u_char *p, const uint8_t **srcp, + const uint8_t **dstp) +{ +#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)) { + *srcp = ADDR2; + *dstp = ADDR1; + } else if (!FC_TO_DS(fc) && FC_FROM_DS(fc)) { + *srcp = ADDR3; + *dstp = ADDR1; + } else if (FC_TO_DS(fc) && !FC_FROM_DS(fc)) { + *srcp = ADDR2; + *dstp = ADDR3; + } else if (FC_TO_DS(fc) && FC_FROM_DS(fc)) { + *srcp = ADDR4; + *dstp = ADDR3; + } + +#undef ADDR1 +#undef ADDR2 +#undef ADDR3 +#undef ADDR4 +} + static void -data_header_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, - const u_int8_t **dstp) +get_mgmt_src_dst_mac(const u_char *p, const uint8_t **srcp, const uint8_t **dstp) +{ + const struct mgmt_header_t *hp = (const struct mgmt_header_t *) p; + + if (srcp != NULL) + *srcp = hp->sa; + if (dstp != NULL) + *dstp = hp->da; +} + +/* + * Print Header funcs + */ + +static void +data_header_print(netdissect_options *ndo, uint16_t fc, const u_char *p) { u_int subtype = FC_SUBTYPE(fc); if (DATA_FRAME_IS_CF_ACK(subtype) || DATA_FRAME_IS_CF_POLL(subtype) || DATA_FRAME_IS_QOS(subtype)) { - printf("CF "); + ND_PRINT((ndo, "CF ")); if (DATA_FRAME_IS_CF_ACK(subtype)) { if (DATA_FRAME_IS_CF_POLL(subtype)) - printf("Ack/Poll"); + ND_PRINT((ndo, "Ack/Poll")); else - printf("Ack"); + ND_PRINT((ndo, "Ack")); } else { if (DATA_FRAME_IS_CF_POLL(subtype)) - printf("Poll"); + ND_PRINT((ndo, "Poll")); } if (DATA_FRAME_IS_QOS(subtype)) - printf("+QoS"); - printf(" "); + ND_PRINT((ndo, "+QoS")); + ND_PRINT((ndo, " ")); } #define ADDR1 (p + 4) @@ -1057,45 +2131,21 @@ data_header_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, #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)); + ND_PRINT((ndo, "DA:%s SA:%s BSSID:%s ", + etheraddr_string(ndo, ADDR1), etheraddr_string(ndo, ADDR2), + etheraddr_string(ndo, 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)); + ND_PRINT((ndo, "DA:%s BSSID:%s SA:%s ", + etheraddr_string(ndo, ADDR1), etheraddr_string(ndo, ADDR2), + etheraddr_string(ndo, 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)); + ND_PRINT((ndo, "BSSID:%s SA:%s DA:%s ", + etheraddr_string(ndo, ADDR1), etheraddr_string(ndo, ADDR2), + etheraddr_string(ndo, 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)); + ND_PRINT((ndo, "RA:%s TA:%s DA:%s SA:%s ", + etheraddr_string(ndo, ADDR1), etheraddr_string(ndo, ADDR2), + etheraddr_string(ndo, ADDR3), etheraddr_string(ndo, ADDR4))); } #undef ADDR1 @@ -1105,82 +2155,67 @@ data_header_print(u_int16_t fc, const u_char *p, const u_int8_t **srcp, } static void -mgmt_header_print(const u_char *p, const u_int8_t **srcp, - const u_int8_t **dstp) +mgmt_header_print(netdissect_options *ndo, const u_char *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)); + ND_PRINT((ndo, "BSSID:%s DA:%s SA:%s ", + etheraddr_string(ndo, (hp)->bssid), etheraddr_string(ndo, (hp)->da), + etheraddr_string(ndo, (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) +ctrl_header_print(netdissect_options *ndo, uint16_t fc, const u_char *p) { - if (srcp != NULL) - *srcp = NULL; - if (dstp != NULL) - *dstp = NULL; - if (!eflag) - return; - switch (FC_SUBTYPE(fc)) { case CTRL_BAR: - printf(" RA:%s TA:%s CTL(%x) SEQ(%u) ", - etheraddr_string(((const struct ctrl_bar_t *)p)->ra), - etheraddr_string(((const struct ctrl_bar_t *)p)->ta), - EXTRACT_LE_16BITS(&(((const struct ctrl_bar_t *)p)->ctl)), - EXTRACT_LE_16BITS(&(((const struct ctrl_bar_t *)p)->seq))); + ND_PRINT((ndo, " RA:%s TA:%s CTL(%x) SEQ(%u) ", + etheraddr_string(ndo, ((const struct ctrl_bar_hdr_t *)p)->ra), + etheraddr_string(ndo, ((const struct ctrl_bar_hdr_t *)p)->ta), + EXTRACT_LE_16BITS(&(((const struct ctrl_bar_hdr_t *)p)->ctl)), + EXTRACT_LE_16BITS(&(((const struct ctrl_bar_hdr_t *)p)->seq)))); break; case CTRL_BA: - printf("RA:%s ", - etheraddr_string(((const struct ctrl_ba_t *)p)->ra)); + ND_PRINT((ndo, "RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_ba_hdr_t *)p)->ra))); break; 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)); + ND_PRINT((ndo, "BSSID:%s TA:%s ", + etheraddr_string(ndo, ((const struct ctrl_ps_poll_hdr_t *)p)->bssid), + etheraddr_string(ndo, ((const struct ctrl_ps_poll_hdr_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)); + ND_PRINT((ndo, "RA:%s TA:%s ", + etheraddr_string(ndo, ((const struct ctrl_rts_hdr_t *)p)->ra), + etheraddr_string(ndo, ((const struct ctrl_rts_hdr_t *)p)->ta))); break; case CTRL_CTS: - printf("RA:%s ", - etheraddr_string(((const struct ctrl_cts_t *)p)->ra)); + ND_PRINT((ndo, "RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_cts_hdr_t *)p)->ra))); break; case CTRL_ACK: - printf("RA:%s ", - etheraddr_string(((const struct ctrl_ack_t *)p)->ra)); + ND_PRINT((ndo, "RA:%s ", + etheraddr_string(ndo, ((const struct ctrl_ack_hdr_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)); + ND_PRINT((ndo, "RA:%s BSSID:%s ", + etheraddr_string(ndo, ((const struct ctrl_end_hdr_t *)p)->ra), + etheraddr_string(ndo, ((const struct ctrl_end_hdr_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)); + ND_PRINT((ndo, "RA:%s BSSID:%s ", + etheraddr_string(ndo, ((const struct ctrl_end_ack_hdr_t *)p)->ra), + etheraddr_string(ndo, ((const struct ctrl_end_ack_hdr_t *)p)->bssid))); break; default: - printf("(H) Unknown Ctrl Subtype"); + /* We shouldn't get here - we should already have quit */ break; } } static int -extract_header_length(u_int16_t fc) +extract_header_length(netdissect_options *ndo, + uint16_t fc) { int len; @@ -1189,8 +2224,12 @@ extract_header_length(u_int16_t fc) return MGMT_HDRLEN; case T_CTRL: switch (FC_SUBTYPE(fc)) { + case CTRL_CONTROL_WRAPPER: + return CTRL_CONTROL_WRAPPER_HDRLEN; case CTRL_BAR: return CTRL_BAR_HDRLEN; + case CTRL_BA: + return CTRL_BA_HDRLEN; case CTRL_PS_POLL: return CTRL_PS_POLL_HDRLEN; case CTRL_RTS: @@ -1204,6 +2243,7 @@ extract_header_length(u_int16_t fc) case CTRL_END_ACK: return CTRL_END_ACK_HDRLEN; default: + ND_PRINT((ndo, "unknown 802.11 ctrl frame subtype (%d)", FC_SUBTYPE(fc))); return 0; } case T_DATA: @@ -1212,7 +2252,7 @@ extract_header_length(u_int16_t fc) len += 2; return len; default: - printf("unknown IEEE802.11 frame type (%d)", FC_TYPE(fc)); + ND_PRINT((ndo, "unknown 802.11 frame type (%d)", FC_TYPE(fc))); return 0; } } @@ -1224,63 +2264,58 @@ extract_mesh_header_length(const u_char *p) } /* - * 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. + * Print the 802.11 MAC header. */ static void -ieee_802_11_hdr_print(u_int16_t fc, const u_char *p, u_int hdrlen, - u_int meshdrlen, const u_int8_t **srcp, const u_int8_t **dstp) +ieee_802_11_hdr_print(netdissect_options *ndo, + uint16_t fc, const u_char *p, u_int hdrlen, + u_int meshdrlen) { - if (vflag) { + if (ndo->ndo_vflag) { if (FC_MORE_DATA(fc)) - printf("More Data "); + ND_PRINT((ndo, "More Data ")); if (FC_MORE_FLAG(fc)) - printf("More Fragments "); + ND_PRINT((ndo, "More Fragments ")); if (FC_POWER_MGMT(fc)) - printf("Pwr Mgmt "); + ND_PRINT((ndo, "Pwr Mgmt ")); if (FC_RETRY(fc)) - printf("Retry "); + ND_PRINT((ndo, "Retry ")); if (FC_ORDER(fc)) - printf("Strictly Ordered "); - if (FC_WEP(fc)) - printf("WEP Encrypted "); + ND_PRINT((ndo, "Strictly Ordered ")); + if (FC_PROTECTED(fc)) + ND_PRINT((ndo, "Protected ")); if (FC_TYPE(fc) != T_CTRL || FC_SUBTYPE(fc) != CTRL_PS_POLL) - printf("%dus ", + ND_PRINT((ndo, "%dus ", EXTRACT_LE_16BITS( - &((const struct mgmt_header_t *)p)->duration)); + &((const struct mgmt_header_t *)p)->duration))); } if (meshdrlen != 0) { const struct meshcntl_t *mc = (const struct meshcntl_t *)&p[hdrlen - meshdrlen]; int ae = mc->flags & 3; - printf("MeshData (AE %d TTL %u seq %u", ae, mc->ttl, - EXTRACT_LE_32BITS(mc->seq)); + ND_PRINT((ndo, "MeshData (AE %d TTL %u seq %u", ae, mc->ttl, + EXTRACT_LE_32BITS(mc->seq))); if (ae > 0) - printf(" A4:%s", etheraddr_string(mc->addr4)); + ND_PRINT((ndo, " A4:%s", etheraddr_string(ndo, mc->addr4))); if (ae > 1) - printf(" A5:%s", etheraddr_string(mc->addr5)); + ND_PRINT((ndo, " A5:%s", etheraddr_string(ndo, mc->addr5))); if (ae > 2) - printf(" A6:%s", etheraddr_string(mc->addr6)); - printf(") "); + ND_PRINT((ndo, " A6:%s", etheraddr_string(ndo, mc->addr6))); + ND_PRINT((ndo, ") ")); } switch (FC_TYPE(fc)) { case T_MGMT: - mgmt_header_print(p, srcp, dstp); + mgmt_header_print(ndo, p); break; case T_CTRL: - ctrl_header_print(fc, p, srcp, dstp); + ctrl_header_print(ndo, fc, p); break; case T_DATA: - data_header_print(fc, p, srcp, dstp); + data_header_print(ndo, fc, p); break; default: - printf("(header) unknown IEEE802.11 frame type (%d)", - FC_TYPE(fc)); - *srcp = NULL; - *dstp = NULL; break; } } @@ -1290,18 +2325,19 @@ ieee_802_11_hdr_print(u_int16_t fc, const u_char *p, u_int hdrlen, #endif static u_int -ieee802_11_print(const u_char *p, u_int length, u_int orig_caplen, int pad, - u_int fcslen) +ieee802_11_print(netdissect_options *ndo, + const u_char *p, u_int length, u_int orig_caplen, int pad, + u_int fcslen) { - u_int16_t fc; + uint16_t fc; u_int caplen, hdrlen, meshdrlen; - const u_int8_t *src, *dst; - u_short extracted_ethertype; + const uint8_t *src, *dst; + int llc_hdrlen; caplen = orig_caplen; /* Remove FCS, if present */ if (length < fcslen) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } length -= fcslen; @@ -1309,31 +2345,36 @@ ieee802_11_print(const u_char *p, u_int length, u_int orig_caplen, int pad, /* Amount of FCS in actual packet data, if any */ fcslen = caplen - length; caplen -= fcslen; - snapend -= fcslen; + ndo->ndo_snapend -= fcslen; } if (caplen < IEEE802_11_FC_LEN) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return orig_caplen; } fc = EXTRACT_LE_16BITS(p); - hdrlen = extract_header_length(fc); + hdrlen = extract_header_length(ndo, fc); + if (hdrlen == 0) { + /* Unknown frame type or control frame subtype; quit. */ + return (0); + } if (pad) hdrlen = roundup2(hdrlen, 4); - if (FC_TYPE(fc) == T_DATA && DATA_FRAME_IS_QOS(FC_SUBTYPE(fc))) { + if (ndo->ndo_Hflag && FC_TYPE(fc) == T_DATA && + DATA_FRAME_IS_QOS(FC_SUBTYPE(fc))) { meshdrlen = extract_mesh_header_length(p+hdrlen); hdrlen += meshdrlen; } else meshdrlen = 0; - if (caplen < hdrlen) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return hdrlen; } - ieee_802_11_hdr_print(fc, p, hdrlen, meshdrlen, &src, &dst); + if (ndo->ndo_eflag) + ieee_802_11_hdr_print(ndo, fc, p, hdrlen, meshdrlen); /* * Go past the 802.11 header. @@ -1344,15 +2385,15 @@ ieee802_11_print(const u_char *p, u_int length, u_int orig_caplen, int pad, switch (FC_TYPE(fc)) { case T_MGMT: - if (!mgmt_body_print(fc, - (const struct mgmt_header_t *)(p - hdrlen), p, length)) { - printf("[|802.11]"); + get_mgmt_src_dst_mac(p - hdrlen, &src, &dst); + if (!mgmt_body_print(ndo, fc, src, p, length)) { + ND_PRINT((ndo, "%s", tstr)); return hdrlen; } break; case T_CTRL: - if (!ctrl_body_print(fc, p - hdrlen)) { - printf("[|802.11]"); + if (!ctrl_body_print(ndo, fc, p - hdrlen)) { + ND_PRINT((ndo, "%s", tstr)); return hdrlen; } break; @@ -1360,30 +2401,29 @@ ieee802_11_print(const u_char *p, u_int length, u_int orig_caplen, int pad, if (DATA_FRAME_IS_NULL(FC_SUBTYPE(fc))) return hdrlen; /* no-data frame */ /* There may be a problem w/ AP not having this bit set */ - if (FC_WEP(fc)) { - if (!wep_print(p)) { - printf("[|802.11]"); + if (FC_PROTECTED(fc)) { + ND_PRINT((ndo, "Data")); + if (!wep_print(ndo, p)) { + ND_PRINT((ndo, "%s", tstr)); 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, hdrlen, - meshdrlen, NULL, NULL); - if (extracted_ethertype) - printf("(LLC %s) ", - etherproto_string( - htons(extracted_ethertype))); - if (!suppress_default_print) - default_print(p, caplen); + } else { + get_data_src_dst_mac(fc, p - hdrlen, &src, &dst); + llc_hdrlen = llc_print(ndo, p, length, caplen, dst, src); + if (llc_hdrlen < 0) { + /* + * Some kinds of LLC packet we cannot + * handle intelligently + */ + if (!ndo->ndo_suppress_default_print) + ND_DEFAULTPRINT(p, caplen); + llc_hdrlen = -llc_hdrlen; + } + hdrlen += llc_hdrlen; } break; default: - printf("unknown 802.11 frame type (%d)", FC_TYPE(fc)); + /* We shouldn't get here - we should already have quit */ break; } @@ -1397,9 +2437,10 @@ ieee802_11_print(const u_char *p, u_int length, u_int orig_caplen, int pad, * is the number of bytes actually captured. */ u_int -ieee802_11_if_print(const struct pcap_pkthdr *h, const u_char *p) +ieee802_11_if_print(netdissect_options *ndo, + const struct pcap_pkthdr *h, const u_char *p) { - return ieee802_11_print(p, h->len, h->caplen, 0, 0); + return ieee802_11_print(ndo, p, h->len, h->caplen, 0, 0); } #define IEEE80211_CHAN_FHSS \ @@ -1427,58 +2468,70 @@ ieee802_11_if_print(const struct pcap_pkthdr *h, const u_char *p) (IS_CHAN_PUREG(flags) || IS_CHAN_G(flags)) static void -print_chaninfo(int freq, int flags) +print_chaninfo(netdissect_options *ndo, + int freq, int flags) { - printf("%u MHz", freq); + ND_PRINT((ndo, "%u MHz", freq)); if (IS_CHAN_FHSS(flags)) - printf(" FHSS"); + ND_PRINT((ndo, " FHSS")); if (IS_CHAN_A(flags)) { if (flags & IEEE80211_CHAN_HALF) - printf(" 11a/10Mhz"); + ND_PRINT((ndo, " 11a/10Mhz")); else if (flags & IEEE80211_CHAN_QUARTER) - printf(" 11a/5Mhz"); + ND_PRINT((ndo, " 11a/5Mhz")); else - printf(" 11a"); + ND_PRINT((ndo, " 11a")); } if (IS_CHAN_ANYG(flags)) { if (flags & IEEE80211_CHAN_HALF) - printf(" 11g/10Mhz"); + ND_PRINT((ndo, " 11g/10Mhz")); else if (flags & IEEE80211_CHAN_QUARTER) - printf(" 11g/5Mhz"); + ND_PRINT((ndo, " 11g/5Mhz")); else - printf(" 11g"); + ND_PRINT((ndo, " 11g")); } else if (IS_CHAN_B(flags)) - printf(" 11b"); + ND_PRINT((ndo, " 11b")); if (flags & IEEE80211_CHAN_TURBO) - printf(" Turbo"); + ND_PRINT((ndo, " Turbo")); if (flags & IEEE80211_CHAN_HT20) - printf(" ht/20"); + ND_PRINT((ndo, " ht/20")); else if (flags & IEEE80211_CHAN_HT40D) - printf(" ht/40-"); + ND_PRINT((ndo, " ht/40-")); else if (flags & IEEE80211_CHAN_HT40U) - printf(" ht/40+"); - printf(" "); + ND_PRINT((ndo, " ht/40+")); + ND_PRINT((ndo, " ")); } static int -print_radiotap_field(struct cpack_state *s, u_int32_t bit, u_int8_t *flags) +print_radiotap_field(netdissect_options *ndo, + struct cpack_state *s, uint32_t bit, uint8_t *flags, + struct radiotap_state *state, uint32_t presentflags) { union { int8_t i8; - u_int8_t u8; + uint8_t u8; int16_t i16; - u_int16_t u16; - u_int32_t u32; - u_int64_t u64; + uint16_t u16; + uint32_t u32; + uint64_t u64; } u, u2, u3, u4; int rc; switch (bit) { case IEEE80211_RADIOTAP_FLAGS: rc = cpack_uint8(s, &u.u8); + if (rc != 0) + break; *flags = u.u8; break; case IEEE80211_RADIOTAP_RATE: + rc = cpack_uint8(s, &u.u8); + if (rc != 0) + break; + + /* Save state rate */ + state->rate = u.u8; + break; case IEEE80211_RADIOTAP_DB_ANTSIGNAL: case IEEE80211_RADIOTAP_DB_ANTNOISE: case IEEE80211_RADIOTAP_ANTENNA: @@ -1497,6 +2550,7 @@ print_radiotap_field(struct cpack_state *s, u_int32_t bit, u_int8_t *flags) case IEEE80211_RADIOTAP_FHSS: case IEEE80211_RADIOTAP_LOCK_QUALITY: case IEEE80211_RADIOTAP_TX_ATTENUATION: + case IEEE80211_RADIOTAP_RX_FLAGS: rc = cpack_uint16(s, &u.u16); break; case IEEE80211_RADIOTAP_DB_TX_ATTENUATION: @@ -1520,84 +2574,255 @@ print_radiotap_field(struct cpack_state *s, u_int32_t bit, u_int8_t *flags) break; rc = cpack_uint8(s, &u4.u8); break; + case IEEE80211_RADIOTAP_MCS: + rc = cpack_uint8(s, &u.u8); + if (rc != 0) + break; + rc = cpack_uint8(s, &u2.u8); + if (rc != 0) + break; + rc = cpack_uint8(s, &u3.u8); + break; + case IEEE80211_RADIOTAP_VENDOR_NAMESPACE: { + uint8_t vns[3]; + uint16_t length; + uint8_t subspace; + + if ((cpack_align_and_reserve(s, 2)) == NULL) { + rc = -1; + break; + } + + rc = cpack_uint8(s, &vns[0]); + if (rc != 0) + break; + rc = cpack_uint8(s, &vns[1]); + if (rc != 0) + break; + rc = cpack_uint8(s, &vns[2]); + if (rc != 0) + break; + rc = cpack_uint8(s, &subspace); + if (rc != 0) + break; + rc = cpack_uint16(s, &length); + if (rc != 0) + break; + + /* Skip up to length */ + s->c_next += length; + break; + } default: /* this bit indicates a field whose * size we do not know, so we cannot * proceed. Just print the bit number. */ - printf("[bit %u] ", bit); + ND_PRINT((ndo, "[bit %u] ", bit)); return -1; } if (rc != 0) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return rc; } + /* Preserve the state present flags */ + state->present = presentflags; + switch (bit) { case IEEE80211_RADIOTAP_CHANNEL: - print_chaninfo(u.u16, u2.u16); + /* + * If CHANNEL and XCHANNEL are both present, skip + * CHANNEL. + */ + if (presentflags & (1 << IEEE80211_RADIOTAP_XCHANNEL)) + break; + print_chaninfo(ndo, u.u16, u2.u16); break; case IEEE80211_RADIOTAP_FHSS: - printf("fhset %d fhpat %d ", u.u16 & 0xff, (u.u16 >> 8) & 0xff); + ND_PRINT((ndo, "fhset %d fhpat %d ", u.u16 & 0xff, (u.u16 >> 8) & 0xff)); break; case IEEE80211_RADIOTAP_RATE: - if (u.u8 & 0x80) - PRINT_HT_RATE("", u.u8, " Mb/s "); - else - PRINT_RATE("", u.u8, " Mb/s "); + /* + * XXX On FreeBSD rate & 0x80 means we have an MCS. On + * Linux and AirPcap it does not. (What about + * Mac OS X, NetBSD, OpenBSD, and DragonFly BSD?) + * + * This is an issue either for proprietary extensions + * to 11a or 11g, which do exist, or for 11n + * implementations that stuff a rate value into + * this field, which also appear to exist. + * + * We currently handle that by assuming that + * if the 0x80 bit is set *and* the remaining + * bits have a value between 0 and 15 it's + * an MCS value, otherwise it's a rate. If + * there are cases where systems that use + * "0x80 + MCS index" for MCS indices > 15, + * or stuff a rate value here between 64 and + * 71.5 Mb/s in here, we'll need a preference + * setting. Such rates do exist, e.g. 11n + * MCS 7 at 20 MHz with a long guard interval. + */ + if (u.u8 >= 0x80 && u.u8 <= 0x8f) { + /* + * XXX - we don't know the channel width + * or guard interval length, so we can't + * convert this to a data rate. + * + * If you want us to show a data rate, + * use the MCS field, not the Rate field; + * the MCS field includes not only the + * MCS index, it also includes bandwidth + * and guard interval information. + * + * XXX - can we get the channel width + * from XChannel and the guard interval + * information from Flags, at least on + * FreeBSD? + */ + ND_PRINT((ndo, "MCS %u ", u.u8 & 0x7f)); + } else + ND_PRINT((ndo, "%2.1f Mb/s ", .5 * u.u8)); break; case IEEE80211_RADIOTAP_DBM_ANTSIGNAL: - printf("%ddB signal ", u.i8); + ND_PRINT((ndo, "%ddB signal ", u.i8)); break; case IEEE80211_RADIOTAP_DBM_ANTNOISE: - printf("%ddB noise ", u.i8); + ND_PRINT((ndo, "%ddB noise ", u.i8)); break; case IEEE80211_RADIOTAP_DB_ANTSIGNAL: - printf("%ddB signal ", u.u8); + ND_PRINT((ndo, "%ddB signal ", u.u8)); break; case IEEE80211_RADIOTAP_DB_ANTNOISE: - printf("%ddB noise ", u.u8); + ND_PRINT((ndo, "%ddB noise ", u.u8)); break; case IEEE80211_RADIOTAP_LOCK_QUALITY: - printf("%u sq ", u.u16); + ND_PRINT((ndo, "%u sq ", u.u16)); break; case IEEE80211_RADIOTAP_TX_ATTENUATION: - printf("%d tx power ", -(int)u.u16); + ND_PRINT((ndo, "%d tx power ", -(int)u.u16)); break; case IEEE80211_RADIOTAP_DB_TX_ATTENUATION: - printf("%ddB tx power ", -(int)u.u8); + ND_PRINT((ndo, "%ddB tx power ", -(int)u.u8)); break; case IEEE80211_RADIOTAP_DBM_TX_POWER: - printf("%ddBm tx power ", u.i8); + ND_PRINT((ndo, "%ddBm tx power ", u.i8)); break; case IEEE80211_RADIOTAP_FLAGS: if (u.u8 & IEEE80211_RADIOTAP_F_CFP) - printf("cfp "); + ND_PRINT((ndo, "cfp ")); if (u.u8 & IEEE80211_RADIOTAP_F_SHORTPRE) - printf("short preamble "); + ND_PRINT((ndo, "short preamble ")); if (u.u8 & IEEE80211_RADIOTAP_F_WEP) - printf("wep "); + ND_PRINT((ndo, "wep ")); if (u.u8 & IEEE80211_RADIOTAP_F_FRAG) - printf("fragmented "); + ND_PRINT((ndo, "fragmented ")); if (u.u8 & IEEE80211_RADIOTAP_F_BADFCS) - printf("bad-fcs "); + ND_PRINT((ndo, "bad-fcs ")); break; case IEEE80211_RADIOTAP_ANTENNA: - printf("antenna %d ", u.u8); + ND_PRINT((ndo, "antenna %d ", u.u8)); break; case IEEE80211_RADIOTAP_TSFT: - printf("%" PRIu64 "us tsft ", u.u64); + ND_PRINT((ndo, "%" PRIu64 "us tsft ", u.u64)); + break; + case IEEE80211_RADIOTAP_RX_FLAGS: + /* Do nothing for now */ break; case IEEE80211_RADIOTAP_XCHANNEL: - print_chaninfo(u2.u16, u.u32); + print_chaninfo(ndo, u2.u16, u.u32); + break; + case IEEE80211_RADIOTAP_MCS: { + static const char *bandwidth[4] = { + "20 MHz", + "40 MHz", + "20 MHz (L)", + "20 MHz (U)" + }; + float htrate; + + if (u.u8 & IEEE80211_RADIOTAP_MCS_MCS_INDEX_KNOWN) { + /* + * We know the MCS index. + */ + if (u3.u8 <= MAX_MCS_INDEX) { + /* + * And it's in-range. + */ + if (u.u8 & (IEEE80211_RADIOTAP_MCS_BANDWIDTH_KNOWN|IEEE80211_RADIOTAP_MCS_GUARD_INTERVAL_KNOWN)) { + /* + * And we know both the bandwidth and + * the guard interval, so we can look + * up the rate. + */ + htrate = + ieee80211_float_htrates \ + [u3.u8] \ + [((u2.u8 & IEEE80211_RADIOTAP_MCS_BANDWIDTH_MASK) == IEEE80211_RADIOTAP_MCS_BANDWIDTH_40 ? 1 : 0)] \ + [((u2.u8 & IEEE80211_RADIOTAP_MCS_SHORT_GI) ? 1 : 0)]; + } else { + /* + * We don't know both the bandwidth + * and the guard interval, so we can + * only report the MCS index. + */ + htrate = 0.0; + } + } else { + /* + * The MCS value is out of range. + */ + htrate = 0.0; + } + if (htrate != 0.0) { + /* + * We have the rate. + * Print it. + */ + ND_PRINT((ndo, "%.1f Mb/s MCS %u ", htrate, u3.u8)); + } else { + /* + * We at least have the MCS index. + * Print it. + */ + ND_PRINT((ndo, "MCS %u ", u3.u8)); + } + } + if (u.u8 & IEEE80211_RADIOTAP_MCS_BANDWIDTH_KNOWN) { + ND_PRINT((ndo, "%s ", + bandwidth[u2.u8 & IEEE80211_RADIOTAP_MCS_BANDWIDTH_MASK])); + } + if (u.u8 & IEEE80211_RADIOTAP_MCS_GUARD_INTERVAL_KNOWN) { + ND_PRINT((ndo, "%s GI ", + (u2.u8 & IEEE80211_RADIOTAP_MCS_SHORT_GI) ? + "short" : "lon")); + } + if (u.u8 & IEEE80211_RADIOTAP_MCS_HT_FORMAT_KNOWN) { + ND_PRINT((ndo, "%s ", + (u2.u8 & IEEE80211_RADIOTAP_MCS_HT_GREENFIELD) ? + "greenfield" : "mixed")); + } + if (u.u8 & IEEE80211_RADIOTAP_MCS_FEC_TYPE_KNOWN) { + ND_PRINT((ndo, "%s FEC ", + (u2.u8 & IEEE80211_RADIOTAP_MCS_FEC_LDPC) ? + "LDPC" : "BCC")); + } + if (u.u8 & IEEE80211_RADIOTAP_MCS_STBC_KNOWN) { + ND_PRINT((ndo, "RX-STBC%u ", + (u2.u8 & IEEE80211_RADIOTAP_MCS_STBC_MASK) >> IEEE80211_RADIOTAP_MCS_STBC_SHIFT)); + } + break; + } } return 0; } static u_int -ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) +ieee802_11_radio_print(netdissect_options *ndo, + 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))) @@ -1610,18 +2835,19 @@ ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) struct cpack_state cpacker; struct ieee80211_radiotap_header *hdr; - u_int32_t present, next_present; - u_int32_t *presentp, *last_presentp; + uint32_t present, next_present; + uint32_t presentflags = 0; + uint32_t *presentp, *last_presentp; enum ieee80211_radiotap_type bit; int bit0; - const u_char *iter; u_int len; - u_int8_t flags; + uint8_t flags; int pad; u_int fcslen; + struct radiotap_state state; if (caplen < sizeof(*hdr)) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } @@ -1630,25 +2856,20 @@ ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) len = EXTRACT_LE_16BITS(&hdr->it_len); if (caplen < len) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } + cpack_init(&cpacker, (uint8_t *)hdr, len); /* align against header start */ + cpack_advance(&cpacker, sizeof(*hdr)); /* includes the 1st bitmap */ for (last_presentp = &hdr->it_present; IS_EXTENDED(last_presentp) && (u_char*)(last_presentp + 1) <= p + len; - last_presentp++); + last_presentp++) + cpack_advance(&cpacker, sizeof(hdr->it_present)); /* more bitmaps */ /* 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]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } @@ -1660,6 +2881,11 @@ ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) fcslen = 0; for (bit0 = 0, presentp = &hdr->it_present; presentp <= last_presentp; presentp++, bit0 += 32) { + presentflags = EXTRACT_LE_32BITS(presentp); + + /* Clear state. */ + memset(&state, 0, sizeof(state)); + for (present = EXTRACT_LE_32BITS(presentp); present; present = next_present) { /* clear the least significant bit that is set */ @@ -1669,17 +2895,17 @@ ieee802_11_radio_print(const u_char *p, u_int length, u_int caplen) bit = (enum ieee80211_radiotap_type) (bit0 + BITNO_32(present ^ next_present)); - if (print_radiotap_field(&cpacker, bit, &flags) != 0) + if (print_radiotap_field(ndo, &cpacker, bit, &flags, &state, presentflags) != 0) goto out; } } +out: if (flags & IEEE80211_RADIOTAP_F_DATAPAD) pad = 1; /* Atheros padding */ if (flags & IEEE80211_RADIOTAP_F_FCS) fcslen = 4; /* FCS at end of packet */ -out: - return len + ieee802_11_print(p + len, length - len, caplen - len, pad, + return len + ieee802_11_print(ndo, p + len, length - len, caplen - len, pad, fcslen); #undef BITNO_32 #undef BITNO_16 @@ -1690,12 +2916,13 @@ out: } static u_int -ieee802_11_avs_radio_print(const u_char *p, u_int length, u_int caplen) +ieee802_11_avs_radio_print(netdissect_options *ndo, + const u_char *p, u_int length, u_int caplen) { - u_int32_t caphdr_len; + uint32_t caphdr_len; if (caplen < 8) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } @@ -1706,16 +2933,16 @@ ieee802_11_avs_radio_print(const u_char *p, u_int length, u_int caplen) * to be large enough to include even the version * cookie or capture header length! */ - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } if (caplen < caphdr_len) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } - return caphdr_len + ieee802_11_print(p + caphdr_len, + return caphdr_len + ieee802_11_print(ndo, p + caphdr_len, length - caphdr_len, caplen - caphdr_len, 0, 0); } @@ -1739,28 +2966,29 @@ ieee802_11_avs_radio_print(const u_char *p, u_int length, u_int caplen) * indicate whether it's a Prism header or an AVS header). */ u_int -prism_if_print(const struct pcap_pkthdr *h, const u_char *p) +prism_if_print(netdissect_options *ndo, + const struct pcap_pkthdr *h, const u_char *p) { u_int caplen = h->caplen; u_int length = h->len; - u_int32_t msgcode; + uint32_t msgcode; if (caplen < 4) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } msgcode = EXTRACT_32BITS(p); if (msgcode == WLANCAP_MAGIC_COOKIE_V1 || msgcode == WLANCAP_MAGIC_COOKIE_V2) - return ieee802_11_avs_radio_print(p, length, caplen); + return ieee802_11_avs_radio_print(ndo, p, length, caplen); if (caplen < PRISM_HDR_LEN) { - printf("[|802.11]"); + ND_PRINT((ndo, "%s", tstr)); return caplen; } - return PRISM_HDR_LEN + ieee802_11_print(p + PRISM_HDR_LEN, + return PRISM_HDR_LEN + ieee802_11_print(ndo, p + PRISM_HDR_LEN, length - PRISM_HDR_LEN, caplen - PRISM_HDR_LEN, 0, 0); } @@ -1769,9 +2997,10 @@ prism_if_print(const struct pcap_pkthdr *h, const u_char *p) * header, containing information such as radio information. */ u_int -ieee802_11_radio_if_print(const struct pcap_pkthdr *h, const u_char *p) +ieee802_11_radio_if_print(netdissect_options *ndo, + const struct pcap_pkthdr *h, const u_char *p) { - return ieee802_11_radio_print(p, h->len, h->caplen); + return ieee802_11_radio_print(ndo, p, h->len, h->caplen); } /* @@ -1780,7 +3009,8 @@ ieee802_11_radio_if_print(const struct pcap_pkthdr *h, const u_char *p) * which we currently ignore. */ u_int -ieee802_11_radio_avs_if_print(const struct pcap_pkthdr *h, const u_char *p) +ieee802_11_radio_avs_if_print(netdissect_options *ndo, + const struct pcap_pkthdr *h, const u_char *p) { - return ieee802_11_avs_radio_print(p, h->len, h->caplen); + return ieee802_11_avs_radio_print(ndo, p, h->len, h->caplen); }