161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* 261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * hostapd - WNM 361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * Copyright (c) 2011-2012, 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" 1261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "common/ieee802_11_defs.h" 1361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/hostapd.h" 1461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/sta_info.h" 1561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_config.h" 1661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_drv_ops.h" 1761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/wpa_auth.h" 1861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "wnm_ap.h" 1961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_TFS_IE_LEN 1024 2161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 2261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211V 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; 6061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt enum wnm_oper tfs_oper = action_type == 0 ? WNM_SLEEP_TFS_RESP_IE_ADD : 6161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 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; 7661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.intval = 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 */ 10861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wpa_auth_uses_mfp(sta->wpa_sm) || action_type != 1){ 10961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->u.action.u.wnm_sleep_resp.keydata_len = 0; 11061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else { 11161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt gtk_elem_len = wpa_wnmsleep_gtk_subelem(sta->wpa_sm, pos); 11261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += gtk_elem_len; 11361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Pass 4, gtk_len = %d", 11461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) gtk_elem_len); 11561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211W 11661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = wpa_wnmsleep_igtk_subelem(sta->wpa_sm, pos); 11761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (res < 0) { 11861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(wnmtfs_ie); 11961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(mgmt); 12061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return -1; 12161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 12261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt igtk_elem_len = res; 12361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += igtk_elem_len; 12461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Pass 4 igtk_len = %d", 12561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt (int) igtk_elem_len); 12661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211W */ 12761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 12861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WPA_PUT_LE16((u8 *) 12961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &mgmt->u.action.u.wnm_sleep_resp.keydata_len, 13061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt gtk_elem_len + igtk_elem_len); 13161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 13261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, &wnmsleep_ie, wnmsleep_ie_len); 13361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* copy TFS IE here */ 13461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += wnmsleep_ie_len; 13561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_memcpy(pos, wnmtfs_ie, wnmtfs_ie_len); 13661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 13761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt len = 1 + sizeof(mgmt->u.action.u.wnm_sleep_resp) + gtk_elem_len + 13861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt igtk_elem_len + wnmsleep_ie_len + wnmtfs_ie_len; 13961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* In driver, response frame should be forced to sent when STA is in 14161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * PS mode */ 14261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, 14361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt mgmt->da, &mgmt->u.action.category, len); 14461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!res) { 14661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Successfully send WNM-Sleep Response " 14761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt "frame"); 14861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 14961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* when entering wnmsleep 15061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 1. pause the node in driver 15161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 2. mark the node so that AP won't update GTK/IGTK during 15261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * WNM Sleep 15361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 15461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT && 15561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.action_type == 0) { 15661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt hostapd_drv_wnm_oper(hapd, WNM_SLEEP_ENTER_CONFIRM, 15761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt addr, NULL, NULL); 15861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_set_wnmsleep(sta->wpa_sm, 1); 15961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 16061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* when exiting wnmsleep 16161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 1. unmark the node 16261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 2. start GTK/IGTK update if MFP is not used 16361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * 3. unpause the node in driver 16461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 16561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT && 16661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie.action_type == 1) { 16761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_set_wnmsleep(sta->wpa_sm, 0); 16861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt hostapd_drv_wnm_oper(hapd, WNM_SLEEP_EXIT_CONFIRM, 16961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt addr, NULL, NULL); 17061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wpa_auth_uses_mfp(sta->wpa_sm) && action_type == 1) 17161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_wnmsleep_rekey_gtk(sta->wpa_sm); 17261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 17361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else 17461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Fail to send WNM-Sleep Response frame"); 17561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 17661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_GTK_SUBELEM_LEN 17761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_IGTK_SUBELEM_LEN 17861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(wnmtfs_ie); 17961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt os_free(mgmt); 18061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return res; 18161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 18261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 18361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 18461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void ieee802_11_rx_wnmsleep_req(struct hostapd_data *hapd, 18561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt const u8 *addr, const u8 *frm, int len) 18661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 18761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* 18861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * Action [1] | Dialog Token [1] | WNM-Sleep Mode IE | 18961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * TFS Response IE 19061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt */ 19161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *pos = (u8 *) frm; /* point to action field */ 19261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 dialog_token = pos[1]; 19361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct wnm_sleep_element *wnmsleep_ie = NULL; 19461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* multiple TFS Req IE (assuming consecutive) */ 19561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *tfsreq_ie_start = NULL; 19661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *tfsreq_ie_end = NULL; 19761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u16 tfsreq_ie_len = 0; 19861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 19961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += 1 + 1; 20061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt while (pos - frm < len - 1) { 20161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 ie_len = *(pos+1); 20261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (*pos == WLAN_EID_WNMSLEEP) 20361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie = (struct wnm_sleep_element *)pos; 20461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt else if (*pos == WLAN_EID_TFS_REQ) { 20561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!tfsreq_ie_start) 20661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_start = pos; 20761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_end = pos; 20861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } else 20961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "EID %d not recognized", *pos); 21061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt pos += ie_len + 2; 21161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 21261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (!wnmsleep_ie) { 21461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "No WNM-Sleep IE found"); 21561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt return; 21661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 21761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 21861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmsleep_ie->action_type == 0 && tfsreq_ie_start && 21961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_end && tfsreq_ie_end - tfsreq_ie_start >= 0) { 22061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_len = (tfsreq_ie_end + tfsreq_ie_end[1] + 2) - 22161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt tfsreq_ie_start; 22261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "TFS Req IE(s) found"); 22361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* pass the TFS Req IE(s) to driver for processing */ 22461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, 22561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &tfsreq_ie_len, 22661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt WNM_SLEEP_TFS_REQ_IE_SET)) 22761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wpa_printf(MSG_DEBUG, "Fail to set TFS Req IE"); 22861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 22961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 23061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ieee802_11_send_wnmsleep_resp(hapd, addr, dialog_token, 23161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie->action_type, 23261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt wnmsleep_ie->intval); 23361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 23461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt if (wnmsleep_ie->action_type == 1) { 23561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt /* clear the tfs after sending the resp frame */ 23661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, 23761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt &tfsreq_ie_len, WNM_SLEEP_TFS_IE_DEL); 23861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 23961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 24061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 24161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 24261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtvoid ieee802_11_rx_wnm_action_ap(struct hostapd_data *hapd, 24361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt struct rx_action *action) 24461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{ 24561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 *pos = (u8 *) action->data + 1; /* point to the action field */ 24661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt u8 act = *pos; 24761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 24861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt switch (act) { 24961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt case WNM_SLEEP_MODE_REQ: 25061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt ieee802_11_rx_wnmsleep_req(hapd, action->sa, action->data + 1, 25161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt action->len); 25261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 25361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt default: 25461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt break; 25561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt } 25661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt} 25761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt 25861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211V */ 259