]> git.ipfire.org Git - thirdparty/hostap.git/blame - wpa_supplicant/sme.c
nl80211: Fix RTM NEW/DELLINK IFLA_IFNAME copy for maximum ifname length
[thirdparty/hostap.git] / wpa_supplicant / sme.c
CommitLineData
c2a04078
JM
1/*
2 * wpa_supplicant - SME
6ac4b15e 3 * Copyright (c) 2009-2014, Jouni Malinen <j@w1.fi>
c2a04078 4 *
0f3d578e
JM
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
c2a04078
JM
7 */
8
9#include "includes.h"
10
11#include "common.h"
7d878ca7 12#include "utils/eloop.h"
90973fb2 13#include "common/ieee802_11_defs.h"
d9a27b04 14#include "common/ieee802_11_common.h"
f9da7505 15#include "common/ocv.h"
3204795d 16#include "common/hw_features_common.h"
c2a04078 17#include "eapol_supp/eapol_supp_sm.h"
90973fb2 18#include "common/wpa_common.h"
98efcc41 19#include "common/sae.h"
10ec6a5f 20#include "common/dpp.h"
3acb5005
JM
21#include "rsn_supp/wpa.h"
22#include "rsn_supp/pmksa_cache.h"
c2a04078
JM
23#include "config.h"
24#include "wpa_supplicant_i.h"
2d5b792d 25#include "driver_i.h"
c2a04078
JM
26#include "wpas_glue.h"
27#include "wps_supplicant.h"
5f3a6aa0 28#include "p2p_supplicant.h"
8bac466b 29#include "notify.h"
6fa81a3b 30#include "bss.h"
9ba9fa07 31#include "scan.h"
c2a04078 32#include "sme.h"
cb418324 33#include "hs20_supplicant.h"
c2a04078 34
e29853bb
BG
35#define SME_AUTH_TIMEOUT 5
36#define SME_ASSOC_TIMEOUT 5
37
38static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx);
39static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx);
c3701c66 40static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx);
e29853bb 41static void sme_stop_sa_query(struct wpa_supplicant *wpa_s);
e29853bb
BG
42
43
c10347f2
JM
44#ifdef CONFIG_SAE
45
625f202a
JM
46static int index_within_array(const int *array, int idx)
47{
48 int i;
49 for (i = 0; i < idx; i++) {
18ca7332 50 if (array[i] <= 0)
625f202a
JM
51 return 0;
52 }
53 return 1;
54}
55
56
57static int sme_set_sae_group(struct wpa_supplicant *wpa_s)
58{
59 int *groups = wpa_s->conf->sae_groups;
a9fe1303 60 int default_groups[] = { 19, 20, 21, 0 };
625f202a 61
18ca7332 62 if (!groups || groups[0] <= 0)
625f202a
JM
63 groups = default_groups;
64
65 /* Configuration may have changed, so validate current index */
66 if (!index_within_array(groups, wpa_s->sme.sae_group_index))
67 return -1;
68
69 for (;;) {
70 int group = groups[wpa_s->sme.sae_group_index];
04e6c4cc 71 if (group <= 0)
625f202a
JM
72 break;
73 if (sae_set_group(&wpa_s->sme.sae, group) == 0) {
74 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected SAE group %d",
75 wpa_s->sme.sae.group);
3d1d4691 76 return 0;
625f202a
JM
77 }
78 wpa_s->sme.sae_group_index++;
79 }
80
81 return -1;
82}
83
84
8e31e955
JM
85static struct wpabuf * sme_auth_build_sae_commit(struct wpa_supplicant *wpa_s,
86 struct wpa_ssid *ssid,
fd830891 87 const u8 *bssid, int external,
cfe1ea5c 88 int reuse, int *ret_use_pt)
c10347f2
JM
89{
90 struct wpabuf *buf;
d136c376 91 size_t len;
a34ca59e 92 const char *password;
cfe1ea5c
JM
93 struct wpa_bss *bss;
94 int use_pt = 0;
95
96 if (ret_use_pt)
97 *ret_use_pt = 0;
c10347f2 98
a0f19e9c
JM
99#ifdef CONFIG_TESTING_OPTIONS
100 if (wpa_s->sae_commit_override) {
101 wpa_printf(MSG_DEBUG, "SAE: TESTING - commit override");
102 buf = wpabuf_alloc(4 + wpabuf_len(wpa_s->sae_commit_override));
103 if (!buf)
104 return NULL;
be609c6f
JM
105 if (!external) {
106 wpabuf_put_le16(buf, 1); /* Transaction seq# */
107 wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
108 }
a0f19e9c
JM
109 wpabuf_put_buf(buf, wpa_s->sae_commit_override);
110 return buf;
111 }
112#endif /* CONFIG_TESTING_OPTIONS */
113
a34ca59e
JM
114 password = ssid->sae_password;
115 if (!password)
116 password = ssid->passphrase;
117 if (!password) {
8e31e955
JM
118 wpa_printf(MSG_DEBUG, "SAE: No password available");
119 return NULL;
120 }
121
fd830891
JM
122 if (reuse && wpa_s->sme.sae.tmp &&
123 os_memcmp(bssid, wpa_s->sme.sae.tmp->bssid, ETH_ALEN) == 0) {
124 wpa_printf(MSG_DEBUG,
125 "SAE: Reuse previously generated PWE on a retry with the same AP");
cfe1ea5c 126 use_pt = wpa_s->sme.sae.tmp->h2e;
fd830891
JM
127 goto reuse_data;
128 }
625f202a
JM
129 if (sme_set_sae_group(wpa_s) < 0) {
130 wpa_printf(MSG_DEBUG, "SAE: Failed to select group");
a46d72d7 131 return NULL;
625f202a 132 }
a46d72d7 133
641d79f1 134 if (ssid->sae_password_id && wpa_s->conf->sae_pwe != 3)
e36a5894
JM
135 use_pt = 1;
136
137 if (use_pt || wpa_s->conf->sae_pwe == 1 || wpa_s->conf->sae_pwe == 2) {
cfe1ea5c
JM
138 bss = wpa_bss_get_bssid_latest(wpa_s, bssid);
139 if (bss) {
140 const u8 *rsnxe;
141
142 rsnxe = wpa_bss_get_ie(bss, WLAN_EID_RSNX);
143 if (rsnxe && rsnxe[1] >= 1)
144 use_pt = !!(rsnxe[2] &
145 BIT(WLAN_RSNX_CAPAB_SAE_H2E));
146 }
147
e36a5894 148 if ((wpa_s->conf->sae_pwe == 1 || ssid->sae_password_id) &&
641d79f1 149 wpa_s->conf->sae_pwe != 3 &&
e36a5894 150 !use_pt) {
cfe1ea5c
JM
151 wpa_printf(MSG_DEBUG,
152 "SAE: Cannot use H2E with the selected AP");
153 return NULL;
154 }
155 }
156
157 if (use_pt &&
158 sae_prepare_commit_pt(&wpa_s->sme.sae, ssid->pt,
159 wpa_s->own_addr, bssid,
160 wpa_s->sme.sae_rejected_groups) < 0)
161 return NULL;
162 if (!use_pt &&
163 sae_prepare_commit(wpa_s->own_addr, bssid,
a34ca59e 164 (u8 *) password, os_strlen(password),
9be19d0b 165 ssid->sae_password_id,
8e31e955
JM
166 &wpa_s->sme.sae) < 0) {
167 wpa_printf(MSG_DEBUG, "SAE: Could not pick PWE");
168 return NULL;
169 }
fd830891
JM
170 if (wpa_s->sme.sae.tmp)
171 os_memcpy(wpa_s->sme.sae.tmp->bssid, bssid, ETH_ALEN);
8e31e955 172
fd830891 173reuse_data:
5e32fb01 174 len = wpa_s->sme.sae_token ? 3 + wpabuf_len(wpa_s->sme.sae_token) : 0;
9be19d0b
JM
175 if (ssid->sae_password_id)
176 len += 4 + os_strlen(ssid->sae_password_id);
d136c376 177 buf = wpabuf_alloc(4 + SAE_COMMIT_MAX_LEN + len);
c10347f2
JM
178 if (buf == NULL)
179 return NULL;
5ff39c13
SD
180 if (!external) {
181 wpabuf_put_le16(buf, 1); /* Transaction seq# */
cfe1ea5c
JM
182 wpabuf_put_le16(buf, use_pt ? WLAN_STATUS_SAE_HASH_TO_ELEMENT :
183 WLAN_STATUS_SUCCESS);
5ff39c13 184 }
10223b50
JM
185 if (sae_write_commit(&wpa_s->sme.sae, buf, wpa_s->sme.sae_token,
186 ssid->sae_password_id) < 0) {
187 wpabuf_free(buf);
188 return NULL;
189 }
cfe1ea5c
JM
190 if (ret_use_pt)
191 *ret_use_pt = use_pt;
c10347f2
JM
192
193 return buf;
194}
195
196
5ff39c13
SD
197static struct wpabuf * sme_auth_build_sae_confirm(struct wpa_supplicant *wpa_s,
198 int external)
c10347f2
JM
199{
200 struct wpabuf *buf;
201
fb8fcc29 202 buf = wpabuf_alloc(4 + SAE_CONFIRM_MAX_LEN);
c10347f2
JM
203 if (buf == NULL)
204 return NULL;
205
5ff39c13
SD
206 if (!external) {
207 wpabuf_put_le16(buf, 2); /* Transaction seq# */
208 wpabuf_put_le16(buf, WLAN_STATUS_SUCCESS);
209 }
fb8fcc29 210 sae_write_confirm(&wpa_s->sme.sae, buf);
c10347f2
JM
211
212 return buf;
213}
214
215#endif /* CONFIG_SAE */
216
217
b361d580
AK
218/**
219 * sme_auth_handle_rrm - Handle RRM aspects of current authentication attempt
220 * @wpa_s: Pointer to wpa_supplicant data
221 * @bss: Pointer to the bss which is the target of authentication attempt
222 */
223static void sme_auth_handle_rrm(struct wpa_supplicant *wpa_s,
224 struct wpa_bss *bss)
225{
226 const u8 rrm_ie_len = 5;
227 u8 *pos;
228 const u8 *rrm_ie;
229
230 wpa_s->rrm.rrm_used = 0;
231
232 wpa_printf(MSG_DEBUG,
233 "RRM: Determining whether RRM can be used - device support: 0x%x",
234 wpa_s->drv_rrm_flags);
235
236 rrm_ie = wpa_bss_get_ie(bss, WLAN_EID_RRM_ENABLED_CAPABILITIES);
237 if (!rrm_ie || !(bss->caps & IEEE80211_CAP_RRM)) {
238 wpa_printf(MSG_DEBUG, "RRM: No RRM in network");
239 return;
240 }
241
00ed0aa2
BL
242 if (!((wpa_s->drv_rrm_flags &
243 WPA_DRIVER_FLAGS_DS_PARAM_SET_IE_IN_PROBES) &&
244 (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_QUIET)) &&
245 !(wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_SUPPORT_RRM)) {
b361d580
AK
246 wpa_printf(MSG_DEBUG,
247 "RRM: Insufficient RRM support in driver - do not use RRM");
248 return;
249 }
250
849367af
JM
251 if (sizeof(wpa_s->sme.assoc_req_ie) <
252 wpa_s->sme.assoc_req_ie_len + rrm_ie_len + 2) {
b361d580
AK
253 wpa_printf(MSG_INFO,
254 "RRM: Unable to use RRM, no room for RRM IE");
255 return;
256 }
257
258 wpa_printf(MSG_DEBUG, "RRM: Adding RRM IE to Association Request");
259 pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
b361d580
AK
260 os_memset(pos, 0, 2 + rrm_ie_len);
261 *pos++ = WLAN_EID_RRM_ENABLED_CAPABILITIES;
262 *pos++ = rrm_ie_len;
70d1e728
AO
263
264 /* Set supported capabilites flags */
265 if (wpa_s->drv_rrm_flags & WPA_DRIVER_FLAGS_TX_POWER_INSERTION)
266 *pos |= WLAN_RRM_CAPS_LINK_MEASUREMENT;
267
d7342014
JM
268 *pos |= WLAN_RRM_CAPS_BEACON_REPORT_PASSIVE |
269 WLAN_RRM_CAPS_BEACON_REPORT_ACTIVE |
270 WLAN_RRM_CAPS_BEACON_REPORT_TABLE;
76196ddb 271
4a742011
DS
272 if (wpa_s->lci)
273 pos[1] |= WLAN_RRM_CAPS_LCI_MEASUREMENT;
274
b361d580
AK
275 wpa_s->sme.assoc_req_ie_len += rrm_ie_len + 2;
276 wpa_s->rrm.rrm_used = 1;
277}
278
279
215ae884
JM
280static void sme_send_authentication(struct wpa_supplicant *wpa_s,
281 struct wpa_bss *bss, struct wpa_ssid *ssid,
282 int start)
c2a04078
JM
283{
284 struct wpa_driver_auth_params params;
8bac466b 285 struct wpa_ssid *old_ssid;
fdbe50ed 286#ifdef CONFIG_IEEE80211R
c2a04078 287 const u8 *ie;
fdbe50ed 288#endif /* CONFIG_IEEE80211R */
af3e362f 289#if defined(CONFIG_IEEE80211R) || defined(CONFIG_FILS)
c2a04078 290 const u8 *md = NULL;
af3e362f 291#endif /* CONFIG_IEEE80211R || CONFIG_FILS */
200c7693 292 int bssid_changed;
c10347f2 293 struct wpabuf *resp = NULL;
0bbaa9b9 294 u8 ext_capab[18];
03e47c9c 295 int ext_capab_len;
59b416c7 296 int skip_auth;
170244a1
IP
297 u8 *wpa_ie;
298 size_t wpa_ie_len;
077232f6
BL
299#ifdef CONFIG_MBO
300 const u8 *mbo_ie;
301#endif /* CONFIG_MBO */
6140cca8 302 int omit_rsnxe = 0;
c2a04078
JM
303
304 if (bss == NULL) {
f049052b
BG
305 wpa_msg(wpa_s, MSG_ERROR, "SME: No scan result available for "
306 "the network");
6ac4b15e 307 wpas_connect_work_done(wpa_s);
c2a04078
JM
308 return;
309 }
310
59b416c7
JM
311 skip_auth = wpa_s->conf->reassoc_same_bss_optim &&
312 wpa_s->reassoc_same_bss;
8f770587
JM
313 wpa_s->current_bss = bss;
314
c2a04078
JM
315 os_memset(&params, 0, sizeof(params));
316 wpa_s->reassociate = 0;
317
318 params.freq = bss->freq;
319 params.bssid = bss->bssid;
6fa81a3b
JM
320 params.ssid = bss->ssid;
321 params.ssid_len = bss->ssid_len;
2f4f73b1 322 params.p2p = ssid->p2p_group;
c2a04078 323
62fa124c
JM
324 if (wpa_s->sme.ssid_len != params.ssid_len ||
325 os_memcmp(wpa_s->sme.ssid, params.ssid, params.ssid_len) != 0)
326 wpa_s->sme.prev_bssid_set = 0;
327
c2a04078
JM
328 wpa_s->sme.freq = params.freq;
329 os_memcpy(wpa_s->sme.ssid, params.ssid, params.ssid_len);
330 wpa_s->sme.ssid_len = params.ssid_len;
331
abd9fafa 332 params.auth_alg = WPA_AUTH_ALG_OPEN;
c2a04078
JM
333#ifdef IEEE8021X_EAPOL
334 if (ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) {
335 if (ssid->leap) {
336 if (ssid->non_leap == 0)
abd9fafa 337 params.auth_alg = WPA_AUTH_ALG_LEAP;
c2a04078 338 else
abd9fafa 339 params.auth_alg |= WPA_AUTH_ALG_LEAP;
c2a04078
JM
340 }
341 }
342#endif /* IEEE8021X_EAPOL */
f049052b
BG
343 wpa_dbg(wpa_s, MSG_DEBUG, "Automatic auth_alg selection: 0x%x",
344 params.auth_alg);
c2a04078 345 if (ssid->auth_alg) {
abd9fafa 346 params.auth_alg = ssid->auth_alg;
f049052b
BG
347 wpa_dbg(wpa_s, MSG_DEBUG, "Overriding auth_alg selection: "
348 "0x%x", params.auth_alg);
c2a04078 349 }
c10347f2 350#ifdef CONFIG_SAE
bc26ac50 351 wpa_s->sme.sae_pmksa_caching = 0;
c10347f2
JM
352 if (wpa_key_mgmt_sae(ssid->key_mgmt)) {
353 const u8 *rsn;
354 struct wpa_ie_data ied;
355
356 rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
267ac3bc
JM
357 if (!rsn) {
358 wpa_dbg(wpa_s, MSG_DEBUG,
359 "SAE enabled, but target BSS does not advertise RSN");
dd6c5980
JM
360#ifdef CONFIG_DPP
361 } else if (wpa_parse_wpa_ie(rsn, 2 + rsn[1], &ied) == 0 &&
362 (ssid->key_mgmt & WPA_KEY_MGMT_DPP) &&
363 (ied.key_mgmt & WPA_KEY_MGMT_DPP)) {
364 wpa_dbg(wpa_s, MSG_DEBUG, "Prefer DPP over SAE when both are enabled");
365#endif /* CONFIG_DPP */
267ac3bc
JM
366 } else if (wpa_parse_wpa_ie(rsn, 2 + rsn[1], &ied) == 0 &&
367 wpa_key_mgmt_sae(ied.key_mgmt)) {
368 wpa_dbg(wpa_s, MSG_DEBUG, "Using SAE auth_alg");
369 params.auth_alg = WPA_AUTH_ALG_SAE;
370 } else {
371 wpa_dbg(wpa_s, MSG_DEBUG,
372 "SAE enabled, but target BSS does not advertise SAE AKM for RSN");
c10347f2
JM
373 }
374 }
375#endif /* CONFIG_SAE */
c2a04078 376
200c7693
JM
377#ifdef CONFIG_WEP
378 {
379 int i;
380
381 for (i = 0; i < NUM_WEP_KEYS; i++) {
382 if (ssid->wep_key_len[i])
383 params.wep_key[i] = ssid->wep_key[i];
384 params.wep_key_len[i] = ssid->wep_key_len[i];
385 }
386 params.wep_tx_keyidx = ssid->wep_tx_keyidx;
a0b2f99b 387 }
200c7693 388#endif /* CONFIG_WEP */
a0b2f99b 389
f337f0e9
JM
390 if ((wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE) ||
391 wpa_bss_get_ie(bss, WLAN_EID_RSN)) &&
0bf927a0 392 wpa_key_mgmt_wpa(ssid->key_mgmt)) {
c2a04078 393 int try_opportunistic;
869af307
JM
394 const u8 *cache_id = NULL;
395
6e202021
JM
396 try_opportunistic = (ssid->proactive_key_caching < 0 ?
397 wpa_s->conf->okc :
398 ssid->proactive_key_caching) &&
c2a04078 399 (ssid->proto & WPA_PROTO_RSN);
869af307
JM
400#ifdef CONFIG_FILS
401 if (wpa_key_mgmt_fils(ssid->key_mgmt))
402 cache_id = wpa_bss_get_fils_cache_id(bss);
403#endif /* CONFIG_FILS */
c2a04078
JM
404 if (pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid,
405 wpa_s->current_ssid,
852b2f27
JM
406 try_opportunistic, cache_id,
407 0) == 0)
ba422613 408 eapol_sm_notify_pmkid_attempt(wpa_s->eapol);
c2a04078
JM
409 wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
410 if (wpa_supplicant_set_suites(wpa_s, bss, ssid,
411 wpa_s->sme.assoc_req_ie,
412 &wpa_s->sme.assoc_req_ie_len)) {
f049052b
BG
413 wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
414 "key management and encryption suites");
6ac4b15e 415 wpas_connect_work_done(wpa_s);
c2a04078
JM
416 return;
417 }
dc673aec
JM
418#ifdef CONFIG_HS20
419 } else if (wpa_bss_get_vendor_ie(bss, OSEN_IE_VENDOR_TYPE) &&
420 (ssid->key_mgmt & WPA_KEY_MGMT_OSEN)) {
421 /* No PMKSA caching, but otherwise similar to RSN/WPA */
422 wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
423 if (wpa_supplicant_set_suites(wpa_s, bss, ssid,
424 wpa_s->sme.assoc_req_ie,
425 &wpa_s->sme.assoc_req_ie_len)) {
426 wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
427 "key management and encryption suites");
428 wpas_connect_work_done(wpa_s);
429 return;
430 }
431#endif /* CONFIG_HS20 */
a3f7e518
JM
432 } else if ((ssid->key_mgmt & WPA_KEY_MGMT_IEEE8021X_NO_WPA) &&
433 wpa_key_mgmt_wpa_ieee8021x(ssid->key_mgmt)) {
434 /*
435 * Both WPA and non-WPA IEEE 802.1X enabled in configuration -
436 * use non-WPA since the scan results did not indicate that the
437 * AP is using WPA or WPA2.
438 */
439 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
440 wpa_s->sme.assoc_req_ie_len = 0;
0bf927a0 441 } else if (wpa_key_mgmt_wpa_any(ssid->key_mgmt)) {
c2a04078
JM
442 wpa_s->sme.assoc_req_ie_len = sizeof(wpa_s->sme.assoc_req_ie);
443 if (wpa_supplicant_set_suites(wpa_s, NULL, ssid,
444 wpa_s->sme.assoc_req_ie,
445 &wpa_s->sme.assoc_req_ie_len)) {
f049052b
BG
446 wpa_msg(wpa_s, MSG_WARNING, "SME: Failed to set WPA "
447 "key management and encryption suites (no "
448 "scan results)");
6ac4b15e 449 wpas_connect_work_done(wpa_s);
c2a04078
JM
450 return;
451 }
452#ifdef CONFIG_WPS
453 } else if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
454 struct wpabuf *wps_ie;
455 wps_ie = wps_build_assoc_req_ie(wpas_wps_get_req_type(ssid));
456 if (wps_ie && wpabuf_len(wps_ie) <=
457 sizeof(wpa_s->sme.assoc_req_ie)) {
458 wpa_s->sme.assoc_req_ie_len = wpabuf_len(wps_ie);
459 os_memcpy(wpa_s->sme.assoc_req_ie, wpabuf_head(wps_ie),
460 wpa_s->sme.assoc_req_ie_len);
461 } else
462 wpa_s->sme.assoc_req_ie_len = 0;
463 wpabuf_free(wps_ie);
464 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
465#endif /* CONFIG_WPS */
466 } else {
467 wpa_supplicant_set_non_wpa_policy(wpa_s, ssid);
468 wpa_s->sme.assoc_req_ie_len = 0;
469 }
470
170244a1
IP
471 /* In case the WPA vendor IE is used, it should be placed after all the
472 * non-vendor IEs, as the lower layer expects the IEs to be ordered as
473 * defined in the standard. Store the WPA IE so it can later be
474 * inserted at the correct location.
475 */
476 wpa_ie = NULL;
477 wpa_ie_len = 0;
478 if (wpa_s->wpa_proto == WPA_PROTO_WPA) {
479 wpa_ie = os_memdup(wpa_s->sme.assoc_req_ie,
480 wpa_s->sme.assoc_req_ie_len);
481 if (wpa_ie) {
482 wpa_dbg(wpa_s, MSG_DEBUG, "WPA: Storing WPA IE");
483
484 wpa_ie_len = wpa_s->sme.assoc_req_ie_len;
485 wpa_s->sme.assoc_req_ie_len = 0;
486 } else {
487 wpa_msg(wpa_s, MSG_WARNING, "WPA: Failed copy WPA IE");
488 wpas_connect_work_done(wpa_s);
489 return;
490 }
491 }
492
c2a04078 493#ifdef CONFIG_IEEE80211R
6fa81a3b 494 ie = wpa_bss_get_ie(bss, WLAN_EID_MOBILITY_DOMAIN);
c2a04078
JM
495 if (ie && ie[1] >= MOBILITY_DOMAIN_ID_LEN)
496 md = ie + 2;
e7846b68 497 wpa_sm_set_ft_params(wpa_s->wpa, ie, ie ? 2 + ie[1] : 0);
322d328e
JM
498 if (md && (!wpa_key_mgmt_ft(ssid->key_mgmt) ||
499 !wpa_key_mgmt_ft(wpa_s->key_mgmt)))
500 md = NULL;
c2a04078
JM
501 if (md) {
502 /* Prepare for the next transition */
76b7981d 503 wpa_ft_prepare_auth_request(wpa_s->wpa, ie);
c2a04078
JM
504 }
505
af3e362f
JM
506 if (md) {
507 wpa_dbg(wpa_s, MSG_DEBUG, "SME: FT mobility domain %02x%02x",
508 md[0], md[1]);
509
6140cca8 510 omit_rsnxe = !wpa_bss_get_ie(bss, WLAN_EID_RSNX);
c2a04078
JM
511 if (wpa_s->sme.assoc_req_ie_len + 5 <
512 sizeof(wpa_s->sme.assoc_req_ie)) {
513 struct rsn_mdie *mdie;
514 u8 *pos = wpa_s->sme.assoc_req_ie +
515 wpa_s->sme.assoc_req_ie_len;
516 *pos++ = WLAN_EID_MOBILITY_DOMAIN;
517 *pos++ = sizeof(*mdie);
518 mdie = (struct rsn_mdie *) pos;
519 os_memcpy(mdie->mobility_domain, md,
520 MOBILITY_DOMAIN_ID_LEN);
f4ec630d 521 mdie->ft_capab = md[MOBILITY_DOMAIN_ID_LEN];
c2a04078
JM
522 wpa_s->sme.assoc_req_ie_len += 5;
523 }
524
f808bd59 525 if (wpa_s->sme.prev_bssid_set && wpa_s->sme.ft_used &&
0d7b4409
JM
526 os_memcmp(md, wpa_s->sme.mobility_domain, 2) == 0 &&
527 wpa_sm_has_ptk(wpa_s->wpa)) {
f049052b
BG
528 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying to use FT "
529 "over-the-air");
abd9fafa 530 params.auth_alg = WPA_AUTH_ALG_FT;
c2a04078
JM
531 params.ie = wpa_s->sme.ft_ies;
532 params.ie_len = wpa_s->sme.ft_ies_len;
533 }
534 }
535#endif /* CONFIG_IEEE80211R */
536
3f56a2b7 537 wpa_s->sme.mfp = wpas_get_ssid_pmf(wpa_s, ssid);
62d49803 538 if (wpa_s->sme.mfp != NO_MGMT_FRAME_PROTECTION) {
6fa81a3b 539 const u8 *rsn = wpa_bss_get_ie(bss, WLAN_EID_RSN);
c2a04078
JM
540 struct wpa_ie_data _ie;
541 if (rsn && wpa_parse_wpa_ie(rsn, 2 + rsn[1], &_ie) == 0 &&
542 _ie.capabilities &
543 (WPA_CAPABILITY_MFPC | WPA_CAPABILITY_MFPR)) {
f049052b
BG
544 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Selected AP supports "
545 "MFP: require MFP");
c2a04078
JM
546 wpa_s->sme.mfp = MGMT_FRAME_PROTECTION_REQUIRED;
547 }
548 }
c2a04078 549
5f3a6aa0
JM
550#ifdef CONFIG_P2P
551 if (wpa_s->global->p2p) {
552 u8 *pos;
553 size_t len;
554 int res;
5f3a6aa0
JM
555 pos = wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len;
556 len = sizeof(wpa_s->sme.assoc_req_ie) -
557 wpa_s->sme.assoc_req_ie_len;
ffad8858
JM
558 res = wpas_p2p_assoc_req_ie(wpa_s, bss, pos, len,
559 ssid->p2p_group);
5f3a6aa0
JM
560 if (res >= 0)
561 wpa_s->sme.assoc_req_ie_len += res;
562 }
563#endif /* CONFIG_P2P */
564
b36a3a65
AN
565#ifdef CONFIG_FST
566 if (wpa_s->fst_ies) {
567 int fst_ies_len = wpabuf_len(wpa_s->fst_ies);
568
569 if (wpa_s->sme.assoc_req_ie_len + fst_ies_len <=
570 sizeof(wpa_s->sme.assoc_req_ie)) {
571 os_memcpy(wpa_s->sme.assoc_req_ie +
572 wpa_s->sme.assoc_req_ie_len,
573 wpabuf_head(wpa_s->fst_ies),
574 fst_ies_len);
575 wpa_s->sme.assoc_req_ie_len += fst_ies_len;
576 }
577 }
578#endif /* CONFIG_FST */
579
a0c38e5d
AS
580 sme_auth_handle_rrm(wpa_s, bss);
581
065c029a 582 wpa_s->sme.assoc_req_ie_len += wpas_supp_op_class_ie(
2b9713d6 583 wpa_s, ssid, bss,
065c029a 584 wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
585 sizeof(wpa_s->sme.assoc_req_ie) - wpa_s->sme.assoc_req_ie_len);
5e57ba25 586
cc9a2575
KV
587 if (params.p2p)
588 wpa_drv_get_ext_capa(wpa_s, WPA_IF_P2P_CLIENT);
589 else
590 wpa_drv_get_ext_capa(wpa_s, WPA_IF_STATION);
591
0bbaa9b9
JM
592 ext_capab_len = wpas_build_ext_capab(wpa_s, ext_capab,
593 sizeof(ext_capab));
03e47c9c 594 if (ext_capab_len > 0) {
92cbcf91
JM
595 u8 *pos = wpa_s->sme.assoc_req_ie;
596 if (wpa_s->sme.assoc_req_ie_len > 0 && pos[0] == WLAN_EID_RSN)
597 pos += 2 + pos[1];
03e47c9c 598 os_memmove(pos + ext_capab_len, pos,
92cbcf91
JM
599 wpa_s->sme.assoc_req_ie_len -
600 (pos - wpa_s->sme.assoc_req_ie));
03e47c9c
JM
601 wpa_s->sme.assoc_req_ie_len += ext_capab_len;
602 os_memcpy(pos, ext_capab, ext_capab_len);
92cbcf91 603 }
92cbcf91 604
13256553
JM
605#ifdef CONFIG_TESTING_OPTIONS
606 if (wpa_s->rsnxe_override_assoc &&
607 wpabuf_len(wpa_s->rsnxe_override_assoc) <=
608 sizeof(wpa_s->sme.assoc_req_ie) - wpa_s->sme.assoc_req_ie_len) {
609 wpa_printf(MSG_DEBUG, "TESTING: RSNXE AssocReq override");
610 os_memcpy(wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
611 wpabuf_head(wpa_s->rsnxe_override_assoc),
612 wpabuf_len(wpa_s->rsnxe_override_assoc));
613 wpa_s->sme.assoc_req_ie_len +=
614 wpabuf_len(wpa_s->rsnxe_override_assoc);
615 } else
616#endif /* CONFIG_TESTING_OPTIONS */
6d6c8877
JM
617 if (wpa_s->rsnxe_len > 0 &&
618 wpa_s->rsnxe_len <=
6140cca8
JM
619 sizeof(wpa_s->sme.assoc_req_ie) - wpa_s->sme.assoc_req_ie_len &&
620 !omit_rsnxe) {
6d6c8877
JM
621 os_memcpy(wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
622 wpa_s->rsnxe, wpa_s->rsnxe_len);
623 wpa_s->sme.assoc_req_ie_len += wpa_s->rsnxe_len;
624 }
625
c484b198
AS
626#ifdef CONFIG_HS20
627 if (is_hs20_network(wpa_s, ssid, bss)) {
628 struct wpabuf *hs20;
629
4204669c 630 hs20 = wpabuf_alloc(20 + MAX_ROAMING_CONS_OI_LEN);
c484b198
AS
631 if (hs20) {
632 int pps_mo_id = hs20_get_pps_mo_id(wpa_s, ssid);
633 size_t len;
634
ec2cf403
JM
635 wpas_hs20_add_indication(hs20, pps_mo_id,
636 get_hs20_version(bss));
4204669c 637 wpas_hs20_add_roam_cons_sel(hs20, ssid);
c484b198
AS
638 len = sizeof(wpa_s->sme.assoc_req_ie) -
639 wpa_s->sme.assoc_req_ie_len;
640 if (wpabuf_len(hs20) <= len) {
641 os_memcpy(wpa_s->sme.assoc_req_ie +
642 wpa_s->sme.assoc_req_ie_len,
643 wpabuf_head(hs20), wpabuf_len(hs20));
644 wpa_s->sme.assoc_req_ie_len += wpabuf_len(hs20);
645 }
646 wpabuf_free(hs20);
647 }
648 }
649#endif /* CONFIG_HS20 */
650
170244a1
IP
651 if (wpa_ie) {
652 size_t len;
653
654 wpa_dbg(wpa_s, MSG_DEBUG, "WPA: Reinsert WPA IE");
655
656 len = sizeof(wpa_s->sme.assoc_req_ie) -
657 wpa_s->sme.assoc_req_ie_len;
658
659 if (len > wpa_ie_len) {
660 os_memcpy(wpa_s->sme.assoc_req_ie +
661 wpa_s->sme.assoc_req_ie_len,
662 wpa_ie, wpa_ie_len);
663 wpa_s->sme.assoc_req_ie_len += wpa_ie_len;
664 } else {
665 wpa_dbg(wpa_s, MSG_DEBUG, "WPA: Failed to add WPA IE");
666 }
667
668 os_free(wpa_ie);
669 }
670
d29fa3a7
JM
671 if (wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ]) {
672 struct wpabuf *buf = wpa_s->vendor_elem[VENDOR_ELEM_ASSOC_REQ];
673 size_t len;
674
675 len = sizeof(wpa_s->sme.assoc_req_ie) -
676 wpa_s->sme.assoc_req_ie_len;
677 if (wpabuf_len(buf) <= len) {
678 os_memcpy(wpa_s->sme.assoc_req_ie +
679 wpa_s->sme.assoc_req_ie_len,
680 wpabuf_head(buf), wpabuf_len(buf));
681 wpa_s->sme.assoc_req_ie_len += wpabuf_len(buf);
682 }
683 }
684
92c6e2e3 685#ifdef CONFIG_MBO
077232f6 686 mbo_ie = wpa_bss_get_vendor_ie(bss, MBO_IE_VENDOR_TYPE);
2e06cef8 687 if (!wpa_s->disable_mbo_oce && mbo_ie) {
5e57ba25 688 int len;
92c6e2e3 689
5e57ba25
AS
690 len = wpas_mbo_ie(wpa_s, wpa_s->sme.assoc_req_ie +
691 wpa_s->sme.assoc_req_ie_len,
692 sizeof(wpa_s->sme.assoc_req_ie) -
077232f6
BL
693 wpa_s->sme.assoc_req_ie_len,
694 !!mbo_attr_from_mbo_ie(mbo_ie,
695 OCE_ATTR_ID_CAPA_IND));
5e57ba25
AS
696 if (len >= 0)
697 wpa_s->sme.assoc_req_ie_len += len;
92c6e2e3
DS
698 }
699#endif /* CONFIG_MBO */
700
c10347f2 701#ifdef CONFIG_SAE
59b416c7 702 if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE &&
869af307 703 pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid, ssid, 0,
ab3aebcc
JM
704 NULL,
705 wpa_s->key_mgmt == WPA_KEY_MGMT_FT_SAE ?
706 WPA_KEY_MGMT_FT_SAE :
707 WPA_KEY_MGMT_SAE) == 0) {
bc26ac50
JM
708 wpa_dbg(wpa_s, MSG_DEBUG,
709 "PMKSA cache entry found - try to use PMKSA caching instead of new SAE authentication");
06b1a104 710 wpa_sm_set_pmk_from_pmksa(wpa_s->wpa);
bc26ac50
JM
711 params.auth_alg = WPA_AUTH_ALG_OPEN;
712 wpa_s->sme.sae_pmksa_caching = 1;
713 }
714
59b416c7 715 if (!skip_auth && params.auth_alg == WPA_AUTH_ALG_SAE) {
c10347f2 716 if (start)
8e31e955 717 resp = sme_auth_build_sae_commit(wpa_s, ssid,
fd830891 718 bss->bssid, 0,
cfe1ea5c 719 start == 2, NULL);
c10347f2 720 else
5ff39c13 721 resp = sme_auth_build_sae_confirm(wpa_s, 0);
6ac4b15e 722 if (resp == NULL) {
81648d00 723 wpas_connection_failed(wpa_s, bss->bssid);
c10347f2 724 return;
6ac4b15e 725 }
ce16c489
JM
726 params.auth_data = wpabuf_head(resp);
727 params.auth_data_len = wpabuf_len(resp);
dd43026a 728 wpa_s->sme.sae.state = start ? SAE_COMMITTED : SAE_CONFIRMED;
c10347f2
JM
729 }
730#endif /* CONFIG_SAE */
731
af670cb4
JM
732 bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
733 os_memset(wpa_s->bssid, 0, ETH_ALEN);
734 os_memcpy(wpa_s->pending_bssid, bss->bssid, ETH_ALEN);
735 if (bssid_changed)
736 wpas_notify_bssid_changed(wpa_s);
737
f00b9b88
JM
738 old_ssid = wpa_s->current_ssid;
739 wpa_s->current_ssid = ssid;
740 wpa_supplicant_rsn_supp_set_config(wpa_s, wpa_s->current_ssid);
741 wpa_supplicant_initiate_eapol(wpa_s);
742
743#ifdef CONFIG_FILS
744 /* TODO: FILS operations can in some cases be done between different
745 * network_ctx (i.e., same credentials can be used with multiple
746 * networks). */
747 if (params.auth_alg == WPA_AUTH_ALG_OPEN &&
748 wpa_key_mgmt_fils(ssid->key_mgmt)) {
64983516
JM
749 const u8 *indic;
750 u16 fils_info;
af835d75
AB
751 const u8 *realm, *username, *rrk;
752 size_t realm_len, username_len, rrk_len;
753 u16 next_seq_num;
64983516
JM
754
755 /*
756 * Check FILS Indication element (FILS Information field) bits
757 * indicating supported authentication algorithms against local
758 * configuration (ssid->fils_dh_group). Try to use FILS
759 * authentication only if the AP supports the combination in the
760 * network profile. */
761 indic = wpa_bss_get_ie(bss, WLAN_EID_FILS_INDICATION);
762 if (!indic || indic[1] < 2) {
763 wpa_printf(MSG_DEBUG, "SME: " MACSTR
764 " does not include FILS Indication element - cannot use FILS authentication with it",
765 MAC2STR(bss->bssid));
766 goto no_fils;
767 }
768
769 fils_info = WPA_GET_LE16(indic + 2);
770 if (ssid->fils_dh_group == 0 && !(fils_info & BIT(9))) {
771 wpa_printf(MSG_DEBUG, "SME: " MACSTR
772 " does not support FILS SK without PFS - cannot use FILS authentication with it",
773 MAC2STR(bss->bssid));
774 goto no_fils;
775 }
776 if (ssid->fils_dh_group != 0 && !(fils_info & BIT(10))) {
777 wpa_printf(MSG_DEBUG, "SME: " MACSTR
778 " does not support FILS SK with PFS - cannot use FILS authentication with it",
779 MAC2STR(bss->bssid));
780 goto no_fils;
781 }
782
af835d75
AB
783 if (wpa_s->last_con_fail_realm &&
784 eapol_sm_get_erp_info(wpa_s->eapol, &ssid->eap,
785 &username, &username_len,
786 &realm, &realm_len, &next_seq_num,
787 &rrk, &rrk_len) == 0 &&
788 realm && realm_len == wpa_s->last_con_fail_realm_len &&
789 os_memcmp(realm, wpa_s->last_con_fail_realm,
790 realm_len) == 0) {
791 wpa_printf(MSG_DEBUG,
792 "SME: FILS authentication for this realm failed last time - try to regenerate ERP key hierarchy");
793 goto no_fils;
794 }
795
f00b9b88 796 if (pmksa_cache_set_current(wpa_s->wpa, NULL, bss->bssid,
869af307 797 ssid, 0,
852b2f27
JM
798 wpa_bss_get_fils_cache_id(bss),
799 0) == 0)
f00b9b88
JM
800 wpa_printf(MSG_DEBUG,
801 "SME: Try to use FILS with PMKSA caching");
af3e362f 802 resp = fils_build_auth(wpa_s->wpa, ssid->fils_dh_group, md);
f00b9b88 803 if (resp) {
76e20f4f
JM
804 int auth_alg;
805
806 if (ssid->fils_dh_group)
807 wpa_printf(MSG_DEBUG,
808 "SME: Try to use FILS SK authentication with PFS (DH Group %u)",
809 ssid->fils_dh_group);
810 else
811 wpa_printf(MSG_DEBUG,
812 "SME: Try to use FILS SK authentication without PFS");
813 auth_alg = ssid->fils_dh_group ?
814 WPA_AUTH_ALG_FILS_SK_PFS : WPA_AUTH_ALG_FILS;
815 params.auth_alg = auth_alg;
f00b9b88
JM
816 params.auth_data = wpabuf_head(resp);
817 params.auth_data_len = wpabuf_len(resp);
76e20f4f 818 wpa_s->sme.auth_alg = auth_alg;
f00b9b88
JM
819 }
820 }
64983516 821no_fils:
f00b9b88
JM
822#endif /* CONFIG_FILS */
823
a4cba8f1 824 wpa_supplicant_cancel_sched_scan(wpa_s);
c2a04078
JM
825 wpa_supplicant_cancel_scan(wpa_s);
826
f049052b 827 wpa_msg(wpa_s, MSG_INFO, "SME: Trying to authenticate with " MACSTR
c2a04078
JM
828 " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
829 wpa_ssid_txt(params.ssid, params.ssid_len), params.freq);
830
6aea02e5 831 eapol_sm_notify_portValid(wpa_s->eapol, FALSE);
c2a04078
JM
832 wpa_clear_keys(wpa_s, bss->bssid);
833 wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
8bac466b
JM
834 if (old_ssid != wpa_s->current_ssid)
835 wpas_notify_network_changed(wpa_s);
c2a04078 836
ece4ac5f
MG
837#ifdef CONFIG_HS20
838 hs20_configure_frame_filters(wpa_s);
839#endif /* CONFIG_HS20 */
840
d0df6437
IP
841#ifdef CONFIG_P2P
842 /*
843 * If multi-channel concurrency is not supported, check for any
844 * frequency conflict. In case of any frequency conflict, remove the
845 * least prioritized connection.
846 */
847 if (wpa_s->num_multichan_concurrent < 2) {
848 int freq, num;
849 num = get_shared_radio_freqs(wpa_s, &freq, 1);
850 if (num > 0 && freq > 0 && freq != params.freq) {
851 wpa_printf(MSG_DEBUG,
852 "Conflicting frequency found (%d != %d)",
853 freq, params.freq);
854 if (wpas_p2p_handle_frequency_conflicts(wpa_s,
855 params.freq,
856 ssid) < 0) {
857 wpas_connection_failed(wpa_s, bss->bssid);
858 wpa_supplicant_mark_disassoc(wpa_s);
859 wpabuf_free(resp);
860 wpas_connect_work_done(wpa_s);
861 return;
862 }
863 }
864 }
865#endif /* CONFIG_P2P */
866
59b416c7
JM
867 if (skip_auth) {
868 wpa_msg(wpa_s, MSG_DEBUG,
869 "SME: Skip authentication step on reassoc-to-same-BSS");
870 wpabuf_free(resp);
871 sme_associate(wpa_s, ssid->mode, bss->bssid, WLAN_AUTH_OPEN);
872 return;
873 }
874
875
62c72d72 876 wpa_s->sme.auth_alg = params.auth_alg;
c2a04078 877 if (wpa_drv_authenticate(wpa_s, &params) < 0) {
f049052b 878 wpa_msg(wpa_s, MSG_INFO, "SME: Authentication request to the "
c2a04078 879 "driver failed");
ed57c590 880 wpas_connection_failed(wpa_s, bss->bssid);
1193dc8f 881 wpa_supplicant_mark_disassoc(wpa_s);
c10347f2 882 wpabuf_free(resp);
6ac4b15e 883 wpas_connect_work_done(wpa_s);
c2a04078
JM
884 return;
885 }
886
e29853bb
BG
887 eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
888 NULL);
c2a04078
JM
889
890 /*
891 * Association will be started based on the authentication event from
892 * the driver.
893 */
c10347f2
JM
894
895 wpabuf_free(resp);
896}
897
898
6ac4b15e
JM
899static void sme_auth_start_cb(struct wpa_radio_work *work, int deinit)
900{
901 struct wpa_connect_work *cwork = work->ctx;
902 struct wpa_supplicant *wpa_s = work->wpa_s;
903
904 if (deinit) {
b3253ebb
AO
905 if (work->started)
906 wpa_s->connect_work = NULL;
907
6ac4b15e
JM
908 wpas_connect_work_free(cwork);
909 return;
910 }
911
912 wpa_s->connect_work = work;
913
a7f5271d 914 if (cwork->bss_removed ||
6108536d
HW
915 !wpas_valid_bss_ssid(wpa_s, cwork->bss, cwork->ssid) ||
916 wpas_network_disabled(wpa_s, cwork->ssid)) {
6ac4b15e
JM
917 wpa_dbg(wpa_s, MSG_DEBUG, "SME: BSS/SSID entry for authentication not valid anymore - drop connection attempt");
918 wpas_connect_work_done(wpa_s);
919 return;
920 }
921
2c2c5579
JM
922 /* Starting new connection, so clear the possibly used WPA IE from the
923 * previous association. */
924 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, NULL, 0);
6d6c8877
JM
925 wpa_sm_set_assoc_rsnxe(wpa_s->wpa, NULL, 0);
926 wpa_s->rsnxe_len = 0;
2c2c5579 927
6ac4b15e
JM
928 sme_send_authentication(wpa_s, cwork->bss, cwork->ssid, 1);
929}
930
931
c10347f2
JM
932void sme_authenticate(struct wpa_supplicant *wpa_s,
933 struct wpa_bss *bss, struct wpa_ssid *ssid)
934{
6ac4b15e
JM
935 struct wpa_connect_work *cwork;
936
937 if (bss == NULL || ssid == NULL)
938 return;
939 if (wpa_s->connect_work) {
940 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reject sme_authenticate() call since connect_work exist");
941 return;
942 }
943
f0e30c84 944 if (radio_work_pending(wpa_s, "sme-connect")) {
f1c4dbf5
IP
945 /*
946 * The previous sme-connect work might no longer be valid due to
947 * the fact that the BSS list was updated. In addition, it makes
948 * sense to adhere to the 'newer' decision.
949 */
950 wpa_dbg(wpa_s, MSG_DEBUG,
951 "SME: Remove previous pending sme-connect");
952 radio_remove_works(wpa_s, "sme-connect", 0);
f0e30c84
JM
953 }
954
4ead7cfd
KV
955 wpas_abort_ongoing_scan(wpa_s);
956
6ac4b15e
JM
957 cwork = os_zalloc(sizeof(*cwork));
958 if (cwork == NULL)
959 return;
960 cwork->bss = bss;
961 cwork->ssid = ssid;
962 cwork->sme = 1;
963
98efcc41 964#ifdef CONFIG_SAE
dd43026a 965 wpa_s->sme.sae.state = SAE_NOTHING;
98efcc41 966 wpa_s->sme.sae.send_confirm = 0;
18ca7332 967 wpa_s->sme.sae_group_index = 0;
98efcc41 968#endif /* CONFIG_SAE */
6ac4b15e
JM
969
970 if (radio_add_work(wpa_s, bss->freq, "sme-connect", 1,
971 sme_auth_start_cb, cwork) < 0)
972 wpas_connect_work_free(cwork);
c2a04078
JM
973}
974
975
c10347f2 976#ifdef CONFIG_SAE
21af6d15 977
5ff39c13
SD
978static int sme_external_auth_build_buf(struct wpabuf *buf,
979 struct wpabuf *params,
980 const u8 *sa, const u8 *da,
cfe1ea5c
JM
981 u16 auth_transaction, u16 seq_num,
982 u16 status_code)
5ff39c13
SD
983{
984 struct ieee80211_mgmt *resp;
985
986 resp = wpabuf_put(buf, offsetof(struct ieee80211_mgmt,
987 u.auth.variable));
988
989 resp->frame_control = host_to_le16((WLAN_FC_TYPE_MGMT << 2) |
990 (WLAN_FC_STYPE_AUTH << 4));
991 os_memcpy(resp->da, da, ETH_ALEN);
992 os_memcpy(resp->sa, sa, ETH_ALEN);
993 os_memcpy(resp->bssid, da, ETH_ALEN);
fcb3f11e
AP
994 resp->u.auth.auth_alg = host_to_le16(WLAN_AUTH_SAE);
995 resp->seq_ctrl = host_to_le16(seq_num << 4);
996 resp->u.auth.auth_transaction = host_to_le16(auth_transaction);
cfe1ea5c 997 resp->u.auth.status_code = host_to_le16(status_code);
5ff39c13
SD
998 if (params)
999 wpabuf_put_buf(buf, params);
1000
1001 return 0;
1002}
1003
1004
fb6ebd1c
SD
1005static int sme_external_auth_send_sae_commit(struct wpa_supplicant *wpa_s,
1006 const u8 *bssid,
1007 struct wpa_ssid *ssid)
5ff39c13
SD
1008{
1009 struct wpabuf *resp, *buf;
cfe1ea5c 1010 int use_pt;
5ff39c13 1011
cfe1ea5c 1012 resp = sme_auth_build_sae_commit(wpa_s, ssid, bssid, 1, 0, &use_pt);
fb6ebd1c
SD
1013 if (!resp) {
1014 wpa_printf(MSG_DEBUG, "SAE: Failed to build SAE commit");
1015 return -1;
1016 }
5ff39c13
SD
1017
1018 wpa_s->sme.sae.state = SAE_COMMITTED;
1019 buf = wpabuf_alloc(4 + SAE_COMMIT_MAX_LEN + wpabuf_len(resp));
1020 if (!buf) {
1021 wpabuf_free(resp);
fb6ebd1c 1022 return -1;
5ff39c13
SD
1023 }
1024
1025 wpa_s->sme.seq_num++;
1026 sme_external_auth_build_buf(buf, resp, wpa_s->own_addr,
cfe1ea5c
JM
1027 bssid, 1, wpa_s->sme.seq_num,
1028 use_pt ? WLAN_STATUS_SAE_HASH_TO_ELEMENT :
1029 WLAN_STATUS_SUCCESS);
c4988e73 1030 wpa_drv_send_mlme(wpa_s, wpabuf_head(buf), wpabuf_len(buf), 1, 0, 0);
5ff39c13
SD
1031 wpabuf_free(resp);
1032 wpabuf_free(buf);
fb6ebd1c
SD
1033
1034 return 0;
5ff39c13
SD
1035}
1036
1037
1038static void sme_send_external_auth_status(struct wpa_supplicant *wpa_s,
1039 u16 status)
1040{
1041 struct external_auth params;
1042
1043 os_memset(&params, 0, sizeof(params));
1044 params.status = status;
d42df8d6
JM
1045 params.ssid = wpa_s->sme.ext_auth_ssid;
1046 params.ssid_len = wpa_s->sme.ext_auth_ssid_len;
1047 params.bssid = wpa_s->sme.ext_auth_bssid;
346d10cf
SD
1048 if (wpa_s->conf->sae_pmkid_in_assoc && status == WLAN_STATUS_SUCCESS)
1049 params.pmkid = wpa_s->sme.sae.pmkid;
5ff39c13
SD
1050 wpa_drv_send_external_auth_status(wpa_s, &params);
1051}
1052
1053
fb6ebd1c
SD
1054static int sme_handle_external_auth_start(struct wpa_supplicant *wpa_s,
1055 union wpa_event_data *data)
5ff39c13
SD
1056{
1057 struct wpa_ssid *ssid;
1058 size_t ssid_str_len = data->external_auth.ssid_len;
dd1a8cef 1059 const u8 *ssid_str = data->external_auth.ssid;
5ff39c13
SD
1060
1061 /* Get the SSID conf from the ssid string obtained */
1062 for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
1063 if (!wpas_network_disabled(wpa_s, ssid) &&
1064 ssid_str_len == ssid->ssid_len &&
18a0508a 1065 os_memcmp(ssid_str, ssid->ssid, ssid_str_len) == 0 &&
bcf19000 1066 (ssid->key_mgmt & (WPA_KEY_MGMT_SAE | WPA_KEY_MGMT_FT_SAE)))
5ff39c13
SD
1067 break;
1068 }
fb6ebd1c
SD
1069 if (!ssid ||
1070 sme_external_auth_send_sae_commit(wpa_s, data->external_auth.bssid,
1071 ssid) < 0)
1072 return -1;
1073
1074 return 0;
5ff39c13
SD
1075}
1076
1077
1078static void sme_external_auth_send_sae_confirm(struct wpa_supplicant *wpa_s,
1079 const u8 *da)
1080{
1081 struct wpabuf *resp, *buf;
1082
1083 resp = sme_auth_build_sae_confirm(wpa_s, 1);
1084 if (!resp) {
1085 wpa_printf(MSG_DEBUG, "SAE: Confirm message buf alloc failure");
1086 return;
1087 }
1088
1089 wpa_s->sme.sae.state = SAE_CONFIRMED;
1090 buf = wpabuf_alloc(4 + SAE_CONFIRM_MAX_LEN + wpabuf_len(resp));
1091 if (!buf) {
1092 wpa_printf(MSG_DEBUG, "SAE: Auth Confirm buf alloc failure");
1093 wpabuf_free(resp);
1094 return;
1095 }
1096 wpa_s->sme.seq_num++;
1097 sme_external_auth_build_buf(buf, resp, wpa_s->own_addr,
cfe1ea5c
JM
1098 da, 2, wpa_s->sme.seq_num,
1099 WLAN_STATUS_SUCCESS);
c4988e73 1100 wpa_drv_send_mlme(wpa_s, wpabuf_head(buf), wpabuf_len(buf), 1, 0, 0);
5ff39c13
SD
1101 wpabuf_free(resp);
1102 wpabuf_free(buf);
1103}
1104
1105
1106void sme_external_auth_trigger(struct wpa_supplicant *wpa_s,
1107 union wpa_event_data *data)
1108{
1109 if (RSN_SELECTOR_GET(&data->external_auth.key_mgmt_suite) !=
1110 RSN_AUTH_KEY_MGMT_SAE)
1111 return;
1112
1113 if (data->external_auth.action == EXT_AUTH_START) {
d42df8d6
JM
1114 if (!data->external_auth.bssid || !data->external_auth.ssid)
1115 return;
1116 os_memcpy(wpa_s->sme.ext_auth_bssid, data->external_auth.bssid,
1117 ETH_ALEN);
1118 os_memcpy(wpa_s->sme.ext_auth_ssid, data->external_auth.ssid,
1119 data->external_auth.ssid_len);
1120 wpa_s->sme.ext_auth_ssid_len = data->external_auth.ssid_len;
5ff39c13
SD
1121 wpa_s->sme.seq_num = 0;
1122 wpa_s->sme.sae.state = SAE_NOTHING;
1123 wpa_s->sme.sae.send_confirm = 0;
1124 wpa_s->sme.sae_group_index = 0;
fb6ebd1c
SD
1125 if (sme_handle_external_auth_start(wpa_s, data) < 0)
1126 sme_send_external_auth_status(wpa_s,
1127 WLAN_STATUS_UNSPECIFIED_FAILURE);
5ff39c13
SD
1128 } else if (data->external_auth.action == EXT_AUTH_ABORT) {
1129 /* Report failure to driver for the wrong trigger */
1130 sme_send_external_auth_status(wpa_s,
1131 WLAN_STATUS_UNSPECIFIED_FAILURE);
1132 }
1133}
1134
1135
444d76f7
JM
1136static int sme_sae_is_group_enabled(struct wpa_supplicant *wpa_s, int group)
1137{
1138 int *groups = wpa_s->conf->sae_groups;
1139 int default_groups[] = { 19, 20, 21, 0 };
1140 int i;
1141
1142 if (!groups)
1143 groups = default_groups;
1144
1145 for (i = 0; groups[i] > 0; i++) {
1146 if (groups[i] == group)
1147 return 1;
1148 }
1149
1150 return 0;
1151}
1152
1153
1154static int sme_check_sae_rejected_groups(struct wpa_supplicant *wpa_s,
1155 const struct wpabuf *groups)
1156{
1157 size_t i, count;
1158 const u8 *pos;
1159
1160 if (!groups)
1161 return 0;
1162
1163 pos = wpabuf_head(groups);
1164 count = wpabuf_len(groups) / 2;
1165 for (i = 0; i < count; i++) {
1166 int enabled;
1167 u16 group;
1168
1169 group = WPA_GET_LE16(pos);
1170 pos += 2;
1171 enabled = sme_sae_is_group_enabled(wpa_s, group);
1172 wpa_printf(MSG_DEBUG, "SAE: Rejected group %u is %s",
1173 group, enabled ? "enabled" : "disabled");
1174 if (enabled)
1175 return 1;
1176 }
1177
1178 return 0;
1179}
1180
1181
c10347f2 1182static int sme_sae_auth(struct wpa_supplicant *wpa_s, u16 auth_transaction,
5ff39c13
SD
1183 u16 status_code, const u8 *data, size_t len,
1184 int external, const u8 *sa)
c10347f2 1185{
a959a3b6
MH
1186 int *groups;
1187
c10347f2
JM
1188 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE authentication transaction %u "
1189 "status code %u", auth_transaction, status_code);
c10347f2 1190
d136c376
JM
1191 if (auth_transaction == 1 &&
1192 status_code == WLAN_STATUS_ANTI_CLOGGING_TOKEN_REQ &&
1193 wpa_s->sme.sae.state == SAE_COMMITTED &&
5ff39c13 1194 (external || wpa_s->current_bss) && wpa_s->current_ssid) {
a9fe1303 1195 int default_groups[] = { 19, 20, 21, 0 };
a959a3b6 1196 u16 group;
5e32fb01
JM
1197 const u8 *token_pos;
1198 size_t token_len;
1199 int h2e = 0;
a959a3b6
MH
1200
1201 groups = wpa_s->conf->sae_groups;
1202 if (!groups || groups[0] <= 0)
1203 groups = default_groups;
1204
5e32fb01
JM
1205 wpa_hexdump(MSG_DEBUG, "SME: SAE anti-clogging token request",
1206 data, len);
a959a3b6
MH
1207 if (len < sizeof(le16)) {
1208 wpa_dbg(wpa_s, MSG_DEBUG,
1209 "SME: Too short SAE anti-clogging token request");
1210 return -1;
1211 }
1212 group = WPA_GET_LE16(data);
1213 wpa_dbg(wpa_s, MSG_DEBUG,
1214 "SME: SAE anti-clogging token requested (group %u)",
1215 group);
1216 if (sae_group_allowed(&wpa_s->sme.sae, groups, group) !=
1217 WLAN_STATUS_SUCCESS) {
1218 wpa_dbg(wpa_s, MSG_ERROR,
1219 "SME: SAE group %u of anti-clogging request is invalid",
1220 group);
1221 return -1;
1222 }
d136c376 1223 wpabuf_free(wpa_s->sme.sae_token);
5e32fb01
JM
1224 token_pos = data + sizeof(le16);
1225 token_len = len - sizeof(le16);
1226 if (wpa_s->sme.sae.tmp)
1227 h2e = wpa_s->sme.sae.tmp->h2e;
1228 if (h2e) {
1229 if (token_len < 3) {
1230 wpa_dbg(wpa_s, MSG_DEBUG,
1231 "SME: Too short SAE anti-clogging token container");
1232 return -1;
1233 }
1234 if (token_pos[0] != WLAN_EID_EXTENSION ||
1235 token_pos[1] == 0 ||
1236 token_pos[1] > token_len - 2 ||
1237 token_pos[2] != WLAN_EID_EXT_ANTI_CLOGGING_TOKEN) {
1238 wpa_dbg(wpa_s, MSG_DEBUG,
1239 "SME: Invalid SAE anti-clogging token container header");
1240 return -1;
1241 }
1242 token_len = token_pos[1] - 1;
1243 token_pos += 3;
1244 }
1245 wpa_s->sme.sae_token = wpabuf_alloc_copy(token_pos, token_len);
1246 wpa_hexdump_buf(MSG_DEBUG, "SME: Requested anti-clogging token",
1247 wpa_s->sme.sae_token);
5ff39c13
SD
1248 if (!external)
1249 sme_send_authentication(wpa_s, wpa_s->current_bss,
fd830891 1250 wpa_s->current_ssid, 2);
5ff39c13
SD
1251 else
1252 sme_external_auth_send_sae_commit(
d42df8d6 1253 wpa_s, wpa_s->sme.ext_auth_bssid,
5ff39c13 1254 wpa_s->current_ssid);
d136c376
JM
1255 return 0;
1256 }
1257
625f202a
JM
1258 if (auth_transaction == 1 &&
1259 status_code == WLAN_STATUS_FINITE_CYCLIC_GROUP_NOT_SUPPORTED &&
1260 wpa_s->sme.sae.state == SAE_COMMITTED &&
5ff39c13 1261 (external || wpa_s->current_bss) && wpa_s->current_ssid) {
625f202a 1262 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SAE group not supported");
447cd5f2
JM
1263 int_array_add_unique(&wpa_s->sme.sae_rejected_groups,
1264 wpa_s->sme.sae.group);
625f202a
JM
1265 wpa_s->sme.sae_group_index++;
1266 if (sme_set_sae_group(wpa_s) < 0)
1267 return -1; /* no other groups enabled */
1268 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Try next enabled SAE group");
5ff39c13
SD
1269 if (!external)
1270 sme_send_authentication(wpa_s, wpa_s->current_bss,
1271 wpa_s->current_ssid, 1);
1272 else
1273 sme_external_auth_send_sae_commit(
d42df8d6 1274 wpa_s, wpa_s->sme.ext_auth_bssid,
5ff39c13 1275 wpa_s->current_ssid);
625f202a
JM
1276 return 0;
1277 }
1278
9be19d0b
JM
1279 if (auth_transaction == 1 &&
1280 status_code == WLAN_STATUS_UNKNOWN_PASSWORD_IDENTIFIER) {
1281 const u8 *bssid = sa ? sa : wpa_s->pending_bssid;
1282
1283 wpa_msg(wpa_s, MSG_INFO,
1284 WPA_EVENT_SAE_UNKNOWN_PASSWORD_IDENTIFIER MACSTR,
1285 MAC2STR(bssid));
1286 return -1;
1287 }
1288
cfe1ea5c
JM
1289 if (status_code != WLAN_STATUS_SUCCESS &&
1290 status_code != WLAN_STATUS_SAE_HASH_TO_ELEMENT)
c10347f2
JM
1291 return -1;
1292
1293 if (auth_transaction == 1) {
6a58444d
JM
1294 u16 res;
1295
a959a3b6 1296 groups = wpa_s->conf->sae_groups;
18ca7332 1297
c10347f2 1298 wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE commit");
5ff39c13 1299 if ((!external && wpa_s->current_bss == NULL) ||
c10347f2
JM
1300 wpa_s->current_ssid == NULL)
1301 return -1;
1b5865a5
JM
1302 if (wpa_s->sme.sae.state != SAE_COMMITTED) {
1303 wpa_printf(MSG_DEBUG,
1304 "SAE: Ignore commit message while waiting for confirm");
1305 return 0;
1306 }
ca1cecc5
JM
1307 if (wpa_s->sme.sae.tmp && wpa_s->sme.sae.tmp->h2e &&
1308 status_code == WLAN_STATUS_SUCCESS) {
1309 wpa_printf(MSG_DEBUG,
1310 "SAE: Unexpected use of status code 0 in SAE commit when H2E was expected");
1311 return -1;
1312 }
1313 if (wpa_s->sme.sae.tmp && !wpa_s->sme.sae.tmp->h2e &&
1314 status_code == WLAN_STATUS_SAE_HASH_TO_ELEMENT) {
1315 wpa_printf(MSG_DEBUG,
1316 "SAE: Unexpected use of status code for H2E in SAE commit when H2E was not expected");
1317 return -1;
1318 }
1319
18ca7332
JM
1320 if (groups && groups[0] <= 0)
1321 groups = NULL;
6a58444d 1322 res = sae_parse_commit(&wpa_s->sme.sae, data, len, NULL, NULL,
86f60848
JM
1323 groups, status_code ==
1324 WLAN_STATUS_SAE_HASH_TO_ELEMENT);
6a58444d
JM
1325 if (res == SAE_SILENTLY_DISCARD) {
1326 wpa_printf(MSG_DEBUG,
1327 "SAE: Drop commit message due to reflection attack");
1328 return 0;
1329 }
1330 if (res != WLAN_STATUS_SUCCESS)
21af6d15 1331 return -1;
146f6c9a 1332
444d76f7
JM
1333 if (wpa_s->sme.sae.tmp &&
1334 sme_check_sae_rejected_groups(
1335 wpa_s,
c88e01e1 1336 wpa_s->sme.sae.tmp->peer_rejected_groups))
444d76f7
JM
1337 return -1;
1338
146f6c9a
JM
1339 if (sae_process_commit(&wpa_s->sme.sae) < 0) {
1340 wpa_printf(MSG_DEBUG, "SAE: Failed to process peer "
1341 "commit");
1342 return -1;
1343 }
1344
d136c376
JM
1345 wpabuf_free(wpa_s->sme.sae_token);
1346 wpa_s->sme.sae_token = NULL;
5ff39c13
SD
1347 if (!external)
1348 sme_send_authentication(wpa_s, wpa_s->current_bss,
1349 wpa_s->current_ssid, 0);
1350 else
1351 sme_external_auth_send_sae_confirm(wpa_s, sa);
c10347f2
JM
1352 return 0;
1353 } else if (auth_transaction == 2) {
cfe1ea5c
JM
1354 if (status_code != WLAN_STATUS_SUCCESS)
1355 return -1;
c10347f2 1356 wpa_dbg(wpa_s, MSG_DEBUG, "SME SAE confirm");
dd43026a 1357 if (wpa_s->sme.sae.state != SAE_CONFIRMED)
21af6d15 1358 return -1;
f2e9818f 1359 if (sae_check_confirm(&wpa_s->sme.sae, data, len) < 0)
21af6d15 1360 return -1;
dd43026a 1361 wpa_s->sme.sae.state = SAE_ACCEPTED;
b4fd3613 1362 sae_clear_temp_data(&wpa_s->sme.sae);
5ff39c13
SD
1363
1364 if (external) {
1365 /* Report success to driver */
1366 sme_send_external_auth_status(wpa_s,
1367 WLAN_STATUS_SUCCESS);
1368 }
1369
c10347f2
JM
1370 return 1;
1371 }
1372
1373 return -1;
1374}
5ff39c13
SD
1375
1376
b7cd6487 1377static int sme_sae_set_pmk(struct wpa_supplicant *wpa_s, const u8 *bssid)
d2b20838
JM
1378{
1379 wpa_printf(MSG_DEBUG,
1380 "SME: SAE completed - setting PMK for 4-way handshake");
1381 wpa_sm_set_pmk(wpa_s->wpa, wpa_s->sme.sae.pmk, PMK_LEN,
b7cd6487 1382 wpa_s->sme.sae.pmkid, bssid);
d2b20838
JM
1383 if (wpa_s->conf->sae_pmkid_in_assoc) {
1384 /* Update the own RSNE contents now that we have set the PMK
1385 * and added a PMKSA cache entry based on the successfully
1386 * completed SAE exchange. In practice, this will add the PMKID
1387 * into RSNE. */
1388 if (wpa_s->sme.assoc_req_ie_len + 2 + PMKID_LEN >
1389 sizeof(wpa_s->sme.assoc_req_ie)) {
1390 wpa_msg(wpa_s, MSG_WARNING,
1391 "RSN: Not enough room for inserting own PMKID into RSNE");
1392 return -1;
1393 }
1394 if (wpa_insert_pmkid(wpa_s->sme.assoc_req_ie,
1395 &wpa_s->sme.assoc_req_ie_len,
1396 wpa_s->sme.sae.pmkid) < 0)
1397 return -1;
1398 wpa_hexdump(MSG_DEBUG,
1399 "SME: Updated Association Request IEs",
1400 wpa_s->sme.assoc_req_ie,
1401 wpa_s->sme.assoc_req_ie_len);
1402 }
1403
1404 return 0;
1405}
1406
1407
5ff39c13
SD
1408void sme_external_auth_mgmt_rx(struct wpa_supplicant *wpa_s,
1409 const u8 *auth_frame, size_t len)
1410{
1411 const struct ieee80211_mgmt *header;
1412 size_t auth_length;
1413
1414 header = (const struct ieee80211_mgmt *) auth_frame;
1415 auth_length = IEEE80211_HDRLEN + sizeof(header->u.auth);
1416
1417 if (len < auth_length) {
1418 /* Notify failure to the driver */
1419 sme_send_external_auth_status(wpa_s,
1420 WLAN_STATUS_UNSPECIFIED_FAILURE);
1421 return;
1422 }
1423
fcb3f11e 1424 if (le_to_host16(header->u.auth.auth_alg) == WLAN_AUTH_SAE) {
5ff39c13
SD
1425 int res;
1426
fcb3f11e
AP
1427 res = sme_sae_auth(
1428 wpa_s, le_to_host16(header->u.auth.auth_transaction),
1429 le_to_host16(header->u.auth.status_code),
1430 header->u.auth.variable,
1431 len - auth_length, 1, header->sa);
5ff39c13
SD
1432 if (res < 0) {
1433 /* Notify failure to the driver */
1434 sme_send_external_auth_status(
1435 wpa_s, WLAN_STATUS_UNSPECIFIED_FAILURE);
1436 return;
1437 }
1438 if (res != 1)
1439 return;
1440
b7cd6487 1441 if (sme_sae_set_pmk(wpa_s, wpa_s->sme.ext_auth_bssid) < 0)
d2b20838 1442 return;
5ff39c13
SD
1443 }
1444}
1445
c10347f2
JM
1446#endif /* CONFIG_SAE */
1447
1448
c2a04078
JM
1449void sme_event_auth(struct wpa_supplicant *wpa_s, union wpa_event_data *data)
1450{
c2a04078
JM
1451 struct wpa_ssid *ssid = wpa_s->current_ssid;
1452
1453 if (ssid == NULL) {
f049052b
BG
1454 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
1455 "when network is not selected");
c2a04078
JM
1456 return;
1457 }
1458
1459 if (wpa_s->wpa_state != WPA_AUTHENTICATING) {
f049052b
BG
1460 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication event "
1461 "when not in authenticating state");
c2a04078
JM
1462 return;
1463 }
1464
1465 if (os_memcmp(wpa_s->pending_bssid, data->auth.peer, ETH_ALEN) != 0) {
f049052b
BG
1466 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Ignore authentication with "
1467 "unexpected peer " MACSTR,
1468 MAC2STR(data->auth.peer));
c2a04078
JM
1469 return;
1470 }
1471
f049052b 1472 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication response: peer=" MACSTR
c10347f2 1473 " auth_type=%d auth_transaction=%d status_code=%d",
f049052b 1474 MAC2STR(data->auth.peer), data->auth.auth_type,
c10347f2 1475 data->auth.auth_transaction, data->auth.status_code);
c2a04078
JM
1476 wpa_hexdump(MSG_MSGDUMP, "SME: Authentication response IEs",
1477 data->auth.ies, data->auth.ies_len);
1478
e29853bb
BG
1479 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
1480
c10347f2
JM
1481#ifdef CONFIG_SAE
1482 if (data->auth.auth_type == WLAN_AUTH_SAE) {
21af6d15
JM
1483 int res;
1484 res = sme_sae_auth(wpa_s, data->auth.auth_transaction,
1485 data->auth.status_code, data->auth.ies,
5ff39c13 1486 data->auth.ies_len, 0, NULL);
21af6d15
JM
1487 if (res < 0) {
1488 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1489 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
1490
1491 }
1492 if (res != 1)
c10347f2 1493 return;
47b55a3e 1494
b7cd6487 1495 if (sme_sae_set_pmk(wpa_s, wpa_s->pending_bssid) < 0)
d2b20838 1496 return;
c10347f2
JM
1497 }
1498#endif /* CONFIG_SAE */
1499
c2a04078 1500 if (data->auth.status_code != WLAN_STATUS_SUCCESS) {
ec4387f9
JM
1501 char *ie_txt = NULL;
1502
1503 if (data->auth.ies && data->auth.ies_len) {
1504 size_t buflen = 2 * data->auth.ies_len + 1;
1505 ie_txt = os_malloc(buflen);
1506 if (ie_txt) {
1507 wpa_snprintf_hex(ie_txt, buflen, data->auth.ies,
1508 data->auth.ies_len);
1509 }
1510 }
1511 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_AUTH_REJECT MACSTR
5f11880f 1512 " auth_type=%u auth_transaction=%u status_code=%u%s%s",
ec4387f9
JM
1513 MAC2STR(data->auth.peer), data->auth.auth_type,
1514 data->auth.auth_transaction, data->auth.status_code,
5f11880f
JM
1515 ie_txt ? " ie=" : "",
1516 ie_txt ? ie_txt : "");
ec4387f9 1517 os_free(ie_txt);
cb1583f6 1518
af835d75
AB
1519#ifdef CONFIG_FILS
1520 if (wpa_s->sme.auth_alg == WPA_AUTH_ALG_FILS ||
1521 wpa_s->sme.auth_alg == WPA_AUTH_ALG_FILS_SK_PFS)
1522 fils_connection_failure(wpa_s);
1523#endif /* CONFIG_FILS */
1524
cb1583f6
SO
1525 if (data->auth.status_code !=
1526 WLAN_STATUS_NOT_SUPPORTED_AUTH_ALG ||
1527 wpa_s->sme.auth_alg == data->auth.auth_type ||
7e6646c7 1528 wpa_s->current_ssid->auth_alg == WPA_AUTH_ALG_LEAP) {
0fb337c1 1529 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
c1c02342 1530 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
cb1583f6 1531 return;
7e6646c7 1532 }
cb1583f6 1533
d9504779
JM
1534 wpas_connect_work_done(wpa_s);
1535
cb1583f6
SO
1536 switch (data->auth.auth_type) {
1537 case WLAN_AUTH_OPEN:
1538 wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_SHARED;
1539
f049052b 1540 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying SHARED auth");
cb1583f6
SO
1541 wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
1542 wpa_s->current_ssid);
1543 return;
1544
1545 case WLAN_AUTH_SHARED_KEY:
1546 wpa_s->current_ssid->auth_alg = WPA_AUTH_ALG_LEAP;
1547
f049052b 1548 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Trying LEAP auth");
cb1583f6
SO
1549 wpa_supplicant_associate(wpa_s, wpa_s->current_bss,
1550 wpa_s->current_ssid);
1551 return;
1552
1553 default:
1554 return;
1555 }
c2a04078
JM
1556 }
1557
1558#ifdef CONFIG_IEEE80211R
1559 if (data->auth.auth_type == WLAN_AUTH_FT) {
c6c41f6e
JM
1560 const u8 *ric_ies = NULL;
1561 size_t ric_ies_len = 0;
1562
1563 if (wpa_s->ric_ies) {
1564 ric_ies = wpabuf_head(wpa_s->ric_ies);
1565 ric_ies_len = wpabuf_len(wpa_s->ric_ies);
1566 }
ee140ef9
JM
1567 if (wpa_ft_process_response(wpa_s->wpa, data->auth.ies,
1568 data->auth.ies_len, 0,
c6c41f6e
JM
1569 data->auth.peer,
1570 ric_ies, ric_ies_len) < 0) {
ee140ef9
JM
1571 wpa_dbg(wpa_s, MSG_DEBUG,
1572 "SME: FT Authentication response processing failed");
1573 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_DISCONNECTED "bssid="
1574 MACSTR
1575 " reason=%d locally_generated=1",
1576 MAC2STR(wpa_s->pending_bssid),
1577 WLAN_REASON_DEAUTH_LEAVING);
1578 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1579 wpa_supplicant_mark_disassoc(wpa_s);
1580 return;
1581 }
c2a04078
JM
1582 }
1583#endif /* CONFIG_IEEE80211R */
1584
a6609937 1585#ifdef CONFIG_FILS
76e20f4f
JM
1586 if (data->auth.auth_type == WLAN_AUTH_FILS_SK ||
1587 data->auth.auth_type == WLAN_AUTH_FILS_SK_PFS) {
1588 u16 expect_auth_type;
1589
1590 expect_auth_type = wpa_s->sme.auth_alg ==
1591 WPA_AUTH_ALG_FILS_SK_PFS ? WLAN_AUTH_FILS_SK_PFS :
1592 WLAN_AUTH_FILS_SK;
1593 if (data->auth.auth_type != expect_auth_type) {
1594 wpa_dbg(wpa_s, MSG_DEBUG,
1595 "SME: FILS Authentication response used different auth alg (%u; expected %u)",
1596 data->auth.auth_type, expect_auth_type);
1597 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_DISCONNECTED "bssid="
1598 MACSTR
1599 " reason=%d locally_generated=1",
1600 MAC2STR(wpa_s->pending_bssid),
1601 WLAN_REASON_DEAUTH_LEAVING);
1602 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1603 wpa_supplicant_mark_disassoc(wpa_s);
1604 return;
1605 }
1606
ba9774bd
JM
1607 if (fils_process_auth(wpa_s->wpa, wpa_s->pending_bssid,
1608 data->auth.ies, data->auth.ies_len) < 0) {
a6609937
JM
1609 wpa_dbg(wpa_s, MSG_DEBUG,
1610 "SME: FILS Authentication response processing failed");
1611 wpa_msg(wpa_s, MSG_INFO, WPA_EVENT_DISCONNECTED "bssid="
1612 MACSTR
1613 " reason=%d locally_generated=1",
1614 MAC2STR(wpa_s->pending_bssid),
1615 WLAN_REASON_DEAUTH_LEAVING);
1616 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1617 wpa_supplicant_mark_disassoc(wpa_s);
1618 return;
1619 }
1620 }
1621#endif /* CONFIG_FILS */
1622
71024cb2
JM
1623 sme_associate(wpa_s, ssid->mode, data->auth.peer,
1624 data->auth.auth_type);
1625}
1626
1627
7d440a3b
JM
1628#ifdef CONFIG_IEEE80211R
1629static void remove_ie(u8 *buf, size_t *len, u8 eid)
1630{
1631 u8 *pos, *next, *end;
1632
1633 pos = (u8 *) get_ie(buf, *len, eid);
1634 if (pos) {
1635 next = pos + 2 + pos[1];
1636 end = buf + *len;
1637 *len -= 2 + pos[1];
1638 os_memmove(pos, next, end - next);
1639 }
1640}
1641#endif /* CONFIG_IEEE80211R */
1642
1643
71024cb2
JM
1644void sme_associate(struct wpa_supplicant *wpa_s, enum wpas_mode mode,
1645 const u8 *bssid, u16 auth_type)
1646{
1647 struct wpa_driver_associate_params params;
d9a27b04 1648 struct ieee802_11_elems elems;
86cd6928
JM
1649#ifdef CONFIG_FILS
1650 u8 nonces[2 * FILS_NONCE_LEN];
1651#endif /* CONFIG_FILS */
80e8a5ee
BG
1652#ifdef CONFIG_HT_OVERRIDES
1653 struct ieee80211_ht_capabilities htcaps;
1654 struct ieee80211_ht_capabilities htcaps_mask;
1655#endif /* CONFIG_HT_OVERRIDES */
e9ee8dc3
JB
1656#ifdef CONFIG_VHT_OVERRIDES
1657 struct ieee80211_vht_capabilities vhtcaps;
1658 struct ieee80211_vht_capabilities vhtcaps_mask;
1659#endif /* CONFIG_VHT_OVERRIDES */
71024cb2 1660
c2a04078 1661 os_memset(&params, 0, sizeof(params));
86cd6928
JM
1662
1663#ifdef CONFIG_FILS
76e20f4f
JM
1664 if (auth_type == WLAN_AUTH_FILS_SK ||
1665 auth_type == WLAN_AUTH_FILS_SK_PFS) {
86cd6928
JM
1666 struct wpabuf *buf;
1667 const u8 *snonce, *anonce;
5732b770
JM
1668 const unsigned int max_hlp = 20;
1669 struct wpabuf *hlp[max_hlp];
1670 unsigned int i, num_hlp = 0;
1671 struct fils_hlp_req *req;
1672
1673 dl_list_for_each(req, &wpa_s->fils_hlp_req, struct fils_hlp_req,
1674 list) {
1675 hlp[num_hlp] = wpabuf_alloc(2 * ETH_ALEN + 6 +
1676 wpabuf_len(req->pkt));
1677 if (!hlp[num_hlp])
1678 break;
1679 wpabuf_put_data(hlp[num_hlp], req->dst, ETH_ALEN);
1680 wpabuf_put_data(hlp[num_hlp], wpa_s->own_addr,
1681 ETH_ALEN);
1682 wpabuf_put_data(hlp[num_hlp],
1683 "\xaa\xaa\x03\x00\x00\x00", 6);
1684 wpabuf_put_buf(hlp[num_hlp], req->pkt);
1685 num_hlp++;
1686 if (num_hlp >= max_hlp)
1687 break;
1688 }
86cd6928
JM
1689
1690 buf = fils_build_assoc_req(wpa_s->wpa, &params.fils_kek,
1691 &params.fils_kek_len, &snonce,
5732b770
JM
1692 &anonce,
1693 (const struct wpabuf **) hlp,
1694 num_hlp);
1695 for (i = 0; i < num_hlp; i++)
1696 wpabuf_free(hlp[i]);
86cd6928
JM
1697 if (!buf)
1698 return;
7d440a3b
JM
1699 wpa_hexdump(MSG_DEBUG, "FILS: assoc_req before FILS elements",
1700 wpa_s->sme.assoc_req_ie,
1701 wpa_s->sme.assoc_req_ie_len);
1702#ifdef CONFIG_IEEE80211R
1703 if (wpa_key_mgmt_ft(wpa_s->key_mgmt)) {
1704 /* Remove RSNE and MDE to allow them to be overridden
1705 * with FILS+FT specific values from
1706 * fils_build_assoc_req(). */
1707 remove_ie(wpa_s->sme.assoc_req_ie,
1708 &wpa_s->sme.assoc_req_ie_len,
1709 WLAN_EID_RSN);
1710 wpa_hexdump(MSG_DEBUG,
1711 "FILS: assoc_req after RSNE removal",
1712 wpa_s->sme.assoc_req_ie,
1713 wpa_s->sme.assoc_req_ie_len);
1714 remove_ie(wpa_s->sme.assoc_req_ie,
1715 &wpa_s->sme.assoc_req_ie_len,
1716 WLAN_EID_MOBILITY_DOMAIN);
1717 wpa_hexdump(MSG_DEBUG,
1718 "FILS: assoc_req after MDE removal",
1719 wpa_s->sme.assoc_req_ie,
1720 wpa_s->sme.assoc_req_ie_len);
1721 }
1722#endif /* CONFIG_IEEE80211R */
86cd6928
JM
1723 /* TODO: Make wpa_s->sme.assoc_req_ie use dynamic allocation */
1724 if (wpa_s->sme.assoc_req_ie_len + wpabuf_len(buf) >
1725 sizeof(wpa_s->sme.assoc_req_ie)) {
1726 wpa_printf(MSG_ERROR,
1727 "FILS: Not enough buffer room for own AssocReq elements");
1728 wpabuf_free(buf);
1729 return;
1730 }
1731 os_memcpy(wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
1732 wpabuf_head(buf), wpabuf_len(buf));
1733 wpa_s->sme.assoc_req_ie_len += wpabuf_len(buf);
1734 wpabuf_free(buf);
7d440a3b
JM
1735 wpa_hexdump(MSG_DEBUG, "FILS: assoc_req after FILS elements",
1736 wpa_s->sme.assoc_req_ie,
1737 wpa_s->sme.assoc_req_ie_len);
86cd6928
JM
1738
1739 os_memcpy(nonces, snonce, FILS_NONCE_LEN);
1740 os_memcpy(nonces + FILS_NONCE_LEN, anonce, FILS_NONCE_LEN);
1741 params.fils_nonces = nonces;
1742 params.fils_nonces_len = sizeof(nonces);
1743 }
1744#endif /* CONFIG_FILS */
1745
0a614799 1746#ifdef CONFIG_OWE
265bda34
JM
1747#ifdef CONFIG_TESTING_OPTIONS
1748 if (get_ie_ext(wpa_s->sme.assoc_req_ie, wpa_s->sme.assoc_req_ie_len,
1749 WLAN_EID_EXT_OWE_DH_PARAM)) {
1750 wpa_printf(MSG_INFO, "TESTING: Override OWE DH element");
1751 } else
1752#endif /* CONFIG_TESTING_OPTIONS */
0a614799
JM
1753 if (auth_type == WLAN_AUTH_OPEN &&
1754 wpa_s->key_mgmt == WPA_KEY_MGMT_OWE) {
1755 struct wpabuf *owe_ie;
2cb40e9f 1756 u16 group;
0a614799 1757
2cb40e9f 1758 if (wpa_s->current_ssid && wpa_s->current_ssid->owe_group) {
ec9f4837 1759 group = wpa_s->current_ssid->owe_group;
698c9e20
AK
1760 } else if (wpa_s->assoc_status_code ==
1761 WLAN_STATUS_FINITE_CYCLIC_GROUP_NOT_SUPPORTED) {
2cb40e9f
JM
1762 if (wpa_s->last_owe_group == 19)
1763 group = 20;
1764 else if (wpa_s->last_owe_group == 20)
1765 group = 21;
1766 else
1767 group = OWE_DH_GROUP;
698c9e20
AK
1768 } else {
1769 group = OWE_DH_GROUP;
2cb40e9f 1770 }
698c9e20 1771
2cb40e9f
JM
1772 wpa_s->last_owe_group = group;
1773 wpa_printf(MSG_DEBUG, "OWE: Try to use group %u", group);
ec9f4837 1774 owe_ie = owe_build_assoc_req(wpa_s->wpa, group);
0a614799
JM
1775 if (!owe_ie) {
1776 wpa_printf(MSG_ERROR,
1777 "OWE: Failed to build IE for Association Request frame");
1778 return;
1779 }
1780 if (wpa_s->sme.assoc_req_ie_len + wpabuf_len(owe_ie) >
1781 sizeof(wpa_s->sme.assoc_req_ie)) {
1782 wpa_printf(MSG_ERROR,
1783 "OWE: Not enough buffer room for own Association Request frame elements");
1784 wpabuf_free(owe_ie);
1785 return;
1786 }
1787 os_memcpy(wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
1788 wpabuf_head(owe_ie), wpabuf_len(owe_ie));
1789 wpa_s->sme.assoc_req_ie_len += wpabuf_len(owe_ie);
1790 wpabuf_free(owe_ie);
1791 }
1792#endif /* CONFIG_OWE */
1793
10ec6a5f
JM
1794#ifdef CONFIG_DPP2
1795 if (wpa_s->key_mgmt == WPA_KEY_MGMT_DPP && wpa_s->current_ssid &&
1796 wpa_s->current_ssid->dpp_netaccesskey) {
1797 struct wpa_ssid *ssid = wpa_s->current_ssid;
1798
1799 dpp_pfs_free(wpa_s->dpp_pfs);
1800 wpa_s->dpp_pfs = dpp_pfs_init(ssid->dpp_netaccesskey,
1801 ssid->dpp_netaccesskey_len);
1802 if (!wpa_s->dpp_pfs) {
1803 wpa_printf(MSG_DEBUG, "DPP: Could not initialize PFS");
1804 /* Try to continue without PFS */
1805 goto pfs_fail;
1806 }
1807 if (wpa_s->sme.assoc_req_ie_len +
1808 wpabuf_len(wpa_s->dpp_pfs->ie) >
1809 sizeof(wpa_s->sme.assoc_req_ie)) {
1810 wpa_printf(MSG_ERROR,
1811 "DPP: Not enough buffer room for own Association Request frame elements");
1812 dpp_pfs_free(wpa_s->dpp_pfs);
1813 wpa_s->dpp_pfs = NULL;
1814 goto pfs_fail;
1815 }
1816 os_memcpy(wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
1817 wpabuf_head(wpa_s->dpp_pfs->ie),
1818 wpabuf_len(wpa_s->dpp_pfs->ie));
1819 wpa_s->sme.assoc_req_ie_len += wpabuf_len(wpa_s->dpp_pfs->ie);
1820 }
1821pfs_fail:
1822#endif /* CONFIG_DPP2 */
1823
5abc7823
VN
1824 if (wpa_s->current_ssid && wpa_s->current_ssid->multi_ap_backhaul_sta) {
1825 size_t multi_ap_ie_len;
1826
1827 multi_ap_ie_len = add_multi_ap_ie(
1828 wpa_s->sme.assoc_req_ie + wpa_s->sme.assoc_req_ie_len,
1829 sizeof(wpa_s->sme.assoc_req_ie) -
1830 wpa_s->sme.assoc_req_ie_len,
1831 MULTI_AP_BACKHAUL_STA);
1832 if (multi_ap_ie_len == 0) {
1833 wpa_printf(MSG_ERROR,
1834 "Multi-AP: Failed to build Multi-AP IE");
1835 return;
1836 }
1837 wpa_s->sme.assoc_req_ie_len += multi_ap_ie_len;
1838 }
1839
71024cb2 1840 params.bssid = bssid;
c2a04078
JM
1841 params.ssid = wpa_s->sme.ssid;
1842 params.ssid_len = wpa_s->sme.ssid_len;
4ec68377 1843 params.freq.freq = wpa_s->sme.freq;
1f6c0ab8
BS
1844 params.bg_scan_period = wpa_s->current_ssid ?
1845 wpa_s->current_ssid->bg_scan_period : -1;
c2a04078
JM
1846 params.wpa_ie = wpa_s->sme.assoc_req_ie_len ?
1847 wpa_s->sme.assoc_req_ie : NULL;
1848 params.wpa_ie_len = wpa_s->sme.assoc_req_ie_len;
8c41734e
JM
1849 wpa_hexdump(MSG_DEBUG, "SME: Association Request IEs",
1850 params.wpa_ie, params.wpa_ie_len);
4848a38d
JM
1851 params.pairwise_suite = wpa_s->pairwise_cipher;
1852 params.group_suite = wpa_s->group_cipher;
61a56c14 1853 params.mgmt_group_suite = wpa_s->mgmt_group_cipher;
163f801e
JM
1854 params.key_mgmt_suite = wpa_s->key_mgmt;
1855 params.wpa_proto = wpa_s->wpa_proto;
80e8a5ee
BG
1856#ifdef CONFIG_HT_OVERRIDES
1857 os_memset(&htcaps, 0, sizeof(htcaps));
1858 os_memset(&htcaps_mask, 0, sizeof(htcaps_mask));
1859 params.htcaps = (u8 *) &htcaps;
1860 params.htcaps_mask = (u8 *) &htcaps_mask;
1861 wpa_supplicant_apply_ht_overrides(wpa_s, wpa_s->current_ssid, &params);
1862#endif /* CONFIG_HT_OVERRIDES */
e9ee8dc3
JB
1863#ifdef CONFIG_VHT_OVERRIDES
1864 os_memset(&vhtcaps, 0, sizeof(vhtcaps));
1865 os_memset(&vhtcaps_mask, 0, sizeof(vhtcaps_mask));
1866 params.vhtcaps = &vhtcaps;
1867 params.vhtcaps_mask = &vhtcaps_mask;
1868 wpa_supplicant_apply_vht_overrides(wpa_s, wpa_s->current_ssid, &params);
1869#endif /* CONFIG_VHT_OVERRIDES */
c2a04078 1870#ifdef CONFIG_IEEE80211R
8c41734e
JM
1871 if (auth_type == WLAN_AUTH_FT && wpa_s->sme.ft_ies &&
1872 get_ie(wpa_s->sme.ft_ies, wpa_s->sme.ft_ies_len,
1873 WLAN_EID_RIC_DATA)) {
1874 /* There seems to be a pretty inconvenient bug in the Linux
1875 * kernel IE splitting functionality when RIC is used. For now,
1876 * skip correct behavior in IE construction here (i.e., drop the
1877 * additional non-FT-specific IEs) to avoid kernel issues. This
1878 * is fine since RIC is used only for testing purposes in the
1879 * current implementation. */
1880 wpa_printf(MSG_INFO,
1881 "SME: Linux kernel workaround - do not try to include additional IEs with RIC");
c2a04078
JM
1882 params.wpa_ie = wpa_s->sme.ft_ies;
1883 params.wpa_ie_len = wpa_s->sme.ft_ies_len;
8c41734e
JM
1884 } else if (auth_type == WLAN_AUTH_FT && wpa_s->sme.ft_ies) {
1885 const u8 *rm_en, *pos, *end;
1886 size_t rm_en_len = 0;
1887 u8 *rm_en_dup = NULL, *wpos;
1888
1889 /* Remove RSNE, MDE, FTE to allow them to be overridden with
1890 * FT specific values */
1891 remove_ie(wpa_s->sme.assoc_req_ie,
1892 &wpa_s->sme.assoc_req_ie_len,
1893 WLAN_EID_RSN);
1894 remove_ie(wpa_s->sme.assoc_req_ie,
1895 &wpa_s->sme.assoc_req_ie_len,
1896 WLAN_EID_MOBILITY_DOMAIN);
1897 remove_ie(wpa_s->sme.assoc_req_ie,
1898 &wpa_s->sme.assoc_req_ie_len,
1899 WLAN_EID_FAST_BSS_TRANSITION);
1900 rm_en = get_ie(wpa_s->sme.assoc_req_ie,
1901 wpa_s->sme.assoc_req_ie_len,
1902 WLAN_EID_RRM_ENABLED_CAPABILITIES);
1903 if (rm_en) {
1904 /* Need to remove RM Enabled Capabilities element as
1905 * well temporarily, so that it can be placed between
1906 * RSNE and MDE. */
1907 rm_en_len = 2 + rm_en[1];
1908 rm_en_dup = os_memdup(rm_en, rm_en_len);
1909 remove_ie(wpa_s->sme.assoc_req_ie,
1910 &wpa_s->sme.assoc_req_ie_len,
1911 WLAN_EID_RRM_ENABLED_CAPABILITIES);
1912 }
1913 wpa_hexdump(MSG_DEBUG,
1914 "SME: Association Request IEs after FT IE removal",
1915 wpa_s->sme.assoc_req_ie,
1916 wpa_s->sme.assoc_req_ie_len);
1917 if (wpa_s->sme.assoc_req_ie_len + wpa_s->sme.ft_ies_len +
1918 rm_en_len > sizeof(wpa_s->sme.assoc_req_ie)) {
1919 wpa_printf(MSG_ERROR,
1920 "SME: Not enough buffer room for FT IEs in Association Request frame");
1921 os_free(rm_en_dup);
1922 return;
1923 }
1924
1925 os_memmove(wpa_s->sme.assoc_req_ie + wpa_s->sme.ft_ies_len +
1926 rm_en_len,
1927 wpa_s->sme.assoc_req_ie,
1928 wpa_s->sme.assoc_req_ie_len);
1929 pos = wpa_s->sme.ft_ies;
1930 end = pos + wpa_s->sme.ft_ies_len;
1931 wpos = wpa_s->sme.assoc_req_ie;
1932 if (*pos == WLAN_EID_RSN) {
1933 os_memcpy(wpos, pos, 2 + pos[1]);
1934 wpos += 2 + pos[1];
1935 pos += 2 + pos[1];
1936 }
1937 if (rm_en_dup) {
1938 os_memcpy(wpos, rm_en_dup, rm_en_len);
1939 wpos += rm_en_len;
1940 os_free(rm_en_dup);
1941 }
1942 os_memcpy(wpos, pos, end - pos);
1943 wpa_s->sme.assoc_req_ie_len += wpa_s->sme.ft_ies_len +
1944 rm_en_len;
1945 params.wpa_ie = wpa_s->sme.assoc_req_ie;
1946 params.wpa_ie_len = wpa_s->sme.assoc_req_ie_len;
1947 wpa_hexdump(MSG_DEBUG,
1948 "SME: Association Request IEs after FT override",
1949 params.wpa_ie, params.wpa_ie_len);
c2a04078
JM
1950 }
1951#endif /* CONFIG_IEEE80211R */
71024cb2 1952 params.mode = mode;
c2a04078 1953 params.mgmt_frame_protection = wpa_s->sme.mfp;
b361d580 1954 params.rrm_used = wpa_s->rrm.rrm_used;
62fa124c
JM
1955 if (wpa_s->sme.prev_bssid_set)
1956 params.prev_bssid = wpa_s->sme.prev_bssid;
c2a04078
JM
1957
1958 wpa_msg(wpa_s, MSG_INFO, "Trying to associate with " MACSTR
1959 " (SSID='%s' freq=%d MHz)", MAC2STR(params.bssid),
1960 params.ssid ? wpa_ssid_txt(params.ssid, params.ssid_len) : "",
4ec68377 1961 params.freq.freq);
c2a04078
JM
1962
1963 wpa_supplicant_set_state(wpa_s, WPA_ASSOCIATING);
1964
9efc3f2a
JM
1965 if (params.wpa_ie == NULL ||
1966 ieee802_11_parse_elems(params.wpa_ie, params.wpa_ie_len, &elems, 0)
d9a27b04 1967 < 0) {
f049052b 1968 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Could not parse own IEs?!");
d9a27b04
JM
1969 os_memset(&elems, 0, sizeof(elems));
1970 }
64fa840a
JM
1971 if (elems.rsn_ie) {
1972 params.wpa_proto = WPA_PROTO_RSN;
d9a27b04
JM
1973 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.rsn_ie - 2,
1974 elems.rsn_ie_len + 2);
64fa840a
JM
1975 } else if (elems.wpa_ie) {
1976 params.wpa_proto = WPA_PROTO_WPA;
d9a27b04
JM
1977 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.wpa_ie - 2,
1978 elems.wpa_ie_len + 2);
df0f01d9
JM
1979 } else if (elems.osen) {
1980 params.wpa_proto = WPA_PROTO_OSEN;
1981 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, elems.osen - 2,
1982 elems.osen_len + 2);
64fa840a 1983 } else
d9a27b04 1984 wpa_sm_set_assoc_wpa_ie(wpa_s->wpa, NULL, 0);
6d6c8877
JM
1985 if (elems.rsnxe)
1986 wpa_sm_set_assoc_rsnxe(wpa_s->wpa, elems.rsnxe - 2,
1987 elems.rsnxe_len + 2);
1988 else
1989 wpa_sm_set_assoc_rsnxe(wpa_s->wpa, NULL, 0);
ffad8858 1990 if (wpa_s->current_ssid && wpa_s->current_ssid->p2p_group)
6e3f4b89 1991 params.p2p = 1;
d9a27b04 1992
ba307f85
LD
1993 if (wpa_s->p2pdev->set_sta_uapsd)
1994 params.uapsd = wpa_s->p2pdev->sta_uapsd;
eea2fd9e
JM
1995 else
1996 params.uapsd = -1;
1997
c2a04078 1998 if (wpa_drv_associate(wpa_s, &params) < 0) {
f049052b
BG
1999 wpa_msg(wpa_s, MSG_INFO, "SME: Association request to the "
2000 "driver failed");
e5ad96b7 2001 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
c1c02342 2002 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
e5ad96b7 2003 os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
c2a04078
JM
2004 return;
2005 }
2006
e29853bb
BG
2007 eloop_register_timeout(SME_ASSOC_TIMEOUT, 0, sme_assoc_timer, wpa_s,
2008 NULL);
daa40960
JM
2009
2010#ifdef CONFIG_TESTING_OPTIONS
2011 wpabuf_free(wpa_s->last_assoc_req_wpa_ie);
2012 wpa_s->last_assoc_req_wpa_ie = NULL;
2013 if (params.wpa_ie)
2014 wpa_s->last_assoc_req_wpa_ie =
2015 wpabuf_alloc_copy(params.wpa_ie, params.wpa_ie_len);
2016#endif /* CONFIG_TESTING_OPTIONS */
c2a04078
JM
2017}
2018
2019
2020int sme_update_ft_ies(struct wpa_supplicant *wpa_s, const u8 *md,
2021 const u8 *ies, size_t ies_len)
2022{
2023 if (md == NULL || ies == NULL) {
f049052b 2024 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Remove mobility domain");
c2a04078
JM
2025 os_free(wpa_s->sme.ft_ies);
2026 wpa_s->sme.ft_ies = NULL;
2027 wpa_s->sme.ft_ies_len = 0;
2028 wpa_s->sme.ft_used = 0;
2029 return 0;
2030 }
2031
2032 os_memcpy(wpa_s->sme.mobility_domain, md, MOBILITY_DOMAIN_ID_LEN);
2033 wpa_hexdump(MSG_DEBUG, "SME: FT IEs", ies, ies_len);
2034 os_free(wpa_s->sme.ft_ies);
a1f11e34 2035 wpa_s->sme.ft_ies = os_memdup(ies, ies_len);
c2a04078
JM
2036 if (wpa_s->sme.ft_ies == NULL)
2037 return -1;
c2a04078
JM
2038 wpa_s->sme.ft_ies_len = ies_len;
2039 return 0;
2040}
efa46078
JM
2041
2042
e29853bb 2043static void sme_deauth(struct wpa_supplicant *wpa_s)
efa46078 2044{
8bac466b
JM
2045 int bssid_changed;
2046
8bac466b 2047 bssid_changed = !is_zero_ether_addr(wpa_s->bssid);
76d11d3f 2048
76d11d3f
JM
2049 if (wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
2050 WLAN_REASON_DEAUTH_LEAVING) < 0) {
f049052b
BG
2051 wpa_msg(wpa_s, MSG_INFO, "SME: Deauth request to the driver "
2052 "failed");
76d11d3f 2053 }
62fa124c 2054 wpa_s->sme.prev_bssid_set = 0;
76d11d3f 2055
0fb337c1 2056 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
76d11d3f 2057 wpa_supplicant_set_state(wpa_s, WPA_DISCONNECTED);
efa46078
JM
2058 os_memset(wpa_s->bssid, 0, ETH_ALEN);
2059 os_memset(wpa_s->pending_bssid, 0, ETH_ALEN);
8bac466b
JM
2060 if (bssid_changed)
2061 wpas_notify_bssid_changed(wpa_s);
efa46078 2062}
da1fb17c
JM
2063
2064
e29853bb
BG
2065void sme_event_assoc_reject(struct wpa_supplicant *wpa_s,
2066 union wpa_event_data *data)
2067{
2068 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association with " MACSTR " failed: "
2069 "status code %d", MAC2STR(wpa_s->pending_bssid),
2070 data->assoc_reject.status_code);
2071
2072 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
2073
bc26ac50
JM
2074#ifdef CONFIG_SAE
2075 if (wpa_s->sme.sae_pmksa_caching && wpa_s->current_ssid &&
2076 wpa_key_mgmt_sae(wpa_s->current_ssid->key_mgmt)) {
2077 wpa_dbg(wpa_s, MSG_DEBUG,
2078 "PMKSA caching attempt rejected - drop PMKSA cache entry and fall back to SAE authentication");
2079 wpa_sm_aborted_cached(wpa_s->wpa);
2080 wpa_sm_pmksa_cache_flush(wpa_s->wpa, wpa_s->current_ssid);
2081 if (wpa_s->current_bss) {
2082 struct wpa_bss *bss = wpa_s->current_bss;
2083 struct wpa_ssid *ssid = wpa_s->current_ssid;
2084
2085 wpa_drv_deauthenticate(wpa_s, wpa_s->pending_bssid,
2086 WLAN_REASON_DEAUTH_LEAVING);
2087 wpas_connect_work_done(wpa_s);
2088 wpa_supplicant_mark_disassoc(wpa_s);
2089 wpa_supplicant_connect(wpa_s, bss, ssid);
2090 return;
2091 }
2092 }
2093#endif /* CONFIG_SAE */
2094
e29853bb
BG
2095 /*
2096 * For now, unconditionally terminate the previous authentication. In
2097 * theory, this should not be needed, but mac80211 gets quite confused
2098 * if the authentication is left pending.. Some roaming cases might
2099 * benefit from using the previous authentication, so this could be
2100 * optimized in the future.
2101 */
2102 sme_deauth(wpa_s);
2103}
2104
2105
da1fb17c
JM
2106void sme_event_auth_timed_out(struct wpa_supplicant *wpa_s,
2107 union wpa_event_data *data)
2108{
f049052b 2109 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Authentication timed out");
0fb337c1 2110 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
1193dc8f 2111 wpa_supplicant_mark_disassoc(wpa_s);
da1fb17c
JM
2112}
2113
2114
2115void sme_event_assoc_timed_out(struct wpa_supplicant *wpa_s,
2116 union wpa_event_data *data)
2117{
f049052b 2118 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association timed out");
0fb337c1 2119 wpas_connection_failed(wpa_s, wpa_s->pending_bssid);
da1fb17c 2120 wpa_supplicant_mark_disassoc(wpa_s);
da1fb17c 2121}
a84ed99e
JM
2122
2123
2124void sme_event_disassoc(struct wpa_supplicant *wpa_s,
d7df0fa7 2125 struct disassoc_info *info)
a84ed99e 2126{
f049052b 2127 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Disassociation event received");
17fbb751 2128 if (wpa_s->sme.prev_bssid_set) {
a84ed99e
JM
2129 /*
2130 * cfg80211/mac80211 can get into somewhat confused state if
2131 * the AP only disassociates us and leaves us in authenticated
2132 * state. For now, force the state to be cleared to avoid
2133 * confusing errors if we try to associate with the AP again.
2134 */
f049052b
BG
2135 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Deauthenticate to clear "
2136 "driver state");
7e26053a 2137 wpa_drv_deauthenticate(wpa_s, wpa_s->sme.prev_bssid,
a84ed99e
JM
2138 WLAN_REASON_DEAUTH_LEAVING);
2139 }
2140}
7d878ca7
JM
2141
2142
e29853bb
BG
2143static void sme_auth_timer(void *eloop_ctx, void *timeout_ctx)
2144{
2145 struct wpa_supplicant *wpa_s = eloop_ctx;
2146 if (wpa_s->wpa_state == WPA_AUTHENTICATING) {
2147 wpa_msg(wpa_s, MSG_DEBUG, "SME: Authentication timeout");
2148 sme_deauth(wpa_s);
2149 }
2150}
2151
2152
2153static void sme_assoc_timer(void *eloop_ctx, void *timeout_ctx)
2154{
2155 struct wpa_supplicant *wpa_s = eloop_ctx;
2156 if (wpa_s->wpa_state == WPA_ASSOCIATING) {
2157 wpa_msg(wpa_s, MSG_DEBUG, "SME: Association timeout");
2158 sme_deauth(wpa_s);
2159 }
2160}
2161
2162
2163void sme_state_changed(struct wpa_supplicant *wpa_s)
2164{
2165 /* Make sure timers are cleaned up appropriately. */
2166 if (wpa_s->wpa_state != WPA_ASSOCIATING)
2167 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
2168 if (wpa_s->wpa_state != WPA_AUTHENTICATING)
2169 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
2170}
2171
2172
2173void sme_disassoc_while_authenticating(struct wpa_supplicant *wpa_s,
2174 const u8 *prev_pending_bssid)
2175{
2176 /*
2177 * mac80211-workaround to force deauth on failed auth cmd,
2178 * requires us to remain in authenticating state to allow the
2179 * second authentication attempt to be continued properly.
2180 */
2181 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Allow pending authentication "
2182 "to proceed after disconnection event");
2183 wpa_supplicant_set_state(wpa_s, WPA_AUTHENTICATING);
2184 os_memcpy(wpa_s->pending_bssid, prev_pending_bssid, ETH_ALEN);
2185
2186 /*
2187 * Re-arm authentication timer in case auth fails for whatever reason.
2188 */
2189 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
2190 eloop_register_timeout(SME_AUTH_TIMEOUT, 0, sme_auth_timer, wpa_s,
2191 NULL);
2192}
2193
2194
4e70bbf1
JM
2195void sme_clear_on_disassoc(struct wpa_supplicant *wpa_s)
2196{
2197 wpa_s->sme.prev_bssid_set = 0;
2198#ifdef CONFIG_SAE
2199 wpabuf_free(wpa_s->sme.sae_token);
2200 wpa_s->sme.sae_token = NULL;
2201 sae_clear_data(&wpa_s->sme.sae);
2202#endif /* CONFIG_SAE */
2203#ifdef CONFIG_IEEE80211R
60a5737e 2204 if (wpa_s->sme.ft_ies || wpa_s->sme.ft_used)
4e70bbf1
JM
2205 sme_update_ft_ies(wpa_s, NULL, NULL, 0);
2206#endif /* CONFIG_IEEE80211R */
01ac337b 2207 sme_stop_sa_query(wpa_s);
4e70bbf1
JM
2208}
2209
2210
e29853bb
BG
2211void sme_deinit(struct wpa_supplicant *wpa_s)
2212{
4e70bbf1 2213 sme_clear_on_disassoc(wpa_s);
447cd5f2
JM
2214#ifdef CONFIG_SAE
2215 os_free(wpa_s->sme.sae_rejected_groups);
2216 wpa_s->sme.sae_rejected_groups = NULL;
2217#endif /* CONFIG_SAE */
e29853bb
BG
2218
2219 eloop_cancel_timeout(sme_assoc_timer, wpa_s, NULL);
2220 eloop_cancel_timeout(sme_auth_timer, wpa_s, NULL);
c3701c66
RM
2221 eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
2222}
2223
2224
2225static void sme_send_2040_bss_coex(struct wpa_supplicant *wpa_s,
2226 const u8 *chan_list, u8 num_channels,
2227 u8 num_intol)
2228{
2229 struct ieee80211_2040_bss_coex_ie *bc_ie;
2230 struct ieee80211_2040_intol_chan_report *ic_report;
2231 struct wpabuf *buf;
2232
31ded52e
JM
2233 wpa_printf(MSG_DEBUG, "SME: Send 20/40 BSS Coexistence to " MACSTR
2234 " (num_channels=%u num_intol=%u)",
2235 MAC2STR(wpa_s->bssid), num_channels, num_intol);
2236 wpa_hexdump(MSG_DEBUG, "SME: 20/40 BSS Intolerant Channels",
2237 chan_list, num_channels);
c3701c66
RM
2238
2239 buf = wpabuf_alloc(2 + /* action.category + action_code */
2240 sizeof(struct ieee80211_2040_bss_coex_ie) +
2241 sizeof(struct ieee80211_2040_intol_chan_report) +
2242 num_channels);
2243 if (buf == NULL)
2244 return;
2245
2246 wpabuf_put_u8(buf, WLAN_ACTION_PUBLIC);
2247 wpabuf_put_u8(buf, WLAN_PA_20_40_BSS_COEX);
2248
2249 bc_ie = wpabuf_put(buf, sizeof(*bc_ie));
2250 bc_ie->element_id = WLAN_EID_20_40_BSS_COEXISTENCE;
2251 bc_ie->length = 1;
2252 if (num_intol)
2253 bc_ie->coex_param |= WLAN_20_40_BSS_COEX_20MHZ_WIDTH_REQ;
2254
2255 if (num_channels > 0) {
2256 ic_report = wpabuf_put(buf, sizeof(*ic_report));
2257 ic_report->element_id = WLAN_EID_20_40_BSS_INTOLERANT;
2258 ic_report->length = num_channels + 1;
2259 ic_report->op_class = 0;
2260 os_memcpy(wpabuf_put(buf, num_channels), chan_list,
2261 num_channels);
2262 }
2263
2264 if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
2265 wpa_s->own_addr, wpa_s->bssid,
2266 wpabuf_head(buf), wpabuf_len(buf), 0) < 0) {
2267 wpa_msg(wpa_s, MSG_INFO,
2268 "SME: Failed to send 20/40 BSS Coexistence frame");
2269 }
2270
2271 wpabuf_free(buf);
2272}
2273
2274
3204795d
SM
2275int sme_proc_obss_scan(struct wpa_supplicant *wpa_s,
2276 struct wpa_scan_results *scan_res)
c3701c66 2277{
c3701c66 2278 const u8 *ie;
c3701c66
RM
2279 u8 chan_list[P2P_MAX_CHANNELS], channel;
2280 u8 num_channels = 0, num_intol = 0, i;
3204795d
SM
2281 size_t j;
2282 int pri_freq, sec_freq;
c3701c66
RM
2283
2284 if (!wpa_s->sme.sched_obss_scan)
2285 return 0;
2286
2287 wpa_s->sme.sched_obss_scan = 0;
2288 if (!wpa_s->current_bss || wpa_s->wpa_state != WPA_COMPLETED)
2289 return 1;
2290
2291 /*
2292 * Check whether AP uses regulatory triplet or channel triplet in
2293 * country info. Right now the operating class of the BSS channel
2294 * width trigger event is "unknown" (IEEE Std 802.11-2012 10.15.12),
2295 * based on the assumption that operating class triplet is not used in
2296 * beacon frame. If the First Channel Number/Operating Extension
2297 * Identifier octet has a positive integer value of 201 or greater,
2298 * then its operating class triplet.
2299 *
2300 * TODO: If Supported Operating Classes element is present in beacon
2301 * frame, have to lookup operating class in Annex E and fill them in
2302 * 2040 coex frame.
2303 */
2304 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_COUNTRY);
2305 if (ie && (ie[1] >= 6) && (ie[5] >= 201))
2306 return 1;
2307
2308 os_memset(chan_list, 0, sizeof(chan_list));
2309
3204795d
SM
2310 pri_freq = wpa_s->assoc_freq;
2311
2312 switch (wpa_s->sme.ht_sec_chan) {
2313 case HT_SEC_CHAN_ABOVE:
2314 sec_freq = pri_freq + 20;
2315 break;
2316 case HT_SEC_CHAN_BELOW:
2317 sec_freq = pri_freq - 20;
2318 break;
2319 case HT_SEC_CHAN_UNKNOWN:
2320 default:
2321 wpa_msg(wpa_s, MSG_WARNING,
2322 "Undefined secondary channel: drop OBSS scan results");
2323 return 1;
2324 }
2325
2326 for (j = 0; j < scan_res->num; j++) {
2327 struct wpa_scan_res *bss = scan_res->res[j];
e864c0ae 2328 enum hostapd_hw_mode mode;
3204795d
SM
2329 int res;
2330
2331 /* Skip other band bss */
e864c0ae
JM
2332 mode = ieee80211_freq_to_chan(bss->freq, &channel);
2333 if (mode != HOSTAPD_MODE_IEEE80211G &&
2334 mode != HOSTAPD_MODE_IEEE80211B)
c3701c66
RM
2335 continue;
2336
3204795d
SM
2337 res = check_bss_coex_40mhz(bss, pri_freq, sec_freq);
2338 if (res) {
2339 if (res == 2)
7f8eb34d
JM
2340 num_intol++;
2341
c3701c66
RM
2342 /* Check whether the channel is already considered */
2343 for (i = 0; i < num_channels; i++) {
2344 if (channel == chan_list[i])
2345 break;
2346 }
2347 if (i != num_channels)
2348 continue;
2349
c3701c66
RM
2350 chan_list[num_channels++] = channel;
2351 }
2352 }
2353
2354 sme_send_2040_bss_coex(wpa_s, chan_list, num_channels, num_intol);
2355 return 1;
2356}
2357
2358
d97a3c48
JM
2359static void wpa_obss_scan_freqs_list(struct wpa_supplicant *wpa_s,
2360 struct wpa_driver_scan_params *params)
6434ad09 2361{
d97a3c48 2362 /* Include only affected channels */
6434ad09
JM
2363 struct hostapd_hw_modes *mode;
2364 int count, i;
d97a3c48 2365 int start, end;
6434ad09 2366
d97a3c48 2367 mode = get_mode(wpa_s->hw.modes, wpa_s->hw.num_modes,
d0e116f6 2368 HOSTAPD_MODE_IEEE80211G, 0);
6434ad09
JM
2369 if (mode == NULL) {
2370 /* No channels supported in this band - use empty list */
2371 params->freqs = os_zalloc(sizeof(int));
2372 return;
2373 }
2374
d97a3c48
JM
2375 if (wpa_s->sme.ht_sec_chan == HT_SEC_CHAN_UNKNOWN &&
2376 wpa_s->current_bss) {
2377 const u8 *ie;
2378
2379 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_OPERATION);
2380 if (ie && ie[1] >= 2) {
2381 u8 o;
2382
2383 o = ie[3] & HT_INFO_HT_PARAM_SECONDARY_CHNL_OFF_MASK;
2384 if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_ABOVE)
2385 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_ABOVE;
2386 else if (o == HT_INFO_HT_PARAM_SECONDARY_CHNL_BELOW)
2387 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_BELOW;
2388 }
2389 }
2390
2391 start = wpa_s->assoc_freq - 10;
2392 end = wpa_s->assoc_freq + 10;
2393 switch (wpa_s->sme.ht_sec_chan) {
2394 case HT_SEC_CHAN_UNKNOWN:
2395 /* HT40+ possible on channels 1..9 */
2396 if (wpa_s->assoc_freq <= 2452)
2397 start -= 20;
2398 /* HT40- possible on channels 5-13 */
2399 if (wpa_s->assoc_freq >= 2432)
2400 end += 20;
2401 break;
2402 case HT_SEC_CHAN_ABOVE:
2403 end += 20;
2404 break;
2405 case HT_SEC_CHAN_BELOW:
2406 start -= 20;
2407 break;
2408 }
2409 wpa_printf(MSG_DEBUG,
2410 "OBSS: assoc_freq %d possible affected range %d-%d",
2411 wpa_s->assoc_freq, start, end);
2412
f9884c09 2413 params->freqs = os_calloc(mode->num_channels + 1, sizeof(int));
6434ad09
JM
2414 if (params->freqs == NULL)
2415 return;
2416 for (count = 0, i = 0; i < mode->num_channels; i++) {
d97a3c48
JM
2417 int freq;
2418
6434ad09
JM
2419 if (mode->channels[i].flag & HOSTAPD_CHAN_DISABLED)
2420 continue;
d97a3c48
JM
2421 freq = mode->channels[i].freq;
2422 if (freq - 10 >= end || freq + 10 <= start)
2423 continue; /* not affected */
2424 params->freqs[count++] = freq;
6434ad09
JM
2425 }
2426}
2427
2428
c3701c66
RM
2429static void sme_obss_scan_timeout(void *eloop_ctx, void *timeout_ctx)
2430{
2431 struct wpa_supplicant *wpa_s = eloop_ctx;
2432 struct wpa_driver_scan_params params;
2433
2434 if (!wpa_s->current_bss) {
2435 wpa_printf(MSG_DEBUG, "SME OBSS: Ignore scan request");
2436 return;
2437 }
2438
2439 os_memset(&params, 0, sizeof(params));
d97a3c48 2440 wpa_obss_scan_freqs_list(wpa_s, &params);
57a8f8af 2441 params.low_priority = 1;
c3701c66
RM
2442 wpa_printf(MSG_DEBUG, "SME OBSS: Request an OBSS scan");
2443
2444 if (wpa_supplicant_trigger_scan(wpa_s, &params))
2445 wpa_printf(MSG_DEBUG, "SME OBSS: Failed to trigger scan");
2446 else
2447 wpa_s->sme.sched_obss_scan = 1;
6434ad09 2448 os_free(params.freqs);
c3701c66
RM
2449
2450 eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
2451 sme_obss_scan_timeout, wpa_s, NULL);
2452}
2453
2454
2455void sme_sched_obss_scan(struct wpa_supplicant *wpa_s, int enable)
2456{
2457 const u8 *ie;
2458 struct wpa_bss *bss = wpa_s->current_bss;
2459 struct wpa_ssid *ssid = wpa_s->current_ssid;
b6871ebb
AN
2460 struct hostapd_hw_modes *hw_mode = NULL;
2461 int i;
c3701c66
RM
2462
2463 eloop_cancel_timeout(sme_obss_scan_timeout, wpa_s, NULL);
2464 wpa_s->sme.sched_obss_scan = 0;
d97a3c48 2465 wpa_s->sme.ht_sec_chan = HT_SEC_CHAN_UNKNOWN;
c3701c66
RM
2466 if (!enable)
2467 return;
2468
368b1957
AK
2469 /*
2470 * Schedule OBSS scan if driver is using station SME in wpa_supplicant
2471 * or it expects OBSS scan to be performed by wpa_supplicant.
2472 */
2473 if (!((wpa_s->drv_flags & WPA_DRIVER_FLAGS_SME) ||
2474 (wpa_s->drv_flags & WPA_DRIVER_FLAGS_OBSS_SCAN)) ||
f74618cb 2475 ssid == NULL || ssid->mode != WPAS_MODE_INFRA)
368b1957 2476 return;
c3701c66 2477
b6871ebb
AN
2478 if (!wpa_s->hw.modes)
2479 return;
2480
2481 /* only HT caps in 11g mode are relevant */
2482 for (i = 0; i < wpa_s->hw.num_modes; i++) {
2483 hw_mode = &wpa_s->hw.modes[i];
2484 if (hw_mode->mode == HOSTAPD_MODE_IEEE80211G)
2485 break;
2486 }
2487
2488 /* Driver does not support HT40 for 11g or doesn't have 11g. */
2489 if (i == wpa_s->hw.num_modes || !hw_mode ||
2490 !(hw_mode->ht_capab & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
2491 return;
c3701c66
RM
2492
2493 if (bss == NULL || bss->freq < 2400 || bss->freq > 2500)
2494 return; /* Not associated on 2.4 GHz band */
2495
2496 /* Check whether AP supports HT40 */
2497 ie = wpa_bss_get_ie(wpa_s->current_bss, WLAN_EID_HT_CAP);
2498 if (!ie || ie[1] < 2 ||
2499 !(WPA_GET_LE16(ie + 2) & HT_CAP_INFO_SUPP_CHANNEL_WIDTH_SET))
2500 return; /* AP does not support HT40 */
2501
2502 ie = wpa_bss_get_ie(wpa_s->current_bss,
2503 WLAN_EID_OVERLAPPING_BSS_SCAN_PARAMS);
2504 if (!ie || ie[1] < 14)
2505 return; /* AP does not request OBSS scans */
2506
2507 wpa_s->sme.obss_scan_int = WPA_GET_LE16(ie + 6);
2508 if (wpa_s->sme.obss_scan_int < 10) {
2509 wpa_printf(MSG_DEBUG, "SME: Invalid OBSS Scan Interval %u "
2510 "replaced with the minimum 10 sec",
2511 wpa_s->sme.obss_scan_int);
2512 wpa_s->sme.obss_scan_int = 10;
2513 }
2514 wpa_printf(MSG_DEBUG, "SME: OBSS Scan Interval %u sec",
2515 wpa_s->sme.obss_scan_int);
2516 eloop_register_timeout(wpa_s->sme.obss_scan_int, 0,
2517 sme_obss_scan_timeout, wpa_s, NULL);
e29853bb
BG
2518}
2519
2520
7d878ca7
JM
2521static const unsigned int sa_query_max_timeout = 1000;
2522static const unsigned int sa_query_retry_timeout = 201;
f91e68e9 2523static const unsigned int sa_query_ch_switch_max_delay = 5000; /* in usec */
7d878ca7
JM
2524
2525static int sme_check_sa_query_timeout(struct wpa_supplicant *wpa_s)
2526{
2527 u32 tu;
46b8d4c0
JB
2528 struct os_reltime now, passed;
2529 os_get_reltime(&now);
2530 os_reltime_sub(&now, &wpa_s->sme.sa_query_start, &passed);
7d878ca7
JM
2531 tu = (passed.sec * 1000000 + passed.usec) / 1024;
2532 if (sa_query_max_timeout < tu) {
f049052b 2533 wpa_dbg(wpa_s, MSG_DEBUG, "SME: SA Query timed out");
7d878ca7
JM
2534 sme_stop_sa_query(wpa_s);
2535 wpa_supplicant_deauthenticate(
2536 wpa_s, WLAN_REASON_PREV_AUTH_NOT_VALID);
2537 return 1;
2538 }
2539
2540 return 0;
2541}
2542
2543
2544static void sme_send_sa_query_req(struct wpa_supplicant *wpa_s,
2545 const u8 *trans_id)
2546{
f9da7505
MV
2547 u8 req[2 + WLAN_SA_QUERY_TR_ID_LEN + OCV_OCI_EXTENDED_LEN];
2548 u8 req_len = 2 + WLAN_SA_QUERY_TR_ID_LEN;
2549
f049052b
BG
2550 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Sending SA Query Request to "
2551 MACSTR, MAC2STR(wpa_s->bssid));
7d878ca7
JM
2552 wpa_hexdump(MSG_DEBUG, "SME: SA Query Transaction ID",
2553 trans_id, WLAN_SA_QUERY_TR_ID_LEN);
2554 req[0] = WLAN_ACTION_SA_QUERY;
2555 req[1] = WLAN_SA_QUERY_REQUEST;
2556 os_memcpy(req + 2, trans_id, WLAN_SA_QUERY_TR_ID_LEN);
f9da7505
MV
2557
2558#ifdef CONFIG_OCV
2559 if (wpa_sm_ocv_enabled(wpa_s->wpa)) {
2560 struct wpa_channel_info ci;
2561
2562 if (wpa_drv_channel_info(wpa_s, &ci) != 0) {
2563 wpa_printf(MSG_WARNING,
2564 "Failed to get channel info for OCI element in SA Query Request frame");
2565 return;
2566 }
2567
2568 if (ocv_insert_extended_oci(&ci, req + req_len) < 0)
2569 return;
2570
2571 req_len += OCV_OCI_EXTENDED_LEN;
2572 }
2573#endif /* CONFIG_OCV */
2574
190b9062 2575 if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
7d878ca7 2576 wpa_s->own_addr, wpa_s->bssid,
f9da7505 2577 req, req_len, 0) < 0)
f049052b
BG
2578 wpa_msg(wpa_s, MSG_INFO, "SME: Failed to send SA Query "
2579 "Request");
7d878ca7
JM
2580}
2581
2582
2583static void sme_sa_query_timer(void *eloop_ctx, void *timeout_ctx)
2584{
2585 struct wpa_supplicant *wpa_s = eloop_ctx;
2586 unsigned int timeout, sec, usec;
2587 u8 *trans_id, *nbuf;
2588
2589 if (wpa_s->sme.sa_query_count > 0 &&
2590 sme_check_sa_query_timeout(wpa_s))
2591 return;
2592
067ffa26
JM
2593 nbuf = os_realloc_array(wpa_s->sme.sa_query_trans_id,
2594 wpa_s->sme.sa_query_count + 1,
2595 WLAN_SA_QUERY_TR_ID_LEN);
f8608fab
JM
2596 if (nbuf == NULL) {
2597 sme_stop_sa_query(wpa_s);
7d878ca7 2598 return;
f8608fab 2599 }
7d878ca7
JM
2600 if (wpa_s->sme.sa_query_count == 0) {
2601 /* Starting a new SA Query procedure */
46b8d4c0 2602 os_get_reltime(&wpa_s->sme.sa_query_start);
7d878ca7
JM
2603 }
2604 trans_id = nbuf + wpa_s->sme.sa_query_count * WLAN_SA_QUERY_TR_ID_LEN;
2605 wpa_s->sme.sa_query_trans_id = nbuf;
2606 wpa_s->sme.sa_query_count++;
2607
cb5ef952
JM
2608 if (os_get_random(trans_id, WLAN_SA_QUERY_TR_ID_LEN) < 0) {
2609 wpa_printf(MSG_DEBUG, "Could not generate SA Query ID");
f8608fab 2610 sme_stop_sa_query(wpa_s);
cb5ef952
JM
2611 return;
2612 }
7d878ca7
JM
2613
2614 timeout = sa_query_retry_timeout;
2615 sec = ((timeout / 1000) * 1024) / 1000;
2616 usec = (timeout % 1000) * 1024;
2617 eloop_register_timeout(sec, usec, sme_sa_query_timer, wpa_s, NULL);
2618
f049052b
BG
2619 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Association SA Query attempt %d",
2620 wpa_s->sme.sa_query_count);
7d878ca7
JM
2621
2622 sme_send_sa_query_req(wpa_s, trans_id);
2623}
2624
2625
2626static void sme_start_sa_query(struct wpa_supplicant *wpa_s)
2627{
2628 sme_sa_query_timer(wpa_s, NULL);
2629}
2630
2631
19df9b07 2632static void sme_stop_sa_query(struct wpa_supplicant *wpa_s)
7d878ca7 2633{
7a206c50
JM
2634 if (wpa_s->sme.sa_query_trans_id)
2635 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Stop SA Query");
7d878ca7
JM
2636 eloop_cancel_timeout(sme_sa_query_timer, wpa_s, NULL);
2637 os_free(wpa_s->sme.sa_query_trans_id);
2638 wpa_s->sme.sa_query_trans_id = NULL;
2639 wpa_s->sme.sa_query_count = 0;
2640}
2641
2642
2643void sme_event_unprot_disconnect(struct wpa_supplicant *wpa_s, const u8 *sa,
2644 const u8 *da, u16 reason_code)
2645{
2646 struct wpa_ssid *ssid;
3302b7c2 2647 struct os_reltime now;
7d878ca7 2648
7d878ca7
JM
2649 if (wpa_s->wpa_state != WPA_COMPLETED)
2650 return;
2651 ssid = wpa_s->current_ssid;
3f56a2b7 2652 if (wpas_get_ssid_pmf(wpa_s, ssid) == NO_MGMT_FRAME_PROTECTION)
7d878ca7
JM
2653 return;
2654 if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
2655 return;
2656 if (reason_code != WLAN_REASON_CLASS2_FRAME_FROM_NONAUTH_STA &&
2657 reason_code != WLAN_REASON_CLASS3_FRAME_FROM_NONASSOC_STA)
2658 return;
2659 if (wpa_s->sme.sa_query_count > 0)
2660 return;
2661
3302b7c2
JM
2662 os_get_reltime(&now);
2663 if (wpa_s->sme.last_unprot_disconnect.sec &&
2664 !os_reltime_expired(&now, &wpa_s->sme.last_unprot_disconnect, 10))
2665 return; /* limit SA Query procedure frequency */
2666 wpa_s->sme.last_unprot_disconnect = now;
2667
f049052b
BG
2668 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Unprotected disconnect dropped - "
2669 "possible AP/STA state mismatch - trigger SA Query");
7d878ca7
JM
2670 sme_start_sa_query(wpa_s);
2671}
2672
2673
f91e68e9
MV
2674void sme_event_ch_switch(struct wpa_supplicant *wpa_s)
2675{
2676 unsigned int usec;
2677 u32 _rand;
2678
2679 if (wpa_s->wpa_state != WPA_COMPLETED ||
2680 !wpa_sm_ocv_enabled(wpa_s->wpa))
2681 return;
2682
2683 wpa_dbg(wpa_s, MSG_DEBUG,
2684 "SME: Channel switch completed - trigger new SA Query to verify new operating channel");
2685 sme_stop_sa_query(wpa_s);
2686
2687 if (os_get_random((u8 *) &_rand, sizeof(_rand)) < 0)
2688 _rand = os_random();
2689 usec = _rand % (sa_query_ch_switch_max_delay + 1);
2690 eloop_register_timeout(0, usec, sme_sa_query_timer, wpa_s, NULL);
2691}
2692
2693
f9da7505
MV
2694static void sme_process_sa_query_request(struct wpa_supplicant *wpa_s,
2695 const u8 *sa, const u8 *data,
2696 size_t len)
2697{
2698 u8 resp[2 + WLAN_SA_QUERY_TR_ID_LEN + OCV_OCI_EXTENDED_LEN];
2699 u8 resp_len = 2 + WLAN_SA_QUERY_TR_ID_LEN;
2700
2701 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Sending SA Query Response to "
2702 MACSTR, MAC2STR(wpa_s->bssid));
2703
2704 resp[0] = WLAN_ACTION_SA_QUERY;
2705 resp[1] = WLAN_SA_QUERY_RESPONSE;
2706 os_memcpy(resp + 2, data + 1, WLAN_SA_QUERY_TR_ID_LEN);
2707
2708#ifdef CONFIG_OCV
2709 if (wpa_sm_ocv_enabled(wpa_s->wpa)) {
2710 struct wpa_channel_info ci;
2711
2712 if (wpa_drv_channel_info(wpa_s, &ci) != 0) {
2713 wpa_printf(MSG_WARNING,
2714 "Failed to get channel info for OCI element in SA Query Response frame");
2715 return;
2716 }
2717
2718 if (ocv_insert_extended_oci(&ci, resp + resp_len) < 0)
2719 return;
2720
2721 resp_len += OCV_OCI_EXTENDED_LEN;
2722 }
2723#endif /* CONFIG_OCV */
2724
2725 if (wpa_drv_send_action(wpa_s, wpa_s->assoc_freq, 0, wpa_s->bssid,
2726 wpa_s->own_addr, wpa_s->bssid,
2727 resp, resp_len, 0) < 0)
2728 wpa_msg(wpa_s, MSG_INFO,
2729 "SME: Failed to send SA Query Response");
2730}
2731
2732
2733static void sme_process_sa_query_response(struct wpa_supplicant *wpa_s,
2734 const u8 *sa, const u8 *data,
2735 size_t len)
7d878ca7
JM
2736{
2737 int i;
2738
f9da7505 2739 if (!wpa_s->sme.sa_query_trans_id)
7d878ca7 2740 return;
f9da7505 2741
f049052b
BG
2742 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Received SA Query response from "
2743 MACSTR " (trans_id %02x%02x)", MAC2STR(sa), data[1], data[2]);
7d878ca7
JM
2744
2745 if (os_memcmp(sa, wpa_s->bssid, ETH_ALEN) != 0)
2746 return;
2747
2748 for (i = 0; i < wpa_s->sme.sa_query_count; i++) {
2749 if (os_memcmp(wpa_s->sme.sa_query_trans_id +
2750 i * WLAN_SA_QUERY_TR_ID_LEN,
2751 data + 1, WLAN_SA_QUERY_TR_ID_LEN) == 0)
2752 break;
2753 }
2754
2755 if (i >= wpa_s->sme.sa_query_count) {
f049052b
BG
2756 wpa_dbg(wpa_s, MSG_DEBUG, "SME: No matching SA Query "
2757 "transaction identifier found");
7d878ca7
JM
2758 return;
2759 }
2760
f049052b
BG
2761 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Reply to pending SA Query received "
2762 "from " MACSTR, MAC2STR(sa));
7d878ca7
JM
2763 sme_stop_sa_query(wpa_s);
2764}
2765
f9da7505
MV
2766
2767void sme_sa_query_rx(struct wpa_supplicant *wpa_s, const u8 *sa,
2768 const u8 *data, size_t len)
2769{
2770 if (len < 1 + WLAN_SA_QUERY_TR_ID_LEN)
2771 return;
2772
2773 wpa_dbg(wpa_s, MSG_DEBUG, "SME: Received SA Query frame from "
2774 MACSTR " (trans_id %02x%02x)", MAC2STR(sa), data[1], data[2]);
2775
2776#ifdef CONFIG_OCV
2777 if (wpa_sm_ocv_enabled(wpa_s->wpa)) {
2778 struct ieee802_11_elems elems;
2779 struct wpa_channel_info ci;
2780
2781 if (ieee802_11_parse_elems(data + 1 + WLAN_SA_QUERY_TR_ID_LEN,
2782 len - 1 - WLAN_SA_QUERY_TR_ID_LEN,
2783 &elems, 1) == ParseFailed) {
2784 wpa_printf(MSG_DEBUG,
2785 "SA Query: Failed to parse elements");
2786 return;
2787 }
2788
2789 if (wpa_drv_channel_info(wpa_s, &ci) != 0) {
2790 wpa_printf(MSG_WARNING,
2791 "Failed to get channel info to validate received OCI in SA Query Action frame");
2792 return;
2793 }
2794
2795 if (ocv_verify_tx_params(elems.oci, elems.oci_len, &ci,
2796 channel_width_to_int(ci.chanwidth),
2797 ci.seg1_idx) != 0) {
2798 wpa_printf(MSG_WARNING, "%s", ocv_errorstr);
2799 return;
2800 }
2801 }
2802#endif /* CONFIG_OCV */
2803
2804 if (data[0] == WLAN_SA_QUERY_REQUEST)
2805 sme_process_sa_query_request(wpa_s, sa, data, len);
2806 else if (data[0] == WLAN_SA_QUERY_RESPONSE)
2807 sme_process_sa_query_response(wpa_s, sa, data, len);
2808}