]> git.ipfire.org Git - thirdparty/hostap.git/blob - wpa_supplicant/sme.c
SME: Add support for global RRM flag
[thirdparty/hostap.git] / wpa_supplicant / sme.c
1 /*
2 * wpa_supplicant - SME
3 * Copyright (c) 2009-2014, Jouni Malinen <j@w1.fi>
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "includes.h"
10
11 #include "common.h"
12 #include "utils/eloop.h"
13 #include "common/ieee802_11_defs.h"
14 #include "common/ieee802_11_common.h"
15 #include "eapol_supp/eapol_supp_sm.h"
16 #include "common/wpa_common.h"
17 #include "common/sae.h"
18 #include "rsn_supp/wpa.h"
19 #include "rsn_supp/pmksa_cache.h"
20 #include "config.h"
21 #include "wpa_supplicant_i.h"
22 #include "driver_i.h"
23 #include "wpas_glue.h"
24 #include "wps_supplicant.h"
25 #include "p2p_supplicant.h"
26 #include "notify.h"
27 #include "bss.h"
28 #include "scan.h"
29 #include "sme.h"
30 #include "hs20_supplicant.h"
31
32 #define SME_AUTH_TIMEOUT 5
33 #define SME_ASSOC_TIMEOUT 5
34
35 static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx);
36 static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx);
37 static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx);
38 #ifdef CONFIG_IEEE80211W
39 static void sme_stop_sa_query(struct wpa_supplicant *wpa_s);
40 #endif /* CONFIG_IEEE80211W */
41
42
43 #ifdef CONFIG_SAE
44
45 static int index_within_array(const int *array, int idx)
46 {
47 int i;
48 for (i = 0; i < idx; i++) {
49 if (array[i] <= 0)
50 return 0;
51 }
52 return 1;
53 }
54
55
56 static int sme_set_sae_group(struct wpa_supplicant *wpa_s)
57 {
58 int *groups = wpa_s->conf->sae_groups;
59 int default_groups[] = { 19, 20, 21, 25, 26, 0 };
60
61 if (!groups || groups[0] <= 0)
62 groups = default_groups;
63
64 /* Configuration may have changed, so validate current index */
65 if (!index_within_array(groups, wpa_s->sme.sae_group_index))
66 return -1;
67
68 for (;;) {
69 int group = groups[wpa_s->sme.sae_group_index];
70 if (group <= 0)
71 break;
72 if (sae_set_group(&wpa_s->sme.sae, group) == 0) {
73 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected SAE group %d",
74 wpa_s->sme.sae.group);
75 return 0;
76 }
77 wpa_s->sme.sae_group_index++;
78 }
79
80 return -1;
81 }
82
83
84 static struct wpabuf * sme_auth_build_sae_commit(struct wpa_supplicant *wpa_s,
85 struct wpa_ssid *ssid,
86 const u8 *bssid)
87 {
88 struct wpabuf *buf;
89 size_t len;
90
91 if (ssid->passphrase == NULL) {
92 wpa_printf(MSG_DEBUG, "SAE: No password available");
93 return NULL;
94 }
95
96 if (sme_set_sae_group(wpa_s) < 0) {
97 wpa_printf(MSG_DEBUG, "SAE: Failed to select group");
98 return NULL;
99 }
100
101 if (sae_prepare_commit(wpa_s->own_addr, bssid,
102 (u8 *) ssid->passphrase,
103 os_strlen(ssid->passphrase),
104 &wpa_s->sme.sae) < 0) {
105 wpa_printf(MSG_DEBUG, "SAE: Could not pick PWE");
106 return NULL;
107 }
108
109 len = wpa_s->sme.sae_token ? wpabuf_len(wpa_s->sme.sae_token) : 0;
110 buf = wpabuf_alloc(4 + SAE_COMMIT_MAX_LEN + len);
111 if (buf == NULL)
112 return NULL;
113
114 wpabuf_put_le16(buf, 1); /* Transaction seq# */
115 wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
116 sae_write_commit(&wpa_s->sme.sae, buf, wpa_s->sme.sae_token);
117
118 return buf;
119 }
120
121
122 static struct wpabuf * sme_auth_build_sae_confirm(struct wpa_supplicant *wpa_s)
123 {
124 struct wpabuf *buf;
125
126 buf = wpabuf_alloc(4 + SAE_CONFIRM_MAX_LEN);
127 if (buf == NULL)
128 return NULL;
129
130 wpabuf_put_le16(buf, 2); /* Transaction seq# */
131 wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
132 sae_write_confirm(&wpa_s->sme.sae, buf);
133
134 return buf;
135 }
136
137 #endif /* CONFIG_SAE */
138
139
140 /**
141 * sme_auth_handle_rrm - Handle RRM aspects of current authentication attempt
142 * @wpa_s: Pointer to wpa_supplicant data
143 * @bss: Pointer to the bss which is the target of authentication attempt
144 */
145 static void sme_auth_handle_rrm(struct wpa_supplicant *wpa_s,
146 struct wpa_bss *bss)
147 {
148 const u8 rrm_ie_len = 5;
149 u8 *pos;
150 const u8 *rrm_ie;
151
152 wpa_s->rrm.rrm_used = 0;
153
154 wpa_printf(MSG_DEBUG,
155 "RRM: Determining whether RRM can be used - device support: 0x%x",
156 wpa_s->drv_rrm_flags);
157
158 rrm_ie = wpa_bss_get_ie(bss, WLAN_EID_RRM_ENABLED_CAPABILITIES);
159 if (!rrm_ie || !(bss->caps & IEEE80211_CAP_RRM)) {
160 wpa_printf(MSG_DEBUG, "RRM: No RRM in network");
161 return;
162 }
163
164 if (!((wpa_s->drv_rrm_flags &
165 WPA_DRIVER_FLAGS_DS_PARAM_SET_IE_IN_PROBES) &&
166 (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_QUIET)) &&
167 !(wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_SUPPORT_RRM)) {
168 wpa_printf(MSG_DEBUG,
169 "RRM: Insufficient RRM support in driver - do not use RRM");
170 return;
171 }
172
173 if (sizeof(wpa_s->sme.assoc_req_ie) <
174 wpa_s->sme.assoc_req_ie_len + rrm_ie_len + 2) {
175 wpa_printf(MSG_INFO,
176 "RRM: Unable to use RRM, no room for RRM IE");
177 return;
178 }
179
180 wpa_printf(MSG_DEBUG, "RRM: Adding RRM IE to Association Request");
181 pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
182 os_memset(pos, 0, 2 + rrm_ie_len);
183 *pos++ = WLAN_EID_RRM_ENABLED_CAPABILITIES;
184 *pos++ = rrm_ie_len;
185
186 /* Set supported capabilites flags */
187 if (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_TX_POWER_INSERTION)
188 *pos |= WLAN_RRM_CAPS_LINK_MEASUREMENT;
189
190 if (wpa_s->lci)
191 pos[1] |= WLAN_RRM_CAPS_LCI_MEASUREMENT;
192
193 wpa_s->sme.assoc_req_ie_len += rrm_ie_len + 2;
194 wpa_s->rrm.rrm_used = 1;
195 }
196
197
198 static void sme_send_authentication(struct wpa_supplicant *wpa_s,
199 struct wpa_bss *bss, struct wpa_ssid *ssid,
200 int start)
201 {
202 struct wpa_driver_auth_params params;
203 struct wpa_ssid *old_ssid;
204 #ifdef CONFIG_IEEE80211R
205 const u8 *ie;
206 #endif /* CONFIG_IEEE80211R */
207 #ifdef CONFIG_IEEE80211R
208 const u8 *md = NULL;
209 #endif /* CONFIG_IEEE80211R */
210 int i, bssid_changed;
211 struct wpabuf *resp = NULL;
212 u8 ext_capab[18];
213 int ext_capab_len;
214 int skip_auth;
215 #ifdef CONFIG_MBO
216 const u8 *mbo;
217 #endif /* CONFIG_MBO */
218
219 if (bss == NULL) {
220 wpa_msg(wpa_s, MSG_ERROR, "SME: No scan result available for "
221 "the network");
222 wpas_connect_work_done(wpa_s);
223 return;
224 }
225
226 skip_auth = wpa_s->conf->reassoc_same_bss_optim &&
227 wpa_s->reassoc_same_bss;
228 wpa_s->current_bss = bss;
229
230 os_memset(&params, 0, sizeof(params));
231 wpa_s->reassociate = 0;
232
233 params.freq = bss->freq;
234 params.bssid = bss->bssid;
235 params.ssid = bss->ssid;
236 params.ssid_len = bss->ssid_len;
237 params.p2p = ssid->p2p_group;
238
239 if (wpa_s->sme.ssid_len != params.ssid_len ||
240 os_memcmp(wpa_s->sme.ssid, params.ssid, params.ssid_len) != 0)
241 wpa_s->sme.prev_bssid_set = 0;
242
243 wpa_s->sme.freq = params.freq;
244 os_memcpy(wpa_s->sme.ssid, params.ssid, params.ssid_len);
245 wpa_s->sme.ssid_len = params.ssid_len;
246
247 params.auth_alg = WPA_AUTH_ALG_OPEN;
248 #ifdef IEEE8021X_EAPOL
249 if (ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) {
250 if (ssid->leap) {
251 if (ssid->non_leap == 0)
252 params.auth_alg = WPA_AUTH_ALG_LEAP;
253 else
254 params.auth_alg |= WPA_AUTH_ALG_LEAP;
255 }
256 }
257 #endif /* IEEE8021X_EAPOL */
258 wpa_dbg(wpa_s, MSG_DEBUG, "Automatic auth_alg selection: 0x%x",
259 params.auth_alg);
260 if (ssid->auth_alg) {
261 params.auth_alg = ssid->auth_alg;
262 wpa_dbg(wpa_s, MSG_DEBUG, "Overriding auth_alg selection: "
263 "0x%x", params.auth_alg);
264 }
265 #ifdef CONFIG_SAE
266 wpa_s->sme.sae_pmksa_caching = 0;
267 if (wpa_key_mgmt_sae(ssid->key_mgmt)) {
268 const u8 *rsn;
269 struct wpa_ie_data ied;
270
271 rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
272 if (!rsn) {
273 wpa_dbg(wpa_s, MSG_DEBUG,
274 "SAE enabled, but target BSS does not advertise RSN");
275 } else if (wpa_parse_wpa_ie(rsn, 2 + rsn[1], &ied) == 0 &&
276 wpa_key_mgmt_sae(ied.key_mgmt)) {
277 wpa_dbg(wpa_s, MSG_DEBUG, "Using SAE auth_alg");
278 params.auth_alg = WPA_AUTH_ALG_SAE;
279 } else {
280 wpa_dbg(wpa_s, MSG_DEBUG,
281 "SAE enabled, but target BSS does not advertise SAE AKM for RSN");
282 }
283 }
284 #endif /* CONFIG_SAE */
285
286 for (i = 0; i < NUM_WEP_KEYS; i++) {
287 if (ssid->wep_key_len[i])
288 params.wep_key[i] = ssid->wep_key[i];
289 params.wep_key_len[i] = ssid->wep_key_len[i];
290 }
291 params.wep_tx_keyidx = ssid->wep_tx_keyidx;
292
293 bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
294 os_memset(wpa_s->bssid, 0, ETH_ALEN);
295 os_memcpy(wpa_s->pending_bssid, bss->bssid, ETH_ALEN);
296 if (bssid_changed)
297 wpas_notify_bssid_changed(wpa_s);
298
299 if ((wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE) ||
300 wpa_bss_get_ie(bss, WLAN_EID_RSN)) &&
301 wpa_key_mgmt_wpa(ssid->key_mgmt)) {
302 int try_opportunistic;
303 try_opportunistic = (ssid->proactive_key_caching < 0 ?
304 wpa_s->conf->okc :
305 ssid->proactive_key_caching) &&
306 (ssid->proto & WPA_PROTO_RSN);
307 if (pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid,
308 wpa_s->current_ssid,
309 try_opportunistic) == 0)
310 eapol_sm_notify_pmkid_attempt(wpa_s->eapol);
311 wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
312 if (wpa_supplicant_set_suites(wpa_s, bss, ssid,
313 wpa_s->sme.assoc_req_ie,
314 &wpa_s->sme.assoc_req_ie_len)) {
315 wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
316 "key management and encryption suites");
317 wpas_connect_work_done(wpa_s);
318 return;
319 }
320 } else if ((ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) &&
321 wpa_key_mgmt_wpa_ieee8021x(ssid->key_mgmt)) {
322 /*
323 * Both WPA and non-WPA IEEE 802.1X enabled in configuration -
324 * use non-WPA since the scan results did not indicate that the
325 * AP is using WPA or WPA2.
326 */
327 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
328 wpa_s->sme.assoc_req_ie_len = 0;
329 } else if (wpa_key_mgmt_wpa_any(ssid->key_mgmt)) {
330 wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
331 if (wpa_supplicant_set_suites(wpa_s, NULL, ssid,
332 wpa_s->sme.assoc_req_ie,
333 &wpa_s->sme.assoc_req_ie_len)) {
334 wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
335 "key management and encryption suites (no "
336 "scan results)");
337 wpas_connect_work_done(wpa_s);
338 return;
339 }
340 #ifdef CONFIG_WPS
341 } else if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
342 struct wpabuf *wps_ie;
343 wps_ie = wps_build_assoc_req_ie(wpas_wps_get_req_type(ssid));
344 if (wps_ie && wpabuf_len(wps_ie) <=
345 sizeof(wpa_s->sme.assoc_req_ie)) {
346 wpa_s->sme.assoc_req_ie_len = wpabuf_len(wps_ie);
347 os_memcpy(wpa_s->sme.assoc_req_ie, wpabuf_head(wps_ie),
348 wpa_s->sme.assoc_req_ie_len);
349 } else
350 wpa_s->sme.assoc_req_ie_len = 0;
351 wpabuf_free(wps_ie);
352 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
353 #endif /* CONFIG_WPS */
354 } else {
355 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
356 wpa_s->sme.assoc_req_ie_len = 0;
357 }
358
359 #ifdef CONFIG_IEEE80211R
360 ie = wpa_bss_get_ie(bss, WLAN_EID_MOBILITY_DOMAIN);
361 if (ie && ie[1] >= MOBILITY_DOMAIN_ID_LEN)
362 md = ie + 2;
363 wpa_sm_set_ft_params(wpa_s->wpa, ie, ie ? 2 + ie[1] : 0);
364 if (md) {
365 /* Prepare for the next transition */
366 wpa_ft_prepare_auth_request(wpa_s->wpa, ie);
367 }
368
369 if (md && wpa_key_mgmt_ft(ssid->key_mgmt)) {
370 if (wpa_s->sme.assoc_req_ie_len + 5 <
371 sizeof(wpa_s->sme.assoc_req_ie)) {
372 struct rsn_mdie *mdie;
373 u8 *pos = wpa_s->sme.assoc_req_ie +
374 wpa_s->sme.assoc_req_ie_len;
375 *pos++ = WLAN_EID_MOBILITY_DOMAIN;
376 *pos++ = sizeof(*mdie);
377 mdie = (struct rsn_mdie *) pos;
378 os_memcpy(mdie->mobility_domain, md,
379 MOBILITY_DOMAIN_ID_LEN);
380 mdie->ft_capab = md[MOBILITY_DOMAIN_ID_LEN];
381 wpa_s->sme.assoc_req_ie_len += 5;
382 }
383
384 if (wpa_s->sme.ft_used &&
385 os_memcmp(md, wpa_s->sme.mobility_domain, 2) == 0 &&
386 wpa_sm_has_ptk(wpa_s->wpa)) {
387 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying to use FT "
388 "over-the-air");
389 params.auth_alg = WPA_AUTH_ALG_FT;
390 params.ie = wpa_s->sme.ft_ies;
391 params.ie_len = wpa_s->sme.ft_ies_len;
392 }
393 }
394 #endif /* CONFIG_IEEE80211R */
395
396 #ifdef CONFIG_IEEE80211W
397 wpa_s->sme.mfp = wpas_get_ssid_pmf(wpa_s, ssid);
398 if (wpa_s->sme.mfp != NO_MGMT_FRAME_PROTECTION) {
399 const u8 *rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
400 struct wpa_ie_data _ie;
401 if (rsn && wpa_parse_wpa_ie(rsn, 2 + rsn[1], &_ie) == 0 &&
402 _ie.capabilities &
403 (WPA_CAPABILITY_MFPC | WPA_CAPABILITY_MFPR)) {
404 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected AP supports "
405 "MFP: require MFP");
406 wpa_s->sme.mfp = MGMT_FRAME_PROTECTION_REQUIRED;
407 }
408 }
409 #endif /* CONFIG_IEEE80211W */
410
411 #ifdef CONFIG_P2P
412 if (wpa_s->global->p2p) {
413 u8 *pos;
414 size_t len;
415 int res;
416 pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
417 len = sizeof(wpa_s->sme.assoc_req_ie) -
418 wpa_s->sme.assoc_req_ie_len;
419 res = wpas_p2p_assoc_req_ie(wpa_s, bss, pos, len,
420 ssid->p2p_group);
421 if (res >= 0)
422 wpa_s->sme.assoc_req_ie_len += res;
423 }
424 #endif /* CONFIG_P2P */
425
426 #ifdef CONFIG_FST
427 if (wpa_s->fst_ies) {
428 int fst_ies_len = wpabuf_len(wpa_s->fst_ies);
429
430 if (wpa_s->sme.assoc_req_ie_len + fst_ies_len <=
431 sizeof(wpa_s->sme.assoc_req_ie)) {
432 os_memcpy(wpa_s->sme.assoc_req_ie +
433 wpa_s->sme.assoc_req_ie_len,
434 wpabuf_head(wpa_s->fst_ies),
435 fst_ies_len);
436 wpa_s->sme.assoc_req_ie_len += fst_ies_len;
437 }
438 }
439 #endif /* CONFIG_FST */
440
441 sme_auth_handle_rrm(wpa_s, bss);
442
443 #ifdef CONFIG_MBO
444 mbo = wpa_bss_get_vendor_ie(bss, MBO_IE_VENDOR_TYPE);
445 if (mbo) {
446 int len;
447
448 len = wpas_mbo_supp_op_class_ie(
449 wpa_s, bss->freq,
450 wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
451 sizeof(wpa_s->sme.assoc_req_ie) -
452 wpa_s->sme.assoc_req_ie_len);
453 if (len > 0)
454 wpa_s->sme.assoc_req_ie_len += len;
455 }
456 #endif /* CONFIG_MBO */
457
458 ext_capab_len = wpas_build_ext_capab(wpa_s, ext_capab,
459 sizeof(ext_capab));
460 if (ext_capab_len > 0) {
461 u8 *pos = wpa_s->sme.assoc_req_ie;
462 if (wpa_s->sme.assoc_req_ie_len > 0 && pos[0] == WLAN_EID_RSN)
463 pos += 2 + pos[1];
464 os_memmove(pos + ext_capab_len, pos,
465 wpa_s->sme.assoc_req_ie_len -
466 (pos - wpa_s->sme.assoc_req_ie));
467 wpa_s->sme.assoc_req_ie_len += ext_capab_len;
468 os_memcpy(pos, ext_capab, ext_capab_len);
469 }
470
471 #ifdef CONFIG_HS20
472 if (is_hs20_network(wpa_s, ssid, bss)) {
473 struct wpabuf *hs20;
474
475 hs20 = wpabuf_alloc(20);
476 if (hs20) {
477 int pps_mo_id = hs20_get_pps_mo_id(wpa_s, ssid);
478 size_t len;
479
480 wpas_hs20_add_indication(hs20, pps_mo_id);
481 len = sizeof(wpa_s->sme.assoc_req_ie) -
482 wpa_s->sme.assoc_req_ie_len;
483 if (wpabuf_len(hs20) <= len) {
484 os_memcpy(wpa_s->sme.assoc_req_ie +
485 wpa_s->sme.assoc_req_ie_len,
486 wpabuf_head(hs20), wpabuf_len(hs20));
487 wpa_s->sme.assoc_req_ie_len += wpabuf_len(hs20);
488 }
489 wpabuf_free(hs20);
490 }
491 }
492 #endif /* CONFIG_HS20 */
493
494 if (wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ]) {
495 struct wpabuf *buf = wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ];
496 size_t len;
497
498 len = sizeof(wpa_s->sme.assoc_req_ie) -
499 wpa_s->sme.assoc_req_ie_len;
500 if (wpabuf_len(buf) <= len) {
501 os_memcpy(wpa_s->sme.assoc_req_ie +
502 wpa_s->sme.assoc_req_ie_len,
503 wpabuf_head(buf), wpabuf_len(buf));
504 wpa_s->sme.assoc_req_ie_len += wpabuf_len(buf);
505 }
506 }
507
508 #ifdef CONFIG_MBO
509 if (mbo) {
510 int len;
511
512 len = wpas_mbo_ie(wpa_s, wpa_s->sme.assoc_req_ie +
513 wpa_s->sme.assoc_req_ie_len,
514 sizeof(wpa_s->sme.assoc_req_ie) -
515 wpa_s->sme.assoc_req_ie_len);
516 if (len >= 0)
517 wpa_s->sme.assoc_req_ie_len += len;
518 }
519 #endif /* CONFIG_MBO */
520
521 #ifdef CONFIG_SAE
522 if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE &&
523 pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid, ssid, 0) == 0)
524 {
525 wpa_dbg(wpa_s, MSG_DEBUG,
526 "PMKSA cache entry found - try to use PMKSA caching instead of new SAE authentication");
527 params.auth_alg = WPA_AUTH_ALG_OPEN;
528 wpa_s->sme.sae_pmksa_caching = 1;
529 }
530
531 if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE) {
532 if (start)
533 resp = sme_auth_build_sae_commit(wpa_s, ssid,
534 bss->bssid);
535 else
536 resp = sme_auth_build_sae_confirm(wpa_s);
537 if (resp == NULL) {
538 wpas_connection_failed(wpa_s, bss->bssid);
539 return;
540 }
541 params.sae_data = wpabuf_head(resp);
542 params.sae_data_len = wpabuf_len(resp);
543 wpa_s->sme.sae.state = start ? SAE_COMMITTED : SAE_CONFIRMED;
544 }
545 #endif /* CONFIG_SAE */
546
547 wpa_supplicant_cancel_sched_scan(wpa_s);
548 wpa_supplicant_cancel_scan(wpa_s);
549
550 wpa_msg(wpa_s, MSG_INFO, "SME: Trying to authenticate with " MACSTR
551 " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
552 wpa_ssid_txt(params.ssid, params.ssid_len), params.freq);
553
554 wpa_clear_keys(wpa_s, bss->bssid);
555 wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
556 old_ssid = wpa_s->current_ssid;
557 wpa_s->current_ssid = ssid;
558 wpa_supplicant_rsn_supp_set_config(wpa_s, wpa_s->current_ssid);
559 wpa_supplicant_initiate_eapol(wpa_s);
560 if (old_ssid != wpa_s->current_ssid)
561 wpas_notify_network_changed(wpa_s);
562
563 #ifdef CONFIG_HS20
564 hs20_configure_frame_filters(wpa_s);
565 #endif /* CONFIG_HS20 */
566
567 #ifdef CONFIG_P2P
568 /*
569 * If multi-channel concurrency is not supported, check for any
570 * frequency conflict. In case of any frequency conflict, remove the
571 * least prioritized connection.
572 */
573 if (wpa_s->num_multichan_concurrent < 2) {
574 int freq, num;
575 num = get_shared_radio_freqs(wpa_s, &freq, 1);
576 if (num > 0 && freq > 0 && freq != params.freq) {
577 wpa_printf(MSG_DEBUG,
578 "Conflicting frequency found (%d != %d)",
579 freq, params.freq);
580 if (wpas_p2p_handle_frequency_conflicts(wpa_s,
581 params.freq,
582 ssid) < 0) {
583 wpas_connection_failed(wpa_s, bss->bssid);
584 wpa_supplicant_mark_disassoc(wpa_s);
585 wpabuf_free(resp);
586 wpas_connect_work_done(wpa_s);
587 return;
588 }
589 }
590 }
591 #endif /* CONFIG_P2P */
592
593 if (skip_auth) {
594 wpa_msg(wpa_s, MSG_DEBUG,
595 "SME: Skip authentication step on reassoc-to-same-BSS");
596 wpabuf_free(resp);
597 sme_associate(wpa_s, ssid->mode, bss->bssid, WLAN_AUTH_OPEN);
598 return;
599 }
600
601
602 wpa_s->sme.auth_alg = params.auth_alg;
603 if (wpa_drv_authenticate(wpa_s, &params) < 0) {
604 wpa_msg(wpa_s, MSG_INFO, "SME: Authentication request to the "
605 "driver failed");
606 wpas_connection_failed(wpa_s, bss->bssid);
607 wpa_supplicant_mark_disassoc(wpa_s);
608 wpabuf_free(resp);
609 wpas_connect_work_done(wpa_s);
610 return;
611 }
612
613 eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
614 NULL);
615
616 /*
617 * Association will be started based on the authentication event from
618 * the driver.
619 */
620
621 wpabuf_free(resp);
622 }
623
624
625 static void sme_auth_start_cb(struct wpa_radio_work *work, int deinit)
626 {
627 struct wpa_connect_work *cwork = work->ctx;
628 struct wpa_supplicant *wpa_s = work->wpa_s;
629
630 if (deinit) {
631 if (work->started)
632 wpa_s->connect_work = NULL;
633
634 wpas_connect_work_free(cwork);
635 return;
636 }
637
638 wpa_s->connect_work = work;
639
640 if (cwork->bss_removed ||
641 !wpas_valid_bss_ssid(wpa_s, cwork->bss, cwork->ssid) ||
642 wpas_network_disabled(wpa_s, cwork->ssid)) {
643 wpa_dbg(wpa_s, MSG_DEBUG, "SME: BSS/SSID entry for authentication not valid anymore - drop connection attempt");
644 wpas_connect_work_done(wpa_s);
645 return;
646 }
647
648 sme_send_authentication(wpa_s, cwork->bss, cwork->ssid, 1);
649 }
650
651
652 void sme_authenticate(struct wpa_supplicant *wpa_s,
653 struct wpa_bss *bss, struct wpa_ssid *ssid)
654 {
655 struct wpa_connect_work *cwork;
656
657 if (bss == NULL || ssid == NULL)
658 return;
659 if (wpa_s->connect_work) {
660 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reject sme_authenticate() call since connect_work exist");
661 return;
662 }
663
664 if (radio_work_pending(wpa_s, "sme-connect")) {
665 /*
666 * The previous sme-connect work might no longer be valid due to
667 * the fact that the BSS list was updated. In addition, it makes
668 * sense to adhere to the 'newer' decision.
669 */
670 wpa_dbg(wpa_s, MSG_DEBUG,
671 "SME: Remove previous pending sme-connect");
672 radio_remove_works(wpa_s, "sme-connect", 0);
673 }
674
675 wpas_abort_ongoing_scan(wpa_s);
676
677 cwork = os_zalloc(sizeof(*cwork));
678 if (cwork == NULL)
679 return;
680 cwork->bss = bss;
681 cwork->ssid = ssid;
682 cwork->sme = 1;
683
684 #ifdef CONFIG_SAE
685 wpa_s->sme.sae.state = SAE_NOTHING;
686 wpa_s->sme.sae.send_confirm = 0;
687 wpa_s->sme.sae_group_index = 0;
688 #endif /* CONFIG_SAE */
689
690 if (radio_add_work(wpa_s, bss->freq, "sme-connect", 1,
691 sme_auth_start_cb, cwork) < 0)
692 wpas_connect_work_free(cwork);
693 }
694
695
696 #ifdef CONFIG_SAE
697
698 static int sme_sae_auth(struct wpa_supplicant *wpa_s, u16 auth_transaction,
699 u16 status_code, const u8 *data, size_t len)
700 {
701 int *groups;
702
703 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE authentication transaction %u "
704 "status code %u", auth_transaction, status_code);
705
706 if (auth_transaction == 1 &&
707 status_code == WLAN_STATUS_ANTI_CLOGGING_TOKEN_REQ &&
708 wpa_s->sme.sae.state == SAE_COMMITTED &&
709 wpa_s->current_bss && wpa_s->current_ssid) {
710 int default_groups[] = { 19, 20, 21, 25, 26, 0 };
711 u16 group;
712
713 groups = wpa_s->conf->sae_groups;
714 if (!groups || groups[0] <= 0)
715 groups = default_groups;
716
717 if (len < sizeof(le16)) {
718 wpa_dbg(wpa_s, MSG_DEBUG,
719 "SME: Too short SAE anti-clogging token request");
720 return -1;
721 }
722 group = WPA_GET_LE16(data);
723 wpa_dbg(wpa_s, MSG_DEBUG,
724 "SME: SAE anti-clogging token requested (group %u)",
725 group);
726 if (sae_group_allowed(&wpa_s->sme.sae, groups, group) !=
727 WLAN_STATUS_SUCCESS) {
728 wpa_dbg(wpa_s, MSG_ERROR,
729 "SME: SAE group %u of anti-clogging request is invalid",
730 group);
731 return -1;
732 }
733 wpabuf_free(wpa_s->sme.sae_token);
734 wpa_s->sme.sae_token = wpabuf_alloc_copy(data + sizeof(le16),
735 len - sizeof(le16));
736 sme_send_authentication(wpa_s, wpa_s->current_bss,
737 wpa_s->current_ssid, 1);
738 return 0;
739 }
740
741 if (auth_transaction == 1 &&
742 status_code == WLAN_STATUS_FINITE_CYCLIC_GROUP_NOT_SUPPORTED &&
743 wpa_s->sme.sae.state == SAE_COMMITTED &&
744 wpa_s->current_bss && wpa_s->current_ssid) {
745 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE group not supported");
746 wpa_s->sme.sae_group_index++;
747 if (sme_set_sae_group(wpa_s) < 0)
748 return -1; /* no other groups enabled */
749 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Try next enabled SAE group");
750 sme_send_authentication(wpa_s, wpa_s->current_bss,
751 wpa_s->current_ssid, 1);
752 return 0;
753 }
754
755 if (status_code != WLAN_STATUS_SUCCESS)
756 return -1;
757
758 if (auth_transaction == 1) {
759 u16 res;
760
761 groups = wpa_s->conf->sae_groups;
762
763 wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE commit");
764 if (wpa_s->current_bss == NULL ||
765 wpa_s->current_ssid == NULL)
766 return -1;
767 if (wpa_s->sme.sae.state != SAE_COMMITTED)
768 return -1;
769 if (groups && groups[0] <= 0)
770 groups = NULL;
771 res = sae_parse_commit(&wpa_s->sme.sae, data, len, NULL, NULL,
772 groups);
773 if (res == SAE_SILENTLY_DISCARD) {
774 wpa_printf(MSG_DEBUG,
775 "SAE: Drop commit message due to reflection attack");
776 return 0;
777 }
778 if (res != WLAN_STATUS_SUCCESS)
779 return -1;
780
781 if (sae_process_commit(&wpa_s->sme.sae) < 0) {
782 wpa_printf(MSG_DEBUG, "SAE: Failed to process peer "
783 "commit");
784 return -1;
785 }
786
787 wpabuf_free(wpa_s->sme.sae_token);
788 wpa_s->sme.sae_token = NULL;
789 sme_send_authentication(wpa_s, wpa_s->current_bss,
790 wpa_s->current_ssid, 0);
791 return 0;
792 } else if (auth_transaction == 2) {
793 wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE confirm");
794 if (wpa_s->sme.sae.state != SAE_CONFIRMED)
795 return -1;
796 if (sae_check_confirm(&wpa_s->sme.sae, data, len) < 0)
797 return -1;
798 wpa_s->sme.sae.state = SAE_ACCEPTED;
799 sae_clear_temp_data(&wpa_s->sme.sae);
800 return 1;
801 }
802
803 return -1;
804 }
805 #endif /* CONFIG_SAE */
806
807
808 void sme_event_auth(struct wpa_supplicant *wpa_s, union wpa_event_data *data)
809 {
810 struct wpa_ssid *ssid = wpa_s->current_ssid;
811
812 if (ssid == NULL) {
813 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
814 "when network is not selected");
815 return;
816 }
817
818 if (wpa_s->wpa_state != WPA_AUTHENTICATING) {
819 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
820 "when not in authenticating state");
821 return;
822 }
823
824 if (os_memcmp(wpa_s->pending_bssid, data->auth.peer, ETH_ALEN) != 0) {
825 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication with "
826 "unexpected peer " MACSTR,
827 MAC2STR(data->auth.peer));
828 return;
829 }
830
831 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication response: peer=" MACSTR
832 " auth_type=%d auth_transaction=%d status_code=%d",
833 MAC2STR(data->auth.peer), data->auth.auth_type,
834 data->auth.auth_transaction, data->auth.status_code);
835 wpa_hexdump(MSG_MSGDUMP, "SME: Authentication response IEs",
836 data->auth.ies, data->auth.ies_len);
837
838 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
839
840 #ifdef CONFIG_SAE
841 if (data->auth.auth_type == WLAN_AUTH_SAE) {
842 int res;
843 res = sme_sae_auth(wpa_s, data->auth.auth_transaction,
844 data->auth.status_code, data->auth.ies,
845 data->auth.ies_len);
846 if (res < 0) {
847 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
848 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
849
850 }
851 if (res != 1)
852 return;
853
854 wpa_printf(MSG_DEBUG, "SME: SAE completed - setting PMK for "
855 "4-way handshake");
856 wpa_sm_set_pmk(wpa_s->wpa, wpa_s->sme.sae.pmk, PMK_LEN,
857 wpa_s->sme.sae.pmkid, wpa_s->pending_bssid);
858 }
859 #endif /* CONFIG_SAE */
860
861 if (data->auth.status_code != WLAN_STATUS_SUCCESS) {
862 char *ie_txt = NULL;
863
864 if (data->auth.ies && data->auth.ies_len) {
865 size_t buflen = 2 * data->auth.ies_len + 1;
866 ie_txt = os_malloc(buflen);
867 if (ie_txt) {
868 wpa_snprintf_hex(ie_txt, buflen, data->auth.ies,
869 data->auth.ies_len);
870 }
871 }
872 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_AUTH_REJECT MACSTR
873 " auth_type=%u auth_transaction=%u status_code=%u ie=%s",
874 MAC2STR(data->auth.peer), data->auth.auth_type,
875 data->auth.auth_transaction, data->auth.status_code,
876 ie_txt);
877 os_free(ie_txt);
878
879 if (data->auth.status_code !=
880 WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG ||
881 wpa_s->sme.auth_alg == data->auth.auth_type ||
882 wpa_s->current_ssid->auth_alg == WPA_AUTH_ALG_LEAP) {
883 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
884 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
885 return;
886 }
887
888 wpas_connect_work_done(wpa_s);
889
890 switch (data->auth.auth_type) {
891 case WLAN_AUTH_OPEN:
892 wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_SHARED;
893
894 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying SHARED auth");
895 wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
896 wpa_s->current_ssid);
897 return;
898
899 case WLAN_AUTH_SHARED_KEY:
900 wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_LEAP;
901
902 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying LEAP auth");
903 wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
904 wpa_s->current_ssid);
905 return;
906
907 default:
908 return;
909 }
910 }
911
912 #ifdef CONFIG_IEEE80211R
913 if (data->auth.auth_type == WLAN_AUTH_FT) {
914 if (wpa_ft_process_response(wpa_s->wpa, data->auth.ies,
915 data->auth.ies_len, 0,
916 data->auth.peer, NULL, 0) < 0) {
917 wpa_dbg(wpa_s, MSG_DEBUG,
918 "SME: FT Authentication response processing failed");
919 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_DISCONNECTED "bssid="
920 MACSTR
921 " reason=%d locally_generated=1",
922 MAC2STR(wpa_s->pending_bssid),
923 WLAN_REASON_DEAUTH_LEAVING);
924 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
925 wpa_supplicant_mark_disassoc(wpa_s);
926 return;
927 }
928 }
929 #endif /* CONFIG_IEEE80211R */
930
931 sme_associate(wpa_s, ssid->mode, data->auth.peer,
932 data->auth.auth_type);
933 }
934
935
936 void sme_associate(struct wpa_supplicant *wpa_s, enum wpas_mode mode,
937 const u8 *bssid, u16 auth_type)
938 {
939 struct wpa_driver_associate_params params;
940 struct ieee802_11_elems elems;
941 #ifdef CONFIG_HT_OVERRIDES
942 struct ieee80211_ht_capabilities htcaps;
943 struct ieee80211_ht_capabilities htcaps_mask;
944 #endif /* CONFIG_HT_OVERRIDES */
945 #ifdef CONFIG_VHT_OVERRIDES
946 struct ieee80211_vht_capabilities vhtcaps;
947 struct ieee80211_vht_capabilities vhtcaps_mask;
948 #endif /* CONFIG_VHT_OVERRIDES */
949
950 os_memset(&params, 0, sizeof(params));
951 params.bssid = bssid;
952 params.ssid = wpa_s->sme.ssid;
953 params.ssid_len = wpa_s->sme.ssid_len;
954 params.freq.freq = wpa_s->sme.freq;
955 params.bg_scan_period = wpa_s->current_ssid ?
956 wpa_s->current_ssid->bg_scan_period : -1;
957 params.wpa_ie = wpa_s->sme.assoc_req_ie_len ?
958 wpa_s->sme.assoc_req_ie : NULL;
959 params.wpa_ie_len = wpa_s->sme.assoc_req_ie_len;
960 params.pairwise_suite = wpa_s->pairwise_cipher;
961 params.group_suite = wpa_s->group_cipher;
962 params.key_mgmt_suite = wpa_s->key_mgmt;
963 params.wpa_proto = wpa_s->wpa_proto;
964 #ifdef CONFIG_HT_OVERRIDES
965 os_memset(&htcaps, 0, sizeof(htcaps));
966 os_memset(&htcaps_mask, 0, sizeof(htcaps_mask));
967 params.htcaps = (u8 *) &htcaps;
968 params.htcaps_mask = (u8 *) &htcaps_mask;
969 wpa_supplicant_apply_ht_overrides(wpa_s, wpa_s->current_ssid, &params);
970 #endif /* CONFIG_HT_OVERRIDES */
971 #ifdef CONFIG_VHT_OVERRIDES
972 os_memset(&vhtcaps, 0, sizeof(vhtcaps));
973 os_memset(&vhtcaps_mask, 0, sizeof(vhtcaps_mask));
974 params.vhtcaps = &vhtcaps;
975 params.vhtcaps_mask = &vhtcaps_mask;
976 wpa_supplicant_apply_vht_overrides(wpa_s, wpa_s->current_ssid, &params);
977 #endif /* CONFIG_VHT_OVERRIDES */
978 #ifdef CONFIG_IEEE80211R
979 if (auth_type == WLAN_AUTH_FT && wpa_s->sme.ft_ies) {
980 params.wpa_ie = wpa_s->sme.ft_ies;
981 params.wpa_ie_len = wpa_s->sme.ft_ies_len;
982 }
983 #endif /* CONFIG_IEEE80211R */
984 params.mode = mode;
985 params.mgmt_frame_protection = wpa_s->sme.mfp;
986 params.rrm_used = wpa_s->rrm.rrm_used;
987 if (wpa_s->sme.prev_bssid_set)
988 params.prev_bssid = wpa_s->sme.prev_bssid;
989
990 wpa_msg(wpa_s, MSG_INFO, "Trying to associate with " MACSTR
991 " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
992 params.ssid ? wpa_ssid_txt(params.ssid, params.ssid_len) : "",
993 params.freq.freq);
994
995 wpa_supplicant_set_state(wpa_s, WPA_ASSOCIATING);
996
997 if (params.wpa_ie == NULL ||
998 ieee802_11_parse_elems(params.wpa_ie, params.wpa_ie_len, &elems, 0)
999 < 0) {
1000 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Could not parse own IEs?!");
1001 os_memset(&elems, 0, sizeof(elems));
1002 }
1003 if (elems.rsn_ie) {
1004 params.wpa_proto = WPA_PROTO_RSN;
1005 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.rsn_ie - 2,
1006 elems.rsn_ie_len + 2);
1007 } else if (elems.wpa_ie) {
1008 params.wpa_proto = WPA_PROTO_WPA;
1009 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.wpa_ie - 2,
1010 elems.wpa_ie_len + 2);
1011 } else if (elems.osen) {
1012 params.wpa_proto = WPA_PROTO_OSEN;
1013 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.osen - 2,
1014 elems.osen_len + 2);
1015 } else
1016 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, NULL, 0);
1017 if (wpa_s->current_ssid && wpa_s->current_ssid->p2p_group)
1018 params.p2p = 1;
1019
1020 if (wpa_s->p2pdev->set_sta_uapsd)
1021 params.uapsd = wpa_s->p2pdev->sta_uapsd;
1022 else
1023 params.uapsd = -1;
1024
1025 if (wpa_drv_associate(wpa_s, &params) < 0) {
1026 wpa_msg(wpa_s, MSG_INFO, "SME: Association request to the "
1027 "driver failed");
1028 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1029 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
1030 os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
1031 return;
1032 }
1033
1034 eloop_register_timeout(SME_ASSOC_TIMEOUT, 0, sme_assoc_timer, wpa_s,
1035 NULL);
1036 }
1037
1038
1039 int sme_update_ft_ies(struct wpa_supplicant *wpa_s, const u8 *md,
1040 const u8 *ies, size_t ies_len)
1041 {
1042 if (md == NULL || ies == NULL) {
1043 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Remove mobility domain");
1044 os_free(wpa_s->sme.ft_ies);
1045 wpa_s->sme.ft_ies = NULL;
1046 wpa_s->sme.ft_ies_len = 0;
1047 wpa_s->sme.ft_used = 0;
1048 return 0;
1049 }
1050
1051 os_memcpy(wpa_s->sme.mobility_domain, md, MOBILITY_DOMAIN_ID_LEN);
1052 wpa_hexdump(MSG_DEBUG, "SME: FT IEs", ies, ies_len);
1053 os_free(wpa_s->sme.ft_ies);
1054 wpa_s->sme.ft_ies = os_malloc(ies_len);
1055 if (wpa_s->sme.ft_ies == NULL)
1056 return -1;
1057 os_memcpy(wpa_s->sme.ft_ies, ies, ies_len);
1058 wpa_s->sme.ft_ies_len = ies_len;
1059 return 0;
1060 }
1061
1062
1063 static void sme_deauth(struct wpa_supplicant *wpa_s)
1064 {
1065 int bssid_changed;
1066
1067 bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
1068
1069 if (wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
1070 WLAN_REASON_DEAUTH_LEAVING) < 0) {
1071 wpa_msg(wpa_s, MSG_INFO, "SME: Deauth request to the driver "
1072 "failed");
1073 }
1074 wpa_s->sme.prev_bssid_set = 0;
1075
1076 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1077 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
1078 os_memset(wpa_s->bssid, 0, ETH_ALEN);
1079 os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
1080 if (bssid_changed)
1081 wpas_notify_bssid_changed(wpa_s);
1082 }
1083
1084
1085 void sme_event_assoc_reject(struct wpa_supplicant *wpa_s,
1086 union wpa_event_data *data)
1087 {
1088 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association with " MACSTR " failed: "
1089 "status code %d", MAC2STR(wpa_s->pending_bssid),
1090 data->assoc_reject.status_code);
1091
1092 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
1093
1094 #ifdef CONFIG_SAE
1095 if (wpa_s->sme.sae_pmksa_caching && wpa_s->current_ssid &&
1096 wpa_key_mgmt_sae(wpa_s->current_ssid->key_mgmt)) {
1097 wpa_dbg(wpa_s, MSG_DEBUG,
1098 "PMKSA caching attempt rejected - drop PMKSA cache entry and fall back to SAE authentication");
1099 wpa_sm_aborted_cached(wpa_s->wpa);
1100 wpa_sm_pmksa_cache_flush(wpa_s->wpa, wpa_s->current_ssid);
1101 if (wpa_s->current_bss) {
1102 struct wpa_bss *bss = wpa_s->current_bss;
1103 struct wpa_ssid *ssid = wpa_s->current_ssid;
1104
1105 wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
1106 WLAN_REASON_DEAUTH_LEAVING);
1107 wpas_connect_work_done(wpa_s);
1108 wpa_supplicant_mark_disassoc(wpa_s);
1109 wpa_supplicant_connect(wpa_s, bss, ssid);
1110 return;
1111 }
1112 }
1113 #endif /* CONFIG_SAE */
1114
1115 /*
1116 * For now, unconditionally terminate the previous authentication. In
1117 * theory, this should not be needed, but mac80211 gets quite confused
1118 * if the authentication is left pending.. Some roaming cases might
1119 * benefit from using the previous authentication, so this could be
1120 * optimized in the future.
1121 */
1122 sme_deauth(wpa_s);
1123 }
1124
1125
1126 void sme_event_auth_timed_out(struct wpa_supplicant *wpa_s,
1127 union wpa_event_data *data)
1128 {
1129 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication timed out");
1130 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1131 wpa_supplicant_mark_disassoc(wpa_s);
1132 }
1133
1134
1135 void sme_event_assoc_timed_out(struct wpa_supplicant *wpa_s,
1136 union wpa_event_data *data)
1137 {
1138 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association timed out");
1139 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1140 wpa_supplicant_mark_disassoc(wpa_s);
1141 }
1142
1143
1144 void sme_event_disassoc(struct wpa_supplicant *wpa_s,
1145 struct disassoc_info *info)
1146 {
1147 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Disassociation event received");
1148 if (wpa_s->sme.prev_bssid_set) {
1149 /*
1150 * cfg80211/mac80211 can get into somewhat confused state if
1151 * the AP only disassociates us and leaves us in authenticated
1152 * state. For now, force the state to be cleared to avoid
1153 * confusing errors if we try to associate with the AP again.
1154 */
1155 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Deauthenticate to clear "
1156 "driver state");
1157 wpa_drv_deauthenticate(wpa_s, wpa_s->sme.prev_bssid,
1158 WLAN_REASON_DEAUTH_LEAVING);
1159 }
1160 }
1161
1162
1163 static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx)
1164 {
1165 struct wpa_supplicant *wpa_s = eloop_ctx;
1166 if (wpa_s->wpa_state == WPA_AUTHENTICATING) {
1167 wpa_msg(wpa_s, MSG_DEBUG, "SME: Authentication timeout");
1168 sme_deauth(wpa_s);
1169 }
1170 }
1171
1172
1173 static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx)
1174 {
1175 struct wpa_supplicant *wpa_s = eloop_ctx;
1176 if (wpa_s->wpa_state == WPA_ASSOCIATING) {
1177 wpa_msg(wpa_s, MSG_DEBUG, "SME: Association timeout");
1178 sme_deauth(wpa_s);
1179 }
1180 }
1181
1182
1183 void sme_state_changed(struct wpa_supplicant *wpa_s)
1184 {
1185 /* Make sure timers are cleaned up appropriately. */
1186 if (wpa_s->wpa_state != WPA_ASSOCIATING)
1187 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
1188 if (wpa_s->wpa_state != WPA_AUTHENTICATING)
1189 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
1190 }
1191
1192
1193 void sme_disassoc_while_authenticating(struct wpa_supplicant *wpa_s,
1194 const u8 *prev_pending_bssid)
1195 {
1196 /*
1197 * mac80211-workaround to force deauth on failed auth cmd,
1198 * requires us to remain in authenticating state to allow the
1199 * second authentication attempt to be continued properly.
1200 */
1201 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Allow pending authentication "
1202 "to proceed after disconnection event");
1203 wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
1204 os_memcpy(wpa_s->pending_bssid, prev_pending_bssid, ETH_ALEN);
1205
1206 /*
1207 * Re-arm authentication timer in case auth fails for whatever reason.
1208 */
1209 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
1210 eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
1211 NULL);
1212 }
1213
1214
1215 void sme_clear_on_disassoc(struct wpa_supplicant *wpa_s)
1216 {
1217 wpa_s->sme.prev_bssid_set = 0;
1218 #ifdef CONFIG_SAE
1219 wpabuf_free(wpa_s->sme.sae_token);
1220 wpa_s->sme.sae_token = NULL;
1221 sae_clear_data(&wpa_s->sme.sae);
1222 #endif /* CONFIG_SAE */
1223 #ifdef CONFIG_IEEE80211R
1224 if (wpa_s->sme.ft_ies)
1225 sme_update_ft_ies(wpa_s, NULL, NULL, 0);
1226 #endif /* CONFIG_IEEE80211R */
1227 }
1228
1229
1230 void sme_deinit(struct wpa_supplicant *wpa_s)
1231 {
1232 os_free(wpa_s->sme.ft_ies);
1233 wpa_s->sme.ft_ies = NULL;
1234 wpa_s->sme.ft_ies_len = 0;
1235 #ifdef CONFIG_IEEE80211W
1236 sme_stop_sa_query(wpa_s);
1237 #endif /* CONFIG_IEEE80211W */
1238 sme_clear_on_disassoc(wpa_s);
1239
1240 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
1241 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
1242 eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
1243 }
1244
1245
1246 static void sme_send_2040_bss_coex(struct wpa_supplicant *wpa_s,
1247 const u8 *chan_list, u8 num_channels,
1248 u8 num_intol)
1249 {
1250 struct ieee80211_2040_bss_coex_ie *bc_ie;
1251 struct ieee80211_2040_intol_chan_report *ic_report;
1252 struct wpabuf *buf;
1253
1254 wpa_printf(MSG_DEBUG, "SME: Send 20/40 BSS Coexistence to " MACSTR
1255 " (num_channels=%u num_intol=%u)",
1256 MAC2STR(wpa_s->bssid), num_channels, num_intol);
1257 wpa_hexdump(MSG_DEBUG, "SME: 20/40 BSS Intolerant Channels",
1258 chan_list, num_channels);
1259
1260 buf = wpabuf_alloc(2 + /* action.category + action_code */
1261 sizeof(struct ieee80211_2040_bss_coex_ie) +
1262 sizeof(struct ieee80211_2040_intol_chan_report) +
1263 num_channels);
1264 if (buf == NULL)
1265 return;
1266
1267 wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC);
1268 wpabuf_put_u8(buf, WLAN_PA_20_40_BSS_COEX);
1269
1270 bc_ie = wpabuf_put(buf, sizeof(*bc_ie));
1271 bc_ie->element_id = WLAN_EID_20_40_BSS_COEXISTENCE;
1272 bc_ie->length = 1;
1273 if (num_intol)
1274 bc_ie->coex_param |= WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ;
1275
1276 if (num_channels > 0) {
1277 ic_report = wpabuf_put(buf, sizeof(*ic_report));
1278 ic_report->element_id = WLAN_EID_20_40_BSS_INTOLERANT;
1279 ic_report->length = num_channels + 1;
1280 ic_report->op_class = 0;
1281 os_memcpy(wpabuf_put(buf, num_channels), chan_list,
1282 num_channels);
1283 }
1284
1285 if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
1286 wpa_s->own_addr, wpa_s->bssid,
1287 wpabuf_head(buf), wpabuf_len(buf), 0) < 0) {
1288 wpa_msg(wpa_s, MSG_INFO,
1289 "SME: Failed to send 20/40 BSS Coexistence frame");
1290 }
1291
1292 wpabuf_free(buf);
1293 }
1294
1295
1296 int sme_proc_obss_scan(struct wpa_supplicant *wpa_s)
1297 {
1298 struct wpa_bss *bss;
1299 const u8 *ie;
1300 u16 ht_cap;
1301 u8 chan_list[P2P_MAX_CHANNELS], channel;
1302 u8 num_channels = 0, num_intol = 0, i;
1303
1304 if (!wpa_s->sme.sched_obss_scan)
1305 return 0;
1306
1307 wpa_s->sme.sched_obss_scan = 0;
1308 if (!wpa_s->current_bss || wpa_s->wpa_state != WPA_COMPLETED)
1309 return 1;
1310
1311 /*
1312 * Check whether AP uses regulatory triplet or channel triplet in
1313 * country info. Right now the operating class of the BSS channel
1314 * width trigger event is "unknown" (IEEE Std 802.11-2012 10.15.12),
1315 * based on the assumption that operating class triplet is not used in
1316 * beacon frame. If the First Channel Number/Operating Extension
1317 * Identifier octet has a positive integer value of 201 or greater,
1318 * then its operating class triplet.
1319 *
1320 * TODO: If Supported Operating Classes element is present in beacon
1321 * frame, have to lookup operating class in Annex E and fill them in
1322 * 2040 coex frame.
1323 */
1324 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_COUNTRY);
1325 if (ie && (ie[1] >= 6) && (ie[5] >= 201))
1326 return 1;
1327
1328 os_memset(chan_list, 0, sizeof(chan_list));
1329
1330 dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
1331 /* Skip other band bss */
1332 enum hostapd_hw_mode mode;
1333 mode = ieee80211_freq_to_chan(bss->freq, &channel);
1334 if (mode != HOSTAPD_MODE_IEEE80211G &&
1335 mode != HOSTAPD_MODE_IEEE80211B)
1336 continue;
1337
1338 ie = wpa_bss_get_ie(bss, WLAN_EID_HT_CAP);
1339 ht_cap = (ie && (ie[1] == 26)) ? WPA_GET_LE16(ie + 2) : 0;
1340 wpa_printf(MSG_DEBUG, "SME OBSS scan BSS " MACSTR
1341 " freq=%u chan=%u ht_cap=0x%x",
1342 MAC2STR(bss->bssid), bss->freq, channel, ht_cap);
1343
1344 if (!ht_cap || (ht_cap & HT_CAP_INFO_40MHZ_INTOLERANT)) {
1345 if (ht_cap & HT_CAP_INFO_40MHZ_INTOLERANT)
1346 num_intol++;
1347
1348 /* Check whether the channel is already considered */
1349 for (i = 0; i < num_channels; i++) {
1350 if (channel == chan_list[i])
1351 break;
1352 }
1353 if (i != num_channels)
1354 continue;
1355
1356 chan_list[num_channels++] = channel;
1357 }
1358 }
1359
1360 sme_send_2040_bss_coex(wpa_s, chan_list, num_channels, num_intol);
1361 return 1;
1362 }
1363
1364
1365 static void wpa_obss_scan_freqs_list(struct wpa_supplicant *wpa_s,
1366 struct wpa_driver_scan_params *params)
1367 {
1368 /* Include only affected channels */
1369 struct hostapd_hw_modes *mode;
1370 int count, i;
1371 int start, end;
1372
1373 mode = get_mode(wpa_s->hw.modes, wpa_s->hw.num_modes,
1374 HOSTAPD_MODE_IEEE80211G);
1375 if (mode == NULL) {
1376 /* No channels supported in this band - use empty list */
1377 params->freqs = os_zalloc(sizeof(int));
1378 return;
1379 }
1380
1381 if (wpa_s->sme.ht_sec_chan == HT_SEC_CHAN_UNKNOWN &&
1382 wpa_s->current_bss) {
1383 const u8 *ie;
1384
1385 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_OPERATION);
1386 if (ie && ie[1] >= 2) {
1387 u8 o;
1388
1389 o = ie[3] & HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
1390 if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
1391 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_ABOVE;
1392 else if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
1393 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_BELOW;
1394 }
1395 }
1396
1397 start = wpa_s->assoc_freq - 10;
1398 end = wpa_s->assoc_freq + 10;
1399 switch (wpa_s->sme.ht_sec_chan) {
1400 case HT_SEC_CHAN_UNKNOWN:
1401 /* HT40+ possible on channels 1..9 */
1402 if (wpa_s->assoc_freq <= 2452)
1403 start -= 20;
1404 /* HT40- possible on channels 5-13 */
1405 if (wpa_s->assoc_freq >= 2432)
1406 end += 20;
1407 break;
1408 case HT_SEC_CHAN_ABOVE:
1409 end += 20;
1410 break;
1411 case HT_SEC_CHAN_BELOW:
1412 start -= 20;
1413 break;
1414 }
1415 wpa_printf(MSG_DEBUG,
1416 "OBSS: assoc_freq %d possible affected range %d-%d",
1417 wpa_s->assoc_freq, start, end);
1418
1419 params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
1420 if (params->freqs == NULL)
1421 return;
1422 for (count = 0, i = 0; i < mode->num_channels; i++) {
1423 int freq;
1424
1425 if (mode->channels[i].flag & HOSTAPD_CHAN_DISABLED)
1426 continue;
1427 freq = mode->channels[i].freq;
1428 if (freq - 10 >= end || freq + 10 <= start)
1429 continue; /* not affected */
1430 params->freqs[count++] = freq;
1431 }
1432 }
1433
1434
1435 static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx)
1436 {
1437 struct wpa_supplicant *wpa_s = eloop_ctx;
1438 struct wpa_driver_scan_params params;
1439
1440 if (!wpa_s->current_bss) {
1441 wpa_printf(MSG_DEBUG, "SME OBSS: Ignore scan request");
1442 return;
1443 }
1444
1445 os_memset(&params, 0, sizeof(params));
1446 wpa_obss_scan_freqs_list(wpa_s, &params);
1447 params.low_priority = 1;
1448 wpa_printf(MSG_DEBUG, "SME OBSS: Request an OBSS scan");
1449
1450 if (wpa_supplicant_trigger_scan(wpa_s, &params))
1451 wpa_printf(MSG_DEBUG, "SME OBSS: Failed to trigger scan");
1452 else
1453 wpa_s->sme.sched_obss_scan = 1;
1454 os_free(params.freqs);
1455
1456 eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
1457 sme_obss_scan_timeout, wpa_s, NULL);
1458 }
1459
1460
1461 void sme_sched_obss_scan(struct wpa_supplicant *wpa_s, int enable)
1462 {
1463 const u8 *ie;
1464 struct wpa_bss *bss = wpa_s->current_bss;
1465 struct wpa_ssid *ssid = wpa_s->current_ssid;
1466 struct hostapd_hw_modes *hw_mode = NULL;
1467 int i;
1468
1469 eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
1470 wpa_s->sme.sched_obss_scan = 0;
1471 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_UNKNOWN;
1472 if (!enable)
1473 return;
1474
1475 /*
1476 * Schedule OBSS scan if driver is using station SME in wpa_supplicant
1477 * or it expects OBSS scan to be performed by wpa_supplicant.
1478 */
1479 if (!((wpa_s->drv_flags & WPA_DRIVER_FLAGS_SME) ||
1480 (wpa_s->drv_flags & WPA_DRIVER_FLAGS_OBSS_SCAN)) ||
1481 ssid == NULL || ssid->mode != IEEE80211_MODE_INFRA)
1482 return;
1483
1484 if (!wpa_s->hw.modes)
1485 return;
1486
1487 /* only HT caps in 11g mode are relevant */
1488 for (i = 0; i < wpa_s->hw.num_modes; i++) {
1489 hw_mode = &wpa_s->hw.modes[i];
1490 if (hw_mode->mode == HOSTAPD_MODE_IEEE80211G)
1491 break;
1492 }
1493
1494 /* Driver does not support HT40 for 11g or doesn't have 11g. */
1495 if (i == wpa_s->hw.num_modes || !hw_mode ||
1496 !(hw_mode->ht_capab & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
1497 return;
1498
1499 if (bss == NULL || bss->freq < 2400 || bss->freq > 2500)
1500 return; /* Not associated on 2.4 GHz band */
1501
1502 /* Check whether AP supports HT40 */
1503 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_CAP);
1504 if (!ie || ie[1] < 2 ||
1505 !(WPA_GET_LE16(ie + 2) & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
1506 return; /* AP does not support HT40 */
1507
1508 ie = wpa_bss_get_ie(wpa_s->current_bss,
1509 WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS);
1510 if (!ie || ie[1] < 14)
1511 return; /* AP does not request OBSS scans */
1512
1513 wpa_s->sme.obss_scan_int = WPA_GET_LE16(ie + 6);
1514 if (wpa_s->sme.obss_scan_int < 10) {
1515 wpa_printf(MSG_DEBUG, "SME: Invalid OBSS Scan Interval %u "
1516 "replaced with the minimum 10 sec",
1517 wpa_s->sme.obss_scan_int);
1518 wpa_s->sme.obss_scan_int = 10;
1519 }
1520 wpa_printf(MSG_DEBUG, "SME: OBSS Scan Interval %u sec",
1521 wpa_s->sme.obss_scan_int);
1522 eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
1523 sme_obss_scan_timeout, wpa_s, NULL);
1524 }
1525
1526
1527 #ifdef CONFIG_IEEE80211W
1528
1529 static const unsigned int sa_query_max_timeout = 1000;
1530 static const unsigned int sa_query_retry_timeout = 201;
1531
1532 static int sme_check_sa_query_timeout(struct wpa_supplicant *wpa_s)
1533 {
1534 u32 tu;
1535 struct os_reltime now, passed;
1536 os_get_reltime(&now);
1537 os_reltime_sub(&now, &wpa_s->sme.sa_query_start, &passed);
1538 tu = (passed.sec * 1000000 + passed.usec) / 1024;
1539 if (sa_query_max_timeout < tu) {
1540 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SA Query timed out");
1541 sme_stop_sa_query(wpa_s);
1542 wpa_supplicant_deauthenticate(
1543 wpa_s, WLAN_REASON_PREV_AUTH_NOT_VALID);
1544 return 1;
1545 }
1546
1547 return 0;
1548 }
1549
1550
1551 static void sme_send_sa_query_req(struct wpa_supplicant *wpa_s,
1552 const u8 *trans_id)
1553 {
1554 u8 req[2 + WLAN_SA_QUERY_TR_ID_LEN];
1555 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Sending SA Query Request to "
1556 MACSTR, MAC2STR(wpa_s->bssid));
1557 wpa_hexdump(MSG_DEBUG, "SME: SA Query Transaction ID",
1558 trans_id, WLAN_SA_QUERY_TR_ID_LEN);
1559 req[0] = WLAN_ACTION_SA_QUERY;
1560 req[1] = WLAN_SA_QUERY_REQUEST;
1561 os_memcpy(req + 2, trans_id, WLAN_SA_QUERY_TR_ID_LEN);
1562 if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
1563 wpa_s->own_addr, wpa_s->bssid,
1564 req, sizeof(req), 0) < 0)
1565 wpa_msg(wpa_s, MSG_INFO, "SME: Failed to send SA Query "
1566 "Request");
1567 }
1568
1569
1570 static void sme_sa_query_timer(void *eloop_ctx, void *timeout_ctx)
1571 {
1572 struct wpa_supplicant *wpa_s = eloop_ctx;
1573 unsigned int timeout, sec, usec;
1574 u8 *trans_id, *nbuf;
1575
1576 if (wpa_s->sme.sa_query_count > 0 &&
1577 sme_check_sa_query_timeout(wpa_s))
1578 return;
1579
1580 nbuf = os_realloc_array(wpa_s->sme.sa_query_trans_id,
1581 wpa_s->sme.sa_query_count + 1,
1582 WLAN_SA_QUERY_TR_ID_LEN);
1583 if (nbuf == NULL)
1584 return;
1585 if (wpa_s->sme.sa_query_count == 0) {
1586 /* Starting a new SA Query procedure */
1587 os_get_reltime(&wpa_s->sme.sa_query_start);
1588 }
1589 trans_id = nbuf + wpa_s->sme.sa_query_count * WLAN_SA_QUERY_TR_ID_LEN;
1590 wpa_s->sme.sa_query_trans_id = nbuf;
1591 wpa_s->sme.sa_query_count++;
1592
1593 if (os_get_random(trans_id, WLAN_SA_QUERY_TR_ID_LEN) < 0) {
1594 wpa_printf(MSG_DEBUG, "Could not generate SA Query ID");
1595 return;
1596 }
1597
1598 timeout = sa_query_retry_timeout;
1599 sec = ((timeout / 1000) * 1024) / 1000;
1600 usec = (timeout % 1000) * 1024;
1601 eloop_register_timeout(sec, usec, sme_sa_query_timer, wpa_s, NULL);
1602
1603 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association SA Query attempt %d",
1604 wpa_s->sme.sa_query_count);
1605
1606 sme_send_sa_query_req(wpa_s, trans_id);
1607 }
1608
1609
1610 static void sme_start_sa_query(struct wpa_supplicant *wpa_s)
1611 {
1612 sme_sa_query_timer(wpa_s, NULL);
1613 }
1614
1615
1616 static void sme_stop_sa_query(struct wpa_supplicant *wpa_s)
1617 {
1618 eloop_cancel_timeout(sme_sa_query_timer, wpa_s, NULL);
1619 os_free(wpa_s->sme.sa_query_trans_id);
1620 wpa_s->sme.sa_query_trans_id = NULL;
1621 wpa_s->sme.sa_query_count = 0;
1622 }
1623
1624
1625 void sme_event_unprot_disconnect(struct wpa_supplicant *wpa_s, const u8 *sa,
1626 const u8 *da, u16 reason_code)
1627 {
1628 struct wpa_ssid *ssid;
1629 struct os_reltime now;
1630
1631 if (wpa_s->wpa_state != WPA_COMPLETED)
1632 return;
1633 ssid = wpa_s->current_ssid;
1634 if (wpas_get_ssid_pmf(wpa_s, ssid) == NO_MGMT_FRAME_PROTECTION)
1635 return;
1636 if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
1637 return;
1638 if (reason_code != WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA &&
1639 reason_code != WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA)
1640 return;
1641 if (wpa_s->sme.sa_query_count > 0)
1642 return;
1643
1644 os_get_reltime(&now);
1645 if (wpa_s->sme.last_unprot_disconnect.sec &&
1646 !os_reltime_expired(&now, &wpa_s->sme.last_unprot_disconnect, 10))
1647 return; /* limit SA Query procedure frequency */
1648 wpa_s->sme.last_unprot_disconnect = now;
1649
1650 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Unprotected disconnect dropped - "
1651 "possible AP/STA state mismatch - trigger SA Query");
1652 sme_start_sa_query(wpa_s);
1653 }
1654
1655
1656 void sme_sa_query_rx(struct wpa_supplicant *wpa_s, const u8 *sa,
1657 const u8 *data, size_t len)
1658 {
1659 int i;
1660
1661 if (wpa_s->sme.sa_query_trans_id == NULL ||
1662 len < 1 + WLAN_SA_QUERY_TR_ID_LEN ||
1663 data[0] != WLAN_SA_QUERY_RESPONSE)
1664 return;
1665 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Received SA Query response from "
1666 MACSTR " (trans_id %02x%02x)", MAC2STR(sa), data[1], data[2]);
1667
1668 if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
1669 return;
1670
1671 for (i = 0; i < wpa_s->sme.sa_query_count; i++) {
1672 if (os_memcmp(wpa_s->sme.sa_query_trans_id +
1673 i * WLAN_SA_QUERY_TR_ID_LEN,
1674 data + 1, WLAN_SA_QUERY_TR_ID_LEN) == 0)
1675 break;
1676 }
1677
1678 if (i >= wpa_s->sme.sa_query_count) {
1679 wpa_dbg(wpa_s, MSG_DEBUG, "SME: No matching SA Query "
1680 "transaction identifier found");
1681 return;
1682 }
1683
1684 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reply to pending SA Query received "
1685 "from " MACSTR, MAC2STR(sa));
1686 sme_stop_sa_query(wpa_s);
1687 }
1688
1689 #endif /* CONFIG_IEEE80211W */