summaryrefslogtreecommitdiffstats
path: root/contrib/hostapd/ieee802_11.c
diff options
context:
space:
mode:
authorsam <sam@FreeBSD.org>2005-06-05 22:35:03 +0000
committersam <sam@FreeBSD.org>2005-06-05 22:35:03 +0000
commit21e78f430e299464b3c902bec78f8daa1f0e2e71 (patch)
treea7d225a062cd128980707f3fa918dec2d015c46b /contrib/hostapd/ieee802_11.c
downloadFreeBSD-src-21e78f430e299464b3c902bec78f8daa1f0e2e71.zip
FreeBSD-src-21e78f430e299464b3c902bec78f8daa1f0e2e71.tar.gz
Stripped down import of hostapd v0.3.7
Diffstat (limited to 'contrib/hostapd/ieee802_11.c')
-rw-r--r--contrib/hostapd/ieee802_11.c1217
1 files changed, 1217 insertions, 0 deletions
diff --git a/contrib/hostapd/ieee802_11.c b/contrib/hostapd/ieee802_11.c
new file mode 100644
index 0000000..16a3d0e
--- /dev/null
+++ b/contrib/hostapd/ieee802_11.c
@@ -0,0 +1,1217 @@
+/*
+ * Host AP (software wireless LAN access point) user space daemon for
+ * Host AP kernel driver / IEEE 802.11 Management
+ * Copyright (c) 2002-2005, Jouni Malinen <jkmaline@cc.hut.fi>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * Alternatively, this software may be distributed under the terms of BSD
+ * license.
+ *
+ * See README and COPYING for more details.
+ */
+
+#include <stdlib.h>
+#include <stdio.h>
+#include <string.h>
+#include <sys/socket.h>
+#include <net/if.h>
+#include <arpa/inet.h>
+#include <time.h>
+
+#include "eloop.h"
+#include "hostapd.h"
+#include "ieee802_11.h"
+#include "radius.h"
+#include "radius_client.h"
+#include "ieee802_11_auth.h"
+#include "sta_info.h"
+#include "eapol_sm.h"
+#include "rc4.h"
+#include "ieee802_1x.h"
+#include "wpa.h"
+#include "accounting.h"
+#include "driver.h"
+
+
+static u8 * hostapd_eid_supp_rates(hostapd *hapd, u8 *eid)
+{
+ u8 *pos = eid;
+
+ *pos++ = WLAN_EID_SUPP_RATES;
+ *pos++ = 4; /* len */
+ *pos++ = 0x82; /* 1 Mbps, base set */
+ *pos++ = 0x84; /* 2 Mbps, base set */
+ *pos++ = 0x0b; /* 5.5 Mbps */
+ *pos++ = 0x16; /* 11 Mbps */
+
+ return pos;
+}
+
+
+static u16 hostapd_own_capab_info(hostapd *hapd)
+{
+ int capab = WLAN_CAPABILITY_ESS;
+ if (hapd->conf->wpa ||
+ (hapd->conf->ieee802_1x &&
+ (hapd->conf->default_wep_key_len ||
+ hapd->conf->individual_wep_key_len)))
+ capab |= WLAN_CAPABILITY_PRIVACY;
+ return capab;
+}
+
+
+static const u8 WPA_OUI_TYPE[] = { 0x00, 0x50, 0xf2, 1 };
+
+ParseRes ieee802_11_parse_elems(struct hostapd_data *hapd, u8 *start,
+ size_t len,
+ struct ieee802_11_elems *elems,
+ int show_errors)
+{
+ size_t left = len;
+ u8 *pos = start;
+ int unknown = 0;
+
+ memset(elems, 0, sizeof(*elems));
+
+ while (left >= 2) {
+ u8 id, elen;
+
+ id = *pos++;
+ elen = *pos++;
+ left -= 2;
+
+ if (elen > left) {
+ if (show_errors) {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "IEEE 802.11 element parse "
+ "failed (id=%d elen=%d "
+ "left=%lu)\n",
+ id, elen, (unsigned long) left);
+ if (HOSTAPD_DEBUG_COND(HOSTAPD_DEBUG_MINIMAL))
+ hostapd_hexdump("IEs", start, len);
+ }
+ return ParseFailed;
+ }
+
+ switch (id) {
+ case WLAN_EID_SSID:
+ elems->ssid = pos;
+ elems->ssid_len = elen;
+ break;
+ case WLAN_EID_SUPP_RATES:
+ elems->supp_rates = pos;
+ elems->supp_rates_len = elen;
+ break;
+ case WLAN_EID_FH_PARAMS:
+ elems->fh_params = pos;
+ elems->fh_params_len = elen;
+ break;
+ case WLAN_EID_DS_PARAMS:
+ elems->ds_params = pos;
+ elems->ds_params_len = elen;
+ break;
+ case WLAN_EID_CF_PARAMS:
+ elems->cf_params = pos;
+ elems->cf_params_len = elen;
+ break;
+ case WLAN_EID_TIM:
+ elems->tim = pos;
+ elems->tim_len = elen;
+ break;
+ case WLAN_EID_IBSS_PARAMS:
+ elems->ibss_params = pos;
+ elems->ibss_params_len = elen;
+ break;
+ case WLAN_EID_CHALLENGE:
+ elems->challenge = pos;
+ elems->challenge_len = elen;
+ break;
+ case WLAN_EID_GENERIC:
+ if (elen > 4 && memcmp(pos, WPA_OUI_TYPE, 4) == 0) {
+ elems->wpa_ie = pos;
+ elems->wpa_ie_len = elen;
+ } else if (show_errors) {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_EXCESSIVE,
+ "IEEE 802.11 element parse "
+ "ignored unknown generic element"
+ " (id=%d elen=%d OUI:type="
+ "%02x-%02x-%02x:%d)\n",
+ id, elen,
+ elen >= 1 ? pos[0] : 0,
+ elen >= 2 ? pos[1] : 0,
+ elen >= 3 ? pos[2] : 0,
+ elen >= 4 ? pos[3] : 0);
+ unknown++;
+ } else {
+ unknown++;
+ }
+ break;
+ case WLAN_EID_RSN:
+ elems->rsn_ie = pos;
+ elems->rsn_ie_len = elen;
+ break;
+ default:
+ unknown++;
+ if (!show_errors)
+ break;
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_EXCESSIVE,
+ "IEEE 802.11 element parse ignored "
+ "unknown element (id=%d elen=%d)\n",
+ id, elen);
+ break;
+ }
+
+ left -= elen;
+ pos += elen;
+ }
+
+ if (left)
+ return ParseFailed;
+
+ return unknown ? ParseUnknown : ParseOK;
+}
+
+
+static void ieee802_11_print_ssid(u8 *ssid, u8 len)
+{
+ int i;
+ for (i = 0; i < len; i++) {
+ if (ssid[i] >= 32 && ssid[i] < 127)
+ printf("%c", ssid[i]);
+ else
+ printf("<%02x>", ssid[i]);
+ }
+}
+
+
+static void ieee802_11_sta_authenticate(void *eloop_ctx, void *timeout_ctx)
+{
+ hostapd *hapd = eloop_ctx;
+ struct ieee80211_mgmt mgmt;
+
+ if (hapd->assoc_ap_state == WAIT_BEACON)
+ hapd->assoc_ap_state = AUTHENTICATE;
+ if (hapd->assoc_ap_state != AUTHENTICATE)
+ return;
+
+ printf("Authenticate with AP " MACSTR " SSID=",
+ MAC2STR(hapd->conf->assoc_ap_addr));
+ ieee802_11_print_ssid(hapd->assoc_ap_ssid, hapd->assoc_ap_ssid_len);
+ printf(" (as station)\n");
+
+ memset(&mgmt, 0, sizeof(mgmt));
+ mgmt.frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
+ WLAN_FC_STYPE_AUTH);
+ /* Request TX callback */
+ mgmt.frame_control |= host_to_le16(BIT(1));
+ memcpy(mgmt.da, hapd->conf->assoc_ap_addr, ETH_ALEN);
+ memcpy(mgmt.sa, hapd->own_addr, ETH_ALEN);
+ memcpy(mgmt.bssid, hapd->conf->assoc_ap_addr, ETH_ALEN);
+ mgmt.u.auth.auth_alg = host_to_le16(WLAN_AUTH_OPEN);
+ mgmt.u.auth.auth_transaction = host_to_le16(1);
+ mgmt.u.auth.status_code = host_to_le16(0);
+ if (hostapd_send_mgmt_frame(hapd, &mgmt, IEEE80211_HDRLEN +
+ sizeof(mgmt.u.auth), 0) < 0)
+ perror("ieee802_11_sta_authenticate: send");
+
+ /* Try to authenticate again, if this attempt fails or times out. */
+ eloop_register_timeout(5, 0, ieee802_11_sta_authenticate, hapd, NULL);
+}
+
+
+static void ieee802_11_sta_associate(void *eloop_ctx, void *timeout_ctx)
+{
+ hostapd *hapd = eloop_ctx;
+ u8 buf[256];
+ struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *) buf;
+ u8 *p;
+
+ if (hapd->assoc_ap_state == AUTHENTICATE)
+ hapd->assoc_ap_state = ASSOCIATE;
+ if (hapd->assoc_ap_state != ASSOCIATE)
+ return;
+
+ printf("Associate with AP " MACSTR " SSID=",
+ MAC2STR(hapd->conf->assoc_ap_addr));
+ ieee802_11_print_ssid(hapd->assoc_ap_ssid, hapd->assoc_ap_ssid_len);
+ printf(" (as station)\n");
+
+ memset(mgmt, 0, sizeof(*mgmt));
+ mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
+ WLAN_FC_STYPE_ASSOC_REQ);
+ /* Request TX callback */
+ mgmt->frame_control |= host_to_le16(BIT(1));
+ memcpy(mgmt->da, hapd->conf->assoc_ap_addr, ETH_ALEN);
+ memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
+ memcpy(mgmt->bssid, hapd->conf->assoc_ap_addr, ETH_ALEN);
+ mgmt->u.assoc_req.capab_info = host_to_le16(0);
+ mgmt->u.assoc_req.listen_interval = host_to_le16(1);
+ p = &mgmt->u.assoc_req.variable[0];
+
+ *p++ = WLAN_EID_SSID;
+ *p++ = hapd->assoc_ap_ssid_len;
+ memcpy(p, hapd->assoc_ap_ssid, hapd->assoc_ap_ssid_len);
+ p += hapd->assoc_ap_ssid_len;
+
+ p = hostapd_eid_supp_rates(hapd, p);
+
+ if (hostapd_send_mgmt_frame(hapd, mgmt, p - (u8 *) mgmt, 0) < 0)
+ perror("ieee802_11_sta_associate: send");
+
+ /* Try to authenticate again, if this attempt fails or times out. */
+ eloop_register_timeout(5, 0, ieee802_11_sta_associate, hapd, NULL);
+}
+
+
+static u16 auth_shared_key(hostapd *hapd, struct sta_info *sta,
+ u16 auth_transaction, u8 *challenge, int iswep)
+{
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG,
+ "authentication (shared key, transaction %d)",
+ auth_transaction);
+
+ if (auth_transaction == 1) {
+ if (!sta->challenge) {
+ /* Generate a pseudo-random challenge */
+ u8 key[8];
+ time_t now;
+ int r;
+ sta->challenge = malloc(WLAN_AUTH_CHALLENGE_LEN);
+ if (!sta->challenge)
+ return WLAN_STATUS_UNSPECIFIED_FAILURE;
+ memset(sta->challenge, 0, WLAN_AUTH_CHALLENGE_LEN);
+
+ now = time(NULL);
+ r = random();
+ memcpy(key, &now, 4);
+ memcpy(key + 4, &r, 4);
+ rc4(sta->challenge, WLAN_AUTH_CHALLENGE_LEN,
+ key, sizeof(key));
+ }
+ return 0;
+ }
+
+ if (auth_transaction != 3)
+ return WLAN_STATUS_UNSPECIFIED_FAILURE;
+
+ /* Transaction 3 */
+ if (!iswep || !sta->challenge || !challenge ||
+ memcmp(sta->challenge, challenge, WLAN_AUTH_CHALLENGE_LEN)) {
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO,
+ "shared key authentication - invalid "
+ "challenge-response");
+ return WLAN_STATUS_CHALLENGE_FAIL;
+ }
+
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG,
+ "authentication OK (shared key)");
+#ifdef IEEE80211_REQUIRE_AUTH_ACK
+ /* Station will be marked authenticated if it ACKs the
+ * authentication reply. */
+#else
+ sta->flags |= WLAN_STA_AUTH;
+ wpa_sm_event(hapd, sta, WPA_AUTH);
+#endif
+ free(sta->challenge);
+ sta->challenge = NULL;
+
+ return 0;
+}
+
+
+static void send_auth_reply(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ u16 auth_alg, u16 auth_transaction, u16 resp,
+ u8 *challenge)
+{
+ u8 buf[IEEE80211_HDRLEN + sizeof(mgmt->u.auth) + 2 +
+ WLAN_AUTH_CHALLENGE_LEN];
+ struct ieee80211_mgmt *reply;
+ size_t rlen;
+
+ memset(buf, 0, sizeof(buf));
+ reply = (struct ieee80211_mgmt *) buf;
+ reply->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
+ WLAN_FC_STYPE_AUTH);
+ /* Request TX callback */
+ reply->frame_control |= host_to_le16(BIT(1));
+ memcpy(reply->da, mgmt->sa, ETH_ALEN);
+ memcpy(reply->sa, hapd->own_addr, ETH_ALEN);
+ memcpy(reply->bssid, mgmt->bssid, ETH_ALEN);
+
+ reply->u.auth.auth_alg = host_to_le16(auth_alg);
+ reply->u.auth.auth_transaction = host_to_le16(auth_transaction);
+ reply->u.auth.status_code = host_to_le16(resp);
+ rlen = IEEE80211_HDRLEN + sizeof(reply->u.auth);
+ if (auth_alg == WLAN_AUTH_SHARED_KEY && auth_transaction == 2 &&
+ challenge) {
+ u8 *p = reply->u.auth.variable;
+ *p++ = WLAN_EID_CHALLENGE;
+ *p++ = WLAN_AUTH_CHALLENGE_LEN;
+ memcpy(p, challenge, WLAN_AUTH_CHALLENGE_LEN);
+ rlen += 2 + WLAN_AUTH_CHALLENGE_LEN;
+ } else
+ challenge = NULL;
+
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "authentication reply: STA=" MACSTR " auth_alg=%d "
+ "auth_transaction=%d resp=%d%s\n",
+ MAC2STR(mgmt->sa), auth_alg, auth_transaction,
+ resp, challenge ? " challenge" : "");
+ if (hostapd_send_mgmt_frame(hapd, reply, rlen, 0) < 0)
+ perror("send_auth_reply: send");
+}
+
+
+static void handle_auth(hostapd *hapd, struct ieee80211_mgmt *mgmt, size_t len)
+{
+ u16 auth_alg, auth_transaction, status_code;
+ u16 resp = WLAN_STATUS_SUCCESS;
+ struct sta_info *sta = NULL;
+ int res;
+ u16 fc;
+ u8 *challenge = NULL;
+ u32 session_timeout, acct_interim_interval;
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.auth)) {
+ printf("handle_auth - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ auth_alg = le_to_host16(mgmt->u.auth.auth_alg);
+ auth_transaction = le_to_host16(mgmt->u.auth.auth_transaction);
+ status_code = le_to_host16(mgmt->u.auth.status_code);
+ fc = le_to_host16(mgmt->frame_control);
+
+ if (len >= IEEE80211_HDRLEN + sizeof(mgmt->u.auth) +
+ 2 + WLAN_AUTH_CHALLENGE_LEN &&
+ mgmt->u.auth.variable[0] == WLAN_EID_CHALLENGE &&
+ mgmt->u.auth.variable[1] == WLAN_AUTH_CHALLENGE_LEN)
+ challenge = &mgmt->u.auth.variable[2];
+
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "authentication: STA=" MACSTR " auth_alg=%d "
+ "auth_transaction=%d status_code=%d wep=%d%s\n",
+ MAC2STR(mgmt->sa), auth_alg, auth_transaction,
+ status_code, !!(fc & WLAN_FC_ISWEP),
+ challenge ? " challenge" : "");
+
+ if (hapd->assoc_ap_state == AUTHENTICATE && auth_transaction == 2 &&
+ memcmp(mgmt->sa, hapd->conf->assoc_ap_addr, ETH_ALEN) == 0 &&
+ memcmp(mgmt->bssid, hapd->conf->assoc_ap_addr, ETH_ALEN) == 0) {
+ if (status_code != 0) {
+ printf("Authentication (as station) with AP "
+ MACSTR " failed (status_code=%d)\n",
+ MAC2STR(hapd->conf->assoc_ap_addr),
+ status_code);
+ return;
+ }
+ printf("Authenticated (as station) with AP " MACSTR "\n",
+ MAC2STR(hapd->conf->assoc_ap_addr));
+ ieee802_11_sta_associate(hapd, NULL);
+ return;
+ }
+
+ if (hapd->tkip_countermeasures) {
+ resp = WLAN_REASON_MICHAEL_MIC_FAILURE;
+ goto fail;
+ }
+
+ if (!(((hapd->conf->auth_algs & HOSTAPD_AUTH_OPEN) &&
+ auth_alg == WLAN_AUTH_OPEN) ||
+ ((hapd->conf->auth_algs & HOSTAPD_AUTH_SHARED_KEY) &&
+ auth_alg == WLAN_AUTH_SHARED_KEY))) {
+ printf("Unsupported authentication algorithm (%d)\n",
+ auth_alg);
+ resp = WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG;
+ goto fail;
+ }
+
+ if (!(auth_transaction == 1 ||
+ (auth_alg == WLAN_AUTH_SHARED_KEY && auth_transaction == 3))) {
+ printf("Unknown authentication transaction number (%d)\n",
+ auth_transaction);
+ resp = WLAN_STATUS_UNKNOWN_AUTH_TRANSACTION;
+ goto fail;
+ }
+
+ if (memcmp(mgmt->sa, hapd->own_addr, ETH_ALEN) == 0) {
+ printf("Station " MACSTR " not allowed to authenticate.\n",
+ MAC2STR(mgmt->sa));
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+
+ res = hostapd_allowed_address(hapd, mgmt->sa, (u8 *) mgmt, len,
+ &session_timeout,
+ &acct_interim_interval);
+ if (res == HOSTAPD_ACL_REJECT) {
+ printf("Station " MACSTR " not allowed to authenticate.\n",
+ MAC2STR(mgmt->sa));
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+ if (res == HOSTAPD_ACL_PENDING) {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "Authentication frame "
+ "from " MACSTR " waiting for an external "
+ "authentication\n", MAC2STR(mgmt->sa));
+ /* Authentication code will re-send the authentication frame
+ * after it has received (and cached) information from the
+ * external source. */
+ return;
+ }
+
+ sta = ap_sta_add(hapd, mgmt->sa);
+ if (!sta) {
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+ sta->flags &= ~WLAN_STA_PREAUTH;
+ ieee802_1x_notify_pre_auth(sta->eapol_sm, 0);
+
+ if (hapd->conf->radius_acct_interim_interval == 0 &&
+ acct_interim_interval)
+ sta->acct_interim_interval = acct_interim_interval;
+ if (res == HOSTAPD_ACL_ACCEPT_TIMEOUT)
+ ap_sta_session_timeout(hapd, sta, session_timeout);
+ else
+ ap_sta_no_session_timeout(hapd, sta);
+
+ switch (auth_alg) {
+ case WLAN_AUTH_OPEN:
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG,
+ "authentication OK (open system)");
+#ifdef IEEE80211_REQUIRE_AUTH_ACK
+ /* Station will be marked authenticated if it ACKs the
+ * authentication reply. */
+#else
+ sta->flags |= WLAN_STA_AUTH;
+ wpa_sm_event(hapd, sta, WPA_AUTH);
+#endif
+ break;
+ case WLAN_AUTH_SHARED_KEY:
+ resp = auth_shared_key(hapd, sta, auth_transaction, challenge,
+ fc & WLAN_FC_ISWEP);
+ break;
+ }
+
+ fail:
+ send_auth_reply(hapd, mgmt, auth_alg, auth_transaction + 1, resp,
+ sta ? sta->challenge : NULL);
+}
+
+
+static void handle_assoc(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len, int reassoc)
+{
+ u16 capab_info, listen_interval;
+ u16 resp = WLAN_STATUS_SUCCESS;
+ u8 *pos, *wpa_ie;
+ size_t wpa_ie_len;
+ int send_deauth = 0, send_len, left, i;
+ struct sta_info *sta;
+ struct ieee802_11_elems elems;
+
+ if (len < IEEE80211_HDRLEN + (reassoc ? sizeof(mgmt->u.reassoc_req) :
+ sizeof(mgmt->u.assoc_req))) {
+ printf("handle_assoc(reassoc=%d) - too short payload (len=%lu)"
+ "\n", reassoc, (unsigned long) len);
+ return;
+ }
+
+ if (reassoc) {
+ capab_info = le_to_host16(mgmt->u.reassoc_req.capab_info);
+ listen_interval = le_to_host16(
+ mgmt->u.reassoc_req.listen_interval);
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "reassociation request: STA=" MACSTR
+ " capab_info=0x%02x "
+ "listen_interval=%d current_ap=" MACSTR "\n",
+ MAC2STR(mgmt->sa), capab_info, listen_interval,
+ MAC2STR(mgmt->u.reassoc_req.current_ap));
+ left = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.reassoc_req));
+ pos = mgmt->u.reassoc_req.variable;
+ } else {
+ capab_info = le_to_host16(mgmt->u.assoc_req.capab_info);
+ listen_interval = le_to_host16(
+ mgmt->u.assoc_req.listen_interval);
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "association request: STA=" MACSTR
+ " capab_info=0x%02x listen_interval=%d\n",
+ MAC2STR(mgmt->sa), capab_info, listen_interval);
+ left = len - (IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_req));
+ pos = mgmt->u.assoc_req.variable;
+ }
+
+ sta = ap_get_sta(hapd, mgmt->sa);
+ if (sta == NULL || (sta->flags & WLAN_STA_AUTH) == 0) {
+ printf("STA " MACSTR " trying to associate before "
+ "authentication\n", MAC2STR(mgmt->sa));
+ if (sta) {
+ printf(" sta: addr=" MACSTR " aid=%d flags=0x%04x\n",
+ MAC2STR(sta->addr), sta->aid, sta->flags);
+ }
+ send_deauth = 1;
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+
+ if (hapd->tkip_countermeasures) {
+ resp = WLAN_REASON_MICHAEL_MIC_FAILURE;
+ goto fail;
+ }
+
+ sta->capability = capab_info;
+
+ /* followed by SSID and Supported rates */
+ if (ieee802_11_parse_elems(hapd, pos, left, &elems, 1) == ParseFailed
+ || !elems.ssid) {
+ printf("STA " MACSTR " sent invalid association request\n",
+ MAC2STR(sta->addr));
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+
+ if (elems.ssid_len != hapd->conf->ssid_len ||
+ memcmp(elems.ssid, hapd->conf->ssid, elems.ssid_len) != 0) {
+ printf("Station " MACSTR " tried to associate with "
+ "unknown SSID '", MAC2STR(sta->addr));
+ ieee802_11_print_ssid(elems.ssid, elems.ssid_len);
+ printf("'\n");
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+
+ if (elems.supp_rates) {
+ if (elems.supp_rates_len > sizeof(sta->supported_rates)) {
+ printf("STA " MACSTR ": Invalid supported rates "
+ "element length %d\n", MAC2STR(sta->addr),
+ elems.supp_rates_len);
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+
+ memset(sta->supported_rates, 0, sizeof(sta->supported_rates));
+ memcpy(sta->supported_rates, elems.supp_rates,
+ elems.supp_rates_len);
+
+ sta->tx_supp_rates = 0;
+ for (i = 0; i < elems.supp_rates_len; i++) {
+ if ((sta->supported_rates[i] & 0x7f) == 2)
+ sta->tx_supp_rates |= WLAN_RATE_1M;
+ if ((sta->supported_rates[i] & 0x7f) == 4)
+ sta->tx_supp_rates |= WLAN_RATE_2M;
+ if ((sta->supported_rates[i] & 0x7f) == 11)
+ sta->tx_supp_rates |= WLAN_RATE_5M5;
+ if ((sta->supported_rates[i] & 0x7f) == 22)
+ sta->tx_supp_rates |= WLAN_RATE_11M;
+ }
+ } else
+ sta->tx_supp_rates = 0xff;
+
+ if ((hapd->conf->wpa & HOSTAPD_WPA_VERSION_WPA2) && elems.rsn_ie) {
+ wpa_ie = elems.rsn_ie;
+ wpa_ie_len = elems.rsn_ie_len;
+ } else if ((hapd->conf->wpa & HOSTAPD_WPA_VERSION_WPA) &&
+ elems.wpa_ie) {
+ wpa_ie = elems.wpa_ie;
+ wpa_ie_len = elems.wpa_ie_len;
+ } else {
+ wpa_ie = NULL;
+ wpa_ie_len = 0;
+ }
+ if (hapd->conf->wpa && wpa_ie == NULL) {
+ printf("STA " MACSTR ": No WPA/RSN IE in association "
+ "request\n", MAC2STR(sta->addr));
+ resp = WLAN_STATUS_INVALID_IE;
+ goto fail;
+ }
+
+ if (hapd->conf->wpa) {
+ int res;
+ wpa_ie -= 2;
+ wpa_ie_len += 2;
+ res = wpa_validate_wpa_ie(hapd, sta, wpa_ie, wpa_ie_len,
+ elems.rsn_ie ?
+ HOSTAPD_WPA_VERSION_WPA2 :
+ HOSTAPD_WPA_VERSION_WPA);
+ if (res == WPA_INVALID_GROUP)
+ resp = WLAN_STATUS_GROUP_CIPHER_NOT_VALID;
+ else if (res == WPA_INVALID_PAIRWISE)
+ resp = WLAN_STATUS_PAIRWISE_CIPHER_NOT_VALID;
+ else if (res == WPA_INVALID_AKMP)
+ resp = WLAN_STATUS_AKMP_NOT_VALID;
+ else if (res != WPA_IE_OK)
+ resp = WLAN_STATUS_INVALID_IE;
+ if (resp != WLAN_STATUS_SUCCESS)
+ goto fail;
+ free(sta->wpa_ie);
+ sta->wpa_ie = malloc(wpa_ie_len);
+ if (sta->wpa_ie == NULL) {
+ resp = WLAN_STATUS_UNSPECIFIED_FAILURE;
+ goto fail;
+ }
+ sta->wpa_ie_len = wpa_ie_len;
+ memcpy(sta->wpa_ie, wpa_ie, wpa_ie_len);
+ }
+
+ /* get a unique AID */
+ if (sta->aid > 0) {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ " old AID %d\n", sta->aid);
+ } else {
+ for (sta->aid = 1; sta->aid <= MAX_AID_TABLE_SIZE; sta->aid++)
+ if (hapd->sta_aid[sta->aid - 1] == NULL)
+ break;
+ if (sta->aid > MAX_AID_TABLE_SIZE) {
+ sta->aid = 0;
+ resp = WLAN_STATUS_AP_UNABLE_TO_HANDLE_NEW_STA;
+ printf(" no room for more AIDs\n");
+ goto fail;
+ } else {
+ hapd->sta_aid[sta->aid - 1] = sta;
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ " new AID %d\n", sta->aid);
+ }
+ }
+
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG,
+ "association OK (aid %d)", sta->aid);
+ /* Station will be marked associated, after it acknowledges AssocResp
+ */
+
+ if (sta->last_assoc_req)
+ free(sta->last_assoc_req);
+ sta->last_assoc_req = (struct ieee80211_mgmt *) malloc(len);
+ if (sta->last_assoc_req)
+ memcpy(sta->last_assoc_req, mgmt, len);
+
+ /* Make sure that the previously registered inactivity timer will not
+ * remove the STA immediately. */
+ sta->timeout_next = STA_NULLFUNC;
+
+ fail:
+
+ /* use the queued buffer for transmission because it is large enough
+ * and not needed anymore */
+ mgmt->frame_control =
+ IEEE80211_FC(WLAN_FC_TYPE_MGMT,
+ (send_deauth ? WLAN_FC_STYPE_DEAUTH :
+ (reassoc ? WLAN_FC_STYPE_REASSOC_RESP :
+ WLAN_FC_STYPE_ASSOC_RESP)));
+ memcpy(mgmt->da, mgmt->sa, ETH_ALEN);
+ memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
+ /* Addr3 = BSSID - already set */
+
+ send_len = IEEE80211_HDRLEN;
+ if (send_deauth) {
+ send_len += sizeof(mgmt->u.deauth);
+ mgmt->u.deauth.reason_code = host_to_le16(resp);
+ } else {
+ u8 *p;
+ send_len += sizeof(mgmt->u.assoc_resp);
+ mgmt->u.assoc_resp.capab_info =
+ host_to_le16(hostapd_own_capab_info(hapd));
+ mgmt->u.assoc_resp.status_code = host_to_le16(resp);
+ mgmt->u.assoc_resp.aid = host_to_le16((sta ? sta->aid : 0)
+ | BIT(14) | BIT(15));
+ /* Supported rates */
+ p = hostapd_eid_supp_rates(hapd, mgmt->u.assoc_resp.variable);
+ send_len += p - mgmt->u.assoc_resp.variable;
+
+ /* Request TX callback */
+ mgmt->frame_control |= host_to_le16(BIT(1));
+ }
+
+ if (hostapd_send_mgmt_frame(hapd, mgmt, send_len, 0) < 0)
+ perror("handle_assoc: send");
+}
+
+
+static void handle_assoc_resp(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len)
+{
+ u16 status_code, aid;
+
+ if (hapd->assoc_ap_state != ASSOCIATE) {
+ printf("Unexpected association response received from " MACSTR
+ "\n", MAC2STR(mgmt->sa));
+ return;
+ }
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.assoc_resp)) {
+ printf("handle_assoc_resp - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ if (memcmp(mgmt->sa, hapd->conf->assoc_ap_addr, ETH_ALEN) != 0 ||
+ memcmp(mgmt->bssid, hapd->conf->assoc_ap_addr, ETH_ALEN) != 0) {
+ printf("Received association response from unexpected address "
+ "(SA=" MACSTR " BSSID=" MACSTR "\n",
+ MAC2STR(mgmt->sa), MAC2STR(mgmt->bssid));
+ return;
+ }
+
+ status_code = le_to_host16(mgmt->u.assoc_resp.status_code);
+ aid = le_to_host16(mgmt->u.assoc_resp.aid);
+ aid &= ~(BIT(14) | BIT(15));
+
+ if (status_code != 0) {
+ printf("Association (as station) with AP " MACSTR " failed "
+ "(status_code=%d)\n",
+ MAC2STR(hapd->conf->assoc_ap_addr), status_code);
+ /* Try to authenticate again */
+ hapd->assoc_ap_state = AUTHENTICATE;
+ eloop_register_timeout(5, 0, ieee802_11_sta_authenticate,
+ hapd, NULL);
+ }
+
+ printf("Associated (as station) with AP " MACSTR " (aid=%d)\n",
+ MAC2STR(hapd->conf->assoc_ap_addr), aid);
+ hapd->assoc_ap_aid = aid;
+ hapd->assoc_ap_state = ASSOCIATED;
+
+ if (hostapd_set_assoc_ap(hapd, hapd->conf->assoc_ap_addr)) {
+ printf("Could not set associated AP address to kernel "
+ "driver.\n");
+ }
+}
+
+
+static void handle_disassoc(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len)
+{
+ struct sta_info *sta;
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.disassoc)) {
+ printf("handle_disassoc - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "disassocation: STA=" MACSTR " reason_code=%d\n",
+ MAC2STR(mgmt->sa),
+ le_to_host16(mgmt->u.disassoc.reason_code));
+
+ if (hapd->assoc_ap_state != DO_NOT_ASSOC &&
+ memcmp(mgmt->sa, hapd->conf->assoc_ap_addr, ETH_ALEN) == 0) {
+ printf("Assoc AP " MACSTR " sent disassociation "
+ "(reason_code=%d) - try to authenticate\n",
+ MAC2STR(hapd->conf->assoc_ap_addr),
+ le_to_host16(mgmt->u.disassoc.reason_code));
+ hapd->assoc_ap_state = AUTHENTICATE;
+ ieee802_11_sta_authenticate(hapd, NULL);
+ eloop_register_timeout(0, 500000, ieee802_11_sta_authenticate,
+ hapd, NULL);
+ return;
+ }
+
+ sta = ap_get_sta(hapd, mgmt->sa);
+ if (sta == NULL) {
+ printf("Station " MACSTR " trying to disassociate, but it "
+ "is not associated.\n", MAC2STR(mgmt->sa));
+ return;
+ }
+
+ sta->flags &= ~WLAN_STA_ASSOC;
+ wpa_sm_event(hapd, sta, WPA_DISASSOC);
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO, "disassociated");
+ sta->acct_terminate_cause = RADIUS_ACCT_TERMINATE_CAUSE_USER_REQUEST;
+ ieee802_1x_set_port_enabled(hapd, sta, 0);
+ /* Stop Accounting and IEEE 802.1X sessions, but leave the STA
+ * authenticated. */
+ accounting_sta_stop(hapd, sta);
+ ieee802_1x_free_station(sta);
+ hostapd_sta_remove(hapd, sta->addr);
+
+ if (sta->timeout_next == STA_NULLFUNC ||
+ sta->timeout_next == STA_DISASSOC) {
+ sta->timeout_next = STA_DEAUTH;
+ eloop_cancel_timeout(ap_handle_timer, hapd, sta);
+ eloop_register_timeout(AP_DEAUTH_DELAY, 0, ap_handle_timer,
+ hapd, sta);
+ }
+}
+
+
+static void handle_deauth(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len)
+{
+ struct sta_info *sta;
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.deauth)) {
+ printf("handle_deauth - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "deauthentication: STA=" MACSTR " reason_code=%d\n",
+ MAC2STR(mgmt->sa),
+ le_to_host16(mgmt->u.deauth.reason_code));
+
+ if (hapd->assoc_ap_state != DO_NOT_ASSOC &&
+ memcmp(mgmt->sa, hapd->conf->assoc_ap_addr, ETH_ALEN) == 0) {
+ printf("Assoc AP " MACSTR " sent deauthentication "
+ "(reason_code=%d) - try to authenticate\n",
+ MAC2STR(hapd->conf->assoc_ap_addr),
+ le_to_host16(mgmt->u.deauth.reason_code));
+ hapd->assoc_ap_state = AUTHENTICATE;
+ eloop_register_timeout(0, 500000, ieee802_11_sta_authenticate,
+ hapd, NULL);
+ return;
+ }
+
+ sta = ap_get_sta(hapd, mgmt->sa);
+ if (sta == NULL) {
+ printf("Station " MACSTR " trying to deauthenticate, but it "
+ "is not authenticated.\n", MAC2STR(mgmt->sa));
+ return;
+ }
+
+ sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC);
+ wpa_sm_event(hapd, sta, WPA_DEAUTH);
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG, "deauthenticated");
+ sta->acct_terminate_cause = RADIUS_ACCT_TERMINATE_CAUSE_USER_REQUEST;
+ ieee802_1x_set_port_enabled(hapd, sta, 0);
+ ap_free_sta(hapd, sta);
+}
+
+
+static void handle_beacon(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len)
+{
+ struct ieee802_11_elems elems;
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.beacon)) {
+ printf("handle_beacon - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ (void) ieee802_11_parse_elems(hapd, mgmt->u.beacon.variable,
+ len - (IEEE80211_HDRLEN +
+ sizeof(mgmt->u.beacon)), &elems,
+ 0);
+
+ if (hapd->assoc_ap_state == WAIT_BEACON &&
+ memcmp(mgmt->sa, hapd->conf->assoc_ap_addr, ETH_ALEN) == 0) {
+ if (elems.ssid && elems.ssid_len <= 32) {
+ memcpy(hapd->assoc_ap_ssid, elems.ssid,
+ elems.ssid_len);
+ hapd->assoc_ap_ssid[elems.ssid_len] = '\0';
+ hapd->assoc_ap_ssid_len = elems.ssid_len;
+ }
+ ieee802_11_sta_authenticate(hapd, NULL);
+ }
+
+ if (!HOSTAPD_DEBUG_COND(HOSTAPD_DEBUG_EXCESSIVE))
+ return;
+
+ printf("Beacon from " MACSTR, MAC2STR(mgmt->sa));
+ if (elems.ssid) {
+ printf(" SSID='");
+ ieee802_11_print_ssid(elems.ssid, elems.ssid_len);
+ printf("'");
+ }
+ if (elems.ds_params && elems.ds_params_len == 1)
+ printf(" CHAN=%d", elems.ds_params[0]);
+ printf("\n");
+}
+
+
+void ieee802_11_mgmt(struct hostapd_data *hapd, u8 *buf, size_t len, u16 stype)
+{
+ struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *) buf;
+
+ if (stype == WLAN_FC_STYPE_BEACON) {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_EXCESSIVE, "mgmt::beacon\n");
+ handle_beacon(hapd, mgmt, len);
+ return;
+ }
+
+ if (memcmp(mgmt->bssid, hapd->own_addr, ETH_ALEN) != 0 &&
+ (hapd->assoc_ap_state == DO_NOT_ASSOC ||
+ memcmp(mgmt->bssid, hapd->conf->assoc_ap_addr, ETH_ALEN) != 0)) {
+ printf("MGMT: BSSID=" MACSTR " not our address\n",
+ MAC2STR(mgmt->bssid));
+ return;
+ }
+
+
+ if (stype == WLAN_FC_STYPE_PROBE_REQ) {
+ printf("mgmt::probe_req\n");
+ return;
+ }
+
+ if (memcmp(mgmt->da, hapd->own_addr, ETH_ALEN) != 0) {
+ printf("MGMT: DA=" MACSTR " not our address\n",
+ MAC2STR(mgmt->da));
+ return;
+ }
+
+ switch (stype) {
+ case WLAN_FC_STYPE_AUTH:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::auth\n");
+ handle_auth(hapd, mgmt, len);
+ break;
+ case WLAN_FC_STYPE_ASSOC_REQ:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::assoc_req\n");
+ handle_assoc(hapd, mgmt, len, 0);
+ break;
+ case WLAN_FC_STYPE_ASSOC_RESP:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::assoc_resp\n");
+ handle_assoc_resp(hapd, mgmt, len);
+ break;
+ case WLAN_FC_STYPE_REASSOC_REQ:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::reassoc_req\n");
+ handle_assoc(hapd, mgmt, len, 1);
+ break;
+ case WLAN_FC_STYPE_DISASSOC:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::disassoc\n");
+ handle_disassoc(hapd, mgmt, len);
+ break;
+ case WLAN_FC_STYPE_DEAUTH:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::deauth\n");
+ handle_deauth(hapd, mgmt, len);
+ break;
+ default:
+ printf("unknown mgmt frame subtype %d\n", stype);
+ break;
+ }
+}
+
+
+static void handle_auth_cb(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len, int ok)
+{
+ u16 auth_alg, auth_transaction, status_code;
+ struct sta_info *sta;
+
+ if (!ok) {
+ hostapd_logger(hapd, mgmt->da, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_NOTICE,
+ "did not acknowledge authentication response");
+ return;
+ }
+
+ if (len < IEEE80211_HDRLEN + sizeof(mgmt->u.auth)) {
+ printf("handle_auth_cb - too short payload (len=%lu)\n",
+ (unsigned long) len);
+ return;
+ }
+
+ auth_alg = le_to_host16(mgmt->u.auth.auth_alg);
+ auth_transaction = le_to_host16(mgmt->u.auth.auth_transaction);
+ status_code = le_to_host16(mgmt->u.auth.status_code);
+
+ sta = ap_get_sta(hapd, mgmt->da);
+ if (!sta) {
+ printf("handle_auth_cb: STA " MACSTR " not found\n",
+ MAC2STR(mgmt->da));
+ return;
+ }
+
+ if (status_code == WLAN_STATUS_SUCCESS &&
+ ((auth_alg == WLAN_AUTH_OPEN && auth_transaction == 2) ||
+ (auth_alg == WLAN_AUTH_SHARED_KEY && auth_transaction == 4))) {
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO, "authenticated");
+ sta->flags |= WLAN_STA_AUTH;
+ }
+}
+
+
+static void handle_assoc_cb(hostapd *hapd, struct ieee80211_mgmt *mgmt,
+ size_t len, int reassoc, int ok)
+{
+ u16 status;
+ struct sta_info *sta;
+ int new_assoc = 1;
+
+ if (!ok) {
+ hostapd_logger(hapd, mgmt->da, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_DEBUG,
+ "did not acknowledge association response");
+ return;
+ }
+
+ if (len < IEEE80211_HDRLEN + (reassoc ? sizeof(mgmt->u.reassoc_req) :
+ sizeof(mgmt->u.assoc_req))) {
+ printf("handle_assoc_cb(reassoc=%d) - too short payload "
+ "(len=%lu)\n", reassoc, (unsigned long) len);
+ return;
+ }
+
+ if (reassoc)
+ status = le_to_host16(mgmt->u.reassoc_resp.status_code);
+ else
+ status = le_to_host16(mgmt->u.assoc_resp.status_code);
+
+ sta = ap_get_sta(hapd, mgmt->da);
+ if (!sta) {
+ printf("handle_assoc_cb: STA " MACSTR " not found\n",
+ MAC2STR(mgmt->da));
+ return;
+ }
+
+ if (status != WLAN_STATUS_SUCCESS)
+ goto fail;
+
+ /* Stop previous accounting session, if one is started, and allocate
+ * new session id for the new session. */
+ accounting_sta_stop(hapd, sta);
+ accounting_sta_get_id(hapd, sta);
+
+ hostapd_logger(hapd, sta->addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO,
+ "associated (aid %d, accounting session %08X-%08X)",
+ sta->aid, sta->acct_session_id_hi,
+ sta->acct_session_id_lo);
+
+ if (sta->flags & WLAN_STA_ASSOC)
+ new_assoc = 0;
+ sta->flags |= WLAN_STA_ASSOC;
+
+ if (hostapd_sta_add(hapd, sta->addr, sta->aid, sta->capability,
+ sta->tx_supp_rates)) {
+ printf("Could not add station to kernel driver.\n");
+ }
+
+ wpa_sm_event(hapd, sta, WPA_ASSOC);
+ if (new_assoc)
+ hostapd_new_assoc_sta(hapd, sta);
+ else
+ wpa_sm_event(hapd, sta, WPA_REAUTH);
+
+ ieee802_1x_notify_port_enabled(sta->eapol_sm, 1);
+
+ fail:
+ /* Copy of the association request is not needed anymore */
+ if (sta->last_assoc_req) {
+ free(sta->last_assoc_req);
+ sta->last_assoc_req = NULL;
+ }
+}
+
+
+void ieee802_11_mgmt_cb(struct hostapd_data *hapd, u8 *buf, size_t len,
+ u16 stype, int ok)
+{
+ struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *) buf;
+
+ switch (stype) {
+ case WLAN_FC_STYPE_AUTH:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL, "mgmt::auth cb\n");
+ handle_auth_cb(hapd, mgmt, len, ok);
+ break;
+ case WLAN_FC_STYPE_ASSOC_RESP:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "mgmt::assoc_resp cb\n");
+ handle_assoc_cb(hapd, mgmt, len, 0, ok);
+ break;
+ case WLAN_FC_STYPE_REASSOC_RESP:
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "mgmt::reassoc_resp cb\n");
+ handle_assoc_cb(hapd, mgmt, len, 1, ok);
+ break;
+ default:
+ printf("unknown mgmt cb frame subtype %d\n", stype);
+ break;
+ }
+}
+
+
+static void ieee80211_tkip_countermeasures_stop(void *eloop_ctx,
+ void *timeout_ctx)
+{
+ struct hostapd_data *hapd = eloop_ctx;
+ hapd->tkip_countermeasures = 0;
+ hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO, "TKIP countermeasures ended");
+}
+
+
+static void ieee80211_tkip_countermeasures_start(struct hostapd_data *hapd)
+{
+ struct sta_info *sta;
+
+ hostapd_logger(hapd, NULL, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO, "TKIP countermeasures initiated");
+
+ if (hapd->wpa_auth)
+ hapd->wpa_auth->dot11RSNATKIPCounterMeasuresInvoked++;
+ hapd->tkip_countermeasures = 1;
+ wpa_gtk_rekey(hapd);
+ eloop_cancel_timeout(ieee80211_tkip_countermeasures_stop, hapd, NULL);
+ eloop_register_timeout(60, 0, ieee80211_tkip_countermeasures_stop,
+ hapd, NULL);
+ for (sta = hapd->sta_list; sta != NULL; sta = sta->next) {
+ hostapd_sta_deauth(hapd, sta->addr,
+ WLAN_REASON_MICHAEL_MIC_FAILURE);
+ sta->flags &= ~(WLAN_STA_AUTH | WLAN_STA_ASSOC |
+ WLAN_STA_AUTHORIZED);
+ hostapd_sta_remove(hapd, sta->addr);
+ }
+}
+
+
+void ieee80211_michael_mic_failure(struct hostapd_data *hapd, u8 *addr,
+ int local)
+{
+ time_t now;
+
+ if (addr && local) {
+ struct sta_info *sta = ap_get_sta(hapd, addr);
+ if (sta != NULL) {
+ sta->dot11RSNAStatsTKIPLocalMICFailures++;
+ hostapd_logger(hapd, addr, HOSTAPD_MODULE_IEEE80211,
+ HOSTAPD_LEVEL_INFO,
+ "Michael MIC failure detected in "
+ "received frame");
+ } else {
+ HOSTAPD_DEBUG(HOSTAPD_DEBUG_MINIMAL,
+ "MLME-MICHAELMICFAILURE.indication "
+ "for not associated STA (" MACSTR
+ ") ignored\n", MAC2STR(addr));
+ return;
+ }
+ }
+
+ time(&now);
+ if (now > hapd->michael_mic_failure + 60) {
+ hapd->michael_mic_failures = 1;
+ } else {
+ hapd->michael_mic_failures++;
+ if (hapd->michael_mic_failures > 1)
+ ieee80211_tkip_countermeasures_start(hapd);
+ }
+ hapd->michael_mic_failure = now;
+}
+
+
+int ieee802_11_get_mib(struct hostapd_data *hapd, char *buf, size_t buflen)
+{
+ /* TODO */
+ return 0;
+}
+
+
+int ieee802_11_get_mib_sta(struct hostapd_data *hapd, struct sta_info *sta,
+ char *buf, size_t buflen)
+{
+ /* TODO */
+ return 0;
+}
OpenPOWER on IntegriCloud