Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 1 | /* |
| 2 | * hostapd - WNM |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 3 | * Copyright (c) 2011-2014, Qualcomm Atheros, Inc. |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 4 | * |
| 5 | * This software may be distributed under the terms of the BSD license. |
| 6 | * See README for more details. |
| 7 | */ |
| 8 | |
| 9 | #include "utils/includes.h" |
| 10 | |
| 11 | #include "utils/common.h" |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 12 | #include "utils/eloop.h" |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 13 | #include "common/ieee802_11_defs.h" |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 14 | #include "common/wpa_ctrl.h" |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 15 | #include "ap/hostapd.h" |
| 16 | #include "ap/sta_info.h" |
| 17 | #include "ap/ap_config.h" |
| 18 | #include "ap/ap_drv_ops.h" |
| 19 | #include "ap/wpa_auth.h" |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 20 | #include "mbo_ap.h" |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 21 | #include "wnm_ap.h" |
| 22 | |
| 23 | #define MAX_TFS_IE_LEN 1024 |
| 24 | |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 25 | |
| 26 | /* get the TFS IE from driver */ |
| 27 | static int ieee80211_11_get_tfs_ie(struct hostapd_data *hapd, const u8 *addr, |
| 28 | u8 *buf, u16 *buf_len, enum wnm_oper oper) |
| 29 | { |
| 30 | wpa_printf(MSG_DEBUG, "%s: TFS get operation %d", __func__, oper); |
| 31 | |
| 32 | return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len); |
| 33 | } |
| 34 | |
| 35 | |
| 36 | /* set the TFS IE to driver */ |
| 37 | static int ieee80211_11_set_tfs_ie(struct hostapd_data *hapd, const u8 *addr, |
| 38 | u8 *buf, u16 *buf_len, enum wnm_oper oper) |
| 39 | { |
| 40 | wpa_printf(MSG_DEBUG, "%s: TFS set operation %d", __func__, oper); |
| 41 | |
| 42 | return hostapd_drv_wnm_oper(hapd, oper, addr, buf, buf_len); |
| 43 | } |
| 44 | |
| 45 | |
| 46 | /* MLME-SLEEPMODE.response */ |
| 47 | static int ieee802_11_send_wnmsleep_resp(struct hostapd_data *hapd, |
| 48 | const u8 *addr, u8 dialog_token, |
| 49 | u8 action_type, u16 intval) |
| 50 | { |
| 51 | struct ieee80211_mgmt *mgmt; |
| 52 | int res; |
| 53 | size_t len; |
| 54 | size_t gtk_elem_len = 0; |
| 55 | size_t igtk_elem_len = 0; |
| 56 | struct wnm_sleep_element wnmsleep_ie; |
| 57 | u8 *wnmtfs_ie; |
| 58 | u8 wnmsleep_ie_len; |
| 59 | u16 wnmtfs_ie_len; |
| 60 | u8 *pos; |
| 61 | struct sta_info *sta; |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 62 | enum wnm_oper tfs_oper = action_type == WNM_SLEEP_MODE_ENTER ? |
| 63 | WNM_SLEEP_TFS_RESP_IE_ADD : WNM_SLEEP_TFS_RESP_IE_NONE; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 64 | |
| 65 | sta = ap_get_sta(hapd, addr); |
| 66 | if (sta == NULL) { |
| 67 | wpa_printf(MSG_DEBUG, "%s: station not found", __func__); |
| 68 | return -EINVAL; |
| 69 | } |
| 70 | |
| 71 | /* WNM-Sleep Mode IE */ |
| 72 | os_memset(&wnmsleep_ie, 0, sizeof(struct wnm_sleep_element)); |
| 73 | wnmsleep_ie_len = sizeof(struct wnm_sleep_element); |
| 74 | wnmsleep_ie.eid = WLAN_EID_WNMSLEEP; |
| 75 | wnmsleep_ie.len = wnmsleep_ie_len - 2; |
| 76 | wnmsleep_ie.action_type = action_type; |
| 77 | wnmsleep_ie.status = WNM_STATUS_SLEEP_ACCEPT; |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 78 | wnmsleep_ie.intval = host_to_le16(intval); |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 79 | |
| 80 | /* TFS IE(s) */ |
| 81 | wnmtfs_ie = os_zalloc(MAX_TFS_IE_LEN); |
| 82 | if (wnmtfs_ie == NULL) |
| 83 | return -1; |
| 84 | if (ieee80211_11_get_tfs_ie(hapd, addr, wnmtfs_ie, &wnmtfs_ie_len, |
| 85 | tfs_oper)) { |
| 86 | wnmtfs_ie_len = 0; |
| 87 | os_free(wnmtfs_ie); |
| 88 | wnmtfs_ie = NULL; |
| 89 | } |
| 90 | |
| 91 | #define MAX_GTK_SUBELEM_LEN 45 |
| 92 | #define MAX_IGTK_SUBELEM_LEN 26 |
| 93 | mgmt = os_zalloc(sizeof(*mgmt) + wnmsleep_ie_len + |
| 94 | MAX_GTK_SUBELEM_LEN + MAX_IGTK_SUBELEM_LEN); |
| 95 | if (mgmt == NULL) { |
| 96 | wpa_printf(MSG_DEBUG, "MLME: Failed to allocate buffer for " |
| 97 | "WNM-Sleep Response action frame"); |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 98 | os_free(wnmtfs_ie); |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 99 | return -1; |
| 100 | } |
| 101 | os_memcpy(mgmt->da, addr, ETH_ALEN); |
| 102 | os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); |
| 103 | os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); |
| 104 | mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, |
| 105 | WLAN_FC_STYPE_ACTION); |
| 106 | mgmt->u.action.category = WLAN_ACTION_WNM; |
| 107 | mgmt->u.action.u.wnm_sleep_resp.action = WNM_SLEEP_MODE_RESP; |
| 108 | mgmt->u.action.u.wnm_sleep_resp.dialogtoken = dialog_token; |
| 109 | pos = (u8 *)mgmt->u.action.u.wnm_sleep_resp.variable; |
| 110 | /* add key data if MFP is enabled */ |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 111 | if (!wpa_auth_uses_mfp(sta->wpa_sm) || |
| 112 | action_type != WNM_SLEEP_MODE_EXIT) { |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 113 | mgmt->u.action.u.wnm_sleep_resp.keydata_len = 0; |
| 114 | } else { |
| 115 | gtk_elem_len = wpa_wnmsleep_gtk_subelem(sta->wpa_sm, pos); |
| 116 | pos += gtk_elem_len; |
| 117 | wpa_printf(MSG_DEBUG, "Pass 4, gtk_len = %d", |
| 118 | (int) gtk_elem_len); |
| 119 | #ifdef CONFIG_IEEE80211W |
| 120 | res = wpa_wnmsleep_igtk_subelem(sta->wpa_sm, pos); |
| 121 | if (res < 0) { |
| 122 | os_free(wnmtfs_ie); |
| 123 | os_free(mgmt); |
| 124 | return -1; |
| 125 | } |
| 126 | igtk_elem_len = res; |
| 127 | pos += igtk_elem_len; |
| 128 | wpa_printf(MSG_DEBUG, "Pass 4 igtk_len = %d", |
| 129 | (int) igtk_elem_len); |
| 130 | #endif /* CONFIG_IEEE80211W */ |
| 131 | |
| 132 | WPA_PUT_LE16((u8 *) |
| 133 | &mgmt->u.action.u.wnm_sleep_resp.keydata_len, |
| 134 | gtk_elem_len + igtk_elem_len); |
| 135 | } |
| 136 | os_memcpy(pos, &wnmsleep_ie, wnmsleep_ie_len); |
| 137 | /* copy TFS IE here */ |
| 138 | pos += wnmsleep_ie_len; |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 139 | if (wnmtfs_ie) |
| 140 | os_memcpy(pos, wnmtfs_ie, wnmtfs_ie_len); |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 141 | |
| 142 | len = 1 + sizeof(mgmt->u.action.u.wnm_sleep_resp) + gtk_elem_len + |
| 143 | igtk_elem_len + wnmsleep_ie_len + wnmtfs_ie_len; |
| 144 | |
| 145 | /* In driver, response frame should be forced to sent when STA is in |
| 146 | * PS mode */ |
| 147 | res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, |
| 148 | mgmt->da, &mgmt->u.action.category, len); |
| 149 | |
| 150 | if (!res) { |
| 151 | wpa_printf(MSG_DEBUG, "Successfully send WNM-Sleep Response " |
| 152 | "frame"); |
| 153 | |
| 154 | /* when entering wnmsleep |
| 155 | * 1. pause the node in driver |
| 156 | * 2. mark the node so that AP won't update GTK/IGTK during |
| 157 | * WNM Sleep |
| 158 | */ |
| 159 | if (wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT && |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 160 | wnmsleep_ie.action_type == WNM_SLEEP_MODE_ENTER) { |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 161 | sta->flags |= WLAN_STA_WNM_SLEEP_MODE; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 162 | hostapd_drv_wnm_oper(hapd, WNM_SLEEP_ENTER_CONFIRM, |
| 163 | addr, NULL, NULL); |
| 164 | wpa_set_wnmsleep(sta->wpa_sm, 1); |
| 165 | } |
| 166 | /* when exiting wnmsleep |
| 167 | * 1. unmark the node |
| 168 | * 2. start GTK/IGTK update if MFP is not used |
| 169 | * 3. unpause the node in driver |
| 170 | */ |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 171 | if ((wnmsleep_ie.status == WNM_STATUS_SLEEP_ACCEPT || |
| 172 | wnmsleep_ie.status == |
| 173 | WNM_STATUS_SLEEP_EXIT_ACCEPT_GTK_UPDATE) && |
| 174 | wnmsleep_ie.action_type == WNM_SLEEP_MODE_EXIT) { |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 175 | sta->flags &= ~WLAN_STA_WNM_SLEEP_MODE; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 176 | wpa_set_wnmsleep(sta->wpa_sm, 0); |
| 177 | hostapd_drv_wnm_oper(hapd, WNM_SLEEP_EXIT_CONFIRM, |
| 178 | addr, NULL, NULL); |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 179 | if (!wpa_auth_uses_mfp(sta->wpa_sm)) |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 180 | wpa_wnmsleep_rekey_gtk(sta->wpa_sm); |
| 181 | } |
| 182 | } else |
| 183 | wpa_printf(MSG_DEBUG, "Fail to send WNM-Sleep Response frame"); |
| 184 | |
| 185 | #undef MAX_GTK_SUBELEM_LEN |
| 186 | #undef MAX_IGTK_SUBELEM_LEN |
| 187 | os_free(wnmtfs_ie); |
| 188 | os_free(mgmt); |
| 189 | return res; |
| 190 | } |
| 191 | |
| 192 | |
| 193 | static void ieee802_11_rx_wnmsleep_req(struct hostapd_data *hapd, |
| 194 | const u8 *addr, const u8 *frm, int len) |
| 195 | { |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 196 | /* Dialog Token [1] | WNM-Sleep Mode IE | TFS Response IE */ |
| 197 | const u8 *pos = frm; |
| 198 | u8 dialog_token; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 199 | struct wnm_sleep_element *wnmsleep_ie = NULL; |
| 200 | /* multiple TFS Req IE (assuming consecutive) */ |
| 201 | u8 *tfsreq_ie_start = NULL; |
| 202 | u8 *tfsreq_ie_end = NULL; |
| 203 | u16 tfsreq_ie_len = 0; |
| 204 | |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 205 | dialog_token = *pos++; |
| 206 | while (pos + 1 < frm + len) { |
| 207 | u8 ie_len = pos[1]; |
| 208 | if (pos + 2 + ie_len > frm + len) |
| 209 | break; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 210 | if (*pos == WLAN_EID_WNMSLEEP) |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 211 | wnmsleep_ie = (struct wnm_sleep_element *) pos; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 212 | else if (*pos == WLAN_EID_TFS_REQ) { |
| 213 | if (!tfsreq_ie_start) |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 214 | tfsreq_ie_start = (u8 *) pos; |
| 215 | tfsreq_ie_end = (u8 *) pos; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 216 | } else |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 217 | wpa_printf(MSG_DEBUG, "WNM: EID %d not recognized", |
| 218 | *pos); |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 219 | pos += ie_len + 2; |
| 220 | } |
| 221 | |
| 222 | if (!wnmsleep_ie) { |
| 223 | wpa_printf(MSG_DEBUG, "No WNM-Sleep IE found"); |
| 224 | return; |
| 225 | } |
| 226 | |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 227 | if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_ENTER && |
| 228 | tfsreq_ie_start && tfsreq_ie_end && |
| 229 | tfsreq_ie_end - tfsreq_ie_start >= 0) { |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 230 | tfsreq_ie_len = (tfsreq_ie_end + tfsreq_ie_end[1] + 2) - |
| 231 | tfsreq_ie_start; |
| 232 | wpa_printf(MSG_DEBUG, "TFS Req IE(s) found"); |
| 233 | /* pass the TFS Req IE(s) to driver for processing */ |
| 234 | if (ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, |
| 235 | &tfsreq_ie_len, |
| 236 | WNM_SLEEP_TFS_REQ_IE_SET)) |
| 237 | wpa_printf(MSG_DEBUG, "Fail to set TFS Req IE"); |
| 238 | } |
| 239 | |
| 240 | ieee802_11_send_wnmsleep_resp(hapd, addr, dialog_token, |
| 241 | wnmsleep_ie->action_type, |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 242 | le_to_host16(wnmsleep_ie->intval)); |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 243 | |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 244 | if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT) { |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 245 | /* clear the tfs after sending the resp frame */ |
| 246 | ieee80211_11_set_tfs_ie(hapd, addr, tfsreq_ie_start, |
| 247 | &tfsreq_ie_len, WNM_SLEEP_TFS_IE_DEL); |
| 248 | } |
| 249 | } |
| 250 | |
| 251 | |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 252 | static int ieee802_11_send_bss_trans_mgmt_request(struct hostapd_data *hapd, |
| 253 | const u8 *addr, |
| 254 | u8 dialog_token, |
| 255 | const char *url) |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 256 | { |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 257 | struct ieee80211_mgmt *mgmt; |
| 258 | size_t url_len, len; |
| 259 | u8 *pos; |
| 260 | int res; |
| 261 | |
| 262 | if (url) |
| 263 | url_len = os_strlen(url); |
| 264 | else |
| 265 | url_len = 0; |
| 266 | |
| 267 | mgmt = os_zalloc(sizeof(*mgmt) + (url_len ? 1 + url_len : 0)); |
| 268 | if (mgmt == NULL) |
| 269 | return -1; |
| 270 | os_memcpy(mgmt->da, addr, ETH_ALEN); |
| 271 | os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); |
| 272 | os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); |
| 273 | mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, |
| 274 | WLAN_FC_STYPE_ACTION); |
| 275 | mgmt->u.action.category = WLAN_ACTION_WNM; |
| 276 | mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; |
| 277 | mgmt->u.action.u.bss_tm_req.dialog_token = dialog_token; |
| 278 | mgmt->u.action.u.bss_tm_req.req_mode = 0; |
| 279 | mgmt->u.action.u.bss_tm_req.disassoc_timer = host_to_le16(0); |
| 280 | mgmt->u.action.u.bss_tm_req.validity_interval = 1; |
| 281 | pos = mgmt->u.action.u.bss_tm_req.variable; |
| 282 | if (url) { |
| 283 | *pos++ += url_len; |
| 284 | os_memcpy(pos, url, url_len); |
| 285 | pos += url_len; |
| 286 | } |
| 287 | |
| 288 | wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request to " |
| 289 | MACSTR " dialog_token=%u req_mode=0x%x disassoc_timer=%u " |
| 290 | "validity_interval=%u", |
| 291 | MAC2STR(addr), dialog_token, |
| 292 | mgmt->u.action.u.bss_tm_req.req_mode, |
| 293 | le_to_host16(mgmt->u.action.u.bss_tm_req.disassoc_timer), |
| 294 | mgmt->u.action.u.bss_tm_req.validity_interval); |
| 295 | |
| 296 | len = pos - &mgmt->u.action.category; |
| 297 | res = hostapd_drv_send_action(hapd, hapd->iface->freq, 0, |
| 298 | mgmt->da, &mgmt->u.action.category, len); |
| 299 | os_free(mgmt); |
| 300 | return res; |
| 301 | } |
| 302 | |
| 303 | |
| 304 | static void ieee802_11_rx_bss_trans_mgmt_query(struct hostapd_data *hapd, |
| 305 | const u8 *addr, const u8 *frm, |
| 306 | size_t len) |
| 307 | { |
| 308 | u8 dialog_token, reason; |
| 309 | const u8 *pos, *end; |
| 310 | |
| 311 | if (len < 2) { |
| 312 | wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Query from " |
| 313 | MACSTR, MAC2STR(addr)); |
| 314 | return; |
| 315 | } |
| 316 | |
| 317 | pos = frm; |
| 318 | end = pos + len; |
| 319 | dialog_token = *pos++; |
| 320 | reason = *pos++; |
| 321 | |
| 322 | wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Query from " |
| 323 | MACSTR " dialog_token=%u reason=%u", |
| 324 | MAC2STR(addr), dialog_token, reason); |
| 325 | |
| 326 | wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries", |
| 327 | pos, end - pos); |
| 328 | |
| 329 | ieee802_11_send_bss_trans_mgmt_request(hapd, addr, dialog_token, NULL); |
| 330 | } |
| 331 | |
| 332 | |
| 333 | static void ieee802_11_rx_bss_trans_mgmt_resp(struct hostapd_data *hapd, |
| 334 | const u8 *addr, const u8 *frm, |
| 335 | size_t len) |
| 336 | { |
| 337 | u8 dialog_token, status_code, bss_termination_delay; |
| 338 | const u8 *pos, *end; |
| 339 | |
| 340 | if (len < 3) { |
| 341 | wpa_printf(MSG_DEBUG, "WNM: Ignore too short BSS Transition Management Response from " |
| 342 | MACSTR, MAC2STR(addr)); |
| 343 | return; |
| 344 | } |
| 345 | |
| 346 | pos = frm; |
| 347 | end = pos + len; |
| 348 | dialog_token = *pos++; |
| 349 | status_code = *pos++; |
| 350 | bss_termination_delay = *pos++; |
| 351 | |
| 352 | wpa_printf(MSG_DEBUG, "WNM: BSS Transition Management Response from " |
| 353 | MACSTR " dialog_token=%u status_code=%u " |
| 354 | "bss_termination_delay=%u", MAC2STR(addr), dialog_token, |
| 355 | status_code, bss_termination_delay); |
| 356 | |
| 357 | if (status_code == WNM_BSS_TM_ACCEPT) { |
| 358 | if (end - pos < ETH_ALEN) { |
| 359 | wpa_printf(MSG_DEBUG, "WNM: not enough room for Target BSSID field"); |
| 360 | return; |
| 361 | } |
| 362 | wpa_printf(MSG_DEBUG, "WNM: Target BSSID: " MACSTR, |
| 363 | MAC2STR(pos)); |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 364 | wpa_msg(hapd->msg_ctx, MSG_INFO, BSS_TM_RESP MACSTR |
| 365 | " status_code=%u bss_termination_delay=%u target_bssid=" |
| 366 | MACSTR, |
| 367 | MAC2STR(addr), status_code, bss_termination_delay, |
| 368 | MAC2STR(pos)); |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 369 | pos += ETH_ALEN; |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 370 | } else { |
| 371 | wpa_msg(hapd->msg_ctx, MSG_INFO, BSS_TM_RESP MACSTR |
| 372 | " status_code=%u bss_termination_delay=%u", |
| 373 | MAC2STR(addr), status_code, bss_termination_delay); |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 374 | } |
| 375 | |
| 376 | wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries", |
| 377 | pos, end - pos); |
| 378 | } |
| 379 | |
| 380 | |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 381 | static void ieee802_11_rx_wnm_notification_req(struct hostapd_data *hapd, |
| 382 | const u8 *addr, const u8 *buf, |
| 383 | size_t len) |
| 384 | { |
| 385 | u8 dialog_token, type; |
| 386 | |
| 387 | if (len < 2) |
| 388 | return; |
| 389 | dialog_token = *buf++; |
| 390 | type = *buf++; |
| 391 | len -= 2; |
| 392 | |
| 393 | wpa_printf(MSG_DEBUG, |
| 394 | "WNM: Received WNM Notification Request frame from " |
| 395 | MACSTR " (dialog_token=%u type=%u)", |
| 396 | MAC2STR(addr), dialog_token, type); |
| 397 | wpa_hexdump(MSG_MSGDUMP, "WNM: Notification Request subelements", |
| 398 | buf, len); |
| 399 | if (type == WLAN_EID_VENDOR_SPECIFIC) |
| 400 | mbo_ap_wnm_notification_req(hapd, addr, buf, len); |
| 401 | } |
| 402 | |
| 403 | |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 404 | int ieee802_11_rx_wnm_action_ap(struct hostapd_data *hapd, |
| 405 | const struct ieee80211_mgmt *mgmt, size_t len) |
| 406 | { |
| 407 | u8 action; |
| 408 | const u8 *payload; |
| 409 | size_t plen; |
| 410 | |
| 411 | if (len < IEEE80211_HDRLEN + 2) |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 412 | return -1; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 413 | |
Dmitry Shmidt | 623d63a | 2014-06-13 11:05:14 -0700 | [diff] [blame] | 414 | payload = ((const u8 *) mgmt) + IEEE80211_HDRLEN + 1; |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 415 | action = *payload++; |
Dmitry Shmidt | 623d63a | 2014-06-13 11:05:14 -0700 | [diff] [blame] | 416 | plen = len - IEEE80211_HDRLEN - 2; |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 417 | |
| 418 | switch (action) { |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 419 | case WNM_BSS_TRANS_MGMT_QUERY: |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 420 | ieee802_11_rx_bss_trans_mgmt_query(hapd, mgmt->sa, payload, |
| 421 | plen); |
| 422 | return 0; |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 423 | case WNM_BSS_TRANS_MGMT_RESP: |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 424 | ieee802_11_rx_bss_trans_mgmt_resp(hapd, mgmt->sa, payload, |
| 425 | plen); |
| 426 | return 0; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 427 | case WNM_SLEEP_MODE_REQ: |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 428 | ieee802_11_rx_wnmsleep_req(hapd, mgmt->sa, payload, plen); |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 429 | return 0; |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 430 | case WNM_NOTIFICATION_REQ: |
| 431 | ieee802_11_rx_wnm_notification_req(hapd, mgmt->sa, payload, |
| 432 | plen); |
| 433 | return 0; |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 434 | } |
Dmitry Shmidt | 61d9df3 | 2012-08-29 16:22:06 -0700 | [diff] [blame] | 435 | |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 436 | wpa_printf(MSG_DEBUG, "WNM: Unsupported WNM Action %u from " MACSTR, |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 437 | action, MAC2STR(mgmt->sa)); |
Dmitry Shmidt | a54fa5f | 2013-01-15 13:53:35 -0800 | [diff] [blame] | 438 | return -1; |
| 439 | } |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 440 | |
| 441 | |
| 442 | int wnm_send_disassoc_imminent(struct hostapd_data *hapd, |
| 443 | struct sta_info *sta, int disassoc_timer) |
| 444 | { |
| 445 | u8 buf[1000], *pos; |
| 446 | struct ieee80211_mgmt *mgmt; |
| 447 | |
| 448 | os_memset(buf, 0, sizeof(buf)); |
| 449 | mgmt = (struct ieee80211_mgmt *) buf; |
| 450 | mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, |
| 451 | WLAN_FC_STYPE_ACTION); |
| 452 | os_memcpy(mgmt->da, sta->addr, ETH_ALEN); |
| 453 | os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); |
| 454 | os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); |
| 455 | mgmt->u.action.category = WLAN_ACTION_WNM; |
| 456 | mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; |
| 457 | mgmt->u.action.u.bss_tm_req.dialog_token = 1; |
| 458 | mgmt->u.action.u.bss_tm_req.req_mode = |
| 459 | WNM_BSS_TM_REQ_DISASSOC_IMMINENT; |
| 460 | mgmt->u.action.u.bss_tm_req.disassoc_timer = |
| 461 | host_to_le16(disassoc_timer); |
| 462 | mgmt->u.action.u.bss_tm_req.validity_interval = 0; |
| 463 | |
| 464 | pos = mgmt->u.action.u.bss_tm_req.variable; |
| 465 | |
| 466 | wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request frame to indicate imminent disassociation (disassoc_timer=%d) to " |
| 467 | MACSTR, disassoc_timer, MAC2STR(sta->addr)); |
| 468 | if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) { |
| 469 | wpa_printf(MSG_DEBUG, "Failed to send BSS Transition " |
| 470 | "Management Request frame"); |
| 471 | return -1; |
| 472 | } |
| 473 | |
| 474 | return 0; |
| 475 | } |
| 476 | |
| 477 | |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 478 | static void set_disassoc_timer(struct hostapd_data *hapd, struct sta_info *sta, |
| 479 | int disassoc_timer) |
| 480 | { |
| 481 | int timeout, beacon_int; |
| 482 | |
| 483 | /* |
| 484 | * Prevent STA from reconnecting using cached PMKSA to force |
| 485 | * full authentication with the authentication server (which may |
| 486 | * decide to reject the connection), |
| 487 | */ |
| 488 | wpa_auth_pmksa_remove(hapd->wpa_auth, sta->addr); |
| 489 | |
| 490 | beacon_int = hapd->iconf->beacon_int; |
| 491 | if (beacon_int < 1) |
| 492 | beacon_int = 100; /* best guess */ |
| 493 | /* Calculate timeout in ms based on beacon_int in TU */ |
| 494 | timeout = disassoc_timer * beacon_int * 128 / 125; |
| 495 | wpa_printf(MSG_DEBUG, "Disassociation timer for " MACSTR |
| 496 | " set to %d ms", MAC2STR(sta->addr), timeout); |
| 497 | |
| 498 | sta->timeout_next = STA_DISASSOC_FROM_CLI; |
| 499 | eloop_cancel_timeout(ap_handle_timer, hapd, sta); |
| 500 | eloop_register_timeout(timeout / 1000, |
| 501 | timeout % 1000 * 1000, |
| 502 | ap_handle_timer, hapd, sta); |
| 503 | } |
| 504 | |
| 505 | |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 506 | int wnm_send_ess_disassoc_imminent(struct hostapd_data *hapd, |
| 507 | struct sta_info *sta, const char *url, |
| 508 | int disassoc_timer) |
| 509 | { |
| 510 | u8 buf[1000], *pos; |
| 511 | struct ieee80211_mgmt *mgmt; |
| 512 | size_t url_len; |
| 513 | |
| 514 | os_memset(buf, 0, sizeof(buf)); |
| 515 | mgmt = (struct ieee80211_mgmt *) buf; |
| 516 | mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, |
| 517 | WLAN_FC_STYPE_ACTION); |
| 518 | os_memcpy(mgmt->da, sta->addr, ETH_ALEN); |
| 519 | os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); |
| 520 | os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); |
| 521 | mgmt->u.action.category = WLAN_ACTION_WNM; |
| 522 | mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; |
| 523 | mgmt->u.action.u.bss_tm_req.dialog_token = 1; |
| 524 | mgmt->u.action.u.bss_tm_req.req_mode = |
| 525 | WNM_BSS_TM_REQ_DISASSOC_IMMINENT | |
| 526 | WNM_BSS_TM_REQ_ESS_DISASSOC_IMMINENT; |
| 527 | mgmt->u.action.u.bss_tm_req.disassoc_timer = |
| 528 | host_to_le16(disassoc_timer); |
| 529 | mgmt->u.action.u.bss_tm_req.validity_interval = 0x01; |
| 530 | |
| 531 | pos = mgmt->u.action.u.bss_tm_req.variable; |
| 532 | |
| 533 | /* Session Information URL */ |
| 534 | url_len = os_strlen(url); |
| 535 | if (url_len > 255) |
| 536 | return -1; |
| 537 | *pos++ = url_len; |
| 538 | os_memcpy(pos, url, url_len); |
| 539 | pos += url_len; |
| 540 | |
| 541 | if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) { |
| 542 | wpa_printf(MSG_DEBUG, "Failed to send BSS Transition " |
| 543 | "Management Request frame"); |
| 544 | return -1; |
| 545 | } |
| 546 | |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 547 | if (disassoc_timer) { |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 548 | /* send disassociation frame after time-out */ |
| 549 | set_disassoc_timer(hapd, sta, disassoc_timer); |
| 550 | } |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 551 | |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 552 | return 0; |
| 553 | } |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 554 | |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 555 | |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 556 | int wnm_send_bss_tm_req(struct hostapd_data *hapd, struct sta_info *sta, |
| 557 | u8 req_mode, int disassoc_timer, u8 valid_int, |
| 558 | const u8 *bss_term_dur, const char *url, |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 559 | const u8 *nei_rep, size_t nei_rep_len, |
| 560 | const u8 *mbo_attrs, size_t mbo_len) |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 561 | { |
| 562 | u8 *buf, *pos; |
| 563 | struct ieee80211_mgmt *mgmt; |
| 564 | size_t url_len; |
| 565 | |
| 566 | wpa_printf(MSG_DEBUG, "WNM: Send BSS Transition Management Request to " |
| 567 | MACSTR " req_mode=0x%x disassoc_timer=%d valid_int=0x%x", |
| 568 | MAC2STR(sta->addr), req_mode, disassoc_timer, valid_int); |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 569 | buf = os_zalloc(1000 + nei_rep_len + mbo_len); |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 570 | if (buf == NULL) |
| 571 | return -1; |
| 572 | mgmt = (struct ieee80211_mgmt *) buf; |
| 573 | mgmt->frame_control = IEEE80211_FC(WLAN_FC_TYPE_MGMT, |
| 574 | WLAN_FC_STYPE_ACTION); |
| 575 | os_memcpy(mgmt->da, sta->addr, ETH_ALEN); |
| 576 | os_memcpy(mgmt->sa, hapd->own_addr, ETH_ALEN); |
| 577 | os_memcpy(mgmt->bssid, hapd->own_addr, ETH_ALEN); |
| 578 | mgmt->u.action.category = WLAN_ACTION_WNM; |
| 579 | mgmt->u.action.u.bss_tm_req.action = WNM_BSS_TRANS_MGMT_REQ; |
| 580 | mgmt->u.action.u.bss_tm_req.dialog_token = 1; |
| 581 | mgmt->u.action.u.bss_tm_req.req_mode = req_mode; |
| 582 | mgmt->u.action.u.bss_tm_req.disassoc_timer = |
| 583 | host_to_le16(disassoc_timer); |
| 584 | mgmt->u.action.u.bss_tm_req.validity_interval = valid_int; |
| 585 | |
| 586 | pos = mgmt->u.action.u.bss_tm_req.variable; |
| 587 | |
| 588 | if ((req_mode & WNM_BSS_TM_REQ_BSS_TERMINATION_INCLUDED) && |
| 589 | bss_term_dur) { |
| 590 | os_memcpy(pos, bss_term_dur, 12); |
| 591 | pos += 12; |
| 592 | } |
| 593 | |
| 594 | if (url) { |
| 595 | /* Session Information URL */ |
| 596 | url_len = os_strlen(url); |
Dmitry Shmidt | 432d603 | 2015-01-21 13:19:05 -0800 | [diff] [blame] | 597 | if (url_len > 255) { |
| 598 | os_free(buf); |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 599 | return -1; |
Dmitry Shmidt | 432d603 | 2015-01-21 13:19:05 -0800 | [diff] [blame] | 600 | } |
| 601 | |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 602 | *pos++ = url_len; |
| 603 | os_memcpy(pos, url, url_len); |
| 604 | pos += url_len; |
| 605 | } |
| 606 | |
| 607 | if (nei_rep) { |
| 608 | os_memcpy(pos, nei_rep, nei_rep_len); |
| 609 | pos += nei_rep_len; |
| 610 | } |
| 611 | |
Dmitry Shmidt | 57c2d39 | 2016-02-23 13:40:19 -0800 | [diff] [blame^] | 612 | if (mbo_len > 0) { |
| 613 | pos += mbo_add_ie(pos, buf + sizeof(buf) - pos, mbo_attrs, |
| 614 | mbo_len); |
| 615 | } |
| 616 | |
Dmitry Shmidt | fb45fd5 | 2015-01-05 13:08:17 -0800 | [diff] [blame] | 617 | if (hostapd_drv_send_mlme(hapd, buf, pos - buf, 0) < 0) { |
| 618 | wpa_printf(MSG_DEBUG, |
| 619 | "Failed to send BSS Transition Management Request frame"); |
| 620 | os_free(buf); |
| 621 | return -1; |
| 622 | } |
| 623 | os_free(buf); |
| 624 | |
| 625 | if (disassoc_timer) { |
| 626 | /* send disassociation frame after time-out */ |
| 627 | set_disassoc_timer(hapd, sta, disassoc_timer); |
Dmitry Shmidt | fb79edc | 2014-01-10 10:45:54 -0800 | [diff] [blame] | 628 | } |
| 629 | |
| 630 | return 0; |
| 631 | } |