161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/*
261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt * hostapd - WNM
3fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt * Copyright (c) 2011-2014, 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"
14fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt#include "common/wpa_ctrl.h"
1561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/hostapd.h"
1661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/sta_info.h"
1761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_config.h"
1861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/ap_drv_ops.h"
1961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "ap/wpa_auth.h"
2057c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt#include "mbo_ap.h"
2161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#include "wnm_ap.h"
2261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
2361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_TFS_IE_LEN  1024
2461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
2561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
2661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* get the TFS IE from driver */
2761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee80211_11_get_tfs_ie(struct hostapd_data *hapd, const u8 *addr,
2861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				   u8 *buf, u16 *buf_len, enum wnm_oper oper)
2961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
3061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wpa_printf(MSG_DEBUG, "%s: TFS get operation %d", __func__, oper);
3161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
3261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len);
3361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
3461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
3561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
3661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* set the TFS IE to driver */
3761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee80211_11_set_tfs_ie(struct hostapd_data *hapd, const u8 *addr,
3861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				   u8 *buf, u16 *buf_len, enum wnm_oper oper)
3961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
4061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wpa_printf(MSG_DEBUG, "%s: TFS set operation %d", __func__, oper);
4161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
4261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len);
4361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
4461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
4561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
4661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt/* MLME-SLEEPMODE.response */
4761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic int ieee802_11_send_wnmsleep_resp(struct hostapd_data *hapd,
4861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					 const u8 *addr, u8 dialog_token,
4961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					 u8 action_type, u16 intval)
5061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
5161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	struct ieee80211_mgmt *mgmt;
5261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	int res;
5361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t len;
5461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t gtk_elem_len = 0;
5561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	size_t igtk_elem_len = 0;
5661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	struct wnm_sleep_element wnmsleep_ie;
5761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u8 *wnmtfs_ie;
5861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u8 wnmsleep_ie_len;
5961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u16 wnmtfs_ie_len;
6061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u8 *pos;
6161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	struct sta_info *sta;
62a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	enum wnm_oper tfs_oper = action_type == WNM_SLEEP_MODE_ENTER ?
63a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		WNM_SLEEP_TFS_RESP_IE_ADD : WNM_SLEEP_TFS_RESP_IE_NONE;
6461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
6561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	sta = ap_get_sta(hapd, addr);
6661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (sta == NULL) {
6761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "%s: station not found", __func__);
6861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return -EINVAL;
6961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
7061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
7161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* WNM-Sleep Mode IE */
7261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memset(&wnmsleep_ie, 0, sizeof(struct wnm_sleep_element));
7361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmsleep_ie_len = sizeof(struct wnm_sleep_element);
7461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmsleep_ie.eid = WLAN_EID_WNMSLEEP;
7561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmsleep_ie.len = wnmsleep_ie_len - 2;
7661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmsleep_ie.action_type = action_type;
7761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmsleep_ie.status = WNM_STATUS_SLEEP_ACCEPT;
78fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wnmsleep_ie.intval = host_to_le16(intval);
7961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
8061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* TFS IE(s) */
8161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	wnmtfs_ie = os_zalloc(MAX_TFS_IE_LEN);
8261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (wnmtfs_ie == NULL)
8361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return -1;
8461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (ieee80211_11_get_tfs_ie(hapd, addr, wnmtfs_ie, &wnmtfs_ie_len,
8561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				    tfs_oper)) {
8661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wnmtfs_ie_len = 0;
8761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		os_free(wnmtfs_ie);
8861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wnmtfs_ie = NULL;
8961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
9061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
9161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_GTK_SUBELEM_LEN 45
9261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#define MAX_IGTK_SUBELEM_LEN 26
9361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	mgmt = os_zalloc(sizeof(*mgmt) + wnmsleep_ie_len +
9461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			 MAX_GTK_SUBELEM_LEN + MAX_IGTK_SUBELEM_LEN);
9561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (mgmt == NULL) {
9661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "MLME: Failed to allocate buffer for "
9761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			   "WNM-Sleep Response action frame");
9857c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		os_free(wnmtfs_ie);
9961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return -1;
10061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
10161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memcpy(mgmt->da, addr, ETH_ALEN);
10261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
10361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN);
10461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
10561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					   WLAN_FC_STYPE_ACTION);
10661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	mgmt->u.action.category = WLAN_ACTION_WNM;
10761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	mgmt->u.action.u.wnm_sleep_resp.action = WNM_SLEEP_MODE_RESP;
10861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	mgmt->u.action.u.wnm_sleep_resp.dialogtoken = dialog_token;
10961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	pos = (u8 *)mgmt->u.action.u.wnm_sleep_resp.variable;
11061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* add key data if MFP is enabled */
111a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	if (!wpa_auth_uses_mfp(sta->wpa_sm) ||
112a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	    action_type != WNM_SLEEP_MODE_EXIT) {
11361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		mgmt->u.action.u.wnm_sleep_resp.keydata_len = 0;
11461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	} else {
11561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		gtk_elem_len = wpa_wnmsleep_gtk_subelem(sta->wpa_sm, pos);
11661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		pos += gtk_elem_len;
11761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Pass 4, gtk_len = %d",
11861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			   (int) gtk_elem_len);
11961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#ifdef CONFIG_IEEE80211W
12061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		res = wpa_wnmsleep_igtk_subelem(sta->wpa_sm, pos);
12161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (res < 0) {
12261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_free(wnmtfs_ie);
12361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			os_free(mgmt);
12461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			return -1;
12561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
12661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		igtk_elem_len = res;
12761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		pos += igtk_elem_len;
12861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Pass 4 igtk_len = %d",
12961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			   (int) igtk_elem_len);
13061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#endif /* CONFIG_IEEE80211W */
13161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
13261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		WPA_PUT_LE16((u8 *)
13361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			     &mgmt->u.action.u.wnm_sleep_resp.keydata_len,
13461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			     gtk_elem_len + igtk_elem_len);
13561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
13661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_memcpy(pos, &wnmsleep_ie, wnmsleep_ie_len);
13761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* copy TFS IE here */
13861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	pos += wnmsleep_ie_len;
139a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	if (wnmtfs_ie)
140a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		os_memcpy(pos, wnmtfs_ie, wnmtfs_ie_len);
14161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
14261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	len = 1 + sizeof(mgmt->u.action.u.wnm_sleep_resp) + gtk_elem_len +
14361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		igtk_elem_len + wnmsleep_ie_len + wnmtfs_ie_len;
14461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
14561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* In driver, response frame should be forced to sent when STA is in
14661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	 * PS mode */
14761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0,
14861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				      mgmt->da, &mgmt->u.action.category, len);
14961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
15061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (!res) {
15161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Successfully send WNM-Sleep Response "
15261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			   "frame");
15361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
15461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		/* when entering wnmsleep
15561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * 1. pause the node in driver
15661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * 2. mark the node so that AP won't update GTK/IGTK during
15761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * WNM Sleep
15861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 */
15961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT &&
160a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		    wnmsleep_ie.action_type == WNM_SLEEP_MODE_ENTER) {
161fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			sta->flags |= WLAN_STA_WNM_SLEEP_MODE;
16261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			hostapd_drv_wnm_oper(hapd, WNM_SLEEP_ENTER_CONFIRM,
16361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					     addr, NULL, NULL);
16461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			wpa_set_wnmsleep(sta->wpa_sm, 1);
16561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
16661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		/* when exiting wnmsleep
16761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * 1. unmark the node
16861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * 2. start GTK/IGTK update if MFP is not used
16961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 * 3. unpause the node in driver
17061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		 */
171a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		if ((wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT ||
172a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		     wnmsleep_ie.status ==
173a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		     WNM_STATUS_SLEEP_EXIT_ACCEPT_GTK_UPDATE) &&
174a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		    wnmsleep_ie.action_type == WNM_SLEEP_MODE_EXIT) {
175fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			sta->flags &= ~WLAN_STA_WNM_SLEEP_MODE;
17661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			wpa_set_wnmsleep(sta->wpa_sm, 0);
17761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			hostapd_drv_wnm_oper(hapd, WNM_SLEEP_EXIT_CONFIRM,
17861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					     addr, NULL, NULL);
179a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt			if (!wpa_auth_uses_mfp(sta->wpa_sm))
18061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				wpa_wnmsleep_rekey_gtk(sta->wpa_sm);
18161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		}
18261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	} else
18361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Fail to send WNM-Sleep Response frame");
18461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
18561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_GTK_SUBELEM_LEN
18661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt#undef MAX_IGTK_SUBELEM_LEN
18761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_free(wnmtfs_ie);
18861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	os_free(mgmt);
18961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return res;
19061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
19161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
19261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
19361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidtstatic void ieee802_11_rx_wnmsleep_req(struct hostapd_data *hapd,
19461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				       const u8 *addr, const u8 *frm, int len)
19561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
196a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	/* Dialog Token [1] | WNM-Sleep Mode IE | TFS Response IE */
197a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	const u8 *pos = frm;
198a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	u8 dialog_token;
19961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	struct wnm_sleep_element *wnmsleep_ie = NULL;
20061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	/* multiple TFS Req IE (assuming consecutive) */
20161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u8 *tfsreq_ie_start = NULL;
20261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u8 *tfsreq_ie_end = NULL;
20361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	u16 tfsreq_ie_len = 0;
20461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
205a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	dialog_token = *pos++;
206a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	while (pos + 1 < frm + len) {
207a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		u8 ie_len = pos[1];
208a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		if (pos + 2 + ie_len > frm + len)
209a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt			break;
21061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (*pos == WLAN_EID_WNMSLEEP)
211a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt			wnmsleep_ie = (struct wnm_sleep_element *) pos;
21261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		else if (*pos == WLAN_EID_TFS_REQ) {
21361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			if (!tfsreq_ie_start)
214a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt				tfsreq_ie_start = (u8 *) pos;
215a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt			tfsreq_ie_end = (u8 *) pos;
21661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		} else
217a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt			wpa_printf(MSG_DEBUG, "WNM: EID %d not recognized",
218a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt				   *pos);
21961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		pos += ie_len + 2;
22061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
22161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
22261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (!wnmsleep_ie) {
22361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "No WNM-Sleep IE found");
22461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		return;
22561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
22661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
227a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_ENTER &&
228a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	    tfsreq_ie_start && tfsreq_ie_end &&
229a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	    tfsreq_ie_end - tfsreq_ie_start >= 0) {
23061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		tfsreq_ie_len = (tfsreq_ie_end + tfsreq_ie_end[1] + 2) -
23161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			tfsreq_ie_start;
23261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		wpa_printf(MSG_DEBUG, "TFS Req IE(s) found");
23361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		/* pass the TFS Req IE(s) to driver for processing */
23461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		if (ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start,
23561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					    &tfsreq_ie_len,
23661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					    WNM_SLEEP_TFS_REQ_IE_SET))
23761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			wpa_printf(MSG_DEBUG, "Fail to set TFS Req IE");
23861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
23961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
24061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	ieee802_11_send_wnmsleep_resp(hapd, addr, dialog_token,
24161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt				      wnmsleep_ie->action_type,
242fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt				      le_to_host16(wnmsleep_ie->intval));
24361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
244a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT) {
24561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		/* clear the tfs after sending the resp frame */
24661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start,
24761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					&tfsreq_ie_len, WNM_SLEEP_TFS_IE_DEL);
24861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
24961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt}
25061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
25161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
252fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic int ieee802_11_send_bss_trans_mgmt_request(struct hostapd_data *hapd,
253fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt						  const u8 *addr,
254fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt						  u8 dialog_token,
255fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt						  const char *url)
256fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
257fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	struct ieee80211_mgmt *mgmt;
258fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	size_t url_len, len;
259fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 *pos;
260fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	int res;
261fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
262fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (url)
263fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		url_len = os_strlen(url);
264fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	else
265fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		url_len = 0;
266fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
267fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt = os_zalloc(sizeof(*mgmt) + (url_len ? 1 + url_len : 0));
268fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (mgmt == NULL)
269fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return -1;
270fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->da, addr, ETH_ALEN);
271fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
272fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN);
273fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
274fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					   WLAN_FC_STYPE_ACTION);
275fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.category = WLAN_ACTION_WNM;
276fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ;
277fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.dialog_token = dialog_token;
278fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.req_mode = 0;
279fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.disassoc_timer = host_to_le16(0);
280fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.validity_interval = 1;
281fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos = mgmt->u.action.u.bss_tm_req.variable;
282fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (url) {
283fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		*pos++ += url_len;
284fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		os_memcpy(pos, url, url_len);
285fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		pos += url_len;
286fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
287fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
288fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request to "
289fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MACSTR " dialog_token=%u req_mode=0x%x disassoc_timer=%u "
290fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   "validity_interval=%u",
291fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MAC2STR(addr), dialog_token,
292fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   mgmt->u.action.u.bss_tm_req.req_mode,
293fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   le_to_host16(mgmt->u.action.u.bss_tm_req.disassoc_timer),
294fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   mgmt->u.action.u.bss_tm_req.validity_interval);
295fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
296fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	len = pos - &mgmt->u.action.category;
297fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0,
298fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt				      mgmt->da, &mgmt->u.action.category, len);
299fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_free(mgmt);
300fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	return res;
301fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
302fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
303fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
304fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic void ieee802_11_rx_bss_trans_mgmt_query(struct hostapd_data *hapd,
305fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					       const u8 *addr, const u8 *frm,
306fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					       size_t len)
307fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
308fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 dialog_token, reason;
309fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	const u8 *pos, *end;
310fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
311fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (len < 2) {
312fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Query from "
313fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			   MACSTR, MAC2STR(addr));
314fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return;
315fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
316fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
317fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos = frm;
318fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	end = pos + len;
319fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	dialog_token = *pos++;
320fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	reason = *pos++;
321fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
322fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Query from "
323fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MACSTR " dialog_token=%u reason=%u",
324fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MAC2STR(addr), dialog_token, reason);
325fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
326fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries",
327fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		    pos, end - pos);
328fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
329fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	ieee802_11_send_bss_trans_mgmt_request(hapd, addr, dialog_token, NULL);
330fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
331fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
332fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
333fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtstatic void ieee802_11_rx_bss_trans_mgmt_resp(struct hostapd_data *hapd,
334fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					      const u8 *addr, const u8 *frm,
335fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					      size_t len)
336fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
337fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 dialog_token, status_code, bss_termination_delay;
338fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	const u8 *pos, *end;
339fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
340fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (len < 3) {
341fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Response from "
342fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			   MACSTR, MAC2STR(addr));
343fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return;
344fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
345fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
346fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos = frm;
347fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	end = pos + len;
348fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	dialog_token = *pos++;
349fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	status_code = *pos++;
350fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	bss_termination_delay = *pos++;
351fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
352fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Response from "
353fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MACSTR " dialog_token=%u status_code=%u "
354fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   "bss_termination_delay=%u", MAC2STR(addr), dialog_token,
355fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   status_code, bss_termination_delay);
356fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
357fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (status_code == WNM_BSS_TM_ACCEPT) {
358fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		if (end - pos < ETH_ALEN) {
359fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			wpa_printf(MSG_DEBUG, "WNM: not enough room for Target BSSID field");
360fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			return;
361fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		}
362fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WNM: Target BSSID: " MACSTR,
363fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			   MAC2STR(pos));
364fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, BSS_TM_RESP MACSTR
365fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			" status_code=%u bss_termination_delay=%u target_bssid="
366fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			MACSTR,
367fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			MAC2STR(addr), status_code, bss_termination_delay,
368fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			MAC2STR(pos));
369fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		pos += ETH_ALEN;
370fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	} else {
371fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, BSS_TM_RESP MACSTR
372fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			" status_code=%u bss_termination_delay=%u",
373fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			MAC2STR(addr), status_code, bss_termination_delay);
374fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
375fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
376fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries",
377fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		    pos, end - pos);
378fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
379fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
380fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
38157c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidtstatic void ieee802_11_rx_wnm_notification_req(struct hostapd_data *hapd,
38257c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt					       const u8 *addr, const u8 *buf,
38357c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt					       size_t len)
38457c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt{
38557c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	u8 dialog_token, type;
38657c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt
38757c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	if (len < 2)
38857c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		return;
38957c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	dialog_token = *buf++;
39057c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	type = *buf++;
39157c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	len -= 2;
39257c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt
39357c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	wpa_printf(MSG_DEBUG,
39457c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		   "WNM: Received WNM Notification Request frame from "
39557c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		   MACSTR " (dialog_token=%u type=%u)",
39657c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		   MAC2STR(addr), dialog_token, type);
39757c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	wpa_hexdump(MSG_MSGDUMP, "WNM: Notification Request subelements",
39857c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		    buf, len);
39957c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	if (type == WLAN_EID_VENDOR_SPECIFIC)
40057c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		mbo_ap_wnm_notification_req(hapd, addr, buf, len);
40157c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt}
40257c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt
40357c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt
404a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidtint ieee802_11_rx_wnm_action_ap(struct hostapd_data *hapd,
405fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt				const struct ieee80211_mgmt *mgmt, size_t len)
40661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt{
407fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 action;
408fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	const u8 *payload;
409fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	size_t plen;
410fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
411fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (len < IEEE80211_HDRLEN + 2)
412a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		return -1;
41361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
414623d63a3a443027e50efdaaec027befcc3882527Dmitry Shmidt	payload = ((const u8 *) mgmt) + IEEE80211_HDRLEN + 1;
415fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	action = *payload++;
416623d63a3a443027e50efdaaec027befcc3882527Dmitry Shmidt	plen = len - IEEE80211_HDRLEN - 2;
417fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
418fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	switch (action) {
419a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	case WNM_BSS_TRANS_MGMT_QUERY:
420fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		ieee802_11_rx_bss_trans_mgmt_query(hapd, mgmt->sa, payload,
421fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt						   plen);
422fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return 0;
423a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	case WNM_BSS_TRANS_MGMT_RESP:
424fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		ieee802_11_rx_bss_trans_mgmt_resp(hapd, mgmt->sa, payload,
425fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt						  plen);
426fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return 0;
42761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	case WNM_SLEEP_MODE_REQ:
428fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		ieee802_11_rx_wnmsleep_req(hapd, mgmt->sa, payload, plen);
429a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		return 0;
43057c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	case WNM_NOTIFICATION_REQ:
43157c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		ieee802_11_rx_wnm_notification_req(hapd, mgmt->sa, payload,
43257c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt						   plen);
43357c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		return 0;
43461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
43561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt
436a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: Unsupported WNM Action %u from " MACSTR,
437fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   action, MAC2STR(mgmt->sa));
438a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	return -1;
439a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt}
440fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
441fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
442fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint wnm_send_disassoc_imminent(struct hostapd_data *hapd,
443fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			       struct sta_info *sta, int disassoc_timer)
444fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
445fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 buf[1000], *pos;
446fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	struct ieee80211_mgmt *mgmt;
447fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
448fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memset(buf, 0, sizeof(buf));
449fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt = (struct ieee80211_mgmt *) buf;
450fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
451fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					   WLAN_FC_STYPE_ACTION);
452fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->da, sta->addr, ETH_ALEN);
453fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
454fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN);
455fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.category = WLAN_ACTION_WNM;
456fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ;
457fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.dialog_token = 1;
458fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.req_mode =
459fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		WNM_BSS_TM_REQ_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 = 0;
463fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
464fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos = mgmt->u.action.u.bss_tm_req.variable;
465fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
466fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request frame to indicate imminent disassociation (disassoc_timer=%d) to "
467fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		   MACSTR, disassoc_timer, MAC2STR(sta->addr));
468fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) {
469fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Failed to send BSS Transition "
470fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			   "Management Request frame");
471fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return -1;
472fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
473fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
474fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	return 0;
475fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
476fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
477fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
478fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidtstatic void set_disassoc_timer(struct hostapd_data *hapd, struct sta_info *sta,
479fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			       int disassoc_timer)
480fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt{
481fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	int timeout, beacon_int;
482fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
483fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	/*
484fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	 * Prevent STA from reconnecting using cached PMKSA to force
485fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	 * full authentication with the authentication server (which may
486fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	 * decide to reject the connection),
487fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	 */
488fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	wpa_auth_pmksa_remove(hapd->wpa_auth, sta->addr);
489fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
490fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	beacon_int = hapd->iconf->beacon_int;
491fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (beacon_int < 1)
492fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		beacon_int = 100; /* best guess */
493fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	/* Calculate timeout in ms based on beacon_int in TU */
494fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	timeout = disassoc_timer * beacon_int * 128 / 125;
495fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	wpa_printf(MSG_DEBUG, "Disassociation timer for " MACSTR
496fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		   " set to %d ms", MAC2STR(sta->addr), timeout);
497fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
498fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	sta->timeout_next = STA_DISASSOC_FROM_CLI;
499fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	eloop_cancel_timeout(ap_handle_timer, hapd, sta);
500fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	eloop_register_timeout(timeout / 1000,
501fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			       timeout % 1000 * 1000,
502fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			       ap_handle_timer, hapd, sta);
503fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt}
504fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
505fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
506fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtint wnm_send_ess_disassoc_imminent(struct hostapd_data *hapd,
507fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt				   struct sta_info *sta, const char *url,
508fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt				   int disassoc_timer)
509fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
510fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	u8 buf[1000], *pos;
511fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	struct ieee80211_mgmt *mgmt;
512fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	size_t url_len;
513fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
514fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memset(buf, 0, sizeof(buf));
515fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt = (struct ieee80211_mgmt *) buf;
516fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
517fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt					   WLAN_FC_STYPE_ACTION);
518fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->da, sta->addr, ETH_ALEN);
519fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
520fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN);
521fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.category = WLAN_ACTION_WNM;
522fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ;
523fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.dialog_token = 1;
524fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.req_mode =
525fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		WNM_BSS_TM_REQ_DISASSOC_IMMINENT |
526fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT;
527fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.disassoc_timer =
528fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		host_to_le16(disassoc_timer);
529fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.validity_interval = 0x01;
530fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
531fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos = mgmt->u.action.u.bss_tm_req.variable;
532fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
533fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	/* Session Information URL */
534fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	url_len = os_strlen(url);
535fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (url_len > 255)
536fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return -1;
537fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	*pos++ = url_len;
538fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	os_memcpy(pos, url, url_len);
539fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	pos += url_len;
540fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
541fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) {
542fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Failed to send BSS Transition "
543fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt			   "Management Request frame");
544fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		return -1;
545fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
546fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
547fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (disassoc_timer) {
548fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		/* send disassociation frame after time-out */
549fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		set_disassoc_timer(hapd, sta, disassoc_timer);
550fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	}
551fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
552fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	return 0;
553fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt}
554fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
555fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
556fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidtint wnm_send_bss_tm_req(struct hostapd_data *hapd, struct sta_info *sta,
557fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			u8 req_mode, int disassoc_timer, u8 valid_int,
558fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			const u8 *bss_term_dur, const char *url,
55957c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt			const u8 *nei_rep, size_t nei_rep_len,
56057c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt			const u8 *mbo_attrs, size_t mbo_len)
561fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt{
562fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	u8 *buf, *pos;
563fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	struct ieee80211_mgmt *mgmt;
564fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	size_t url_len;
565fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
566fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request to "
567fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		   MACSTR " req_mode=0x%x disassoc_timer=%d valid_int=0x%x",
568fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		   MAC2STR(sta->addr), req_mode, disassoc_timer, valid_int);
56957c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	buf = os_zalloc(1000 + nei_rep_len + mbo_len);
570fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (buf == NULL)
571fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		return -1;
572fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt = (struct ieee80211_mgmt *) buf;
573fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT,
574fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt					   WLAN_FC_STYPE_ACTION);
575fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	os_memcpy(mgmt->da, sta->addr, ETH_ALEN);
576fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN);
577fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN);
578fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.category = WLAN_ACTION_WNM;
579fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ;
580fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.dialog_token = 1;
581fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.req_mode = req_mode;
582fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.disassoc_timer =
583fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		host_to_le16(disassoc_timer);
584fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	mgmt->u.action.u.bss_tm_req.validity_interval = valid_int;
585fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
586fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	pos = mgmt->u.action.u.bss_tm_req.variable;
587fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
588fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if ((req_mode & WNM_BSS_TM_REQ_BSS_TERMINATION_INCLUDED) &&
589fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	    bss_term_dur) {
590fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		os_memcpy(pos, bss_term_dur, 12);
591fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		pos += 12;
592fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	}
593fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
594fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (url) {
595fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		/* Session Information URL */
596fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		url_len = os_strlen(url);
597432d603c922e970f55866c63212d29c997438977Dmitry Shmidt		if (url_len > 255) {
598432d603c922e970f55866c63212d29c997438977Dmitry Shmidt			os_free(buf);
599fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			return -1;
600432d603c922e970f55866c63212d29c997438977Dmitry Shmidt		}
601432d603c922e970f55866c63212d29c997438977Dmitry Shmidt
602fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		*pos++ = url_len;
603fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		os_memcpy(pos, url, url_len);
604fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		pos += url_len;
605fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	}
606fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
607fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (nei_rep) {
608fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		os_memcpy(pos, nei_rep, nei_rep_len);
609fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		pos += nei_rep_len;
610fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	}
611fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
61257c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	if (mbo_len > 0) {
61357c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt		pos += mbo_add_ie(pos, buf + sizeof(buf) - pos, mbo_attrs,
61457c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt				  mbo_len);
61557c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt	}
61657c2d39d85825f38c5fdac9b73bb0088406ffc85Dmitry Shmidt
617fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) {
618fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		wpa_printf(MSG_DEBUG,
619fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt			   "Failed to send BSS Transition Management Request frame");
620fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		os_free(buf);
621fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		return -1;
622fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	}
623fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	os_free(buf);
624fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt
625fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt	if (disassoc_timer) {
626fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		/* send disassociation frame after time-out */
627fb45fd5cfed8bdccd0859c7fc05449fc187e2d06Dmitry Shmidt		set_disassoc_timer(hapd, sta, disassoc_timer);
628fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	}
629fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
630fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	return 0;
631fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
632