Mark ieee802_11_parse_elems() input and parsed elems const
[libeap.git] / hostapd / drv_callbacks.c
index ca65078..55c7539 100644 (file)
@@ -14,6 +14,7 @@
 
 #include "includes.h"
 
+#include "common.h"
 #include "hostapd.h"
 #include "driver_i.h"
 #include "ieee802_11.h"
@@ -25,6 +26,7 @@
 #include "wpa.h"
 #include "iapp.h"
 #include "wme.h"
+#include "wps_hostapd.h"
 
 
 struct prune_data {
@@ -103,8 +105,6 @@ void hostapd_new_assoc_sta(struct hostapd_data *hapd, struct sta_info *sta,
        if (!hapd->conf->ieee802_1x && !hapd->conf->wpa)
                accounting_sta_start(hapd, sta);
 
-       hostapd_wmm_sta_config(hapd, sta);
-
        /* Start IEEE 802.1X authentication process for new stations */
        ieee802_1x_new_station(hapd, sta);
        if (reassoc) {
@@ -116,41 +116,24 @@ void hostapd_new_assoc_sta(struct hostapd_data *hapd, struct sta_info *sta,
 }
 
 
-void hostapd_tx_status(struct hostapd_data *hapd, const u8 *addr,
-                      const u8 *buf, size_t len, int ack)
+int hostapd_notif_new_sta(struct hostapd_data *hapd, const u8 *addr)
 {
-       struct sta_info *sta;
-
-       sta = ap_get_sta(hapd, addr);
-       if (sta && sta->flags & WLAN_STA_PENDING_POLL) {
-               wpa_printf(MSG_DEBUG, "STA " MACSTR " %s pending "
-                          "activity poll", MAC2STR(sta->addr),
-                          ack ? "ACKed" : "did not ACK");
-               if (ack)
-                       sta->flags &= ~WLAN_STA_PENDING_POLL;
-       }
+       struct sta_info *sta = ap_get_sta(hapd, addr);
        if (sta)
-               ieee802_1x_tx_status(hapd, sta, buf, len, ack);
-}
-
+               return 0;
 
-void hostapd_rx_from_unknown_sta(struct hostapd_data *hapd, const u8 *addr)
-{
-       struct sta_info *sta;
-
-       sta = ap_get_sta(hapd, addr);
-       if (!sta || !(sta->flags & WLAN_STA_ASSOC)) {
-               wpa_printf(MSG_DEBUG, "Data/PS-poll frame from not associated "
-                          "STA " MACSTR, MAC2STR(addr));
-               if (sta && (sta->flags & WLAN_STA_AUTH))
-                       hostapd_sta_disassoc(
-                               hapd, addr,
-                               WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA);
-               else
-                       hostapd_sta_deauth(
-                               hapd, addr,
-                               WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA);
+       wpa_printf(MSG_DEBUG, "Data frame from unknown STA " MACSTR
+                  " - adding a new STA", MAC2STR(addr));
+       sta = ap_sta_add(hapd, addr);
+       if (sta) {
+               hostapd_new_assoc_sta(hapd, sta, 0);
+       } else {
+               wpa_printf(MSG_DEBUG, "Failed to add STA entry for " MACSTR,
+                          MAC2STR(addr));
+               return -1;
        }
+
+       return 0;
 }
 
 
@@ -203,9 +186,26 @@ int hostapd_notif_assoc(struct hostapd_data *hapd, const u8 *addr,
                res = wpa_validate_wpa_ie(hapd->wpa_auth, sta->wpa_sm,
                                          ie, ielen, NULL, 0);
                if (res != WPA_IE_OK) {
+                       int resp;
                        wpa_printf(MSG_DEBUG, "WPA/RSN information element "
                                   "rejected? (res %u)", res);
                        wpa_hexdump(MSG_DEBUG, "IE", ie, ielen);
+                       if (res == WPA_INVALID_GROUP)
+                               resp = WLAN_REASON_GROUP_CIPHER_NOT_VALID;
+                       else if (res == WPA_INVALID_PAIRWISE)
+                               resp = WLAN_REASON_PAIRWISE_CIPHER_NOT_VALID;
+                       else if (res == WPA_INVALID_AKMP)
+                               resp = WLAN_REASON_AKMP_NOT_VALID;
+#ifdef CONFIG_IEEE80211W
+                       else if (res == WPA_MGMT_FRAME_PROTECTION_VIOLATION)
+                               resp = WLAN_REASON_INVALID_IE;
+                       else if (res == WPA_INVALID_MGMT_GROUP_CIPHER)
+                               resp = WLAN_REASON_GROUP_CIPHER_NOT_VALID;
+#endif /* CONFIG_IEEE80211W */
+                       else
+                               resp = WLAN_REASON_INVALID_IE;
+                       hostapd_sta_disassoc(hapd, sta->addr, resp);
+                       ap_free_sta(hapd, sta);
                        return -1;
                }
        } else if (hapd->conf->wps_state) {
@@ -258,23 +258,213 @@ void hostapd_eapol_receive(struct hostapd_data *hapd, const u8 *sa,
 }
 
 
-#ifdef NEED_MLME
-void hostapd_mgmt_rx(struct hostapd_data *hapd, u8 *buf, size_t len,
-                    u16 stype, struct hostapd_frame_info *fi)
+struct hostapd_data * hostapd_sta_get_bss(struct hostapd_data *hapd,
+                                         const u8 *addr)
 {
-       ieee802_11_mgmt(hapd, buf, len, stype, fi);
+       struct hostapd_iface *iface = hapd->iface;
+       size_t j;
+
+       for (j = 0; j < iface->num_bss; j++) {
+               hapd = iface->bss[j];
+               if (ap_get_sta(hapd, addr))
+                       return hapd;
+       }
+
+       return NULL;
+}
+
+
+#ifdef HOSTAPD
+
+#ifdef NEED_AP_MLME
+
+static const u8 * get_hdr_bssid(const struct ieee80211_hdr *hdr, size_t len)
+{
+       u16 fc, type, stype;
+
+       /*
+        * PS-Poll frames are 16 bytes. All other frames are
+        * 24 bytes or longer.
+        */
+       if (len < 16)
+               return NULL;
+
+       fc = le_to_host16(hdr->frame_control);
+       type = WLAN_FC_GET_TYPE(fc);
+       stype = WLAN_FC_GET_STYPE(fc);
+
+       switch (type) {
+       case WLAN_FC_TYPE_DATA:
+               if (len < 24)
+                       return NULL;
+               switch (fc & (WLAN_FC_FROMDS | WLAN_FC_TODS)) {
+               case WLAN_FC_TODS:
+                       return hdr->addr1;
+               case WLAN_FC_FROMDS:
+                       return hdr->addr2;
+               default:
+                       return NULL;
+               }
+       case WLAN_FC_TYPE_CTRL:
+               if (stype != WLAN_FC_STYPE_PSPOLL)
+                       return NULL;
+               return hdr->addr1;
+       case WLAN_FC_TYPE_MGMT:
+               return hdr->addr3;
+       default:
+               return NULL;
+       }
 }
 
 
-void hostapd_mgmt_tx_cb(struct hostapd_data *hapd, u8 *buf, size_t len,
-                       u16 stype, int ok)
+#define HAPD_BROADCAST ((struct hostapd_data *) -1)
+
+static struct hostapd_data * get_hapd_bssid(struct hostapd_iface *iface,
+                                           const u8 *bssid)
 {
+       size_t i;
+
+       if (bssid == NULL)
+               return NULL;
+       if (bssid[0] == 0xff && bssid[1] == 0xff && bssid[2] == 0xff &&
+           bssid[3] == 0xff && bssid[4] == 0xff && bssid[5] == 0xff)
+               return HAPD_BROADCAST;
+
+       for (i = 0; i < iface->num_bss; i++) {
+               if (os_memcmp(bssid, iface->bss[i]->own_addr, ETH_ALEN) == 0)
+                       return iface->bss[i];
+       }
+
+       return NULL;
+}
+
+
+static void hostapd_rx_from_unknown_sta(struct hostapd_data *hapd,
+                                       const struct ieee80211_hdr *hdr,
+                                       size_t len)
+{
+       hapd = get_hapd_bssid(hapd->iface, get_hdr_bssid(hdr, len));
+       if (hapd == NULL || hapd == HAPD_BROADCAST)
+               return;
+
+       ieee802_11_rx_from_unknown(hapd, hdr->addr2);
+}
+
+
+static void hostapd_mgmt_rx(struct hostapd_data *hapd, u8 *buf,
+                           size_t len, struct hostapd_frame_info *fi)
+{
+       struct hostapd_iface *iface = hapd->iface;
+       struct ieee80211_hdr *hdr;
+       const u8 *bssid;
+
+       hdr = (struct ieee80211_hdr *) buf;
+       bssid = get_hdr_bssid(hdr, len);
+       if (bssid == NULL)
+               return;
+
+       hapd = get_hapd_bssid(iface, bssid);
+       if (hapd == NULL) {
+               u16 fc;
+               fc = le_to_host16(hdr->frame_control);
+
+               /*
+                * Drop frames to unknown BSSIDs except for Beacon frames which
+                * could be used to update neighbor information.
+                */
+               if (WLAN_FC_GET_TYPE(fc) == WLAN_FC_TYPE_MGMT &&
+                   WLAN_FC_GET_STYPE(fc) == WLAN_FC_STYPE_BEACON)
+                       hapd = iface->bss[0];
+               else
+                       return;
+       }
+
+       if (hapd == HAPD_BROADCAST) {
+               size_t i;
+               for (i = 0; i < iface->num_bss; i++)
+                       ieee802_11_mgmt(iface->bss[i], buf, len, fi);
+       } else
+               ieee802_11_mgmt(hapd, buf, len, fi);
+}
+
+
+static void hostapd_mgmt_tx_cb(struct hostapd_data *hapd, const u8 *buf,
+                              size_t len, u16 stype, int ok)
+{
+       struct ieee80211_hdr *hdr;
+       hdr = (struct ieee80211_hdr *) buf;
+       hapd = get_hapd_bssid(hapd->iface, get_hdr_bssid(hdr, len));
+       if (hapd == NULL || hapd == HAPD_BROADCAST)
+               return;
        ieee802_11_mgmt_cb(hapd, buf, len, stype, ok);
 }
-#endif /* NEED_MLME */
 
+#endif /* NEED_AP_MLME */
+
+
+void wpa_supplicant_event(void *ctx, wpa_event_type event,
+                         union wpa_event_data *data)
+{
+       struct hostapd_data *hapd = ctx;
+
+       switch (event) {
+       case EVENT_MICHAEL_MIC_FAILURE:
+               michael_mic_failure(hapd, data->michael_mic_failure.src, 1);
+               break;
+       case EVENT_SCAN_RESULTS:
+               if (hapd->iface->scan_cb)
+                       hapd->iface->scan_cb(hapd->iface);
+               break;
+#ifdef CONFIG_IEEE80211R
+       case EVENT_FT_RRB_RX:
+               wpa_ft_rrb_rx(hapd->wpa_auth, data->ft_rrb_rx.src,
+                             data->ft_rrb_rx.data, data->ft_rrb_rx.data_len);
+               break;
+#endif /* CONFIG_IEEE80211R */
+       case EVENT_WPS_BUTTON_PUSHED:
+               hostapd_wps_button_pushed(hapd);
+               break;
+#ifdef NEED_AP_MLME
+       case EVENT_TX_STATUS:
+               switch (data->tx_status.type) {
+               case WLAN_FC_TYPE_MGMT:
+                       hostapd_mgmt_tx_cb(hapd, data->tx_status.data,
+                                          data->tx_status.data_len,
+                                          data->tx_status.stype,
+                                          data->tx_status.ack);
+                       break;
+               case WLAN_FC_TYPE_DATA:
+                       hostapd_tx_status(hapd, data->tx_status.dst,
+                                         data->tx_status.data,
+                                         data->tx_status.data_len,
+                                         data->tx_status.ack);
+                       break;
+               }
+               break;
+       case EVENT_RX_FROM_UNKNOWN:
+               hostapd_rx_from_unknown_sta(hapd, data->rx_from_unknown.hdr,
+                                           data->rx_from_unknown.len);
+               break;
+       case EVENT_RX_MGMT:
+               hostapd_mgmt_rx(hapd, data->rx_mgmt.frame,
+                               data->rx_mgmt.frame_len, data->rx_mgmt.fi);
+               break;
+#endif /* NEED_AP_MLME */
+       default:
+               wpa_printf(MSG_DEBUG, "Unknown event %d", event);
+               break;
+       }
+}
+
+#endif /* HOSTAPD */
 
-void hostapd_michael_mic_failure(struct hostapd_data *hapd, const u8 *addr)
+
+void hostapd_probe_req_rx(struct hostapd_data *hapd, const u8 *sa,
+                        const u8 *ie, size_t ie_len)
 {
-       michael_mic_failure(hapd, addr, 1);
+       size_t i;
+
+       for (i = 0; hapd->probereq_cb && i < hapd->num_probereq_cb; i++)
+               hapd->probereq_cb[i].cb(hapd->probereq_cb[i].ctx,
+                                       sa, ie, ie_len);
 }