1 /* 2 * hostapd - WNM 3 * Copyright (c) 2011-2014, Qualcomm Atheros, Inc. 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" 12 #include "utils/eloop.h" 13 #include "common/ieee802_11_defs.h" 14 #include "common/wpa_ctrl.h" 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" 20 #include "mbo_ap.h" 21 #include "wnm_ap.h" 22 23 #define MAX_TFS_IE_LEN 1024 24 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; 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; 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; 78 wnmsleep_ie.intval = host_to_le16(intval); 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"); 98 os_free(wnmtfs_ie); 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 */ 111 if (!wpa_auth_uses_mfp(sta->wpa_sm) || 112 action_type != WNM_SLEEP_MODE_EXIT) { 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; 139 if (wnmtfs_ie) 140 os_memcpy(pos, wnmtfs_ie, wnmtfs_ie_len); 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 && 160 wnmsleep_ie.action_type == WNM_SLEEP_MODE_ENTER) { 161 sta->flags |= WLAN_STA_WNM_SLEEP_MODE; 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 */ 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) { 175 sta->flags &= ~WLAN_STA_WNM_SLEEP_MODE; 176 wpa_set_wnmsleep(sta->wpa_sm, 0); 177 hostapd_drv_wnm_oper(hapd, WNM_SLEEP_EXIT_CONFIRM, 178 addr, NULL, NULL); 179 if (!wpa_auth_uses_mfp(sta->wpa_sm)) 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 { 196 /* Dialog Token [1] | WNM-Sleep Mode IE | TFS Response IE */ 197 const u8 *pos = frm; 198 u8 dialog_token; 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 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; 210 if (*pos == WLAN_EID_WNMSLEEP) 211 wnmsleep_ie = (struct wnm_sleep_element *) pos; 212 else if (*pos == WLAN_EID_TFS_REQ) { 213 if (!tfsreq_ie_start) 214 tfsreq_ie_start = (u8 *) pos; 215 tfsreq_ie_end = (u8 *) pos; 216 } else 217 wpa_printf(MSG_DEBUG, "WNM: EID %d not recognized", 218 *pos); 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 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) { 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, 242 le_to_host16(wnmsleep_ie->intval)); 243 244 if (wnmsleep_ie->action_type == WNM_SLEEP_MODE_EXIT) { 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 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) 256 { 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)); 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)); 369 pos += ETH_ALEN; 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); 374 } 375 376 wpa_hexdump(MSG_DEBUG, "WNM: BSS Transition Candidate List Entries", 377 pos, end - pos); 378 } 379 380 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 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) 412 return -1; 413 414 payload = ((const u8 *) mgmt) + IEEE80211_HDRLEN + 1; 415 action = *payload++; 416 plen = len - IEEE80211_HDRLEN - 2; 417 418 switch (action) { 419 case WNM_BSS_TRANS_MGMT_QUERY: 420 ieee802_11_rx_bss_trans_mgmt_query(hapd, mgmt->sa, payload, 421 plen); 422 return 0; 423 case WNM_BSS_TRANS_MGMT_RESP: 424 ieee802_11_rx_bss_trans_mgmt_resp(hapd, mgmt->sa, payload, 425 plen); 426 return 0; 427 case WNM_SLEEP_MODE_REQ: 428 ieee802_11_rx_wnmsleep_req(hapd, mgmt->sa, payload, plen); 429 return 0; 430 case WNM_NOTIFICATION_REQ: 431 ieee802_11_rx_wnm_notification_req(hapd, mgmt->sa, payload, 432 plen); 433 return 0; 434 } 435 436 wpa_printf(MSG_DEBUG, "WNM: Unsupported WNM Action %u from " MACSTR, 437 action, MAC2STR(mgmt->sa)); 438 return -1; 439 } 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 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 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 547 if (disassoc_timer) { 548 /* send disassociation frame after time-out */ 549 set_disassoc_timer(hapd, sta, disassoc_timer); 550 } 551 552 return 0; 553 } 554 555 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, 559 const u8 *nei_rep, size_t nei_rep_len, 560 const u8 *mbo_attrs, size_t mbo_len) 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); 569 buf = os_zalloc(1000 + nei_rep_len + mbo_len); 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); 597 if (url_len > 255) { 598 os_free(buf); 599 return -1; 600 } 601 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 612 if (mbo_len > 0) { 613 pos += mbo_add_ie(pos, buf + sizeof(buf) - pos, mbo_attrs, 614 mbo_len); 615 } 616 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); 628 } 629 630 return 0; 631 } 632
