1 /*
2 * wpa_supplicant / WPS integration
3 * Copyright (c) 2008-2014, Jouni Malinen <j@w1.fi>
4 *
5 * This software may be distributed under the terms of the BSD license.
6 * See README for more details.
7 */
8
9 #include "includes.h"
10
11 #include "common.h"
12 #include "eloop.h"
13 #include "uuid.h"
14 #include "crypto/random.h"
15 #include "crypto/dh_group5.h"
16 #include "common/ieee802_11_defs.h"
17 #include "common/ieee802_11_common.h"
18 #include "common/wpa_common.h"
19 #include "common/wpa_ctrl.h"
20 #include "eap_common/eap_wsc_common.h"
21 #include "eap_peer/eap.h"
22 #include "eapol_supp/eapol_supp_sm.h"
23 #include "rsn_supp/wpa.h"
24 #include "wps/wps_attr_parse.h"
25 #include "config.h"
26 #include "wpa_supplicant_i.h"
27 #include "driver_i.h"
28 #include "notify.h"
29 #include "blacklist.h"
30 #include "bss.h"
31 #include "scan.h"
32 #include "ap.h"
33 #include "p2p/p2p.h"
34 #include "p2p_supplicant.h"
35 #include "wps_supplicant.h"
36
37
38 #ifndef WPS_PIN_SCAN_IGNORE_SEL_REG
39 #define WPS_PIN_SCAN_IGNORE_SEL_REG 3
40 #endif /* WPS_PIN_SCAN_IGNORE_SEL_REG */
41
42 static void wpas_wps_timeout(void *eloop_ctx, void *timeout_ctx);
43 static void wpas_clear_wps(struct wpa_supplicant *wpa_s);
44
45
wpas_wps_clear_ap_info(struct wpa_supplicant * wpa_s)46 static void wpas_wps_clear_ap_info(struct wpa_supplicant *wpa_s)
47 {
48 os_free(wpa_s->wps_ap);
49 wpa_s->wps_ap = NULL;
50 wpa_s->num_wps_ap = 0;
51 wpa_s->wps_ap_iter = 0;
52 }
53
54
wpas_wps_assoc_with_cred(void * eloop_ctx,void * timeout_ctx)55 static void wpas_wps_assoc_with_cred(void *eloop_ctx, void *timeout_ctx)
56 {
57 struct wpa_supplicant *wpa_s = eloop_ctx;
58 int use_fast_assoc = timeout_ctx != NULL;
59
60 wpa_printf(MSG_DEBUG, "WPS: Continuing association after eapol_cb");
61 if (!use_fast_assoc ||
62 wpa_supplicant_fast_associate(wpa_s) != 1)
63 wpa_supplicant_req_scan(wpa_s, 0, 0);
64 }
65
66
wpas_wps_assoc_with_cred_cancel(struct wpa_supplicant * wpa_s)67 static void wpas_wps_assoc_with_cred_cancel(struct wpa_supplicant *wpa_s)
68 {
69 eloop_cancel_timeout(wpas_wps_assoc_with_cred, wpa_s, (void *) 0);
70 eloop_cancel_timeout(wpas_wps_assoc_with_cred, wpa_s, (void *) 1);
71 }
72
73
wpas_wps_eapol_cb(struct wpa_supplicant * wpa_s)74 int wpas_wps_eapol_cb(struct wpa_supplicant *wpa_s)
75 {
76 if (wpas_p2p_wps_eapol_cb(wpa_s) > 0)
77 return 1;
78
79 if (!wpa_s->wps_success &&
80 wpa_s->current_ssid &&
81 eap_is_wps_pin_enrollee(&wpa_s->current_ssid->eap)) {
82 const u8 *bssid = wpa_s->bssid;
83 if (is_zero_ether_addr(bssid))
84 bssid = wpa_s->pending_bssid;
85
86 wpa_printf(MSG_DEBUG, "WPS: PIN registration with " MACSTR
87 " did not succeed - continue trying to find "
88 "suitable AP", MAC2STR(bssid));
89 wpa_blacklist_add(wpa_s, bssid);
90
91 wpa_supplicant_deauthenticate(wpa_s,
92 WLAN_REASON_DEAUTH_LEAVING);
93 wpa_s->reassociate = 1;
94 wpa_supplicant_req_scan(wpa_s,
95 wpa_s->blacklist_cleared ? 5 : 0, 0);
96 wpa_s->blacklist_cleared = 0;
97 return 1;
98 }
99
100 wpas_wps_clear_ap_info(wpa_s);
101 eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
102 if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && !wpa_s->wps_success)
103 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_FAIL);
104
105 if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid &&
106 !(wpa_s->current_ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
107 int disabled = wpa_s->current_ssid->disabled;
108 unsigned int freq = wpa_s->assoc_freq;
109 struct wpa_bss *bss;
110 struct wpa_ssid *ssid = NULL;
111 int use_fast_assoc = 0;
112
113 wpa_printf(MSG_DEBUG, "WPS: Network configuration replaced - "
114 "try to associate with the received credential "
115 "(freq=%u)", freq);
116 wpa_supplicant_deauthenticate(wpa_s,
117 WLAN_REASON_DEAUTH_LEAVING);
118 if (disabled) {
119 wpa_printf(MSG_DEBUG, "WPS: Current network is "
120 "disabled - wait for user to enable");
121 return 1;
122 }
123 wpa_s->after_wps = 5;
124 wpa_s->wps_freq = freq;
125 wpa_s->normal_scans = 0;
126 wpa_s->reassociate = 1;
127
128 wpa_printf(MSG_DEBUG, "WPS: Checking whether fast association "
129 "without a new scan can be used");
130 bss = wpa_supplicant_pick_network(wpa_s, &ssid);
131 if (bss) {
132 struct wpabuf *wps;
133 struct wps_parse_attr attr;
134
135 wps = wpa_bss_get_vendor_ie_multi(bss,
136 WPS_IE_VENDOR_TYPE);
137 if (wps && wps_parse_msg(wps, &attr) == 0 &&
138 attr.wps_state &&
139 *attr.wps_state == WPS_STATE_CONFIGURED)
140 use_fast_assoc = 1;
141 wpabuf_free(wps);
142 }
143
144 /*
145 * Complete the next step from an eloop timeout to allow pending
146 * driver events related to the disconnection to be processed
147 * first. This makes it less likely for disconnection event to
148 * cause problems with the following connection.
149 */
150 wpa_printf(MSG_DEBUG, "WPS: Continue association from timeout");
151 wpas_wps_assoc_with_cred_cancel(wpa_s);
152 eloop_register_timeout(0, 10000,
153 wpas_wps_assoc_with_cred, wpa_s,
154 use_fast_assoc ? (void *) 1 :
155 (void *) 0);
156 return 1;
157 }
158
159 if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid) {
160 wpa_printf(MSG_DEBUG, "WPS: Registration completed - waiting "
161 "for external credential processing");
162 wpas_clear_wps(wpa_s);
163 wpa_supplicant_deauthenticate(wpa_s,
164 WLAN_REASON_DEAUTH_LEAVING);
165 return 1;
166 }
167
168 return 0;
169 }
170
171
wpas_wps_security_workaround(struct wpa_supplicant * wpa_s,struct wpa_ssid * ssid,const struct wps_credential * cred)172 static void wpas_wps_security_workaround(struct wpa_supplicant *wpa_s,
173 struct wpa_ssid *ssid,
174 const struct wps_credential *cred)
175 {
176 struct wpa_driver_capa capa;
177 struct wpa_bss *bss;
178 const u8 *ie;
179 struct wpa_ie_data adv;
180 int wpa2 = 0, ccmp = 0;
181
182 /*
183 * Many existing WPS APs do not know how to negotiate WPA2 or CCMP in
184 * case they are configured for mixed mode operation (WPA+WPA2 and
185 * TKIP+CCMP). Try to use scan results to figure out whether the AP
186 * actually supports stronger security and select that if the client
187 * has support for it, too.
188 */
189
190 if (wpa_drv_get_capa(wpa_s, &capa))
191 return; /* Unknown what driver supports */
192
193 if (ssid->ssid == NULL)
194 return;
195 bss = wpa_bss_get(wpa_s, cred->mac_addr, ssid->ssid, ssid->ssid_len);
196 if (bss == NULL) {
197 wpa_printf(MSG_DEBUG, "WPS: The AP was not found from BSS "
198 "table - use credential as-is");
199 return;
200 }
201
202 wpa_printf(MSG_DEBUG, "WPS: AP found from BSS table");
203
204 ie = wpa_bss_get_ie(bss, WLAN_EID_RSN);
205 if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0) {
206 wpa2 = 1;
207 if (adv.pairwise_cipher & WPA_CIPHER_CCMP)
208 ccmp = 1;
209 } else {
210 ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
211 if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0 &&
212 adv.pairwise_cipher & WPA_CIPHER_CCMP)
213 ccmp = 1;
214 }
215
216 if (ie == NULL && (ssid->proto & WPA_PROTO_WPA) &&
217 (ssid->pairwise_cipher & WPA_CIPHER_TKIP)) {
218 /*
219 * TODO: This could be the initial AP configuration and the
220 * Beacon contents could change shortly. Should request a new
221 * scan and delay addition of the network until the updated
222 * scan results are available.
223 */
224 wpa_printf(MSG_DEBUG, "WPS: The AP did not yet advertise WPA "
225 "support - use credential as-is");
226 return;
227 }
228
229 if (ccmp && !(ssid->pairwise_cipher & WPA_CIPHER_CCMP) &&
230 (ssid->pairwise_cipher & WPA_CIPHER_TKIP) &&
231 (capa.key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
232 wpa_printf(MSG_DEBUG, "WPS: Add CCMP into the credential "
233 "based on scan results");
234 if (wpa_s->conf->ap_scan == 1)
235 ssid->pairwise_cipher |= WPA_CIPHER_CCMP;
236 else
237 ssid->pairwise_cipher = WPA_CIPHER_CCMP;
238 }
239
240 if (wpa2 && !(ssid->proto & WPA_PROTO_RSN) &&
241 (ssid->proto & WPA_PROTO_WPA) &&
242 (capa.enc & WPA_DRIVER_CAPA_ENC_CCMP)) {
243 wpa_printf(MSG_DEBUG, "WPS: Add WPA2 into the credential "
244 "based on scan results");
245 if (wpa_s->conf->ap_scan == 1)
246 ssid->proto |= WPA_PROTO_RSN;
247 else
248 ssid->proto = WPA_PROTO_RSN;
249 }
250 }
251
252
wpas_wps_remove_dup_network(struct wpa_supplicant * wpa_s,struct wpa_ssid * new_ssid)253 static void wpas_wps_remove_dup_network(struct wpa_supplicant *wpa_s,
254 struct wpa_ssid *new_ssid)
255 {
256 struct wpa_ssid *ssid, *next;
257
258 for (ssid = wpa_s->conf->ssid, next = ssid ? ssid->next : NULL; ssid;
259 ssid = next, next = ssid ? ssid->next : NULL) {
260 /*
261 * new_ssid has already been added to the list in
262 * wpas_wps_add_network(), so skip it.
263 */
264 if (ssid == new_ssid)
265 continue;
266
267 if (ssid->bssid_set || new_ssid->bssid_set) {
268 if (ssid->bssid_set != new_ssid->bssid_set)
269 continue;
270 if (os_memcmp(ssid->bssid, new_ssid->bssid, ETH_ALEN) !=
271 0)
272 continue;
273 }
274
275 /* compare SSID */
276 if (ssid->ssid_len == 0 || ssid->ssid_len != new_ssid->ssid_len)
277 continue;
278
279 if (ssid->ssid && new_ssid->ssid) {
280 if (os_memcmp(ssid->ssid, new_ssid->ssid,
281 ssid->ssid_len) != 0)
282 continue;
283 } else if (ssid->ssid || new_ssid->ssid)
284 continue;
285
286 /* compare security parameters */
287 if (ssid->auth_alg != new_ssid->auth_alg ||
288 ssid->key_mgmt != new_ssid->key_mgmt ||
289 ssid->proto != new_ssid->proto ||
290 ssid->pairwise_cipher != new_ssid->pairwise_cipher ||
291 ssid->group_cipher != new_ssid->group_cipher)
292 continue;
293
294 /* Remove the duplicated older network entry. */
295 wpa_printf(MSG_DEBUG, "Remove duplicate network %d", ssid->id);
296 wpas_notify_network_removed(wpa_s, ssid);
297 wpa_config_remove_network(wpa_s->conf, ssid->id);
298 }
299 }
300
301
wpa_supplicant_wps_cred(void * ctx,const struct wps_credential * cred)302 static int wpa_supplicant_wps_cred(void *ctx,
303 const struct wps_credential *cred)
304 {
305 struct wpa_supplicant *wpa_s = ctx;
306 struct wpa_ssid *ssid = wpa_s->current_ssid;
307 u16 auth_type;
308 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
309 int registrar = 0;
310 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
311
312 if ((wpa_s->conf->wps_cred_processing == 1 ||
313 wpa_s->conf->wps_cred_processing == 2) && cred->cred_attr) {
314 size_t blen = cred->cred_attr_len * 2 + 1;
315 char *buf = os_malloc(blen);
316 if (buf) {
317 wpa_snprintf_hex(buf, blen,
318 cred->cred_attr, cred->cred_attr_len);
319 wpa_msg(wpa_s, MSG_INFO, "%s%s",
320 WPS_EVENT_CRED_RECEIVED, buf);
321 os_free(buf);
322 }
323
324 wpas_notify_wps_credential(wpa_s, cred);
325 } else
326 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_CRED_RECEIVED);
327
328 wpa_hexdump_key(MSG_DEBUG, "WPS: Received Credential attribute",
329 cred->cred_attr, cred->cred_attr_len);
330
331 if (wpa_s->conf->wps_cred_processing == 1)
332 return 0;
333
334 wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", cred->ssid, cred->ssid_len);
335 wpa_printf(MSG_DEBUG, "WPS: Authentication Type 0x%x",
336 cred->auth_type);
337 wpa_printf(MSG_DEBUG, "WPS: Encryption Type 0x%x", cred->encr_type);
338 wpa_printf(MSG_DEBUG, "WPS: Network Key Index %d", cred->key_idx);
339 wpa_hexdump_key(MSG_DEBUG, "WPS: Network Key",
340 cred->key, cred->key_len);
341 wpa_printf(MSG_DEBUG, "WPS: MAC Address " MACSTR,
342 MAC2STR(cred->mac_addr));
343
344 auth_type = cred->auth_type;
345 if (auth_type == (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
346 wpa_printf(MSG_DEBUG, "WPS: Workaround - convert mixed-mode "
347 "auth_type into WPA2PSK");
348 auth_type = WPS_AUTH_WPA2PSK;
349 }
350
351 if (auth_type != WPS_AUTH_OPEN &&
352 auth_type != WPS_AUTH_WPAPSK &&
353 auth_type != WPS_AUTH_WPA2PSK) {
354 wpa_printf(MSG_DEBUG, "WPS: Ignored credentials for "
355 "unsupported authentication type 0x%x",
356 auth_type);
357 return 0;
358 }
359
360 if (auth_type == WPS_AUTH_WPAPSK || auth_type == WPS_AUTH_WPA2PSK) {
361 if (cred->key_len < 8 || cred->key_len > 2 * PMK_LEN) {
362 wpa_printf(MSG_ERROR, "WPS: Reject PSK credential with "
363 "invalid Network Key length %lu",
364 (unsigned long) cred->key_len);
365 return -1;
366 }
367 }
368
369 if (ssid && (ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
370 wpa_printf(MSG_DEBUG, "WPS: Replace WPS network block based "
371 "on the received credential");
372 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
373 if (ssid->eap.identity &&
374 ssid->eap.identity_len == WSC_ID_REGISTRAR_LEN &&
375 os_memcmp(ssid->eap.identity, WSC_ID_REGISTRAR,
376 WSC_ID_REGISTRAR_LEN) == 0)
377 registrar = 1;
378 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
379 os_free(ssid->eap.identity);
380 ssid->eap.identity = NULL;
381 ssid->eap.identity_len = 0;
382 os_free(ssid->eap.phase1);
383 ssid->eap.phase1 = NULL;
384 os_free(ssid->eap.eap_methods);
385 ssid->eap.eap_methods = NULL;
386 if (!ssid->p2p_group) {
387 ssid->temporary = 0;
388 ssid->bssid_set = 0;
389 }
390 ssid->disabled_until.sec = 0;
391 ssid->disabled_until.usec = 0;
392 ssid->auth_failures = 0;
393 } else {
394 wpa_printf(MSG_DEBUG, "WPS: Create a new network based on the "
395 "received credential");
396 ssid = wpa_config_add_network(wpa_s->conf);
397 if (ssid == NULL)
398 return -1;
399 if (wpa_s->current_ssid) {
400 /*
401 * Should the GO issue multiple credentials for some
402 * reason, each credential should be marked as a
403 * temporary P2P group similarly to the one that gets
404 * marked as such based on the pre-configured values
405 * used for the WPS network block.
406 */
407 ssid->p2p_group = wpa_s->current_ssid->p2p_group;
408 ssid->temporary = wpa_s->current_ssid->temporary;
409 }
410 wpas_notify_network_added(wpa_s, ssid);
411 }
412
413 wpa_config_set_network_defaults(ssid);
414
415 os_free(ssid->ssid);
416 ssid->ssid = os_malloc(cred->ssid_len);
417 if (ssid->ssid) {
418 os_memcpy(ssid->ssid, cred->ssid, cred->ssid_len);
419 ssid->ssid_len = cred->ssid_len;
420 }
421
422 switch (cred->encr_type) {
423 case WPS_ENCR_NONE:
424 break;
425 case WPS_ENCR_TKIP:
426 ssid->pairwise_cipher = WPA_CIPHER_TKIP;
427 break;
428 case WPS_ENCR_AES:
429 ssid->pairwise_cipher = WPA_CIPHER_CCMP;
430 break;
431 }
432
433 switch (auth_type) {
434 case WPS_AUTH_OPEN:
435 ssid->auth_alg = WPA_AUTH_ALG_OPEN;
436 ssid->key_mgmt = WPA_KEY_MGMT_NONE;
437 ssid->proto = 0;
438 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
439 if (registrar) {
440 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_OPEN_NETWORK
441 "id=%d - Credentials for an open "
442 "network disabled by default - use "
443 "'select_network %d' to enable",
444 ssid->id, ssid->id);
445 ssid->disabled = 1;
446 }
447 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
448 break;
449 case WPS_AUTH_WPAPSK:
450 ssid->auth_alg = WPA_AUTH_ALG_OPEN;
451 ssid->key_mgmt = WPA_KEY_MGMT_PSK;
452 ssid->proto = WPA_PROTO_WPA;
453 break;
454 case WPS_AUTH_WPA2PSK:
455 ssid->auth_alg = WPA_AUTH_ALG_OPEN;
456 ssid->key_mgmt = WPA_KEY_MGMT_PSK;
457 ssid->proto = WPA_PROTO_RSN;
458 break;
459 }
460
461 if (ssid->key_mgmt == WPA_KEY_MGMT_PSK) {
462 if (cred->key_len == 2 * PMK_LEN) {
463 if (hexstr2bin((const char *) cred->key, ssid->psk,
464 PMK_LEN)) {
465 wpa_printf(MSG_ERROR, "WPS: Invalid Network "
466 "Key");
467 return -1;
468 }
469 ssid->psk_set = 1;
470 ssid->export_keys = 1;
471 } else if (cred->key_len >= 8 && cred->key_len < 2 * PMK_LEN) {
472 os_free(ssid->passphrase);
473 ssid->passphrase = os_malloc(cred->key_len + 1);
474 if (ssid->passphrase == NULL)
475 return -1;
476 os_memcpy(ssid->passphrase, cred->key, cred->key_len);
477 ssid->passphrase[cred->key_len] = '\0';
478 wpa_config_update_psk(ssid);
479 ssid->export_keys = 1;
480 } else {
481 wpa_printf(MSG_ERROR, "WPS: Invalid Network Key "
482 "length %lu",
483 (unsigned long) cred->key_len);
484 return -1;
485 }
486 }
487
488 wpas_wps_security_workaround(wpa_s, ssid, cred);
489
490 wpas_wps_remove_dup_network(wpa_s, ssid);
491
492 #ifndef CONFIG_NO_CONFIG_WRITE
493 if (wpa_s->conf->update_config &&
494 wpa_config_write(wpa_s->confname, wpa_s->conf)) {
495 wpa_printf(MSG_DEBUG, "WPS: Failed to update configuration");
496 return -1;
497 }
498 #endif /* CONFIG_NO_CONFIG_WRITE */
499
500 /*
501 * Optimize the post-WPS scan based on the channel used during
502 * the provisioning in case EAP-Failure is not received.
503 */
504 wpa_s->after_wps = 5;
505 wpa_s->wps_freq = wpa_s->assoc_freq;
506
507 return 0;
508 }
509
510
wpa_supplicant_wps_event_m2d(struct wpa_supplicant * wpa_s,struct wps_event_m2d * m2d)511 static void wpa_supplicant_wps_event_m2d(struct wpa_supplicant *wpa_s,
512 struct wps_event_m2d *m2d)
513 {
514 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_M2D
515 "dev_password_id=%d config_error=%d",
516 m2d->dev_password_id, m2d->config_error);
517 wpas_notify_wps_event_m2d(wpa_s, m2d);
518 #ifdef CONFIG_P2P
519 if (wpa_s->parent && wpa_s->parent != wpa_s) {
520 wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_M2D
521 "dev_password_id=%d config_error=%d",
522 m2d->dev_password_id, m2d->config_error);
523 }
524 if (m2d->config_error == WPS_CFG_MULTIPLE_PBC_DETECTED) {
525 /*
526 * Notify P2P from eloop timeout to avoid issues with the
527 * interface getting removed while processing a message.
528 */
529 eloop_register_timeout(0, 0, wpas_p2p_pbc_overlap_cb, wpa_s,
530 NULL);
531 }
532 #endif /* CONFIG_P2P */
533 }
534
535
wpas_wps_clear_timeout(void * eloop_ctx,void * timeout_ctx)536 static void wpas_wps_clear_timeout(void *eloop_ctx, void *timeout_ctx)
537 {
538 struct wpa_supplicant *wpa_s = eloop_ctx;
539 wpa_printf(MSG_DEBUG, "WPS: Clear WPS network from timeout");
540 wpas_clear_wps(wpa_s);
541 }
542
543
wpa_supplicant_wps_event_fail(struct wpa_supplicant * wpa_s,struct wps_event_fail * fail)544 static void wpa_supplicant_wps_event_fail(struct wpa_supplicant *wpa_s,
545 struct wps_event_fail *fail)
546 {
547 if (fail->error_indication > 0 &&
548 fail->error_indication < NUM_WPS_EI_VALUES) {
549 wpa_msg(wpa_s, MSG_INFO,
550 WPS_EVENT_FAIL "msg=%d config_error=%d reason=%d (%s)",
551 fail->msg, fail->config_error, fail->error_indication,
552 wps_ei_str(fail->error_indication));
553 if (wpa_s->parent && wpa_s->parent != wpa_s)
554 wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_FAIL
555 "msg=%d config_error=%d reason=%d (%s)",
556 fail->msg, fail->config_error,
557 fail->error_indication,
558 wps_ei_str(fail->error_indication));
559 } else {
560 wpa_msg(wpa_s, MSG_INFO,
561 WPS_EVENT_FAIL "msg=%d config_error=%d",
562 fail->msg, fail->config_error);
563 if (wpa_s->parent && wpa_s->parent != wpa_s)
564 wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_FAIL
565 "msg=%d config_error=%d",
566 fail->msg, fail->config_error);
567 }
568
569 /*
570 * Need to allow WPS processing to complete, e.g., by sending WSC_NACK.
571 */
572 wpa_printf(MSG_DEBUG, "WPS: Register timeout to clear WPS network");
573 eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
574 eloop_register_timeout(0, 100000, wpas_wps_clear_timeout, wpa_s, NULL);
575
576 wpas_notify_wps_event_fail(wpa_s, fail);
577 wpas_p2p_wps_failed(wpa_s, fail);
578 }
579
580
581 static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx);
582
wpas_wps_reenable_networks(struct wpa_supplicant * wpa_s)583 static void wpas_wps_reenable_networks(struct wpa_supplicant *wpa_s)
584 {
585 struct wpa_ssid *ssid;
586 int changed = 0;
587
588 eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
589
590 for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
591 if (ssid->disabled_for_connect && ssid->disabled) {
592 ssid->disabled_for_connect = 0;
593 ssid->disabled = 0;
594 wpas_notify_network_enabled_changed(wpa_s, ssid);
595 changed++;
596 }
597 }
598
599 if (changed) {
600 #ifndef CONFIG_NO_CONFIG_WRITE
601 if (wpa_s->conf->update_config &&
602 wpa_config_write(wpa_s->confname, wpa_s->conf)) {
603 wpa_printf(MSG_DEBUG, "WPS: Failed to update "
604 "configuration");
605 }
606 #endif /* CONFIG_NO_CONFIG_WRITE */
607 }
608 }
609
610
wpas_wps_reenable_networks_cb(void * eloop_ctx,void * timeout_ctx)611 static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx)
612 {
613 struct wpa_supplicant *wpa_s = eloop_ctx;
614 /* Enable the networks disabled during wpas_wps_reassoc */
615 wpas_wps_reenable_networks(wpa_s);
616 }
617
618
wpa_supplicant_wps_event_success(struct wpa_supplicant * wpa_s)619 static void wpa_supplicant_wps_event_success(struct wpa_supplicant *wpa_s)
620 {
621 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_SUCCESS);
622 wpa_s->wps_success = 1;
623 wpas_notify_wps_event_success(wpa_s);
624 if (wpa_s->current_ssid)
625 wpas_clear_temp_disabled(wpa_s, wpa_s->current_ssid, 1);
626 wpa_s->extra_blacklist_count = 0;
627
628 /*
629 * Enable the networks disabled during wpas_wps_reassoc after 10
630 * seconds. The 10 seconds timer is to allow the data connection to be
631 * formed before allowing other networks to be selected.
632 */
633 eloop_register_timeout(10, 0, wpas_wps_reenable_networks_cb, wpa_s,
634 NULL);
635
636 wpas_p2p_wps_success(wpa_s, wpa_s->bssid, 0);
637 }
638
639
wpa_supplicant_wps_event_er_ap_add(struct wpa_supplicant * wpa_s,struct wps_event_er_ap * ap)640 static void wpa_supplicant_wps_event_er_ap_add(struct wpa_supplicant *wpa_s,
641 struct wps_event_er_ap *ap)
642 {
643 char uuid_str[100];
644 char dev_type[WPS_DEV_TYPE_BUFSIZE];
645
646 uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
647 if (ap->pri_dev_type)
648 wps_dev_type_bin2str(ap->pri_dev_type, dev_type,
649 sizeof(dev_type));
650 else
651 dev_type[0] = '\0';
652
653 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_ADD "%s " MACSTR
654 " pri_dev_type=%s wps_state=%d |%s|%s|%s|%s|%s|%s|",
655 uuid_str, MAC2STR(ap->mac_addr), dev_type, ap->wps_state,
656 ap->friendly_name ? ap->friendly_name : "",
657 ap->manufacturer ? ap->manufacturer : "",
658 ap->model_description ? ap->model_description : "",
659 ap->model_name ? ap->model_name : "",
660 ap->manufacturer_url ? ap->manufacturer_url : "",
661 ap->model_url ? ap->model_url : "");
662 }
663
664
wpa_supplicant_wps_event_er_ap_remove(struct wpa_supplicant * wpa_s,struct wps_event_er_ap * ap)665 static void wpa_supplicant_wps_event_er_ap_remove(struct wpa_supplicant *wpa_s,
666 struct wps_event_er_ap *ap)
667 {
668 char uuid_str[100];
669 uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
670 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_REMOVE "%s", uuid_str);
671 }
672
673
wpa_supplicant_wps_event_er_enrollee_add(struct wpa_supplicant * wpa_s,struct wps_event_er_enrollee * enrollee)674 static void wpa_supplicant_wps_event_er_enrollee_add(
675 struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
676 {
677 char uuid_str[100];
678 char dev_type[WPS_DEV_TYPE_BUFSIZE];
679
680 uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
681 if (enrollee->pri_dev_type)
682 wps_dev_type_bin2str(enrollee->pri_dev_type, dev_type,
683 sizeof(dev_type));
684 else
685 dev_type[0] = '\0';
686
687 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_ADD "%s " MACSTR
688 " M1=%d config_methods=0x%x dev_passwd_id=%d pri_dev_type=%s "
689 "|%s|%s|%s|%s|%s|",
690 uuid_str, MAC2STR(enrollee->mac_addr), enrollee->m1_received,
691 enrollee->config_methods, enrollee->dev_passwd_id, dev_type,
692 enrollee->dev_name ? enrollee->dev_name : "",
693 enrollee->manufacturer ? enrollee->manufacturer : "",
694 enrollee->model_name ? enrollee->model_name : "",
695 enrollee->model_number ? enrollee->model_number : "",
696 enrollee->serial_number ? enrollee->serial_number : "");
697 }
698
699
wpa_supplicant_wps_event_er_enrollee_remove(struct wpa_supplicant * wpa_s,struct wps_event_er_enrollee * enrollee)700 static void wpa_supplicant_wps_event_er_enrollee_remove(
701 struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
702 {
703 char uuid_str[100];
704 uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
705 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_REMOVE "%s " MACSTR,
706 uuid_str, MAC2STR(enrollee->mac_addr));
707 }
708
709
wpa_supplicant_wps_event_er_ap_settings(struct wpa_supplicant * wpa_s,struct wps_event_er_ap_settings * ap_settings)710 static void wpa_supplicant_wps_event_er_ap_settings(
711 struct wpa_supplicant *wpa_s,
712 struct wps_event_er_ap_settings *ap_settings)
713 {
714 char uuid_str[100];
715 char key_str[65];
716 const struct wps_credential *cred = ap_settings->cred;
717
718 key_str[0] = '\0';
719 if (cred->auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
720 if (cred->key_len >= 8 && cred->key_len <= 64) {
721 os_memcpy(key_str, cred->key, cred->key_len);
722 key_str[cred->key_len] = '\0';
723 }
724 }
725
726 uuid_bin2str(ap_settings->uuid, uuid_str, sizeof(uuid_str));
727 /* Use wpa_msg_ctrl to avoid showing the key in debug log */
728 wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_SETTINGS
729 "uuid=%s ssid=%s auth_type=0x%04x encr_type=0x%04x "
730 "key=%s",
731 uuid_str, wpa_ssid_txt(cred->ssid, cred->ssid_len),
732 cred->auth_type, cred->encr_type, key_str);
733 }
734
735
wpa_supplicant_wps_event_er_set_sel_reg(struct wpa_supplicant * wpa_s,struct wps_event_er_set_selected_registrar * ev)736 static void wpa_supplicant_wps_event_er_set_sel_reg(
737 struct wpa_supplicant *wpa_s,
738 struct wps_event_er_set_selected_registrar *ev)
739 {
740 char uuid_str[100];
741
742 uuid_bin2str(ev->uuid, uuid_str, sizeof(uuid_str));
743 switch (ev->state) {
744 case WPS_ER_SET_SEL_REG_START:
745 wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
746 "uuid=%s state=START sel_reg=%d dev_passwd_id=%u "
747 "sel_reg_config_methods=0x%x",
748 uuid_str, ev->sel_reg, ev->dev_passwd_id,
749 ev->sel_reg_config_methods);
750 break;
751 case WPS_ER_SET_SEL_REG_DONE:
752 wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
753 "uuid=%s state=DONE", uuid_str);
754 break;
755 case WPS_ER_SET_SEL_REG_FAILED:
756 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_SET_SEL_REG
757 "uuid=%s state=FAILED", uuid_str);
758 break;
759 }
760 }
761
762
wpa_supplicant_wps_event(void * ctx,enum wps_event event,union wps_event_data * data)763 static void wpa_supplicant_wps_event(void *ctx, enum wps_event event,
764 union wps_event_data *data)
765 {
766 struct wpa_supplicant *wpa_s = ctx;
767 switch (event) {
768 case WPS_EV_M2D:
769 wpa_supplicant_wps_event_m2d(wpa_s, &data->m2d);
770 break;
771 case WPS_EV_FAIL:
772 wpa_supplicant_wps_event_fail(wpa_s, &data->fail);
773 break;
774 case WPS_EV_SUCCESS:
775 wpa_supplicant_wps_event_success(wpa_s);
776 break;
777 case WPS_EV_PWD_AUTH_FAIL:
778 #ifdef CONFIG_AP
779 if (wpa_s->ap_iface && data->pwd_auth_fail.enrollee)
780 wpa_supplicant_ap_pwd_auth_fail(wpa_s);
781 #endif /* CONFIG_AP */
782 break;
783 case WPS_EV_PBC_OVERLAP:
784 break;
785 case WPS_EV_PBC_TIMEOUT:
786 break;
787 case WPS_EV_PBC_ACTIVE:
788 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ACTIVE);
789 break;
790 case WPS_EV_PBC_DISABLE:
791 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_DISABLE);
792 break;
793 case WPS_EV_ER_AP_ADD:
794 wpa_supplicant_wps_event_er_ap_add(wpa_s, &data->ap);
795 break;
796 case WPS_EV_ER_AP_REMOVE:
797 wpa_supplicant_wps_event_er_ap_remove(wpa_s, &data->ap);
798 break;
799 case WPS_EV_ER_ENROLLEE_ADD:
800 wpa_supplicant_wps_event_er_enrollee_add(wpa_s,
801 &data->enrollee);
802 break;
803 case WPS_EV_ER_ENROLLEE_REMOVE:
804 wpa_supplicant_wps_event_er_enrollee_remove(wpa_s,
805 &data->enrollee);
806 break;
807 case WPS_EV_ER_AP_SETTINGS:
808 wpa_supplicant_wps_event_er_ap_settings(wpa_s,
809 &data->ap_settings);
810 break;
811 case WPS_EV_ER_SET_SELECTED_REGISTRAR:
812 wpa_supplicant_wps_event_er_set_sel_reg(wpa_s,
813 &data->set_sel_reg);
814 break;
815 case WPS_EV_AP_PIN_SUCCESS:
816 break;
817 }
818 }
819
820
wpa_supplicant_wps_rf_band(void * ctx)821 static int wpa_supplicant_wps_rf_band(void *ctx)
822 {
823 struct wpa_supplicant *wpa_s = ctx;
824
825 if (!wpa_s->current_ssid || !wpa_s->assoc_freq)
826 return 0;
827
828 return (wpa_s->assoc_freq > 2484) ? WPS_RF_50GHZ : WPS_RF_24GHZ;
829 }
830
831
wpas_wps_get_req_type(struct wpa_ssid * ssid)832 enum wps_request_type wpas_wps_get_req_type(struct wpa_ssid *ssid)
833 {
834 if (eap_is_wps_pbc_enrollee(&ssid->eap) ||
835 eap_is_wps_pin_enrollee(&ssid->eap))
836 return WPS_REQ_ENROLLEE;
837 else
838 return WPS_REQ_REGISTRAR;
839 }
840
841
wpas_clear_wps(struct wpa_supplicant * wpa_s)842 static void wpas_clear_wps(struct wpa_supplicant *wpa_s)
843 {
844 int id;
845 struct wpa_ssid *ssid, *remove_ssid = NULL, *prev_current;
846
847 wpa_s->after_wps = 0;
848 wpa_s->known_wps_freq = 0;
849
850 prev_current = wpa_s->current_ssid;
851
852 /* Enable the networks disabled during wpas_wps_reassoc */
853 wpas_wps_reenable_networks(wpa_s);
854
855 eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
856 eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
857
858 /* Remove any existing WPS network from configuration */
859 ssid = wpa_s->conf->ssid;
860 while (ssid) {
861 if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
862 if (ssid == wpa_s->current_ssid) {
863 wpa_supplicant_deauthenticate(
864 wpa_s, WLAN_REASON_DEAUTH_LEAVING);
865 }
866 id = ssid->id;
867 remove_ssid = ssid;
868 } else
869 id = -1;
870 ssid = ssid->next;
871 if (id >= 0) {
872 if (prev_current == remove_ssid) {
873 wpa_sm_set_config(wpa_s->wpa, NULL);
874 eapol_sm_notify_config(wpa_s->eapol, NULL,
875 NULL);
876 }
877 wpas_notify_network_removed(wpa_s, remove_ssid);
878 wpa_config_remove_network(wpa_s->conf, id);
879 }
880 }
881
882 wpas_wps_clear_ap_info(wpa_s);
883 }
884
885
wpas_wps_timeout(void * eloop_ctx,void * timeout_ctx)886 static void wpas_wps_timeout(void *eloop_ctx, void *timeout_ctx)
887 {
888 struct wpa_supplicant *wpa_s = eloop_ctx;
889 wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_TIMEOUT "Requested operation timed "
890 "out");
891 wpas_clear_wps(wpa_s);
892 }
893
894
wpas_wps_add_network(struct wpa_supplicant * wpa_s,int registrar,const u8 * dev_addr,const u8 * bssid)895 static struct wpa_ssid * wpas_wps_add_network(struct wpa_supplicant *wpa_s,
896 int registrar, const u8 *dev_addr,
897 const u8 *bssid)
898 {
899 struct wpa_ssid *ssid;
900
901 ssid = wpa_config_add_network(wpa_s->conf);
902 if (ssid == NULL)
903 return NULL;
904 wpas_notify_network_added(wpa_s, ssid);
905 wpa_config_set_network_defaults(ssid);
906 ssid->temporary = 1;
907 if (wpa_config_set(ssid, "key_mgmt", "WPS", 0) < 0 ||
908 wpa_config_set(ssid, "eap", "WSC", 0) < 0 ||
909 wpa_config_set(ssid, "identity", registrar ?
910 "\"" WSC_ID_REGISTRAR "\"" :
911 "\"" WSC_ID_ENROLLEE "\"", 0) < 0) {
912 wpas_notify_network_removed(wpa_s, ssid);
913 wpa_config_remove_network(wpa_s->conf, ssid->id);
914 return NULL;
915 }
916
917 #ifdef CONFIG_P2P
918 if (dev_addr)
919 os_memcpy(ssid->go_p2p_dev_addr, dev_addr, ETH_ALEN);
920 #endif /* CONFIG_P2P */
921
922 if (bssid) {
923 #ifndef CONFIG_P2P
924 struct wpa_bss *bss;
925 int count = 0;
926 #endif /* CONFIG_P2P */
927
928 os_memcpy(ssid->bssid, bssid, ETH_ALEN);
929 ssid->bssid_set = 1;
930
931 /*
932 * Note: With P2P, the SSID may change at the time the WPS
933 * provisioning is started, so better not filter the AP based
934 * on the current SSID in the scan results.
935 */
936 #ifndef CONFIG_P2P
937 dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
938 if (os_memcmp(bssid, bss->bssid, ETH_ALEN) != 0)
939 continue;
940
941 os_free(ssid->ssid);
942 ssid->ssid = os_malloc(bss->ssid_len);
943 if (ssid->ssid == NULL)
944 break;
945 os_memcpy(ssid->ssid, bss->ssid, bss->ssid_len);
946 ssid->ssid_len = bss->ssid_len;
947 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Picked SSID from "
948 "scan results",
949 ssid->ssid, ssid->ssid_len);
950 count++;
951 }
952
953 if (count > 1) {
954 wpa_printf(MSG_DEBUG, "WPS: More than one SSID found "
955 "for the AP; use wildcard");
956 os_free(ssid->ssid);
957 ssid->ssid = NULL;
958 ssid->ssid_len = 0;
959 }
960 #endif /* CONFIG_P2P */
961 }
962
963 return ssid;
964 }
965
966
wpas_wps_temp_disable(struct wpa_supplicant * wpa_s,struct wpa_ssid * selected)967 static void wpas_wps_temp_disable(struct wpa_supplicant *wpa_s,
968 struct wpa_ssid *selected)
969 {
970 struct wpa_ssid *ssid;
971
972 if (wpa_s->current_ssid)
973 wpa_supplicant_deauthenticate(
974 wpa_s, WLAN_REASON_DEAUTH_LEAVING);
975
976 /* Mark all other networks disabled and trigger reassociation */
977 ssid = wpa_s->conf->ssid;
978 while (ssid) {
979 int was_disabled = ssid->disabled;
980 ssid->disabled_for_connect = 0;
981 /*
982 * In case the network object corresponds to a persistent group
983 * then do not send out network disabled signal. In addition,
984 * do not change disabled status of persistent network objects
985 * from 2 to 1 should we connect to another network.
986 */
987 if (was_disabled != 2) {
988 ssid->disabled = ssid != selected;
989 if (was_disabled != ssid->disabled) {
990 if (ssid->disabled)
991 ssid->disabled_for_connect = 1;
992 wpas_notify_network_enabled_changed(wpa_s,
993 ssid);
994 }
995 }
996 ssid = ssid->next;
997 }
998 }
999
1000
wpas_wps_reassoc(struct wpa_supplicant * wpa_s,struct wpa_ssid * selected,const u8 * bssid,int freq)1001 static void wpas_wps_reassoc(struct wpa_supplicant *wpa_s,
1002 struct wpa_ssid *selected, const u8 *bssid,
1003 int freq)
1004 {
1005 struct wpa_bss *bss;
1006
1007 wpa_s->after_wps = 0;
1008 wpa_s->known_wps_freq = 0;
1009 if (freq) {
1010 wpa_s->after_wps = 5;
1011 wpa_s->wps_freq = freq;
1012 } else if (bssid) {
1013 bss = wpa_bss_get_bssid_latest(wpa_s, bssid);
1014 if (bss && bss->freq > 0) {
1015 wpa_s->known_wps_freq = 1;
1016 wpa_s->wps_freq = bss->freq;
1017 }
1018 }
1019
1020 wpas_wps_temp_disable(wpa_s, selected);
1021
1022 wpa_s->disconnected = 0;
1023 wpa_s->reassociate = 1;
1024 wpa_s->scan_runs = 0;
1025 wpa_s->normal_scans = 0;
1026 wpa_s->wps_success = 0;
1027 wpa_s->blacklist_cleared = 0;
1028
1029 wpa_supplicant_cancel_sched_scan(wpa_s);
1030 wpa_supplicant_req_scan(wpa_s, 0, 0);
1031 }
1032
1033
wpas_wps_start_pbc(struct wpa_supplicant * wpa_s,const u8 * bssid,int p2p_group)1034 int wpas_wps_start_pbc(struct wpa_supplicant *wpa_s, const u8 *bssid,
1035 int p2p_group)
1036 {
1037 struct wpa_ssid *ssid;
1038 wpas_clear_wps(wpa_s);
1039 ssid = wpas_wps_add_network(wpa_s, 0, NULL, bssid);
1040 if (ssid == NULL)
1041 return -1;
1042 ssid->temporary = 1;
1043 ssid->p2p_group = p2p_group;
1044 #ifdef CONFIG_P2P
1045 if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
1046 ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
1047 if (ssid->ssid) {
1048 ssid->ssid_len = wpa_s->go_params->ssid_len;
1049 os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
1050 ssid->ssid_len);
1051 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
1052 "SSID", ssid->ssid, ssid->ssid_len);
1053 }
1054 }
1055 #endif /* CONFIG_P2P */
1056 if (wpa_config_set(ssid, "phase1", "\"pbc=1\"", 0) < 0)
1057 return -1;
1058 if (wpa_s->wps_fragment_size)
1059 ssid->eap.fragment_size = wpa_s->wps_fragment_size;
1060 eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
1061 wpa_s, NULL);
1062 wpas_wps_reassoc(wpa_s, ssid, bssid, 0);
1063 return 0;
1064 }
1065
1066
wpas_wps_start_dev_pw(struct wpa_supplicant * wpa_s,const u8 * dev_addr,const u8 * bssid,const char * pin,int p2p_group,u16 dev_pw_id,const u8 * peer_pubkey_hash,const u8 * ssid_val,size_t ssid_len,int freq)1067 static int wpas_wps_start_dev_pw(struct wpa_supplicant *wpa_s,
1068 const u8 *dev_addr, const u8 *bssid,
1069 const char *pin, int p2p_group, u16 dev_pw_id,
1070 const u8 *peer_pubkey_hash,
1071 const u8 *ssid_val, size_t ssid_len, int freq)
1072 {
1073 struct wpa_ssid *ssid;
1074 char val[128 + 2 * WPS_OOB_PUBKEY_HASH_LEN];
1075 unsigned int rpin = 0;
1076 char hash[2 * WPS_OOB_PUBKEY_HASH_LEN + 10];
1077
1078 wpas_clear_wps(wpa_s);
1079 if (bssid && is_zero_ether_addr(bssid))
1080 bssid = NULL;
1081 ssid = wpas_wps_add_network(wpa_s, 0, dev_addr, bssid);
1082 if (ssid == NULL) {
1083 wpa_printf(MSG_DEBUG, "WPS: Could not add network");
1084 return -1;
1085 }
1086 ssid->temporary = 1;
1087 ssid->p2p_group = p2p_group;
1088 if (ssid_val) {
1089 ssid->ssid = os_malloc(ssid_len);
1090 if (ssid->ssid) {
1091 os_memcpy(ssid->ssid, ssid_val, ssid_len);
1092 ssid->ssid_len = ssid_len;
1093 }
1094 }
1095 if (peer_pubkey_hash) {
1096 os_memcpy(hash, " pkhash=", 8);
1097 wpa_snprintf_hex_uppercase(hash + 8, sizeof(hash) - 8,
1098 peer_pubkey_hash,
1099 WPS_OOB_PUBKEY_HASH_LEN);
1100 } else {
1101 hash[0] = '\0';
1102 }
1103 #ifdef CONFIG_P2P
1104 if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
1105 ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
1106 if (ssid->ssid) {
1107 ssid->ssid_len = wpa_s->go_params->ssid_len;
1108 os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
1109 ssid->ssid_len);
1110 wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
1111 "SSID", ssid->ssid, ssid->ssid_len);
1112 }
1113 }
1114 #endif /* CONFIG_P2P */
1115 if (pin)
1116 os_snprintf(val, sizeof(val), "\"pin=%s dev_pw_id=%u%s\"",
1117 pin, dev_pw_id, hash);
1118 else if (pin == NULL && dev_pw_id == DEV_PW_NFC_CONNECTION_HANDOVER) {
1119 os_snprintf(val, sizeof(val), "\"dev_pw_id=%u%s\"",
1120 dev_pw_id, hash);
1121 } else {
1122 rpin = wps_generate_pin();
1123 os_snprintf(val, sizeof(val), "\"pin=%08d dev_pw_id=%u%s\"",
1124 rpin, dev_pw_id, hash);
1125 }
1126 if (wpa_config_set(ssid, "phase1", val, 0) < 0) {
1127 wpa_printf(MSG_DEBUG, "WPS: Failed to set phase1 '%s'", val);
1128 return -1;
1129 }
1130 if (wpa_s->wps_fragment_size)
1131 ssid->eap.fragment_size = wpa_s->wps_fragment_size;
1132 eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
1133 wpa_s, NULL);
1134 wpa_s->wps_ap_iter = 1;
1135 wpas_wps_reassoc(wpa_s, ssid, bssid, freq);
1136 return rpin;
1137 }
1138
1139
wpas_wps_start_pin(struct wpa_supplicant * wpa_s,const u8 * bssid,const char * pin,int p2p_group,u16 dev_pw_id)1140 int wpas_wps_start_pin(struct wpa_supplicant *wpa_s, const u8 *bssid,
1141 const char *pin, int p2p_group, u16 dev_pw_id)
1142 {
1143 return wpas_wps_start_dev_pw(wpa_s, NULL, bssid, pin, p2p_group,
1144 dev_pw_id, NULL, NULL, 0, 0);
1145 }
1146
1147
1148 /* Cancel the wps pbc/pin requests */
wpas_wps_cancel(struct wpa_supplicant * wpa_s)1149 int wpas_wps_cancel(struct wpa_supplicant *wpa_s)
1150 {
1151 #ifdef CONFIG_AP
1152 if (wpa_s->ap_iface) {
1153 wpa_printf(MSG_DEBUG, "WPS: Cancelling in AP mode");
1154 return wpa_supplicant_ap_wps_cancel(wpa_s);
1155 }
1156 #endif /* CONFIG_AP */
1157
1158 if (wpa_s->wpa_state == WPA_SCANNING ||
1159 wpa_s->wpa_state == WPA_DISCONNECTED) {
1160 wpa_printf(MSG_DEBUG, "WPS: Cancel operation - cancel scan");
1161 wpa_supplicant_cancel_scan(wpa_s);
1162 wpas_clear_wps(wpa_s);
1163 } else if (wpa_s->wpa_state >= WPA_ASSOCIATED) {
1164 wpa_printf(MSG_DEBUG, "WPS: Cancel operation - "
1165 "deauthenticate");
1166 wpa_supplicant_deauthenticate(wpa_s,
1167 WLAN_REASON_DEAUTH_LEAVING);
1168 wpas_clear_wps(wpa_s);
1169 } else {
1170 wpas_wps_reenable_networks(wpa_s);
1171 wpas_wps_clear_ap_info(wpa_s);
1172 if (eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL) >
1173 0)
1174 wpas_clear_wps(wpa_s);
1175 }
1176
1177 wpa_s->after_wps = 0;
1178
1179 return 0;
1180 }
1181
1182
wpas_wps_start_reg(struct wpa_supplicant * wpa_s,const u8 * bssid,const char * pin,struct wps_new_ap_settings * settings)1183 int wpas_wps_start_reg(struct wpa_supplicant *wpa_s, const u8 *bssid,
1184 const char *pin, struct wps_new_ap_settings *settings)
1185 {
1186 struct wpa_ssid *ssid;
1187 char val[200];
1188 char *pos, *end;
1189 int res;
1190
1191 if (!pin)
1192 return -1;
1193 wpas_clear_wps(wpa_s);
1194 ssid = wpas_wps_add_network(wpa_s, 1, NULL, bssid);
1195 if (ssid == NULL)
1196 return -1;
1197 ssid->temporary = 1;
1198 pos = val;
1199 end = pos + sizeof(val);
1200 res = os_snprintf(pos, end - pos, "\"pin=%s", pin);
1201 if (res < 0 || res >= end - pos)
1202 return -1;
1203 pos += res;
1204 if (settings) {
1205 res = os_snprintf(pos, end - pos, " new_ssid=%s new_auth=%s "
1206 "new_encr=%s new_key=%s",
1207 settings->ssid_hex, settings->auth,
1208 settings->encr, settings->key_hex);
1209 if (res < 0 || res >= end - pos)
1210 return -1;
1211 pos += res;
1212 }
1213 res = os_snprintf(pos, end - pos, "\"");
1214 if (res < 0 || res >= end - pos)
1215 return -1;
1216 if (wpa_config_set(ssid, "phase1", val, 0) < 0)
1217 return -1;
1218 if (wpa_s->wps_fragment_size)
1219 ssid->eap.fragment_size = wpa_s->wps_fragment_size;
1220 eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
1221 wpa_s, NULL);
1222 wpas_wps_reassoc(wpa_s, ssid, bssid, 0);
1223 return 0;
1224 }
1225
1226
wpas_wps_new_psk_cb(void * ctx,const u8 * mac_addr,const u8 * p2p_dev_addr,const u8 * psk,size_t psk_len)1227 static int wpas_wps_new_psk_cb(void *ctx, const u8 *mac_addr,
1228 const u8 *p2p_dev_addr, const u8 *psk,
1229 size_t psk_len)
1230 {
1231 if (is_zero_ether_addr(p2p_dev_addr)) {
1232 wpa_printf(MSG_DEBUG,
1233 "Received new WPA/WPA2-PSK from WPS for STA " MACSTR,
1234 MAC2STR(mac_addr));
1235 } else {
1236 wpa_printf(MSG_DEBUG,
1237 "Received new WPA/WPA2-PSK from WPS for STA " MACSTR
1238 " P2P Device Addr " MACSTR,
1239 MAC2STR(mac_addr), MAC2STR(p2p_dev_addr));
1240 }
1241 wpa_hexdump_key(MSG_DEBUG, "Per-device PSK", psk, psk_len);
1242
1243 /* TODO */
1244
1245 return 0;
1246 }
1247
1248
wpas_wps_pin_needed_cb(void * ctx,const u8 * uuid_e,const struct wps_device_data * dev)1249 static void wpas_wps_pin_needed_cb(void *ctx, const u8 *uuid_e,
1250 const struct wps_device_data *dev)
1251 {
1252 char uuid[40], txt[400];
1253 int len;
1254 char devtype[WPS_DEV_TYPE_BUFSIZE];
1255 if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
1256 return;
1257 wpa_printf(MSG_DEBUG, "WPS: PIN needed for UUID-E %s", uuid);
1258 len = os_snprintf(txt, sizeof(txt), "WPS-EVENT-PIN-NEEDED %s " MACSTR
1259 " [%s|%s|%s|%s|%s|%s]",
1260 uuid, MAC2STR(dev->mac_addr), dev->device_name,
1261 dev->manufacturer, dev->model_name,
1262 dev->model_number, dev->serial_number,
1263 wps_dev_type_bin2str(dev->pri_dev_type, devtype,
1264 sizeof(devtype)));
1265 if (len > 0 && len < (int) sizeof(txt))
1266 wpa_printf(MSG_INFO, "%s", txt);
1267 }
1268
1269
wpas_wps_set_sel_reg_cb(void * ctx,int sel_reg,u16 dev_passwd_id,u16 sel_reg_config_methods)1270 static void wpas_wps_set_sel_reg_cb(void *ctx, int sel_reg, u16 dev_passwd_id,
1271 u16 sel_reg_config_methods)
1272 {
1273 #ifdef CONFIG_WPS_ER
1274 struct wpa_supplicant *wpa_s = ctx;
1275
1276 if (wpa_s->wps_er == NULL)
1277 return;
1278 wpa_printf(MSG_DEBUG, "WPS ER: SetSelectedRegistrar - sel_reg=%d "
1279 "dev_password_id=%u sel_reg_config_methods=0x%x",
1280 sel_reg, dev_passwd_id, sel_reg_config_methods);
1281 wps_er_set_sel_reg(wpa_s->wps_er, sel_reg, dev_passwd_id,
1282 sel_reg_config_methods);
1283 #endif /* CONFIG_WPS_ER */
1284 }
1285
1286
wps_fix_config_methods(u16 config_methods)1287 static u16 wps_fix_config_methods(u16 config_methods)
1288 {
1289 if ((config_methods &
1290 (WPS_CONFIG_DISPLAY | WPS_CONFIG_VIRT_DISPLAY |
1291 WPS_CONFIG_PHY_DISPLAY)) == WPS_CONFIG_DISPLAY) {
1292 wpa_printf(MSG_INFO, "WPS: Converting display to "
1293 "virtual_display for WPS 2.0 compliance");
1294 config_methods |= WPS_CONFIG_VIRT_DISPLAY;
1295 }
1296 if ((config_methods &
1297 (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_VIRT_PUSHBUTTON |
1298 WPS_CONFIG_PHY_PUSHBUTTON)) == WPS_CONFIG_PUSHBUTTON) {
1299 wpa_printf(MSG_INFO, "WPS: Converting push_button to "
1300 "virtual_push_button for WPS 2.0 compliance");
1301 config_methods |= WPS_CONFIG_VIRT_PUSHBUTTON;
1302 }
1303
1304 return config_methods;
1305 }
1306
1307
wpas_wps_set_uuid(struct wpa_supplicant * wpa_s,struct wps_context * wps)1308 static void wpas_wps_set_uuid(struct wpa_supplicant *wpa_s,
1309 struct wps_context *wps)
1310 {
1311 char buf[50];
1312 const char *src;
1313
1314 if (is_nil_uuid(wpa_s->conf->uuid)) {
1315 struct wpa_supplicant *first;
1316 first = wpa_s->global->ifaces;
1317 while (first && first->next)
1318 first = first->next;
1319 if (first && first != wpa_s) {
1320 if (wps != wpa_s->global->ifaces->wps)
1321 os_memcpy(wps->uuid,
1322 wpa_s->global->ifaces->wps->uuid,
1323 WPS_UUID_LEN);
1324 src = "from the first interface";
1325 } else {
1326 uuid_gen_mac_addr(wpa_s->own_addr, wps->uuid);
1327 src = "based on MAC address";
1328 }
1329 } else {
1330 os_memcpy(wps->uuid, wpa_s->conf->uuid, WPS_UUID_LEN);
1331 src = "based on configuration";
1332 }
1333
1334 uuid_bin2str(wps->uuid, buf, sizeof(buf));
1335 wpa_dbg(wpa_s, MSG_DEBUG, "WPS: UUID %s: %s", src, buf);
1336 }
1337
1338
wpas_wps_set_vendor_ext_m1(struct wpa_supplicant * wpa_s,struct wps_context * wps)1339 static void wpas_wps_set_vendor_ext_m1(struct wpa_supplicant *wpa_s,
1340 struct wps_context *wps)
1341 {
1342 wpabuf_free(wps->dev.vendor_ext_m1);
1343 wps->dev.vendor_ext_m1 = NULL;
1344
1345 if (wpa_s->conf->wps_vendor_ext_m1) {
1346 wps->dev.vendor_ext_m1 =
1347 wpabuf_dup(wpa_s->conf->wps_vendor_ext_m1);
1348 if (!wps->dev.vendor_ext_m1) {
1349 wpa_printf(MSG_ERROR, "WPS: Cannot "
1350 "allocate memory for vendor_ext_m1");
1351 }
1352 }
1353 }
1354
1355
wpas_wps_init(struct wpa_supplicant * wpa_s)1356 int wpas_wps_init(struct wpa_supplicant *wpa_s)
1357 {
1358 struct wps_context *wps;
1359 struct wps_registrar_config rcfg;
1360 struct hostapd_hw_modes *modes;
1361 u16 m;
1362
1363 wps = os_zalloc(sizeof(*wps));
1364 if (wps == NULL)
1365 return -1;
1366
1367 wps->cred_cb = wpa_supplicant_wps_cred;
1368 wps->event_cb = wpa_supplicant_wps_event;
1369 wps->rf_band_cb = wpa_supplicant_wps_rf_band;
1370 wps->cb_ctx = wpa_s;
1371
1372 wps->dev.device_name = wpa_s->conf->device_name;
1373 wps->dev.manufacturer = wpa_s->conf->manufacturer;
1374 wps->dev.model_name = wpa_s->conf->model_name;
1375 wps->dev.model_number = wpa_s->conf->model_number;
1376 wps->dev.serial_number = wpa_s->conf->serial_number;
1377 wps->config_methods =
1378 wps_config_methods_str2bin(wpa_s->conf->config_methods);
1379 if ((wps->config_methods & (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
1380 (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
1381 wpa_printf(MSG_ERROR, "WPS: Both Label and Display config "
1382 "methods are not allowed at the same time");
1383 os_free(wps);
1384 return -1;
1385 }
1386 wps->config_methods = wps_fix_config_methods(wps->config_methods);
1387 wps->dev.config_methods = wps->config_methods;
1388 os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
1389 WPS_DEV_TYPE_LEN);
1390
1391 wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
1392 os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
1393 WPS_DEV_TYPE_LEN * wps->dev.num_sec_dev_types);
1394
1395 wpas_wps_set_vendor_ext_m1(wpa_s, wps);
1396
1397 wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
1398 modes = wpa_s->hw.modes;
1399 if (modes) {
1400 for (m = 0; m < wpa_s->hw.num_modes; m++) {
1401 if (modes[m].mode == HOSTAPD_MODE_IEEE80211B ||
1402 modes[m].mode == HOSTAPD_MODE_IEEE80211G)
1403 wps->dev.rf_bands |= WPS_RF_24GHZ;
1404 else if (modes[m].mode == HOSTAPD_MODE_IEEE80211A)
1405 wps->dev.rf_bands |= WPS_RF_50GHZ;
1406 }
1407 }
1408 if (wps->dev.rf_bands == 0) {
1409 /*
1410 * Default to claiming support for both bands if the driver
1411 * does not provide support for fetching supported bands.
1412 */
1413 wps->dev.rf_bands = WPS_RF_24GHZ | WPS_RF_50GHZ;
1414 }
1415 os_memcpy(wps->dev.mac_addr, wpa_s->own_addr, ETH_ALEN);
1416 wpas_wps_set_uuid(wpa_s, wps);
1417
1418 wps->auth_types = WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK;
1419 wps->encr_types = WPS_ENCR_AES | WPS_ENCR_TKIP;
1420
1421 os_memset(&rcfg, 0, sizeof(rcfg));
1422 rcfg.new_psk_cb = wpas_wps_new_psk_cb;
1423 rcfg.pin_needed_cb = wpas_wps_pin_needed_cb;
1424 rcfg.set_sel_reg_cb = wpas_wps_set_sel_reg_cb;
1425 rcfg.cb_ctx = wpa_s;
1426
1427 wps->registrar = wps_registrar_init(wps, &rcfg);
1428 if (wps->registrar == NULL) {
1429 wpa_printf(MSG_DEBUG, "Failed to initialize WPS Registrar");
1430 os_free(wps);
1431 return -1;
1432 }
1433
1434 wpa_s->wps = wps;
1435
1436 return 0;
1437 }
1438
1439
1440 #ifdef CONFIG_WPS_ER
wpas_wps_nfc_clear(struct wps_context * wps)1441 static void wpas_wps_nfc_clear(struct wps_context *wps)
1442 {
1443 wps->ap_nfc_dev_pw_id = 0;
1444 wpabuf_free(wps->ap_nfc_dh_pubkey);
1445 wps->ap_nfc_dh_pubkey = NULL;
1446 wpabuf_free(wps->ap_nfc_dh_privkey);
1447 wps->ap_nfc_dh_privkey = NULL;
1448 wpabuf_free(wps->ap_nfc_dev_pw);
1449 wps->ap_nfc_dev_pw = NULL;
1450 }
1451 #endif /* CONFIG_WPS_ER */
1452
1453
wpas_wps_deinit(struct wpa_supplicant * wpa_s)1454 void wpas_wps_deinit(struct wpa_supplicant *wpa_s)
1455 {
1456 wpas_wps_assoc_with_cred_cancel(wpa_s);
1457 eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
1458 eloop_cancel_timeout(wpas_wps_clear_timeout, wpa_s, NULL);
1459 eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
1460 wpas_wps_clear_ap_info(wpa_s);
1461
1462 #ifdef CONFIG_P2P
1463 eloop_cancel_timeout(wpas_p2p_pbc_overlap_cb, wpa_s, NULL);
1464 #endif /* CONFIG_P2P */
1465
1466 if (wpa_s->wps == NULL)
1467 return;
1468
1469 #ifdef CONFIG_WPS_ER
1470 wps_er_deinit(wpa_s->wps_er, NULL, NULL);
1471 wpa_s->wps_er = NULL;
1472 wpas_wps_nfc_clear(wpa_s->wps);
1473 #endif /* CONFIG_WPS_ER */
1474
1475 wps_registrar_deinit(wpa_s->wps->registrar);
1476 wpabuf_free(wpa_s->wps->dh_pubkey);
1477 wpabuf_free(wpa_s->wps->dh_privkey);
1478 wpabuf_free(wpa_s->wps->dev.vendor_ext_m1);
1479 os_free(wpa_s->wps->network_key);
1480 os_free(wpa_s->wps);
1481 wpa_s->wps = NULL;
1482 }
1483
1484
wpas_wps_ssid_bss_match(struct wpa_supplicant * wpa_s,struct wpa_ssid * ssid,struct wpa_bss * bss)1485 int wpas_wps_ssid_bss_match(struct wpa_supplicant *wpa_s,
1486 struct wpa_ssid *ssid, struct wpa_bss *bss)
1487 {
1488 struct wpabuf *wps_ie;
1489
1490 if (!(ssid->key_mgmt & WPA_KEY_MGMT_WPS))
1491 return -1;
1492
1493 wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1494 if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
1495 if (!wps_ie) {
1496 wpa_printf(MSG_DEBUG, " skip - non-WPS AP");
1497 return 0;
1498 }
1499
1500 if (!wps_is_selected_pbc_registrar(wps_ie)) {
1501 wpa_printf(MSG_DEBUG, " skip - WPS AP "
1502 "without active PBC Registrar");
1503 wpabuf_free(wps_ie);
1504 return 0;
1505 }
1506
1507 /* TODO: overlap detection */
1508 wpa_printf(MSG_DEBUG, " selected based on WPS IE "
1509 "(Active PBC)");
1510 wpabuf_free(wps_ie);
1511 return 1;
1512 }
1513
1514 if (eap_is_wps_pin_enrollee(&ssid->eap)) {
1515 if (!wps_ie) {
1516 wpa_printf(MSG_DEBUG, " skip - non-WPS AP");
1517 return 0;
1518 }
1519
1520 /*
1521 * Start with WPS APs that advertise our address as an
1522 * authorized MAC (v2.0) or active PIN Registrar (v1.0) and
1523 * allow any WPS AP after couple of scans since some APs do not
1524 * set Selected Registrar attribute properly when using
1525 * external Registrar.
1526 */
1527 if (!wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1)) {
1528 if (wpa_s->scan_runs < WPS_PIN_SCAN_IGNORE_SEL_REG) {
1529 wpa_printf(MSG_DEBUG, " skip - WPS AP "
1530 "without active PIN Registrar");
1531 wpabuf_free(wps_ie);
1532 return 0;
1533 }
1534 wpa_printf(MSG_DEBUG, " selected based on WPS IE");
1535 } else {
1536 wpa_printf(MSG_DEBUG, " selected based on WPS IE "
1537 "(Authorized MAC or Active PIN)");
1538 }
1539 wpabuf_free(wps_ie);
1540 return 1;
1541 }
1542
1543 if (wps_ie) {
1544 wpa_printf(MSG_DEBUG, " selected based on WPS IE");
1545 wpabuf_free(wps_ie);
1546 return 1;
1547 }
1548
1549 return -1;
1550 }
1551
1552
wpas_wps_ssid_wildcard_ok(struct wpa_supplicant * wpa_s,struct wpa_ssid * ssid,struct wpa_bss * bss)1553 int wpas_wps_ssid_wildcard_ok(struct wpa_supplicant *wpa_s,
1554 struct wpa_ssid *ssid,
1555 struct wpa_bss *bss)
1556 {
1557 struct wpabuf *wps_ie = NULL;
1558 int ret = 0;
1559
1560 if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
1561 wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1562 if (wps_ie && wps_is_selected_pbc_registrar(wps_ie)) {
1563 /* allow wildcard SSID for WPS PBC */
1564 ret = 1;
1565 }
1566 } else if (eap_is_wps_pin_enrollee(&ssid->eap)) {
1567 wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1568 if (wps_ie &&
1569 (wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1) ||
1570 wpa_s->scan_runs >= WPS_PIN_SCAN_IGNORE_SEL_REG)) {
1571 /* allow wildcard SSID for WPS PIN */
1572 ret = 1;
1573 }
1574 }
1575
1576 if (!ret && ssid->bssid_set &&
1577 os_memcmp(ssid->bssid, bss->bssid, ETH_ALEN) == 0) {
1578 /* allow wildcard SSID due to hardcoded BSSID match */
1579 ret = 1;
1580 }
1581
1582 #ifdef CONFIG_WPS_STRICT
1583 if (wps_ie) {
1584 if (wps_validate_beacon_probe_resp(wps_ie, bss->beacon_ie_len >
1585 0, bss->bssid) < 0)
1586 ret = 0;
1587 if (bss->beacon_ie_len) {
1588 struct wpabuf *bcn_wps;
1589 bcn_wps = wpa_bss_get_vendor_ie_multi_beacon(
1590 bss, WPS_IE_VENDOR_TYPE);
1591 if (bcn_wps == NULL) {
1592 wpa_printf(MSG_DEBUG, "WPS: Mandatory WPS IE "
1593 "missing from AP Beacon");
1594 ret = 0;
1595 } else {
1596 if (wps_validate_beacon(wps_ie) < 0)
1597 ret = 0;
1598 wpabuf_free(bcn_wps);
1599 }
1600 }
1601 }
1602 #endif /* CONFIG_WPS_STRICT */
1603
1604 wpabuf_free(wps_ie);
1605
1606 return ret;
1607 }
1608
1609
wpas_wps_scan_pbc_overlap(struct wpa_supplicant * wpa_s,struct wpa_bss * selected,struct wpa_ssid * ssid)1610 int wpas_wps_scan_pbc_overlap(struct wpa_supplicant *wpa_s,
1611 struct wpa_bss *selected, struct wpa_ssid *ssid)
1612 {
1613 const u8 *sel_uuid, *uuid;
1614 struct wpabuf *wps_ie;
1615 int ret = 0;
1616 struct wpa_bss *bss;
1617
1618 if (!eap_is_wps_pbc_enrollee(&ssid->eap))
1619 return 0;
1620
1621 wpa_printf(MSG_DEBUG, "WPS: Check whether PBC session overlap is "
1622 "present in scan results; selected BSSID " MACSTR,
1623 MAC2STR(selected->bssid));
1624
1625 /* Make sure that only one AP is in active PBC mode */
1626 wps_ie = wpa_bss_get_vendor_ie_multi(selected, WPS_IE_VENDOR_TYPE);
1627 if (wps_ie) {
1628 sel_uuid = wps_get_uuid_e(wps_ie);
1629 wpa_hexdump(MSG_DEBUG, "WPS: UUID of the selected BSS",
1630 sel_uuid, UUID_LEN);
1631 } else {
1632 wpa_printf(MSG_DEBUG, "WPS: Selected BSS does not include "
1633 "WPS IE?!");
1634 sel_uuid = NULL;
1635 }
1636
1637 dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
1638 struct wpabuf *ie;
1639 if (bss == selected)
1640 continue;
1641 ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1642 if (!ie)
1643 continue;
1644 if (!wps_is_selected_pbc_registrar(ie)) {
1645 wpabuf_free(ie);
1646 continue;
1647 }
1648 wpa_printf(MSG_DEBUG, "WPS: Another BSS in active PBC mode: "
1649 MACSTR, MAC2STR(bss->bssid));
1650 uuid = wps_get_uuid_e(ie);
1651 wpa_hexdump(MSG_DEBUG, "WPS: UUID of the other BSS",
1652 uuid, UUID_LEN);
1653 if (sel_uuid == NULL || uuid == NULL ||
1654 os_memcmp(sel_uuid, uuid, UUID_LEN) != 0) {
1655 ret = 1; /* PBC overlap */
1656 wpa_msg(wpa_s, MSG_INFO, "WPS: PBC overlap detected: "
1657 MACSTR " and " MACSTR,
1658 MAC2STR(selected->bssid),
1659 MAC2STR(bss->bssid));
1660 wpabuf_free(ie);
1661 break;
1662 }
1663
1664 /* TODO: verify that this is reasonable dual-band situation */
1665
1666 wpabuf_free(ie);
1667 }
1668
1669 wpabuf_free(wps_ie);
1670
1671 return ret;
1672 }
1673
1674
wpas_wps_notify_scan_results(struct wpa_supplicant * wpa_s)1675 void wpas_wps_notify_scan_results(struct wpa_supplicant *wpa_s)
1676 {
1677 struct wpa_bss *bss;
1678 unsigned int pbc = 0, auth = 0, pin = 0, wps = 0;
1679
1680 if (wpa_s->disconnected || wpa_s->wpa_state >= WPA_ASSOCIATED)
1681 return;
1682
1683 dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
1684 struct wpabuf *ie;
1685 ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1686 if (!ie)
1687 continue;
1688 if (wps_is_selected_pbc_registrar(ie))
1689 pbc++;
1690 else if (wps_is_addr_authorized(ie, wpa_s->own_addr, 0))
1691 auth++;
1692 else if (wps_is_selected_pin_registrar(ie))
1693 pin++;
1694 else
1695 wps++;
1696 wpabuf_free(ie);
1697 }
1698
1699 if (pbc)
1700 wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PBC);
1701 else if (auth)
1702 wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_AUTH);
1703 else if (pin)
1704 wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PIN);
1705 else if (wps)
1706 wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE);
1707 }
1708
1709
wpas_wps_searching(struct wpa_supplicant * wpa_s)1710 int wpas_wps_searching(struct wpa_supplicant *wpa_s)
1711 {
1712 struct wpa_ssid *ssid;
1713
1714 for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
1715 if ((ssid->key_mgmt & WPA_KEY_MGMT_WPS) && !ssid->disabled)
1716 return 1;
1717 }
1718
1719 return 0;
1720 }
1721
1722
wpas_wps_scan_result_text(const u8 * ies,size_t ies_len,char * buf,char * end)1723 int wpas_wps_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
1724 char *end)
1725 {
1726 struct wpabuf *wps_ie;
1727 int ret;
1728
1729 wps_ie = ieee802_11_vendor_ie_concat(ies, ies_len, WPS_DEV_OUI_WFA);
1730 if (wps_ie == NULL)
1731 return 0;
1732
1733 ret = wps_attr_text(wps_ie, buf, end);
1734 wpabuf_free(wps_ie);
1735 return ret;
1736 }
1737
1738
wpas_wps_er_start(struct wpa_supplicant * wpa_s,const char * filter)1739 int wpas_wps_er_start(struct wpa_supplicant *wpa_s, const char *filter)
1740 {
1741 #ifdef CONFIG_WPS_ER
1742 if (wpa_s->wps_er) {
1743 wps_er_refresh(wpa_s->wps_er);
1744 return 0;
1745 }
1746 wpa_s->wps_er = wps_er_init(wpa_s->wps, wpa_s->ifname, filter);
1747 if (wpa_s->wps_er == NULL)
1748 return -1;
1749 return 0;
1750 #else /* CONFIG_WPS_ER */
1751 return 0;
1752 #endif /* CONFIG_WPS_ER */
1753 }
1754
1755
wpas_wps_er_stop(struct wpa_supplicant * wpa_s)1756 int wpas_wps_er_stop(struct wpa_supplicant *wpa_s)
1757 {
1758 #ifdef CONFIG_WPS_ER
1759 wps_er_deinit(wpa_s->wps_er, NULL, NULL);
1760 wpa_s->wps_er = NULL;
1761 #endif /* CONFIG_WPS_ER */
1762 return 0;
1763 }
1764
1765
1766 #ifdef CONFIG_WPS_ER
wpas_wps_er_add_pin(struct wpa_supplicant * wpa_s,const u8 * addr,const char * uuid,const char * pin)1767 int wpas_wps_er_add_pin(struct wpa_supplicant *wpa_s, const u8 *addr,
1768 const char *uuid, const char *pin)
1769 {
1770 u8 u[UUID_LEN];
1771 const u8 *use_uuid = NULL;
1772 u8 addr_buf[ETH_ALEN];
1773
1774 if (os_strcmp(uuid, "any") == 0) {
1775 } else if (uuid_str2bin(uuid, u) == 0) {
1776 use_uuid = u;
1777 } else if (hwaddr_aton(uuid, addr_buf) == 0) {
1778 use_uuid = wps_er_get_sta_uuid(wpa_s->wps_er, addr_buf);
1779 if (use_uuid == NULL)
1780 return -1;
1781 } else
1782 return -1;
1783 return wps_registrar_add_pin(wpa_s->wps->registrar, addr,
1784 use_uuid,
1785 (const u8 *) pin, os_strlen(pin), 300);
1786 }
1787
1788
wpas_wps_er_pbc(struct wpa_supplicant * wpa_s,const char * uuid)1789 int wpas_wps_er_pbc(struct wpa_supplicant *wpa_s, const char *uuid)
1790 {
1791 u8 u[UUID_LEN], *use_uuid = NULL;
1792 u8 addr[ETH_ALEN], *use_addr = NULL;
1793
1794 if (uuid_str2bin(uuid, u) == 0)
1795 use_uuid = u;
1796 else if (hwaddr_aton(uuid, addr) == 0)
1797 use_addr = addr;
1798 else
1799 return -1;
1800 return wps_er_pbc(wpa_s->wps_er, use_uuid, use_addr);
1801 }
1802
1803
wpas_wps_er_learn(struct wpa_supplicant * wpa_s,const char * uuid,const char * pin)1804 int wpas_wps_er_learn(struct wpa_supplicant *wpa_s, const char *uuid,
1805 const char *pin)
1806 {
1807 u8 u[UUID_LEN], *use_uuid = NULL;
1808 u8 addr[ETH_ALEN], *use_addr = NULL;
1809
1810 if (uuid_str2bin(uuid, u) == 0)
1811 use_uuid = u;
1812 else if (hwaddr_aton(uuid, addr) == 0)
1813 use_addr = addr;
1814 else
1815 return -1;
1816
1817 return wps_er_learn(wpa_s->wps_er, use_uuid, use_addr, (const u8 *) pin,
1818 os_strlen(pin));
1819 }
1820
1821
wpas_wps_network_to_cred(struct wpa_ssid * ssid,struct wps_credential * cred)1822 static int wpas_wps_network_to_cred(struct wpa_ssid *ssid,
1823 struct wps_credential *cred)
1824 {
1825 os_memset(cred, 0, sizeof(*cred));
1826 if (ssid->ssid_len > 32)
1827 return -1;
1828 os_memcpy(cred->ssid, ssid->ssid, ssid->ssid_len);
1829 cred->ssid_len = ssid->ssid_len;
1830 if (ssid->key_mgmt & WPA_KEY_MGMT_PSK) {
1831 cred->auth_type = (ssid->proto & WPA_PROTO_RSN) ?
1832 WPS_AUTH_WPA2PSK : WPS_AUTH_WPAPSK;
1833 if (ssid->pairwise_cipher & WPA_CIPHER_CCMP)
1834 cred->encr_type = WPS_ENCR_AES;
1835 else
1836 cred->encr_type = WPS_ENCR_TKIP;
1837 if (ssid->passphrase) {
1838 cred->key_len = os_strlen(ssid->passphrase);
1839 if (cred->key_len >= 64)
1840 return -1;
1841 os_memcpy(cred->key, ssid->passphrase, cred->key_len);
1842 } else if (ssid->psk_set) {
1843 cred->key_len = 32;
1844 os_memcpy(cred->key, ssid->psk, 32);
1845 } else
1846 return -1;
1847 } else {
1848 cred->auth_type = WPS_AUTH_OPEN;
1849 cred->encr_type = WPS_ENCR_NONE;
1850 }
1851
1852 return 0;
1853 }
1854
1855
wpas_wps_er_set_config(struct wpa_supplicant * wpa_s,const char * uuid,int id)1856 int wpas_wps_er_set_config(struct wpa_supplicant *wpa_s, const char *uuid,
1857 int id)
1858 {
1859 u8 u[UUID_LEN], *use_uuid = NULL;
1860 u8 addr[ETH_ALEN], *use_addr = NULL;
1861 struct wpa_ssid *ssid;
1862 struct wps_credential cred;
1863
1864 if (uuid_str2bin(uuid, u) == 0)
1865 use_uuid = u;
1866 else if (hwaddr_aton(uuid, addr) == 0)
1867 use_addr = addr;
1868 else
1869 return -1;
1870 ssid = wpa_config_get_network(wpa_s->conf, id);
1871 if (ssid == NULL || ssid->ssid == NULL)
1872 return -1;
1873
1874 if (wpas_wps_network_to_cred(ssid, &cred) < 0)
1875 return -1;
1876 return wps_er_set_config(wpa_s->wps_er, use_uuid, use_addr, &cred);
1877 }
1878
1879
wpas_wps_er_config(struct wpa_supplicant * wpa_s,const char * uuid,const char * pin,struct wps_new_ap_settings * settings)1880 int wpas_wps_er_config(struct wpa_supplicant *wpa_s, const char *uuid,
1881 const char *pin, struct wps_new_ap_settings *settings)
1882 {
1883 u8 u[UUID_LEN], *use_uuid = NULL;
1884 u8 addr[ETH_ALEN], *use_addr = NULL;
1885 struct wps_credential cred;
1886 size_t len;
1887
1888 if (uuid_str2bin(uuid, u) == 0)
1889 use_uuid = u;
1890 else if (hwaddr_aton(uuid, addr) == 0)
1891 use_addr = addr;
1892 else
1893 return -1;
1894 if (settings->ssid_hex == NULL || settings->auth == NULL ||
1895 settings->encr == NULL || settings->key_hex == NULL)
1896 return -1;
1897
1898 os_memset(&cred, 0, sizeof(cred));
1899 len = os_strlen(settings->ssid_hex);
1900 if ((len & 1) || len > 2 * sizeof(cred.ssid) ||
1901 hexstr2bin(settings->ssid_hex, cred.ssid, len / 2))
1902 return -1;
1903 cred.ssid_len = len / 2;
1904
1905 len = os_strlen(settings->key_hex);
1906 if ((len & 1) || len > 2 * sizeof(cred.key) ||
1907 hexstr2bin(settings->key_hex, cred.key, len / 2))
1908 return -1;
1909 cred.key_len = len / 2;
1910
1911 if (os_strcmp(settings->auth, "OPEN") == 0)
1912 cred.auth_type = WPS_AUTH_OPEN;
1913 else if (os_strcmp(settings->auth, "WPAPSK") == 0)
1914 cred.auth_type = WPS_AUTH_WPAPSK;
1915 else if (os_strcmp(settings->auth, "WPA2PSK") == 0)
1916 cred.auth_type = WPS_AUTH_WPA2PSK;
1917 else
1918 return -1;
1919
1920 if (os_strcmp(settings->encr, "NONE") == 0)
1921 cred.encr_type = WPS_ENCR_NONE;
1922 #ifdef CONFIG_TESTING_OPTIONS
1923 else if (os_strcmp(settings->encr, "WEP") == 0)
1924 cred.encr_type = WPS_ENCR_WEP;
1925 #endif /* CONFIG_TESTING_OPTIONS */
1926 else if (os_strcmp(settings->encr, "TKIP") == 0)
1927 cred.encr_type = WPS_ENCR_TKIP;
1928 else if (os_strcmp(settings->encr, "CCMP") == 0)
1929 cred.encr_type = WPS_ENCR_AES;
1930 else
1931 return -1;
1932
1933 return wps_er_config(wpa_s->wps_er, use_uuid, use_addr,
1934 (const u8 *) pin, os_strlen(pin), &cred);
1935 }
1936
1937
1938 #ifdef CONFIG_WPS_NFC
wpas_wps_er_nfc_config_token(struct wpa_supplicant * wpa_s,int ndef,const char * uuid)1939 struct wpabuf * wpas_wps_er_nfc_config_token(struct wpa_supplicant *wpa_s,
1940 int ndef, const char *uuid)
1941 {
1942 struct wpabuf *ret;
1943 u8 u[UUID_LEN], *use_uuid = NULL;
1944 u8 addr[ETH_ALEN], *use_addr = NULL;
1945
1946 if (!wpa_s->wps_er)
1947 return NULL;
1948
1949 if (uuid_str2bin(uuid, u) == 0)
1950 use_uuid = u;
1951 else if (hwaddr_aton(uuid, addr) == 0)
1952 use_addr = addr;
1953 else
1954 return NULL;
1955
1956 ret = wps_er_nfc_config_token(wpa_s->wps_er, use_uuid, use_addr);
1957 if (ndef && ret) {
1958 struct wpabuf *tmp;
1959 tmp = ndef_build_wifi(ret);
1960 wpabuf_free(ret);
1961 if (tmp == NULL)
1962 return NULL;
1963 ret = tmp;
1964 }
1965
1966 return ret;
1967 }
1968 #endif /* CONFIG_WPS_NFC */
1969
1970
1971 static int callbacks_pending = 0;
1972
wpas_wps_terminate_cb(void * ctx)1973 static void wpas_wps_terminate_cb(void *ctx)
1974 {
1975 wpa_printf(MSG_DEBUG, "WPS ER: Terminated");
1976 if (--callbacks_pending <= 0)
1977 eloop_terminate();
1978 }
1979 #endif /* CONFIG_WPS_ER */
1980
1981
wpas_wps_terminate_pending(struct wpa_supplicant * wpa_s)1982 int wpas_wps_terminate_pending(struct wpa_supplicant *wpa_s)
1983 {
1984 #ifdef CONFIG_WPS_ER
1985 if (wpa_s->wps_er) {
1986 callbacks_pending++;
1987 wps_er_deinit(wpa_s->wps_er, wpas_wps_terminate_cb, wpa_s);
1988 wpa_s->wps_er = NULL;
1989 return 1;
1990 }
1991 #endif /* CONFIG_WPS_ER */
1992 return 0;
1993 }
1994
1995
wpas_wps_update_config(struct wpa_supplicant * wpa_s)1996 void wpas_wps_update_config(struct wpa_supplicant *wpa_s)
1997 {
1998 struct wps_context *wps = wpa_s->wps;
1999
2000 if (wps == NULL)
2001 return;
2002
2003 if (wpa_s->conf->changed_parameters & CFG_CHANGED_CONFIG_METHODS) {
2004 wps->config_methods = wps_config_methods_str2bin(
2005 wpa_s->conf->config_methods);
2006 if ((wps->config_methods &
2007 (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
2008 (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
2009 wpa_printf(MSG_ERROR, "WPS: Both Label and Display "
2010 "config methods are not allowed at the "
2011 "same time");
2012 wps->config_methods &= ~WPS_CONFIG_LABEL;
2013 }
2014 }
2015 wps->config_methods = wps_fix_config_methods(wps->config_methods);
2016 wps->dev.config_methods = wps->config_methods;
2017
2018 if (wpa_s->conf->changed_parameters & CFG_CHANGED_DEVICE_TYPE)
2019 os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
2020 WPS_DEV_TYPE_LEN);
2021
2022 if (wpa_s->conf->changed_parameters & CFG_CHANGED_SEC_DEVICE_TYPE) {
2023 wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
2024 os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
2025 wps->dev.num_sec_dev_types * WPS_DEV_TYPE_LEN);
2026 }
2027
2028 if (wpa_s->conf->changed_parameters & CFG_CHANGED_VENDOR_EXTENSION)
2029 wpas_wps_set_vendor_ext_m1(wpa_s, wps);
2030
2031 if (wpa_s->conf->changed_parameters & CFG_CHANGED_OS_VERSION)
2032 wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
2033
2034 if (wpa_s->conf->changed_parameters & CFG_CHANGED_UUID)
2035 wpas_wps_set_uuid(wpa_s, wps);
2036
2037 if (wpa_s->conf->changed_parameters &
2038 (CFG_CHANGED_DEVICE_NAME | CFG_CHANGED_WPS_STRING)) {
2039 /* Update pointers to make sure they refer current values */
2040 wps->dev.device_name = wpa_s->conf->device_name;
2041 wps->dev.manufacturer = wpa_s->conf->manufacturer;
2042 wps->dev.model_name = wpa_s->conf->model_name;
2043 wps->dev.model_number = wpa_s->conf->model_number;
2044 wps->dev.serial_number = wpa_s->conf->serial_number;
2045 }
2046 }
2047
2048
2049 #ifdef CONFIG_WPS_NFC
2050
2051 #ifdef CONFIG_WPS_ER
2052 static struct wpabuf *
wpas_wps_network_config_token(struct wpa_supplicant * wpa_s,int ndef,struct wpa_ssid * ssid)2053 wpas_wps_network_config_token(struct wpa_supplicant *wpa_s, int ndef,
2054 struct wpa_ssid *ssid)
2055 {
2056 struct wpabuf *ret;
2057 struct wps_credential cred;
2058
2059 if (wpas_wps_network_to_cred(ssid, &cred) < 0)
2060 return NULL;
2061
2062 ret = wps_er_config_token_from_cred(wpa_s->wps, &cred);
2063
2064 if (ndef && ret) {
2065 struct wpabuf *tmp;
2066 tmp = ndef_build_wifi(ret);
2067 wpabuf_free(ret);
2068 if (tmp == NULL)
2069 return NULL;
2070 ret = tmp;
2071 }
2072
2073 return ret;
2074 }
2075 #endif /* CONFIG_WPS_ER */
2076
2077
wpas_wps_nfc_config_token(struct wpa_supplicant * wpa_s,int ndef,const char * id_str)2078 struct wpabuf * wpas_wps_nfc_config_token(struct wpa_supplicant *wpa_s,
2079 int ndef, const char *id_str)
2080 {
2081 #ifdef CONFIG_WPS_ER
2082 if (id_str) {
2083 int id;
2084 char *end = NULL;
2085 struct wpa_ssid *ssid;
2086
2087 id = strtol(id_str, &end, 10);
2088 if (end && *end)
2089 return NULL;
2090
2091 ssid = wpa_config_get_network(wpa_s->conf, id);
2092 if (ssid == NULL)
2093 return NULL;
2094 return wpas_wps_network_config_token(wpa_s, ndef, ssid);
2095 }
2096 #endif /* CONFIG_WPS_ER */
2097 #ifdef CONFIG_AP
2098 if (wpa_s->ap_iface)
2099 return wpas_ap_wps_nfc_config_token(wpa_s, ndef);
2100 #endif /* CONFIG_AP */
2101 return NULL;
2102 }
2103
2104
wpas_wps_nfc_token(struct wpa_supplicant * wpa_s,int ndef)2105 struct wpabuf * wpas_wps_nfc_token(struct wpa_supplicant *wpa_s, int ndef)
2106 {
2107 if (wpa_s->conf->wps_nfc_pw_from_config) {
2108 return wps_nfc_token_build(ndef,
2109 wpa_s->conf->wps_nfc_dev_pw_id,
2110 wpa_s->conf->wps_nfc_dh_pubkey,
2111 wpa_s->conf->wps_nfc_dev_pw);
2112 }
2113
2114 return wps_nfc_token_gen(ndef, &wpa_s->conf->wps_nfc_dev_pw_id,
2115 &wpa_s->conf->wps_nfc_dh_pubkey,
2116 &wpa_s->conf->wps_nfc_dh_privkey,
2117 &wpa_s->conf->wps_nfc_dev_pw);
2118 }
2119
2120
wpas_wps_start_nfc(struct wpa_supplicant * wpa_s,const u8 * go_dev_addr,const u8 * bssid,const struct wpabuf * dev_pw,u16 dev_pw_id,int p2p_group,const u8 * peer_pubkey_hash,const u8 * ssid,size_t ssid_len,int freq)2121 int wpas_wps_start_nfc(struct wpa_supplicant *wpa_s, const u8 *go_dev_addr,
2122 const u8 *bssid,
2123 const struct wpabuf *dev_pw, u16 dev_pw_id,
2124 int p2p_group, const u8 *peer_pubkey_hash,
2125 const u8 *ssid, size_t ssid_len, int freq)
2126 {
2127 struct wps_context *wps = wpa_s->wps;
2128 char pw[32 * 2 + 1];
2129
2130 if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER && dev_pw == NULL) {
2131 dev_pw = wpa_s->conf->wps_nfc_dev_pw;
2132 dev_pw_id = wpa_s->conf->wps_nfc_dev_pw_id;
2133 }
2134
2135 if (wpa_s->conf->wps_nfc_dh_pubkey == NULL ||
2136 wpa_s->conf->wps_nfc_dh_privkey == NULL) {
2137 wpa_printf(MSG_DEBUG, "WPS: Missing DH params - "
2138 "cannot start NFC-triggered connection");
2139 return -1;
2140 }
2141
2142 if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER && dev_pw == NULL) {
2143 wpa_printf(MSG_DEBUG, "WPS: Missing Device Password (id=%u) - "
2144 "cannot start NFC-triggered connection", dev_pw_id);
2145 return -1;
2146 }
2147
2148 dh5_free(wps->dh_ctx);
2149 wpabuf_free(wps->dh_pubkey);
2150 wpabuf_free(wps->dh_privkey);
2151 wps->dh_privkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_privkey);
2152 wps->dh_pubkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_pubkey);
2153 if (wps->dh_privkey == NULL || wps->dh_pubkey == NULL) {
2154 wps->dh_ctx = NULL;
2155 wpabuf_free(wps->dh_pubkey);
2156 wps->dh_pubkey = NULL;
2157 wpabuf_free(wps->dh_privkey);
2158 wps->dh_privkey = NULL;
2159 wpa_printf(MSG_DEBUG, "WPS: Failed to get DH priv/pub key");
2160 return -1;
2161 }
2162 wps->dh_ctx = dh5_init_fixed(wps->dh_privkey, wps->dh_pubkey);
2163 if (wps->dh_ctx == NULL) {
2164 wpabuf_free(wps->dh_pubkey);
2165 wps->dh_pubkey = NULL;
2166 wpabuf_free(wps->dh_privkey);
2167 wps->dh_privkey = NULL;
2168 wpa_printf(MSG_DEBUG, "WPS: Failed to initialize DH context");
2169 return -1;
2170 }
2171
2172 if (dev_pw) {
2173 wpa_snprintf_hex_uppercase(pw, sizeof(pw),
2174 wpabuf_head(dev_pw),
2175 wpabuf_len(dev_pw));
2176 }
2177 return wpas_wps_start_dev_pw(wpa_s, go_dev_addr, bssid,
2178 dev_pw ? pw : NULL,
2179 p2p_group, dev_pw_id, peer_pubkey_hash,
2180 ssid, ssid_len, freq);
2181 }
2182
2183
wpas_wps_use_cred(struct wpa_supplicant * wpa_s,struct wps_parse_attr * attr)2184 static int wpas_wps_use_cred(struct wpa_supplicant *wpa_s,
2185 struct wps_parse_attr *attr)
2186 {
2187 /*
2188 * Disable existing networks temporarily to allow the newly learned
2189 * credential to be preferred. Enable the temporarily disabled networks
2190 * after 10 seconds.
2191 */
2192 wpas_wps_temp_disable(wpa_s, NULL);
2193 eloop_register_timeout(10, 0, wpas_wps_reenable_networks_cb, wpa_s,
2194 NULL);
2195
2196 if (wps_oob_use_cred(wpa_s->wps, attr) < 0)
2197 return -1;
2198
2199 if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
2200 return 0;
2201
2202 if (attr->ap_channel) {
2203 u16 chan = WPA_GET_BE16(attr->ap_channel);
2204 int freq = 0;
2205
2206 if (chan >= 1 && chan <= 13)
2207 freq = 2407 + 5 * chan;
2208 else if (chan == 14)
2209 freq = 2484;
2210 else if (chan >= 30)
2211 freq = 5000 + 5 * chan;
2212
2213 if (freq) {
2214 wpa_printf(MSG_DEBUG, "WPS: Credential container indicated AP channel %u -> %u MHz",
2215 chan, freq);
2216 wpa_s->after_wps = 5;
2217 wpa_s->wps_freq = freq;
2218 }
2219 }
2220
2221 wpa_printf(MSG_DEBUG, "WPS: Request reconnection with new network "
2222 "based on the received credential added");
2223 wpa_s->normal_scans = 0;
2224 wpa_supplicant_reinit_autoscan(wpa_s);
2225 wpa_s->disconnected = 0;
2226 wpa_s->reassociate = 1;
2227
2228 wpa_supplicant_cancel_sched_scan(wpa_s);
2229 wpa_supplicant_req_scan(wpa_s, 0, 0);
2230
2231 return 0;
2232 }
2233
2234
2235 #ifdef CONFIG_WPS_ER
wpas_wps_add_nfc_password_token(struct wpa_supplicant * wpa_s,struct wps_parse_attr * attr)2236 static int wpas_wps_add_nfc_password_token(struct wpa_supplicant *wpa_s,
2237 struct wps_parse_attr *attr)
2238 {
2239 return wps_registrar_add_nfc_password_token(
2240 wpa_s->wps->registrar, attr->oob_dev_password,
2241 attr->oob_dev_password_len);
2242 }
2243 #endif /* CONFIG_WPS_ER */
2244
2245
wpas_wps_nfc_tag_process(struct wpa_supplicant * wpa_s,const struct wpabuf * wps)2246 static int wpas_wps_nfc_tag_process(struct wpa_supplicant *wpa_s,
2247 const struct wpabuf *wps)
2248 {
2249 struct wps_parse_attr attr;
2250
2251 wpa_hexdump_buf(MSG_DEBUG, "WPS: Received NFC tag payload", wps);
2252
2253 if (wps_parse_msg(wps, &attr)) {
2254 wpa_printf(MSG_DEBUG, "WPS: Ignore invalid data from NFC tag");
2255 return -1;
2256 }
2257
2258 if (attr.num_cred)
2259 return wpas_wps_use_cred(wpa_s, &attr);
2260
2261 #ifdef CONFIG_WPS_ER
2262 if (attr.oob_dev_password)
2263 return wpas_wps_add_nfc_password_token(wpa_s, &attr);
2264 #endif /* CONFIG_WPS_ER */
2265
2266 wpa_printf(MSG_DEBUG, "WPS: Ignore unrecognized NFC tag");
2267 return -1;
2268 }
2269
2270
wpas_wps_nfc_tag_read(struct wpa_supplicant * wpa_s,const struct wpabuf * data,int forced_freq)2271 int wpas_wps_nfc_tag_read(struct wpa_supplicant *wpa_s,
2272 const struct wpabuf *data, int forced_freq)
2273 {
2274 const struct wpabuf *wps = data;
2275 struct wpabuf *tmp = NULL;
2276 int ret;
2277
2278 if (wpabuf_len(data) < 4)
2279 return -1;
2280
2281 if (*wpabuf_head_u8(data) != 0x10) {
2282 /* Assume this contains full NDEF record */
2283 tmp = ndef_parse_wifi(data);
2284 if (tmp == NULL) {
2285 #ifdef CONFIG_P2P
2286 tmp = ndef_parse_p2p(data);
2287 if (tmp) {
2288 ret = wpas_p2p_nfc_tag_process(wpa_s, tmp,
2289 forced_freq);
2290 wpabuf_free(tmp);
2291 return ret;
2292 }
2293 #endif /* CONFIG_P2P */
2294 wpa_printf(MSG_DEBUG, "WPS: Could not parse NDEF");
2295 return -1;
2296 }
2297 wps = tmp;
2298 }
2299
2300 ret = wpas_wps_nfc_tag_process(wpa_s, wps);
2301 wpabuf_free(tmp);
2302 return ret;
2303 }
2304
2305
wpas_wps_nfc_handover_req(struct wpa_supplicant * wpa_s,int ndef)2306 struct wpabuf * wpas_wps_nfc_handover_req(struct wpa_supplicant *wpa_s,
2307 int ndef)
2308 {
2309 struct wpabuf *ret;
2310
2311 if (wpa_s->conf->wps_nfc_dh_pubkey == NULL &&
2312 wps_nfc_gen_dh(&wpa_s->conf->wps_nfc_dh_pubkey,
2313 &wpa_s->conf->wps_nfc_dh_privkey) < 0)
2314 return NULL;
2315
2316 ret = wps_build_nfc_handover_req(wpa_s->wps,
2317 wpa_s->conf->wps_nfc_dh_pubkey);
2318
2319 if (ndef && ret) {
2320 struct wpabuf *tmp;
2321 tmp = ndef_build_wifi(ret);
2322 wpabuf_free(ret);
2323 if (tmp == NULL)
2324 return NULL;
2325 ret = tmp;
2326 }
2327
2328 return ret;
2329 }
2330
2331
2332 #ifdef CONFIG_WPS_NFC
2333
2334 static struct wpabuf *
wpas_wps_er_nfc_handover_sel(struct wpa_supplicant * wpa_s,int ndef,const char * uuid)2335 wpas_wps_er_nfc_handover_sel(struct wpa_supplicant *wpa_s, int ndef,
2336 const char *uuid)
2337 {
2338 #ifdef CONFIG_WPS_ER
2339 struct wpabuf *ret;
2340 u8 u[UUID_LEN], *use_uuid = NULL;
2341 u8 addr[ETH_ALEN], *use_addr = NULL;
2342 struct wps_context *wps = wpa_s->wps;
2343
2344 if (wps == NULL)
2345 return NULL;
2346
2347 if (uuid == NULL)
2348 return NULL;
2349 if (uuid_str2bin(uuid, u) == 0)
2350 use_uuid = u;
2351 else if (hwaddr_aton(uuid, addr) == 0)
2352 use_addr = addr;
2353 else
2354 return NULL;
2355
2356 if (wpa_s->conf->wps_nfc_dh_pubkey == NULL) {
2357 if (wps_nfc_gen_dh(&wpa_s->conf->wps_nfc_dh_pubkey,
2358 &wpa_s->conf->wps_nfc_dh_privkey) < 0)
2359 return NULL;
2360 }
2361
2362 wpas_wps_nfc_clear(wps);
2363 wps->ap_nfc_dev_pw_id = DEV_PW_NFC_CONNECTION_HANDOVER;
2364 wps->ap_nfc_dh_pubkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_pubkey);
2365 wps->ap_nfc_dh_privkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_privkey);
2366 if (!wps->ap_nfc_dh_pubkey || !wps->ap_nfc_dh_privkey) {
2367 wpas_wps_nfc_clear(wps);
2368 return NULL;
2369 }
2370
2371 ret = wps_er_nfc_handover_sel(wpa_s->wps_er, wpa_s->wps, use_uuid,
2372 use_addr, wpa_s->conf->wps_nfc_dh_pubkey);
2373 if (ndef && ret) {
2374 struct wpabuf *tmp;
2375 tmp = ndef_build_wifi(ret);
2376 wpabuf_free(ret);
2377 if (tmp == NULL)
2378 return NULL;
2379 ret = tmp;
2380 }
2381
2382 return ret;
2383 #else /* CONFIG_WPS_ER */
2384 return NULL;
2385 #endif /* CONFIG_WPS_ER */
2386 }
2387 #endif /* CONFIG_WPS_NFC */
2388
2389
wpas_wps_nfc_handover_sel(struct wpa_supplicant * wpa_s,int ndef,int cr,const char * uuid)2390 struct wpabuf * wpas_wps_nfc_handover_sel(struct wpa_supplicant *wpa_s,
2391 int ndef, int cr, const char *uuid)
2392 {
2393 struct wpabuf *ret;
2394 if (!cr)
2395 return NULL;
2396 ret = wpas_ap_wps_nfc_handover_sel(wpa_s, ndef);
2397 if (ret)
2398 return ret;
2399 return wpas_wps_er_nfc_handover_sel(wpa_s, ndef, uuid);
2400 }
2401
2402
wpas_wps_nfc_rx_handover_sel(struct wpa_supplicant * wpa_s,const struct wpabuf * data)2403 static int wpas_wps_nfc_rx_handover_sel(struct wpa_supplicant *wpa_s,
2404 const struct wpabuf *data)
2405 {
2406 struct wpabuf *wps;
2407 int ret = -1;
2408 u16 wsc_len;
2409 const u8 *pos;
2410 struct wpabuf msg;
2411 struct wps_parse_attr attr;
2412 u16 dev_pw_id;
2413 const u8 *bssid = NULL;
2414 int freq = 0;
2415
2416 wps = ndef_parse_wifi(data);
2417 if (wps == NULL)
2418 return -1;
2419 wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
2420 "payload from NFC connection handover");
2421 wpa_hexdump_buf(MSG_DEBUG, "WPS: NFC payload", wps);
2422 if (wpabuf_len(wps) < 2) {
2423 wpa_printf(MSG_DEBUG, "WPS: Too short Wi-Fi Handover Select "
2424 "Message");
2425 goto out;
2426 }
2427 pos = wpabuf_head(wps);
2428 wsc_len = WPA_GET_BE16(pos);
2429 if (wsc_len > wpabuf_len(wps) - 2) {
2430 wpa_printf(MSG_DEBUG, "WPS: Invalid WSC attribute length (%u) "
2431 "in Wi-Fi Handover Select Message", wsc_len);
2432 goto out;
2433 }
2434 pos += 2;
2435
2436 wpa_hexdump(MSG_DEBUG,
2437 "WPS: WSC attributes in Wi-Fi Handover Select Message",
2438 pos, wsc_len);
2439 if (wsc_len < wpabuf_len(wps) - 2) {
2440 wpa_hexdump(MSG_DEBUG,
2441 "WPS: Ignore extra data after WSC attributes",
2442 pos + wsc_len, wpabuf_len(wps) - 2 - wsc_len);
2443 }
2444
2445 wpabuf_set(&msg, pos, wsc_len);
2446 ret = wps_parse_msg(&msg, &attr);
2447 if (ret < 0) {
2448 wpa_printf(MSG_DEBUG, "WPS: Could not parse WSC attributes in "
2449 "Wi-Fi Handover Select Message");
2450 goto out;
2451 }
2452
2453 if (attr.oob_dev_password == NULL ||
2454 attr.oob_dev_password_len < WPS_OOB_PUBKEY_HASH_LEN + 2) {
2455 wpa_printf(MSG_DEBUG, "WPS: No Out-of-Band Device Password "
2456 "included in Wi-Fi Handover Select Message");
2457 ret = -1;
2458 goto out;
2459 }
2460
2461 if (attr.ssid == NULL) {
2462 wpa_printf(MSG_DEBUG, "WPS: No SSID included in Wi-Fi Handover "
2463 "Select Message");
2464 ret = -1;
2465 goto out;
2466 }
2467
2468 wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", attr.ssid, attr.ssid_len);
2469
2470 if (attr.mac_addr) {
2471 bssid = attr.mac_addr;
2472 wpa_printf(MSG_DEBUG, "WPS: MAC Address (BSSID): " MACSTR,
2473 MAC2STR(bssid));
2474 }
2475
2476 if (attr.rf_bands)
2477 wpa_printf(MSG_DEBUG, "WPS: RF Bands: %d", *attr.rf_bands);
2478
2479 if (attr.ap_channel) {
2480 u16 chan = WPA_GET_BE16(attr.ap_channel);
2481
2482 wpa_printf(MSG_DEBUG, "WPS: AP Channel: %d", chan);
2483
2484 if (chan >= 1 && chan <= 13 &&
2485 (attr.rf_bands == NULL || *attr.rf_bands & WPS_RF_24GHZ))
2486 freq = 2407 + 5 * chan;
2487 else if (chan == 14 &&
2488 (attr.rf_bands == NULL ||
2489 *attr.rf_bands & WPS_RF_24GHZ))
2490 freq = 2484;
2491 else if (chan >= 30 &&
2492 (attr.rf_bands == NULL ||
2493 *attr.rf_bands & WPS_RF_50GHZ))
2494 freq = 5000 + 5 * chan;
2495
2496 if (freq) {
2497 wpa_printf(MSG_DEBUG,
2498 "WPS: AP indicated channel %u -> %u MHz",
2499 chan, freq);
2500 }
2501 }
2502
2503 wpa_hexdump(MSG_DEBUG, "WPS: Out-of-Band Device Password",
2504 attr.oob_dev_password, attr.oob_dev_password_len);
2505 dev_pw_id = WPA_GET_BE16(attr.oob_dev_password +
2506 WPS_OOB_PUBKEY_HASH_LEN);
2507 if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER) {
2508 wpa_printf(MSG_DEBUG, "WPS: Unexpected OOB Device Password ID "
2509 "%u in Wi-Fi Handover Select Message", dev_pw_id);
2510 ret = -1;
2511 goto out;
2512 }
2513 wpa_hexdump(MSG_DEBUG, "WPS: AP Public Key hash",
2514 attr.oob_dev_password, WPS_OOB_PUBKEY_HASH_LEN);
2515
2516 ret = wpas_wps_start_nfc(wpa_s, NULL, bssid, NULL, dev_pw_id, 0,
2517 attr.oob_dev_password,
2518 attr.ssid, attr.ssid_len, freq);
2519
2520 out:
2521 wpabuf_free(wps);
2522 return ret;
2523 }
2524
2525
wpas_wps_nfc_report_handover(struct wpa_supplicant * wpa_s,const struct wpabuf * req,const struct wpabuf * sel)2526 int wpas_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
2527 const struct wpabuf *req,
2528 const struct wpabuf *sel)
2529 {
2530 wpa_printf(MSG_DEBUG, "NFC: WPS connection handover reported");
2531 wpa_hexdump_buf_key(MSG_DEBUG, "WPS: Carrier record in request", req);
2532 wpa_hexdump_buf_key(MSG_DEBUG, "WPS: Carrier record in select", sel);
2533 return wpas_wps_nfc_rx_handover_sel(wpa_s, sel);
2534 }
2535
2536
wpas_er_wps_nfc_report_handover(struct wpa_supplicant * wpa_s,const struct wpabuf * req,const struct wpabuf * sel)2537 int wpas_er_wps_nfc_report_handover(struct wpa_supplicant *wpa_s,
2538 const struct wpabuf *req,
2539 const struct wpabuf *sel)
2540 {
2541 struct wpabuf *wps;
2542 int ret = -1;
2543 u16 wsc_len;
2544 const u8 *pos;
2545 struct wpabuf msg;
2546 struct wps_parse_attr attr;
2547 u16 dev_pw_id;
2548
2549 /*
2550 * Enrollee/station is always initiator of the NFC connection handover,
2551 * so use the request message here to find Enrollee public key hash.
2552 */
2553 wps = ndef_parse_wifi(req);
2554 if (wps == NULL)
2555 return -1;
2556 wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
2557 "payload from NFC connection handover");
2558 wpa_hexdump_buf(MSG_DEBUG, "WPS: NFC payload", wps);
2559 if (wpabuf_len(wps) < 2) {
2560 wpa_printf(MSG_DEBUG, "WPS: Too short Wi-Fi Handover Request "
2561 "Message");
2562 goto out;
2563 }
2564 pos = wpabuf_head(wps);
2565 wsc_len = WPA_GET_BE16(pos);
2566 if (wsc_len > wpabuf_len(wps) - 2) {
2567 wpa_printf(MSG_DEBUG, "WPS: Invalid WSC attribute length (%u) "
2568 "in rt Wi-Fi Handover Request Message", wsc_len);
2569 goto out;
2570 }
2571 pos += 2;
2572
2573 wpa_hexdump(MSG_DEBUG,
2574 "WPS: WSC attributes in Wi-Fi Handover Request Message",
2575 pos, wsc_len);
2576 if (wsc_len < wpabuf_len(wps) - 2) {
2577 wpa_hexdump(MSG_DEBUG,
2578 "WPS: Ignore extra data after WSC attributes",
2579 pos + wsc_len, wpabuf_len(wps) - 2 - wsc_len);
2580 }
2581
2582 wpabuf_set(&msg, pos, wsc_len);
2583 ret = wps_parse_msg(&msg, &attr);
2584 if (ret < 0) {
2585 wpa_printf(MSG_DEBUG, "WPS: Could not parse WSC attributes in "
2586 "Wi-Fi Handover Request Message");
2587 goto out;
2588 }
2589
2590 if (attr.oob_dev_password == NULL ||
2591 attr.oob_dev_password_len < WPS_OOB_PUBKEY_HASH_LEN + 2) {
2592 wpa_printf(MSG_DEBUG, "WPS: No Out-of-Band Device Password "
2593 "included in Wi-Fi Handover Request Message");
2594 ret = -1;
2595 goto out;
2596 }
2597
2598 if (attr.uuid_e == NULL) {
2599 wpa_printf(MSG_DEBUG, "WPS: No UUID-E included in Wi-Fi "
2600 "Handover Request Message");
2601 ret = -1;
2602 goto out;
2603 }
2604
2605 wpa_hexdump(MSG_DEBUG, "WPS: UUID-E", attr.uuid_e, WPS_UUID_LEN);
2606
2607 wpa_hexdump(MSG_DEBUG, "WPS: Out-of-Band Device Password",
2608 attr.oob_dev_password, attr.oob_dev_password_len);
2609 dev_pw_id = WPA_GET_BE16(attr.oob_dev_password +
2610 WPS_OOB_PUBKEY_HASH_LEN);
2611 if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER) {
2612 wpa_printf(MSG_DEBUG, "WPS: Unexpected OOB Device Password ID "
2613 "%u in Wi-Fi Handover Request Message", dev_pw_id);
2614 ret = -1;
2615 goto out;
2616 }
2617 wpa_hexdump(MSG_DEBUG, "WPS: Enrollee Public Key hash",
2618 attr.oob_dev_password, WPS_OOB_PUBKEY_HASH_LEN);
2619
2620 ret = wps_registrar_add_nfc_pw_token(wpa_s->wps->registrar,
2621 attr.oob_dev_password,
2622 DEV_PW_NFC_CONNECTION_HANDOVER,
2623 NULL, 0, 1);
2624
2625 out:
2626 wpabuf_free(wps);
2627 return ret;
2628 }
2629
2630 #endif /* CONFIG_WPS_NFC */
2631
2632
wpas_wps_dump_ap_info(struct wpa_supplicant * wpa_s)2633 static void wpas_wps_dump_ap_info(struct wpa_supplicant *wpa_s)
2634 {
2635 size_t i;
2636 struct os_reltime now;
2637
2638 if (wpa_debug_level > MSG_DEBUG)
2639 return;
2640
2641 if (wpa_s->wps_ap == NULL)
2642 return;
2643
2644 os_get_reltime(&now);
2645
2646 for (i = 0; i < wpa_s->num_wps_ap; i++) {
2647 struct wps_ap_info *ap = &wpa_s->wps_ap[i];
2648 struct wpa_blacklist *e = wpa_blacklist_get(wpa_s, ap->bssid);
2649
2650 wpa_printf(MSG_DEBUG, "WPS: AP[%d] " MACSTR " type=%d "
2651 "tries=%d last_attempt=%d sec ago blacklist=%d",
2652 (int) i, MAC2STR(ap->bssid), ap->type, ap->tries,
2653 ap->last_attempt.sec > 0 ?
2654 (int) now.sec - (int) ap->last_attempt.sec : -1,
2655 e ? e->count : 0);
2656 }
2657 }
2658
2659
wpas_wps_get_ap_info(struct wpa_supplicant * wpa_s,const u8 * bssid)2660 static struct wps_ap_info * wpas_wps_get_ap_info(struct wpa_supplicant *wpa_s,
2661 const u8 *bssid)
2662 {
2663 size_t i;
2664
2665 if (wpa_s->wps_ap == NULL)
2666 return NULL;
2667
2668 for (i = 0; i < wpa_s->num_wps_ap; i++) {
2669 struct wps_ap_info *ap = &wpa_s->wps_ap[i];
2670 if (os_memcmp(ap->bssid, bssid, ETH_ALEN) == 0)
2671 return ap;
2672 }
2673
2674 return NULL;
2675 }
2676
2677
wpas_wps_update_ap_info_bss(struct wpa_supplicant * wpa_s,struct wpa_scan_res * res)2678 static void wpas_wps_update_ap_info_bss(struct wpa_supplicant *wpa_s,
2679 struct wpa_scan_res *res)
2680 {
2681 struct wpabuf *wps;
2682 enum wps_ap_info_type type;
2683 struct wps_ap_info *ap;
2684 int r;
2685
2686 if (wpa_scan_get_vendor_ie(res, WPS_IE_VENDOR_TYPE) == NULL)
2687 return;
2688
2689 wps = wpa_scan_get_vendor_ie_multi(res, WPS_IE_VENDOR_TYPE);
2690 if (wps == NULL)
2691 return;
2692
2693 r = wps_is_addr_authorized(wps, wpa_s->own_addr, 1);
2694 if (r == 2)
2695 type = WPS_AP_SEL_REG_OUR;
2696 else if (r == 1)
2697 type = WPS_AP_SEL_REG;
2698 else
2699 type = WPS_AP_NOT_SEL_REG;
2700
2701 wpabuf_free(wps);
2702
2703 ap = wpas_wps_get_ap_info(wpa_s, res->bssid);
2704 if (ap) {
2705 if (ap->type != type) {
2706 wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR
2707 " changed type %d -> %d",
2708 MAC2STR(res->bssid), ap->type, type);
2709 ap->type = type;
2710 if (type != WPS_AP_NOT_SEL_REG)
2711 wpa_blacklist_del(wpa_s, ap->bssid);
2712 }
2713 return;
2714 }
2715
2716 ap = os_realloc_array(wpa_s->wps_ap, wpa_s->num_wps_ap + 1,
2717 sizeof(struct wps_ap_info));
2718 if (ap == NULL)
2719 return;
2720
2721 wpa_s->wps_ap = ap;
2722 ap = &wpa_s->wps_ap[wpa_s->num_wps_ap];
2723 wpa_s->num_wps_ap++;
2724
2725 os_memset(ap, 0, sizeof(*ap));
2726 os_memcpy(ap->bssid, res->bssid, ETH_ALEN);
2727 ap->type = type;
2728 wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR " type %d added",
2729 MAC2STR(ap->bssid), ap->type);
2730 }
2731
2732
wpas_wps_update_ap_info(struct wpa_supplicant * wpa_s,struct wpa_scan_results * scan_res)2733 void wpas_wps_update_ap_info(struct wpa_supplicant *wpa_s,
2734 struct wpa_scan_results *scan_res)
2735 {
2736 size_t i;
2737
2738 for (i = 0; i < scan_res->num; i++)
2739 wpas_wps_update_ap_info_bss(wpa_s, scan_res->res[i]);
2740
2741 wpas_wps_dump_ap_info(wpa_s);
2742 }
2743
2744
wpas_wps_notify_assoc(struct wpa_supplicant * wpa_s,const u8 * bssid)2745 void wpas_wps_notify_assoc(struct wpa_supplicant *wpa_s, const u8 *bssid)
2746 {
2747 struct wps_ap_info *ap;
2748
2749 wpa_s->after_wps = 0;
2750
2751 if (!wpa_s->wps_ap_iter)
2752 return;
2753 ap = wpas_wps_get_ap_info(wpa_s, bssid);
2754 if (ap == NULL)
2755 return;
2756 ap->tries++;
2757 os_get_reltime(&ap->last_attempt);
2758 }
2759