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 */
ieee80211_11_get_tfs_ie(struct hostapd_data * hapd,const u8 * addr,u8 * buf,u16 * buf_len,enum wnm_oper oper)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 */
ieee80211_11_set_tfs_ie(struct hostapd_data * hapd,const u8 * addr,u8 * buf,u16 * buf_len,enum wnm_oper oper)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 */
ieee802_11_send_wnmsleep_resp(struct hostapd_data * hapd,const u8 * addr,u8 dialog_token,u8 action_type,u16 intval)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
ieee802_11_rx_wnmsleep_req(struct hostapd_data * hapd,const u8 * addr,const u8 * frm,int len)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
ieee802_11_send_bss_trans_mgmt_request(struct hostapd_data * hapd,const u8 * addr,u8 dialog_token,const char * url)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
ieee802_11_rx_bss_trans_mgmt_query(struct hostapd_data * hapd,const u8 * addr,const u8 * frm,size_t len)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
ieee802_11_rx_bss_trans_mgmt_resp(struct hostapd_data * hapd,const u8 * addr,const u8 * frm,size_t len)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
ieee802_11_rx_wnm_notification_req(struct hostapd_data * hapd,const u8 * addr,const u8 * buf,size_t len)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
ieee802_11_rx_wnm_action_ap(struct hostapd_data * hapd,const struct ieee80211_mgmt * mgmt,size_t len)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
wnm_send_disassoc_imminent(struct hostapd_data * hapd,struct sta_info * sta,int disassoc_timer)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
set_disassoc_timer(struct hostapd_data * hapd,struct sta_info * sta,int disassoc_timer)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
wnm_send_ess_disassoc_imminent(struct hostapd_data * hapd,struct sta_info * sta,const char * url,int disassoc_timer)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
wnm_send_bss_tm_req(struct hostapd_data * hapd,struct sta_info * sta,u8 req_mode,int disassoc_timer,u8 valid_int,const u8 * bss_term_dur,const char * url,const u8 * nei_rep,size_t nei_rep_len,const u8 * mbo_attrs,size_t mbo_len)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