|
From 4e7af9f022996cb0a03b30f6af265b757807dfa2 Mon Sep 17 00:00:00 2001
|
|
From: Paul Fertser <fercerpav@gmail.com>
|
|
Date: Wed, 27 Jun 2012 17:44:55 +0400
|
|
Subject: [PATCH 1/3] wpscrack: big-endian fixes
|
|
|
|
This should fix access to the radiotap, 802.11, LLC/SNAP and WFA
|
|
headers' fields. Run-time tested on an ar71xx BE system.
|
|
|
|
Signed-off-by: Paul Fertser <fercerpav@gmail.com>
|
|
---
|
|
src/80211.c | 65 +++++++++++++++++++------------
|
|
src/builder.c | 23 +++++------
|
|
src/defs.h | 116 +++++++++++++++++++++++++++++++++++++++-----------------
|
|
src/exchange.c | 23 ++++++-----
|
|
src/wpsmon.c | 13 ++++--
|
|
5 files changed, 151 insertions(+), 89 deletions(-)
|
|
|
|
diff --git a/src/80211.c b/src/80211.c
|
|
index c2aff59..19f1e92 100644
|
|
--- a/src/80211.c
|
|
+++ b/src/80211.c
|
|
@@ -90,17 +90,19 @@ void read_ap_beacon()
|
|
if(header.len >= MIN_BEACON_SIZE)
|
|
{
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, header.len);
|
|
- frame_header = (struct dot11_frame_header *) (packet + rt_header->len);
|
|
-
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ frame_header = (struct dot11_frame_header *) (packet + rt_header_len);
|
|
+
|
|
if(is_target(frame_header))
|
|
{
|
|
- if(frame_header->fc.type == MANAGEMENT_FRAME && frame_header->fc.sub_type == SUBTYPE_BEACON)
|
|
+ if((frame_header->fc & __cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_BEACON))
|
|
{
|
|
- beacon = (struct beacon_management_frame *) (packet + rt_header->len + sizeof(struct dot11_frame_header));
|
|
+ beacon = (struct beacon_management_frame *) (packet + rt_header_len + sizeof(struct dot11_frame_header));
|
|
set_ap_capability(beacon->capability);
|
|
|
|
/* Obtain the SSID and channel number from the beacon packet */
|
|
- tag_offset = rt_header->len + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
+ tag_offset = rt_header_len + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
channel = parse_beacon_tags(packet, header.len);
|
|
|
|
/* If no channel was manually specified, switch to the AP's current channel */
|
|
@@ -135,29 +137,31 @@ int8_t signal_strength(const u_char *packet, size_t len)
|
|
{
|
|
header = (struct radio_tap_header *) packet;
|
|
|
|
- if((header->flags & SSI_FLAG) == SSI_FLAG)
|
|
+ uint32_t flags = __le32_to_cpu(header->flags);
|
|
+
|
|
+ if((flags & SSI_FLAG) == SSI_FLAG)
|
|
{
|
|
- if((header->flags & TSFT_FLAG) == TSFT_FLAG)
|
|
+ if((flags & TSFT_FLAG) == TSFT_FLAG)
|
|
{
|
|
offset += TSFT_SIZE;
|
|
}
|
|
|
|
- if((header->flags & FLAGS_FLAG) == FLAGS_FLAG)
|
|
+ if((flags & FLAGS_FLAG) == FLAGS_FLAG)
|
|
{
|
|
offset += FLAGS_SIZE;
|
|
}
|
|
|
|
- if((header->flags & RATE_FLAG) == RATE_FLAG)
|
|
+ if((flags & RATE_FLAG) == RATE_FLAG)
|
|
{
|
|
offset += RATE_SIZE;
|
|
}
|
|
|
|
- if((header->flags & CHANNEL_FLAG) == CHANNEL_FLAG)
|
|
+ if((flags & CHANNEL_FLAG) == CHANNEL_FLAG)
|
|
{
|
|
offset += CHANNEL_SIZE;
|
|
}
|
|
|
|
- if((header->flags & FHSS_FLAG) == FHSS_FLAG)
|
|
+ if((flags & FHSS_FLAG) == FHSS_FLAG)
|
|
{
|
|
offset += FHSS_FLAG;
|
|
}
|
|
@@ -196,11 +200,13 @@ int is_wps_locked()
|
|
if(header.len >= MIN_BEACON_SIZE)
|
|
{
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, header.len);
|
|
- frame_header = (struct dot11_frame_header *) (packet + rt_header->len);
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ frame_header = (struct dot11_frame_header *) (packet + rt_header_len);
|
|
|
|
if(memcmp(frame_header->addr3, get_bssid(), MAC_ADDR_LEN) == 0)
|
|
{
|
|
- if(frame_header->fc.type == MANAGEMENT_FRAME && frame_header->fc.sub_type == SUBTYPE_BEACON)
|
|
+ if((frame_header->fc & __cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_FTYPE_MGMT | IEEE80211_STYPE_BEACON))
|
|
{
|
|
if(parse_wps_parameters(packet, header.len, &wps))
|
|
{
|
|
@@ -411,24 +417,30 @@ int associate_recv_loop()
|
|
if(header.len >= MIN_AUTH_SIZE)
|
|
{
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, header.len);
|
|
- dot11_frame = (struct dot11_frame_header *) (packet + rt_header->len);
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ dot11_frame = (struct dot11_frame_header *) (packet + rt_header_len);
|
|
|
|
if((memcmp(dot11_frame->addr3, get_bssid(), MAC_ADDR_LEN) == 0) &&
|
|
(memcmp(dot11_frame->addr1, get_mac(), MAC_ADDR_LEN) == 0))
|
|
{
|
|
- if(dot11_frame->fc.type == MANAGEMENT_FRAME)
|
|
+ if((dot11_frame->fc & __cpu_to_le16(IEEE80211_FCTL_FTYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_FTYPE_MGMT))
|
|
{
|
|
- auth_frame = (struct authentication_management_frame *) (packet + sizeof(struct dot11_frame_header) + rt_header->len);
|
|
- assoc_frame = (struct association_response_management_frame *) (packet + sizeof(struct dot11_frame_header) + rt_header->len);
|
|
+ auth_frame = (struct authentication_management_frame *) (packet + sizeof(struct dot11_frame_header) + rt_header_len);
|
|
+ assoc_frame = (struct association_response_management_frame *) (packet + sizeof(struct dot11_frame_header) + rt_header_len);
|
|
|
|
/* Did we get an authentication packet with a successful status? */
|
|
- if((dot11_frame->fc.sub_type == SUBTYPE_AUTHENTICATION) && (auth_frame->status == AUTHENTICATION_SUCCESS))
|
|
+ if((dot11_frame->fc & __cpu_to_le16(IEEE80211_FCTL_STYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_STYPE_AUTH)
|
|
+ && (auth_frame->status == __cpu_to_le16(AUTHENTICATION_SUCCESS)))
|
|
{
|
|
ret_val = AUTH_OK;
|
|
break;
|
|
}
|
|
/* Did we get an association packet with a successful status? */
|
|
- else if((dot11_frame->fc.sub_type == SUBTYPE_ASSOCIATION) && (assoc_frame->status == ASSOCIATION_SUCCESS))
|
|
+ else if((dot11_frame->fc & __cpu_to_le16(IEEE80211_FCTL_STYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_STYPE_ASSOC_RESP)
|
|
+ && (assoc_frame->status == __cpu_to_le16(ASSOCIATION_SUCCESS)))
|
|
{
|
|
ret_val = ASSOCIATE_OK;
|
|
break;
|
|
@@ -455,13 +467,14 @@ enum encryption_type supported_encryption(const u_char *packet, size_t len)
|
|
if(len > MIN_BEACON_SIZE)
|
|
{
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, len);
|
|
- beacon = (struct beacon_management_frame *) (packet + rt_header->len + sizeof(struct dot11_frame_header));
|
|
- offset = tag_offset = rt_header->len + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ beacon = (struct beacon_management_frame *) (packet + rt_header_len + sizeof(struct dot11_frame_header));
|
|
+ offset = tag_offset = rt_header_len + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
|
|
tag_len = len - tag_offset;
|
|
tag_data = (const u_char *) (packet + tag_offset);
|
|
|
|
- if((beacon->capability & CAPABILITY_WEP) == CAPABILITY_WEP)
|
|
+ if((__le16_to_cpu(beacon->capability) & CAPABILITY_WEP) == CAPABILITY_WEP)
|
|
{
|
|
enc = WEP;
|
|
|
|
@@ -509,7 +522,7 @@ int parse_beacon_tags(const u_char *packet, size_t len)
|
|
struct radio_tap_header *rt_header = NULL;
|
|
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, len);
|
|
- tag_offset = rt_header->len + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
+ tag_offset = __le16_to_cpu(rt_header->len) + sizeof(struct dot11_frame_header) + sizeof(struct beacon_management_frame);
|
|
|
|
if(tag_offset < len)
|
|
{
|
|
@@ -548,7 +561,7 @@ int parse_beacon_tags(const u_char *packet, size_t len)
|
|
{
|
|
if(ie_len == 1)
|
|
{
|
|
- memcpy((int *) &channel, channel_data, ie_len);
|
|
+ channel = *(uint8_t*)channel_data;
|
|
}
|
|
free(channel_data);
|
|
}
|
|
@@ -603,13 +616,13 @@ int check_fcs(const u_char *packet, size_t len)
|
|
if(len > 4)
|
|
{
|
|
/* Get the packet's reported FCS (last 4 bytes of the packet) */
|
|
- memcpy((uint32_t *) &fcs, (packet + (len-4)), 4);
|
|
+ fcs = __le32_to_cpu(*(uint32_t*)(packet + (len-4)));
|
|
|
|
/* FCS is not calculated over the radio tap header */
|
|
if(has_rt_header())
|
|
{
|
|
rt_header = (struct radio_tap_header *) packet;
|
|
- offset += rt_header->len;
|
|
+ offset += __le16_to_cpu(rt_header->len);
|
|
}
|
|
|
|
if(len > offset)
|
|
diff --git a/src/builder.c b/src/builder.c
|
|
index 37f2de7..6bf89e7 100644
|
|
--- a/src/builder.c
|
|
+++ b/src/builder.c
|
|
@@ -44,9 +44,8 @@ const void *build_radio_tap_header(size_t *len)
|
|
memset((void *) buf, 0, sizeof(struct radio_tap_header));
|
|
rt_header = (struct radio_tap_header *) buf;
|
|
|
|
- rt_header->len = sizeof(struct radio_tap_header);
|
|
-
|
|
- *len = rt_header->len;
|
|
+ *len = sizeof(struct radio_tap_header);
|
|
+ rt_header->len = __cpu_to_le16(*len);
|
|
}
|
|
|
|
return buf;
|
|
@@ -67,9 +66,9 @@ const void *build_dot11_frame_header(uint16_t fc, size_t *len)
|
|
|
|
frag_seq += SEQ_MASK;
|
|
|
|
- header->duration = DEFAULT_DURATION;
|
|
- memcpy((void *) &header->fc, (void *) &fc, sizeof(struct frame_control));
|
|
- header->frag_seq = frag_seq;
|
|
+ header->duration = __cpu_to_le16(DEFAULT_DURATION);
|
|
+ header->fc = __cpu_to_le16(fc);
|
|
+ header->frag_seq = __cpu_to_le16(frag_seq);
|
|
|
|
memcpy((void *) header->addr1, get_bssid(), MAC_ADDR_LEN);
|
|
memcpy((void *) header->addr2, get_mac(), MAC_ADDR_LEN);
|
|
@@ -91,8 +90,8 @@ const void *build_authentication_management_frame(size_t *len)
|
|
memset((void *) buf, 0, *len);
|
|
frame = (struct authentication_management_frame *) buf;
|
|
|
|
- frame->algorithm = OPEN_SYSTEM;
|
|
- frame->sequence = 1;
|
|
+ frame->algorithm = __cpu_to_le16(OPEN_SYSTEM);
|
|
+ frame->sequence = __cpu_to_le16(1);
|
|
frame->status = 0;
|
|
}
|
|
|
|
@@ -111,8 +110,8 @@ const void *build_association_management_frame(size_t *len)
|
|
memset((void *) buf, 0, *len);
|
|
frame = (struct association_request_management_frame *) buf;
|
|
|
|
- frame->capability = get_ap_capability();
|
|
- frame->listen_interval = LISTEN_INTERVAL;
|
|
+ frame->capability = __cpu_to_le16(get_ap_capability());
|
|
+ frame->listen_interval = __cpu_to_le16(LISTEN_INTERVAL);
|
|
}
|
|
|
|
return buf;
|
|
@@ -133,7 +132,7 @@ const void *build_llc_header(size_t *len)
|
|
header->dsap = LLC_SNAP;
|
|
header->ssap = LLC_SNAP;
|
|
header->control_field = UNNUMBERED_FRAME;
|
|
- header->type = DOT1X_AUTHENTICATION;
|
|
+ header->type = __cpu_to_be16(DOT1X_AUTHENTICATION);
|
|
|
|
}
|
|
|
|
@@ -279,7 +278,7 @@ const void *build_wfa_header(uint8_t op_code, size_t *len)
|
|
header = (struct wfa_expanded_header *) buf;
|
|
|
|
memcpy(header->id, WFA_VENDOR_ID, sizeof(header->id));
|
|
- header->type = SIMPLE_CONFIG;
|
|
+ header->type = __cpu_to_be32(SIMPLE_CONFIG);
|
|
header->opcode = op_code;
|
|
}
|
|
|
|
diff --git a/src/defs.h b/src/defs.h
|
|
index b2f45ea..0c628e7 100644
|
|
--- a/src/defs.h
|
|
+++ b/src/defs.h
|
|
@@ -41,6 +41,7 @@
|
|
#include <string.h>
|
|
#include <time.h>
|
|
#include <pcap.h>
|
|
+#include <asm/byteorder.h>
|
|
|
|
#include "wps.h"
|
|
|
|
@@ -65,10 +66,10 @@
|
|
#define MANAGEMENT_FRAME 0x00
|
|
#define SUBTYPE_BEACON 0x08
|
|
|
|
-#define DOT1X_AUTHENTICATION 0x8E88
|
|
+#define DOT1X_AUTHENTICATION 0x888E
|
|
#define DOT1X_EAP_PACKET 0x00
|
|
|
|
-#define SIMPLE_CONFIG 0x01000000
|
|
+#define SIMPLE_CONFIG 0x00000001
|
|
|
|
#define P1_SIZE 10000
|
|
#define P2_SIZE 1000
|
|
@@ -282,66 +283,111 @@ enum wfa_elements
|
|
WEP_TRANSMIT_KEY = 0x10064
|
|
};
|
|
|
|
+#define IEEE80211_FCTL_VERS 0x0003
|
|
+#define IEEE80211_FCTL_FTYPE 0x000c
|
|
+#define IEEE80211_FCTL_STYPE 0x00f0
|
|
+#define IEEE80211_FCTL_TODS 0x0100
|
|
+#define IEEE80211_FCTL_FROMDS 0x0200
|
|
+#define IEEE80211_FCTL_MOREFRAGS 0x0400
|
|
+#define IEEE80211_FCTL_RETRY 0x0800
|
|
+#define IEEE80211_FCTL_PM 0x1000
|
|
+#define IEEE80211_FCTL_MOREDATA 0x2000
|
|
+#define IEEE80211_FCTL_PROTECTED 0x4000
|
|
+#define IEEE80211_FCTL_ORDER 0x8000
|
|
+
|
|
+#define IEEE80211_SCTL_FRAG 0x000F
|
|
+#define IEEE80211_SCTL_SEQ 0xFFF0
|
|
+
|
|
+#define IEEE80211_FTYPE_MGMT 0x0000
|
|
+#define IEEE80211_FTYPE_CTL 0x0004
|
|
+#define IEEE80211_FTYPE_DATA 0x0008
|
|
+
|
|
+/* management */
|
|
+#define IEEE80211_STYPE_ASSOC_REQ 0x0000
|
|
+#define IEEE80211_STYPE_ASSOC_RESP 0x0010
|
|
+#define IEEE80211_STYPE_REASSOC_REQ 0x0020
|
|
+#define IEEE80211_STYPE_REASSOC_RESP 0x0030
|
|
+#define IEEE80211_STYPE_PROBE_REQ 0x0040
|
|
+#define IEEE80211_STYPE_PROBE_RESP 0x0050
|
|
+#define IEEE80211_STYPE_BEACON 0x0080
|
|
+#define IEEE80211_STYPE_ATIM 0x0090
|
|
+#define IEEE80211_STYPE_DISASSOC 0x00A0
|
|
+#define IEEE80211_STYPE_AUTH 0x00B0
|
|
+#define IEEE80211_STYPE_DEAUTH 0x00C0
|
|
+#define IEEE80211_STYPE_ACTION 0x00D0
|
|
+
|
|
+/* control */
|
|
+#define IEEE80211_STYPE_BACK_REQ 0x0080
|
|
+#define IEEE80211_STYPE_BACK 0x0090
|
|
+#define IEEE80211_STYPE_PSPOLL 0x00A0
|
|
+#define IEEE80211_STYPE_RTS 0x00B0
|
|
+#define IEEE80211_STYPE_CTS 0x00C0
|
|
+#define IEEE80211_STYPE_ACK 0x00D0
|
|
+#define IEEE80211_STYPE_CFEND 0x00E0
|
|
+#define IEEE80211_STYPE_CFENDACK 0x00F0
|
|
+
|
|
+/* data */
|
|
+#define IEEE80211_STYPE_DATA 0x0000
|
|
+#define IEEE80211_STYPE_DATA_CFACK 0x0010
|
|
+#define IEEE80211_STYPE_DATA_CFPOLL 0x0020
|
|
+#define IEEE80211_STYPE_DATA_CFACKPOLL 0x0030
|
|
+#define IEEE80211_STYPE_NULLFUNC 0x0040
|
|
+#define IEEE80211_STYPE_CFACK 0x0050
|
|
+#define IEEE80211_STYPE_CFPOLL 0x0060
|
|
+#define IEEE80211_STYPE_CFACKPOLL 0x0070
|
|
+#define IEEE80211_STYPE_QOS_DATA 0x0080
|
|
+#define IEEE80211_STYPE_QOS_DATA_CFACK 0x0090
|
|
+#define IEEE80211_STYPE_QOS_DATA_CFPOLL 0x00A0
|
|
+#define IEEE80211_STYPE_QOS_DATA_CFACKPOLL 0x00B0
|
|
+#define IEEE80211_STYPE_QOS_NULLFUNC 0x00C0
|
|
+#define IEEE80211_STYPE_QOS_CFACK 0x00D0
|
|
+#define IEEE80211_STYPE_QOS_CFPOLL 0x00E0
|
|
+#define IEEE80211_STYPE_QOS_CFACKPOLL 0x00F0
|
|
+
|
|
#pragma pack(1)
|
|
struct radio_tap_header
|
|
{
|
|
uint8_t revision;
|
|
uint8_t pad;
|
|
- uint16_t len;
|
|
- uint32_t flags;
|
|
-};
|
|
-
|
|
-struct frame_control
|
|
-{
|
|
- unsigned version : 2;
|
|
- unsigned type : 2;
|
|
- unsigned sub_type : 4;
|
|
-
|
|
- unsigned to_ds : 1;
|
|
- unsigned from_ds : 1;
|
|
- unsigned more_frag : 1;
|
|
- unsigned retry : 1;
|
|
- unsigned pwr_mgt : 1;
|
|
- unsigned more_data : 1;
|
|
- unsigned protected_frame : 1;
|
|
- unsigned order : 1;
|
|
+ __le16 len;
|
|
+ __le32 flags;
|
|
};
|
|
|
|
struct dot11_frame_header
|
|
{
|
|
- struct frame_control fc;
|
|
- uint16_t duration;
|
|
+ __le16 fc;
|
|
+ __le16 duration;
|
|
unsigned char addr1[MAC_ADDR_LEN];
|
|
unsigned char addr2[MAC_ADDR_LEN];
|
|
unsigned char addr3[MAC_ADDR_LEN];
|
|
- uint16_t frag_seq;
|
|
+ __le16 frag_seq;
|
|
};
|
|
|
|
struct authentication_management_frame
|
|
{
|
|
- uint16_t algorithm;
|
|
- uint16_t sequence;
|
|
- uint16_t status;
|
|
+ __le16 algorithm;
|
|
+ __le16 sequence;
|
|
+ __le16 status;
|
|
};
|
|
|
|
struct association_request_management_frame
|
|
{
|
|
- uint16_t capability;
|
|
- uint16_t listen_interval;
|
|
+ __le16 capability;
|
|
+ __le16 listen_interval;
|
|
};
|
|
|
|
struct association_response_management_frame
|
|
{
|
|
- uint16_t capability;
|
|
- uint16_t status;
|
|
- uint16_t id;
|
|
+ __le16 capability;
|
|
+ __le16 status;
|
|
+ __le16 id;
|
|
};
|
|
|
|
struct beacon_management_frame
|
|
{
|
|
unsigned char timestamp[TIMESTAMP_LEN];
|
|
- uint16_t beacon_interval;
|
|
- uint16_t capability;
|
|
+ __le16 beacon_interval;
|
|
+ __le16 capability;
|
|
};
|
|
|
|
struct llc_header
|
|
@@ -350,7 +396,7 @@ struct llc_header
|
|
uint8_t ssap;
|
|
uint8_t control_field;
|
|
unsigned char org_code[3];
|
|
- uint16_t type;
|
|
+ __be16 type;
|
|
};
|
|
|
|
struct dot1X_header
|
|
@@ -371,7 +417,7 @@ struct eap_header
|
|
struct wfa_expanded_header
|
|
{
|
|
unsigned char id[3];
|
|
- uint32_t type;
|
|
+ __be32 type;
|
|
uint8_t opcode;
|
|
uint8_t flags;
|
|
};
|
|
diff --git a/src/exchange.c b/src/exchange.c
|
|
index 23c87e9..4f9a82b 100644
|
|
--- a/src/exchange.c
|
|
+++ b/src/exchange.c
|
|
@@ -306,26 +306,27 @@ enum wps_type process_packet(const u_char *packet, struct pcap_pkthdr *header)
|
|
|
|
/* Cast the radio tap and 802.11 frame headers and parse out the Frame Control field */
|
|
rt_header = (struct radio_tap_header *) packet;
|
|
- frame_header = (struct dot11_frame_header *) (packet+rt_header->len);
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ frame_header = (struct dot11_frame_header *) (packet+rt_header_len);
|
|
|
|
/* Does the BSSID/source address match our target BSSID? */
|
|
if(memcmp(frame_header->addr3, get_bssid(), MAC_ADDR_LEN) == 0)
|
|
{
|
|
/* Is this a data packet sent to our MAC address? */
|
|
- if(frame_header->fc.type == DATA_FRAME &&
|
|
- frame_header->fc.sub_type == SUBTYPE_DATA &&
|
|
- (memcmp(frame_header->addr1, get_mac(), MAC_ADDR_LEN) == 0))
|
|
+ if (((frame_header->fc & __cpu_to_le16(IEEE80211_FCTL_FTYPE | IEEE80211_FCTL_STYPE)) ==
|
|
+ __cpu_to_le16(IEEE80211_FTYPE_DATA | IEEE80211_STYPE_DATA)) &&
|
|
+ (memcmp(frame_header->addr1, get_mac(), MAC_ADDR_LEN) == 0))
|
|
{
|
|
llc = (struct llc_header *) (packet +
|
|
- rt_header->len +
|
|
+ rt_header_len +
|
|
sizeof(struct dot11_frame_header)
|
|
);
|
|
|
|
/* All packets in our exchanges will be 802.1x */
|
|
- if(llc->type == DOT1X_AUTHENTICATION)
|
|
+ if(llc->type == __cpu_to_be16(DOT1X_AUTHENTICATION))
|
|
{
|
|
dot1x = (struct dot1X_header *) (packet +
|
|
- rt_header->len +
|
|
+ rt_header_len +
|
|
sizeof(struct dot11_frame_header) +
|
|
sizeof(struct llc_header)
|
|
);
|
|
@@ -334,7 +335,7 @@ enum wps_type process_packet(const u_char *packet, struct pcap_pkthdr *header)
|
|
if(dot1x->type == DOT1X_EAP_PACKET && (header->len >= EAP_PACKET_SIZE))
|
|
{
|
|
eap = (struct eap_header *) (packet +
|
|
- rt_header->len +
|
|
+ rt_header_len +
|
|
sizeof(struct dot11_frame_header) +
|
|
sizeof(struct llc_header) +
|
|
sizeof(struct dot1X_header)
|
|
@@ -366,7 +367,7 @@ enum wps_type process_packet(const u_char *packet, struct pcap_pkthdr *header)
|
|
else if((eap->type == EAP_EXPANDED) && (header->len > WFA_PACKET_SIZE))
|
|
{
|
|
wfa = (struct wfa_expanded_header *) (packet +
|
|
- rt_header->len +
|
|
+ rt_header_len +
|
|
sizeof(struct dot11_frame_header) +
|
|
sizeof(struct llc_header) +
|
|
sizeof(struct dot1X_header) +
|
|
@@ -374,14 +375,14 @@ enum wps_type process_packet(const u_char *packet, struct pcap_pkthdr *header)
|
|
);
|
|
|
|
/* Verify that this is a WPS message */
|
|
- if(wfa->type == SIMPLE_CONFIG)
|
|
+ if(wfa->type == __cpu_to_be32(SIMPLE_CONFIG))
|
|
{
|
|
wps_msg_len = (size_t) ntohs(eap->len) -
|
|
sizeof(struct eap_header) -
|
|
sizeof(struct wfa_expanded_header);
|
|
|
|
wps_msg = (const void *) (packet +
|
|
- rt_header->len +
|
|
+ rt_header_len +
|
|
sizeof(struct dot11_frame_header) +
|
|
sizeof(struct llc_header) +
|
|
sizeof(struct dot1X_header) +
|
|
diff --git a/src/wpsmon.c b/src/wpsmon.c
|
|
index d976924..22a394f 100644
|
|
--- a/src/wpsmon.c
|
|
+++ b/src/wpsmon.c
|
|
@@ -295,7 +295,8 @@ void parse_wps_settings(const u_char *packet, struct pcap_pkthdr *header, char *
|
|
}
|
|
|
|
rt_header = (struct radio_tap_header *) radio_header(packet, header->len);
|
|
- frame_header = (struct dot11_frame_header *) (packet + rt_header->len);
|
|
+ size_t rt_header_len = __le16_to_cpu(rt_header->len);
|
|
+ frame_header = (struct dot11_frame_header *) (packet + rt_header_len);
|
|
|
|
/* If a specific BSSID was specified, only parse packets from that BSSID */
|
|
if(!is_target(frame_header))
|
|
@@ -323,15 +324,17 @@ void parse_wps_settings(const u_char *packet, struct pcap_pkthdr *header, char *
|
|
channel_changed = 1;
|
|
}
|
|
|
|
- if(frame_header->fc.sub_type == PROBE_RESPONSE ||
|
|
- frame_header->fc.sub_type == SUBTYPE_BEACON)
|
|
+ unsigned fsub_type = frame_header->fc & __cpu_to_le16(IEEE80211_FCTL_STYPE);
|
|
+
|
|
+ if(fsub_type == __cpu_to_le16(IEEE80211_STYPE_PROBE_RESP) ||
|
|
+ fsub_type == __cpu_to_le16(IEEE80211_STYPE_BEACON))
|
|
{
|
|
wps_parsed = parse_wps_parameters(packet, header->len, wps);
|
|
}
|
|
|
|
if(!is_done(bssid) && (get_channel() == channel || source == PCAP_FILE))
|
|
{
|
|
- if(frame_header->fc.sub_type == SUBTYPE_BEACON &&
|
|
+ if(fsub_type == __cpu_to_le16(IEEE80211_STYPE_BEACON) &&
|
|
mode == SCAN &&
|
|
!passive &&
|
|
should_probe(bssid))
|
|
@@ -369,7 +372,7 @@ void parse_wps_settings(const u_char *packet, struct pcap_pkthdr *header, char *
|
|
* If there was no WPS information, then the AP does not support WPS and we should ignore it from here on.
|
|
* If this was a probe response, then we've gotten all WPS info we can get from this AP and should ignore it from here on.
|
|
*/
|
|
- if(!wps_parsed || frame_header->fc.sub_type == PROBE_RESPONSE)
|
|
+ if(!wps_parsed || fsub_type == __cpu_to_le16(IEEE80211_STYPE_PROBE_RESP))
|
|
{
|
|
mark_ap_complete(bssid);
|
|
}
|
|
--
|
|
1.7.7
|
|
|