161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * hostapd - WNM 3fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt * Copyright (c) 2011-2013, Qualcomm Atheros, Inc. 461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * This software may be distributed under the terms of the BSD license. 661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * See README for more details. 761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "utils/includes.h" 1061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 1161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "utils/common.h" 12fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt#include "utils/eloop.h" 1361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common/ieee802_11_defs.h" 1461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/hostapd.h" 1561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/sta_info.h" 1661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_config.h" 1761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_drv_ops.h" 1861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/wpa_auth.h" 1961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "wnm_ap.h" 2061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_TFS_IE_LEN 1024 2261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* get the TFS IE from driver */ 2561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee80211_11_get_tfs_ie(struct hostapd_data *hapd, const u8 *addr, 2661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len, enum wnm_oper oper) 2761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 2861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: TFS get operation %d", __func__, oper); 2961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 3061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len); 3161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 3261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 3361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 3461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* set the TFS IE to driver */ 3561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee80211_11_set_tfs_ie(struct hostapd_data *hapd, const u8 *addr, 3661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *buf, u16 *buf_len, enum wnm_oper oper) 3761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 3861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: TFS set operation %d", __func__, oper); 3961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 4061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len); 4161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 4261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 4361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 4461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* MLME-SLEEPMODE.response */ 4561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee802_11_send_wnmsleep_resp(struct hostapd_data *hapd, 4661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *addr, u8 dialog_token, 4761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 action_type, u16 intval) 4861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 4961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct ieee80211_mgmt *mgmt; 5061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt int res; 5161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t len; 5261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t gtk_elem_len = 0; 5361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt size_t igtk_elem_len = 0; 5461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct wnm_sleep_element wnmsleep_ie; 5561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *wnmtfs_ie; 5661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 wnmsleep_ie_len; 5761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 wnmtfs_ie_len; 5861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *pos; 5961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct sta_info *sta; 60a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt enum wnm_oper tfs_oper = action_type == WNM_SLEEP_MODE_ENTER ? 61a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt WNM_SLEEP_TFS_RESP_IE_ADD : WNM_SLEEP_TFS_RESP_IE_NONE; 6261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 6361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt sta = ap_get_sta(hapd, addr); 6461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (sta == NULL) { 6561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "%s: station not found", __func__); 6661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -EINVAL; 6761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 6861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 6961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* WNM-Sleep Mode IE */ 7061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memset(&wnmsleep_ie, 0, sizeof(struct wnm_sleep_element)); 7161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie_len = sizeof(struct wnm_sleep_element); 7261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.eid = WLAN_EID_WNMSLEEP; 7361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.len = wnmsleep_ie_len - 2; 7461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.action_type = action_type; 7561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.status = WNM_STATUS_SLEEP_ACCEPT; 76fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wnmsleep_ie.intval = host_to_le16(intval); 7761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 7861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* TFS IE(s) */ 7961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmtfs_ie = os_zalloc(MAX_TFS_IE_LEN); 8061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmtfs_ie == NULL) 8161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 8261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ieee80211_11_get_tfs_ie(hapd, addr, wnmtfs_ie, &wnmtfs_ie_len, 8361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfs_oper)) { 8461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmtfs_ie_len = 0; 8561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(wnmtfs_ie); 8661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmtfs_ie = NULL; 8761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 8861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 8961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_GTK_SUBELEM_LEN 45 9061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_IGTK_SUBELEM_LEN 26 9161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt = os_zalloc(sizeof(*mgmt) + wnmsleep_ie_len + 9261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt MAX_GTK_SUBELEM_LEN + MAX_IGTK_SUBELEM_LEN); 9361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (mgmt == NULL) { 9461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "MLME: Failed to allocate buffer for " 9561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "WNM-Sleep Response action frame"); 9661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 9761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 9861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(mgmt->da, addr, ETH_ALEN); 9961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); 10061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); 10161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, 10261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WLAN_FC_STYPE_ACTION); 10361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.category = WLAN_ACTION_WNM; 10461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.u.wnm_sleep_resp.action = WNM_SLEEP_MODE_RESP; 10561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.u.wnm_sleep_resp.dialogtoken = dialog_token; 10661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos = (u8 *)mgmt->u.action.u.wnm_sleep_resp.variable; 10761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* add key data if MFP is enabled */ 108a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (!wpa_auth_uses_mfp(sta->wpa_sm) || 109a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt action_type != WNM_SLEEP_MODE_EXIT) { 11061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.u.wnm_sleep_resp.keydata_len = 0; 11161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 11261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt gtk_elem_len = wpa_wnmsleep_gtk_subelem(sta->wpa_sm, pos); 11361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += gtk_elem_len; 11461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Pass 4, gtk_len = %d", 11561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) gtk_elem_len); 11661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211W 11761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = wpa_wnmsleep_igtk_subelem(sta->wpa_sm, pos); 11861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (res < 0) { 11961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(wnmtfs_ie); 12061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(mgmt); 12161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 12261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 12361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt igtk_elem_len = res; 12461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += igtk_elem_len; 12561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Pass 4 igtk_len = %d", 12661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) igtk_elem_len); 12761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 12861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 12961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WPA_PUT_LE16((u8 *) 13061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &mgmt->u.action.u.wnm_sleep_resp.keydata_len, 13161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt gtk_elem_len + igtk_elem_len); 13261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 13361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &wnmsleep_ie, wnmsleep_ie_len); 13461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy TFS IE here */ 13561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += wnmsleep_ie_len; 136a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (wnmtfs_ie) 137a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt os_memcpy(pos, wnmtfs_ie, wnmtfs_ie_len); 13861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 13961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt len = 1 + sizeof(mgmt->u.action.u.wnm_sleep_resp) + gtk_elem_len + 14061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt igtk_elem_len + wnmsleep_ie_len + wnmtfs_ie_len; 14161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* In driver, response frame should be forced to sent when STA is in 14361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * PS mode */ 14461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, 14561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->da, &mgmt->u.action.category, len); 14661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!res) { 14861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Successfully send WNM-Sleep Response " 14961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "frame"); 15061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 15161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* when entering wnmsleep 15261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 1. pause the node in driver 15361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 2. mark the node so that AP won't update GTK/IGTK during 15461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * WNM Sleep 15561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 15661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT && 157a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wnmsleep_ie.action_type == WNM_SLEEP_MODE_ENTER) { 158fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt sta->flags |= WLAN_STA_WNM_SLEEP_MODE; 15961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt hostapd_drv_wnm_oper(hapd, WNM_SLEEP_ENTER_CONFIRM, 16061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt addr, NULL, NULL); 16161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_set_wnmsleep(sta->wpa_sm, 1); 16261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 16361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* when exiting wnmsleep 16461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 1. unmark the node 16561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 2. start GTK/IGTK update if MFP is not used 16661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 3. unpause the node in driver 16761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 168a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if ((wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT || 169a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wnmsleep_ie.status == 170a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt WNM_STATUS_SLEEP_EXIT_ACCEPT_GTK_UPDATE) && 171a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wnmsleep_ie.action_type == WNM_SLEEP_MODE_EXIT) { 172fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt sta->flags &= ~WLAN_STA_WNM_SLEEP_MODE; 17361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_set_wnmsleep(sta->wpa_sm, 0); 17461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt hostapd_drv_wnm_oper(hapd, WNM_SLEEP_EXIT_CONFIRM, 17561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt addr, NULL, NULL); 176a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (!wpa_auth_uses_mfp(sta->wpa_sm)) 17761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_wnmsleep_rekey_gtk(sta->wpa_sm); 17861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 17961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else 18061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Fail to send WNM-Sleep Response frame"); 18161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 18261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_GTK_SUBELEM_LEN 18361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_IGTK_SUBELEM_LEN 18461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(wnmtfs_ie); 18561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(mgmt); 18661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 18761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 18861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 18961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 19061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void ieee802_11_rx_wnmsleep_req(struct hostapd_data *hapd, 19161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *addr, const u8 *frm, int len) 19261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 193a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt /* Dialog Token [1] | WNM-Sleep Mode IE | TFS Response IE */ 194a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt const u8 *pos = frm; 195a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt u8 dialog_token; 19661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct wnm_sleep_element *wnmsleep_ie = NULL; 19761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* multiple TFS Req IE (assuming consecutive) */ 19861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *tfsreq_ie_start = NULL; 19961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *tfsreq_ie_end = NULL; 20061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 tfsreq_ie_len = 0; 20161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 202a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt dialog_token = *pos++; 203a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt while (pos + 1 < frm + len) { 204a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt u8 ie_len = pos[1]; 205a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (pos + 2 + ie_len > frm + len) 206a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt break; 20761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*pos == WLAN_EID_WNMSLEEP) 208a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wnmsleep_ie = (struct wnm_sleep_element *) pos; 20961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt else if (*pos == WLAN_EID_TFS_REQ) { 21061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!tfsreq_ie_start) 211a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt tfsreq_ie_start = (u8 *) pos; 212a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt tfsreq_ie_end = (u8 *) pos; 21361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else 214a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: EID %d not recognized", 215a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt *pos); 21661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ie_len + 2; 21761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 21861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!wnmsleep_ie) { 22061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "No WNM-Sleep IE found"); 22161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 22261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 22361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 224a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_ENTER && 225a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt tfsreq_ie_start && tfsreq_ie_end && 226a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt tfsreq_ie_end - tfsreq_ie_start >= 0) { 22761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_len = (tfsreq_ie_end + tfsreq_ie_end[1] + 2) - 22861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_start; 22961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) found"); 23061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* pass the TFS Req IE(s) to driver for processing */ 23161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, 23261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &tfsreq_ie_len, 23361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WNM_SLEEP_TFS_REQ_IE_SET)) 23461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Fail to set TFS Req IE"); 23561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 23661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 23761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ieee802_11_send_wnmsleep_resp(hapd, addr, dialog_token, 23861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie->action_type, 239fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt le_to_host16(wnmsleep_ie->intval)); 24061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 241a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT) { 24261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* clear the tfs after sending the resp frame */ 24361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, 24461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &tfsreq_ie_len, WNM_SLEEP_TFS_IE_DEL); 24561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 24661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 24761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 24861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 249fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic int ieee802_11_send_bss_trans_mgmt_request(struct hostapd_data *hapd, 250fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *addr, 251fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 dialog_token, 252fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const char *url) 253fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 254fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt struct ieee80211_mgmt *mgmt; 255fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt size_t url_len, len; 256fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 *pos; 257fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int res; 258fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 259fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (url) 260fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt url_len = os_strlen(url); 261fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt else 262fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt url_len = 0; 263fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 264fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt = os_zalloc(sizeof(*mgmt) + (url_len ? 1 + url_len : 0)); 265fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (mgmt == NULL) 266fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return -1; 267fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->da, addr, ETH_ALEN); 268fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); 269fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); 270fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, 271fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WLAN_FC_STYPE_ACTION); 272fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.category = WLAN_ACTION_WNM; 273fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; 274fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.dialog_token = dialog_token; 275fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.req_mode = 0; 276fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.disassoc_timer = host_to_le16(0); 277fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.validity_interval = 1; 278fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos = mgmt->u.action.u.bss_tm_req.variable; 279fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (url) { 280fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *pos++ += url_len; 281fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(pos, url, url_len); 282fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos += url_len; 283fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 284fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 285fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request to " 286fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR " dialog_token=%u req_mode=0x%x disassoc_timer=%u " 287fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt "validity_interval=%u", 288fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MAC2STR(addr), dialog_token, 289fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.req_mode, 290fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt le_to_host16(mgmt->u.action.u.bss_tm_req.disassoc_timer), 291fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.validity_interval); 292fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 293fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt len = pos - &mgmt->u.action.category; 294fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, 295fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->da, &mgmt->u.action.category, len); 296fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_free(mgmt); 297fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return res; 298fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 299fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 300fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 301fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic void ieee802_11_rx_bss_trans_mgmt_query(struct hostapd_data *hapd, 302fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *addr, const u8 *frm, 303fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt size_t len) 304fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 305fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 dialog_token, reason; 306fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *pos, *end; 307fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 308fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (len < 2) { 309fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Query from " 310fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR, MAC2STR(addr)); 311fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 312fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 313fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 314fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos = frm; 315fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt end = pos + len; 316fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt dialog_token = *pos++; 317fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt reason = *pos++; 318fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 319fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Query from " 320fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR " dialog_token=%u reason=%u", 321fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MAC2STR(addr), dialog_token, reason); 322fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 323fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries", 324fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos, end - pos); 325fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 326fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ieee802_11_send_bss_trans_mgmt_request(hapd, addr, dialog_token, NULL); 327fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 328fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 329fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 330fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic void ieee802_11_rx_bss_trans_mgmt_resp(struct hostapd_data *hapd, 331fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *addr, const u8 *frm, 332fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt size_t len) 333fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 334fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 dialog_token, status_code, bss_termination_delay; 335fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *pos, *end; 336fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 337fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (len < 3) { 338fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Response from " 339fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR, MAC2STR(addr)); 340fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 341fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 342fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 343fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos = frm; 344fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt end = pos + len; 345fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt dialog_token = *pos++; 346fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt status_code = *pos++; 347fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt bss_termination_delay = *pos++; 348fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 349fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Response from " 350fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR " dialog_token=%u status_code=%u " 351fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt "bss_termination_delay=%u", MAC2STR(addr), dialog_token, 352fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt status_code, bss_termination_delay); 353fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 354fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (status_code == WNM_BSS_TM_ACCEPT) { 355fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (end - pos < ETH_ALEN) { 356fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: not enough room for Target BSSID field"); 357fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return; 358fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 359fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Target BSSID: " MACSTR, 360fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MAC2STR(pos)); 361fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos += ETH_ALEN; 362fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 363fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 364fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries", 365fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos, end - pos); 366fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 367fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 368fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 369a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidtint ieee802_11_rx_wnm_action_ap(struct hostapd_data *hapd, 370fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const struct ieee80211_mgmt *mgmt, size_t len) 37161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 372fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 action; 373fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt const u8 *payload; 374fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt size_t plen; 375fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 376fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (len < IEEE80211_HDRLEN + 2) 377a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt return -1; 37861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 379623d63a3a443027e50efdaaec027befcc3882527Dmitry Shmidt payload = ((const u8 *) mgmt) + IEEE80211_HDRLEN + 1; 380fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt action = *payload++; 381623d63a3a443027e50efdaaec027befcc3882527Dmitry Shmidt plen = len - IEEE80211_HDRLEN - 2; 382fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 383fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt switch (action) { 384a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt case WNM_BSS_TRANS_MGMT_QUERY: 385fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ieee802_11_rx_bss_trans_mgmt_query(hapd, mgmt->sa, payload, 386fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt plen); 387fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return 0; 388a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt case WNM_BSS_TRANS_MGMT_RESP: 389fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ieee802_11_rx_bss_trans_mgmt_resp(hapd, mgmt->sa, payload, 390fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt plen); 391fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return 0; 39261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_MODE_REQ: 393fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ieee802_11_rx_wnmsleep_req(hapd, mgmt->sa, payload, plen); 394a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt return 0; 39561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 39661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 397a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Unsupported WNM Action %u from " MACSTR, 398fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt action, MAC2STR(mgmt->sa)); 399a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt return -1; 400a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt} 401fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 402fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 403fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint wnm_send_disassoc_imminent(struct hostapd_data *hapd, 404fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt struct sta_info *sta, int disassoc_timer) 405fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 406fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 buf[1000], *pos; 407fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt struct ieee80211_mgmt *mgmt; 408fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 409fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memset(buf, 0, sizeof(buf)); 410fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt = (struct ieee80211_mgmt *) buf; 411fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, 412fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WLAN_FC_STYPE_ACTION); 413fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->da, sta->addr, ETH_ALEN); 414fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); 415fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); 416fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.category = WLAN_ACTION_WNM; 417fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; 418fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.dialog_token = 1; 419fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.req_mode = 420fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WNM_BSS_TM_REQ_DISASSOC_IMMINENT; 421fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.disassoc_timer = 422fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt host_to_le16(disassoc_timer); 423fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.validity_interval = 0; 424fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 425fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos = mgmt->u.action.u.bss_tm_req.variable; 426fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 427fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request frame to indicate imminent disassociation (disassoc_timer=%d) to " 428fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt MACSTR, disassoc_timer, MAC2STR(sta->addr)); 429fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) { 430fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "Failed to send BSS Transition " 431fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt "Management Request frame"); 432fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return -1; 433fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 434fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 435fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return 0; 436fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 437fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 438fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 439fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint wnm_send_ess_disassoc_imminent(struct hostapd_data *hapd, 440fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt struct sta_info *sta, const char *url, 441fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int disassoc_timer) 442fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{ 443fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt u8 buf[1000], *pos; 444fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt struct ieee80211_mgmt *mgmt; 445fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt size_t url_len; 446fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 447fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memset(buf, 0, sizeof(buf)); 448fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt = (struct ieee80211_mgmt *) buf; 449fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, 450fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WLAN_FC_STYPE_ACTION); 451fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->da, sta->addr, ETH_ALEN); 452fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); 453fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); 454fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.category = WLAN_ACTION_WNM; 455fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; 456fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.dialog_token = 1; 457fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.req_mode = 458fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WNM_BSS_TM_REQ_DISASSOC_IMMINENT | 459fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT; 460fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.disassoc_timer = 461fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt host_to_le16(disassoc_timer); 462fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt mgmt->u.action.u.bss_tm_req.validity_interval = 0x01; 463fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 464fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos = mgmt->u.action.u.bss_tm_req.variable; 465fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 466fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt /* Session Information URL */ 467fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt url_len = os_strlen(url); 468fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (url_len > 255) 469fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return -1; 470fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt *pos++ = url_len; 471fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt os_memcpy(pos, url, url_len); 472fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt pos += url_len; 473fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 474fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) { 475fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "Failed to send BSS Transition " 476fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt "Management Request frame"); 477fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return -1; 478fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 479fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 480fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt /* send disassociation frame after time-out */ 481fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (disassoc_timer) { 482fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt int timeout, beacon_int; 483fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 484fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt /* 485fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt * Prevent STA from reconnecting using cached PMKSA to force 486fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt * full authentication with the authentication server (which may 487fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt * decide to reject the connection), 488fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt */ 489fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_auth_pmksa_remove(hapd->wpa_auth, sta->addr); 490fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 491fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt beacon_int = hapd->iconf->beacon_int; 492fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt if (beacon_int < 1) 493fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt beacon_int = 100; /* best guess */ 494fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt /* Calculate timeout in ms based on beacon_int in TU */ 495fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt timeout = disassoc_timer * beacon_int * 128 / 125; 496fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt wpa_printf(MSG_DEBUG, "Disassociation timer for " MACSTR 497fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt " set to %d ms", MAC2STR(sta->addr), timeout); 498fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 499fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt sta->timeout_next = STA_DISASSOC_FROM_CLI; 500fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt eloop_cancel_timeout(ap_handle_timer, hapd, sta); 501fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt eloop_register_timeout(timeout / 1000, 502fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt timeout % 1000 * 1000, 503fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt ap_handle_timer, hapd, sta); 504fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt } 505fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt 506fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt return 0; 507fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt} 508