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