302 lines
8.5 KiB
C
302 lines
8.5 KiB
C
/*
|
|
*
|
|
* Wireless daemon for Linux
|
|
*
|
|
* Copyright (C) 2014 Intel Corporation. All rights reserved.
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include <stdbool.h>
|
|
#include <asm/byteorder.h>
|
|
#include <linux/types.h>
|
|
|
|
/* Std 802.11, Section 8.2.3 */
|
|
#define IEEE80211_MAX_DATA_LEN 2304
|
|
|
|
/* 802.11, Table 8-1 "Valid type and subtype combinations" */
|
|
enum mpdu_type {
|
|
MPDU_TYPE_MANAGEMENT = 0,
|
|
};
|
|
|
|
/* 802.11, Table 8-1 "Valid type and subtype combinations" */
|
|
enum mpdu_management_subtype {
|
|
MPDU_MANAGEMENT_SUBTYPE_ASSOCIATION_REQUEST = 0x0,
|
|
MPDU_MANAGEMENT_SUBTYPE_ASSOCIATION_RESPONSE = 0x1,
|
|
MPDU_MANAGEMENT_SUBTYPE_REASSOCIATION_REQUEST = 0x2,
|
|
MPDU_MANAGEMENT_SUBTYPE_REASSOCIATION_RESPONSE = 0x3,
|
|
MPDU_MANAGEMENT_SUBTYPE_PROBE_REQUEST = 0x4,
|
|
MPDU_MANAGEMENT_SUBTYPE_PROBE_RESPONSE = 0x5,
|
|
MPDU_MANAGEMENT_SUBTYPE_TIMING_ADVERTISEMENT = 0x6,
|
|
MPDU_MANAGEMENT_SUBTYPE_BEACON = 0x8,
|
|
MPDU_MANAGEMENT_SUBTYPE_ATIM = 0x9,
|
|
MPDU_MANAGEMENT_SUBTYPE_DISASSOCIATION = 0xA,
|
|
MPDU_MANAGEMENT_SUBTYPE_AUTHENTICATION = 0xB,
|
|
MPDU_MANAGEMENT_SUBTYPE_DEAUTHENTICATION = 0xC,
|
|
};
|
|
|
|
/* 802.11, Section 8.4.1.1 Authentication Algorithm Number field */
|
|
enum mmpdu_authentication_algorithm_number {
|
|
MMPDU_AUTH_ALGO_OPEN_SYSTEM = 0,
|
|
MMPDU_AUTH_ALGO_SHARED_KEY,
|
|
};
|
|
|
|
/*
|
|
* 802.11-2012, Section 8.4.1.7:
|
|
*/
|
|
enum mmpdu_reason_code {
|
|
MMPDU_REASON_CODE_UNSPECIFIED = 1,
|
|
MMPDU_REASON_CODE_PREV_AUTH_NOT_VALID = 2,
|
|
MMPDU_REASON_CODE_DEAUTH_LEAVING = 3,
|
|
MMPDU_REASON_CODE_DISASSOC_DUE_TO_INACTIVITY = 4,
|
|
MMPDU_REASON_CODE_DISASSOC_AP_BUSY = 5,
|
|
MMPDU_REASON_CODE_CLASS2_FRAME_FROM_NONAUTH_STA = 6,
|
|
MMPDU_REASON_CODE_CLASS3_FRAME_FROM_NONASSOC_STA = 7,
|
|
MMPDU_REASON_CODE_DISASSOC_STA_HAS_LEFT = 8,
|
|
MMPDU_REASON_CODE_STA_REQ_ASSOC_WITHOUT_AUTH = 9,
|
|
/* 802.11h */
|
|
MMPDU_REASON_CODE_DISASSOC_BAD_POWER = 10,
|
|
MMPDU_REASON_CODE_DISASSOC_BAD_SUPP_CHAN = 11,
|
|
/* 802.11i */
|
|
MMPDU_REASON_CODE_INVALID_IE = 13,
|
|
MMPDU_REASON_CODE_MIC_FAILURE = 14,
|
|
MMPDU_REASON_CODE_4WAY_HANDSHAKE_TIMEOUT = 15,
|
|
MMPDU_REASON_CODE_GROUP_KEY_HANDSHAKE_TIMEOUT = 16,
|
|
MMPDU_REASON_CODE_IE_DIFFERENT = 17,
|
|
MMPDU_REASON_CODE_INVALID_GROUP_CIPHER = 18,
|
|
MMPDU_REASON_CODE_INVALID_PAIRWISE_CIPHER = 19,
|
|
MMPDU_REASON_CODE_INVALID_AKMP = 20,
|
|
MMPDU_REASON_CODE_UNSUPP_RSN_VERSION = 21,
|
|
MMPDU_REASON_CODE_INVALID_RSN_IE_CAP = 22,
|
|
MMPDU_REASON_CODE_IEEE8021X_FAILED = 23,
|
|
MMPDU_REASON_CODE_CIPHER_SUITE_REJECTED = 24,
|
|
/* TDLS (802.11z) */
|
|
MMPDU_REASON_CODE_TDLS_TEARDOWN_UNREACHABLE = 25,
|
|
MMPDU_REASON_CODE_TDLS_TEARDOWN_UNSPECIFIED = 26,
|
|
/* 802.11e */
|
|
MMPDU_REASON_CODE_DISASSOC_UNSPECIFIED_QOS = 32,
|
|
MMPDU_REASON_CODE_DISASSOC_QAP_NO_BANDWIDTH = 33,
|
|
MMPDU_REASON_CODE_DISASSOC_LOW_ACK = 34,
|
|
MMPDU_REASON_CODE_DISASSOC_QAP_EXCEED_TXOP = 35,
|
|
MMPDU_REASON_CODE_QSTA_LEAVE_QBSS = 36,
|
|
MMPDU_REASON_CODE_QSTA_NOT_USE = 37,
|
|
MMPDU_REASON_CODE_QSTA_REQUIRE_SETUP = 38,
|
|
MMPDU_REASON_CODE_QSTA_TIMEOUT = 39,
|
|
MMPDU_REASON_CODE_QSTA_CIPHER_NOT_SUPP = 45,
|
|
/* 802.11s */
|
|
MMPDU_REASON_CODE_MESH_PEER_CANCELED = 52,
|
|
MMPDU_REASON_CODE_MESH_MAX_PEERS = 53,
|
|
MMPDU_REASON_CODE_MESH_CONFIG = 54,
|
|
MMPDU_REASON_CODE_MESH_CLOSE = 55,
|
|
MMPDU_REASON_CODE_MESH_MAX_RETRIES = 56,
|
|
MMPDU_REASON_CODE_MESH_CONFIRM_TIMEOUT = 57,
|
|
MMPDU_REASON_CODE_MESH_INVALID_GTK = 58,
|
|
MMPDU_REASON_CODE_MESH_INCONSISTENT_PARAM = 59,
|
|
MMPDU_REASON_CODE_MESH_INVALID_SECURITY = 60,
|
|
MMPDU_REASON_CODE_MESH_PATH_ERROR = 61,
|
|
MMPDU_REASON_CODE_MESH_PATH_NOFORWARD = 62,
|
|
MMPDU_REASON_CODE_MESH_PATH_DEST_UNREACHABLE = 63,
|
|
MMPDU_REASON_CODE_MAC_EXISTS_IN_MBSS = 64,
|
|
MMPDU_REASON_CODE_MESH_CHAN_REGULATORY = 65,
|
|
MMPDU_REASON_CODE_MESH_CHAN = 66,
|
|
};
|
|
|
|
/* 802.11, Section 8.2.4.1.1, Figure 8-2 */
|
|
struct mpdu_fc {
|
|
#if defined(__LITTLE_ENDIAN_BITFIELD)
|
|
uint8_t protocol_version:2;
|
|
uint8_t type:2;
|
|
uint8_t subtype:4;
|
|
bool to_ds:1;
|
|
bool from_ds:1;
|
|
bool more_fragments:1;
|
|
bool retry:1;
|
|
bool power_mgmt:1;
|
|
bool more_data:1;
|
|
bool protected_frame:1;
|
|
bool order:1;
|
|
#elif defined (__BIG_ENDIAN_BITFIELD)
|
|
uint8_t subtype:4;
|
|
uint8_t type:2;
|
|
uint8_t protocol_version:2;
|
|
bool order:1;
|
|
bool protected_frame:1;
|
|
bool more_data:1;
|
|
bool power_mgmt:1;
|
|
bool retry:1;
|
|
bool more_fragments:1;
|
|
bool from_ds:1;
|
|
bool to_ds:1;
|
|
#else
|
|
#error "Please fix <asm/byteorder.h>"
|
|
#endif
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.1 */
|
|
struct mmpdu_header {
|
|
struct mpdu_fc fc;
|
|
__le16 duration;
|
|
unsigned char address_1[6];
|
|
unsigned char address_2[6];
|
|
unsigned char address_3[6];
|
|
#if defined(__LITTLE_ENDIAN_BITFIELD)
|
|
uint8_t fragment_number:4;
|
|
uint8_t sequence_number_low:4;
|
|
#elif defined (__BIG_ENDIAN_BITFIELD)
|
|
uint8_t sequence_number_low:4;
|
|
uint8_t fragment_number:4;
|
|
#else
|
|
#error "Please fix <asm/byteorder.h>"
|
|
#endif
|
|
uint8_t sequence_number_high;
|
|
__le32 ht_control; /* ToDo? */
|
|
} __attribute__ ((packed));
|
|
|
|
#define MPDU_SEQUENCE_NUMBER(v) \
|
|
(((v).sequence_number_high << 4) + ((v).sequence_number_low))
|
|
|
|
/* 802.11, Section 8.4.1.4 */
|
|
struct mmpdu_field_capability {
|
|
#if defined(__LITTLE_ENDIAN_BITFIELD)
|
|
bool ess:1;
|
|
bool ibss:1;
|
|
bool cf_pollable:1;
|
|
bool cf_poll_req:1;
|
|
bool privacy:1;
|
|
bool preamble:1;
|
|
bool pbcc:1;
|
|
bool chanl_agility:1;
|
|
bool spectrum_mgmt:1;
|
|
bool qos:1;
|
|
bool short_time:1;
|
|
bool apsd:1;
|
|
bool radio_mesure:1;
|
|
bool dsss_ofdm:1;
|
|
bool delayed_ack:1;
|
|
bool immediate_ack:1;
|
|
#elif defined (__BIG_ENDIAN_BITFIELD)
|
|
bool chanl_agility:1;
|
|
bool pbcc:1;
|
|
bool preamble:1;
|
|
bool privacy:1;
|
|
bool cf_poll_req:1;
|
|
bool cf_pollable:1;
|
|
bool ibss:1;
|
|
bool ess:1;
|
|
bool immediate_ack:1;
|
|
bool delayed_ack:1;
|
|
bool dsss_ofdm:1;
|
|
bool radio_mesure:1;
|
|
bool apsd:1;
|
|
bool short_time:1;
|
|
bool qos:1;
|
|
bool spectrum_mgmt:1;
|
|
#else
|
|
#error "Please fix <asm/byteorder.h>"
|
|
#endif
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.5 */
|
|
struct mmpdu_association_request {
|
|
struct mmpdu_field_capability capability;
|
|
__le16 listen_interval;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.6 */
|
|
struct mmpdu_association_response {
|
|
struct mmpdu_field_capability capability;
|
|
__le16 status_code;
|
|
__le16 aid;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.7 */
|
|
struct mmpdu_reassociation_request {
|
|
struct mmpdu_field_capability capability;
|
|
__le16 listen_interval;
|
|
unsigned char current_ap_address[6];
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.8 */
|
|
struct mmpdu_reassociation_response {
|
|
struct mmpdu_field_capability capability;
|
|
__le16 status_code;
|
|
__le16 aid;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.4 */
|
|
struct mmpdu_disassociation {
|
|
__le16 reason_code;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.9 */
|
|
struct mmpdu_probe_request {
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.10 */
|
|
struct mmpdu_probe_response {
|
|
uint8_t timestamp;
|
|
__le16 beacon_interval;
|
|
struct mmpdu_field_capability capability;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.15 */
|
|
struct mmpdu_timing_advertisement {
|
|
uint8_t timestamp;
|
|
struct mmpdu_field_capability capability;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.2 */
|
|
struct mmpdu_beacon {
|
|
uint8_t timestamp;
|
|
__le16 beacon_interval;
|
|
struct mmpdu_field_capability capability;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.11 */
|
|
struct mmpdu_authentication {
|
|
__le16 algorithm;
|
|
__le16 transaction_sequence;
|
|
__le16 status;
|
|
|
|
union {
|
|
struct {
|
|
uint8_t element_id;
|
|
uint8_t challenge_text_len;
|
|
unsigned char challenge_text[253];
|
|
} __attribute__ ((packed)) shared_key_23;
|
|
};
|
|
/* ToDo: FT and SAE parts? */
|
|
} __attribute__ ((packed));
|
|
|
|
/* 802.11, Section 8.3.3.12 */
|
|
struct mmpdu_deauthentication {
|
|
__le16 reason_code;
|
|
uint8_t ies[0];
|
|
} __attribute__ ((packed));
|
|
|
|
const struct mmpdu_header *mpdu_validate(const uint8_t *frame, int len);
|
|
const void *mmpdu_body(const struct mmpdu_header *mpdu);
|