xref: /freebsd/contrib/wpa/wpa_supplicant/wps_supplicant.c (revision f8ea072a542112d5e0e74a2d6ecf75d967c3054c)
1 /*
2  * wpa_supplicant / WPS integration
3  * Copyright (c) 2008-2012, 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 
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 
55 int wpas_wps_eapol_cb(struct wpa_supplicant *wpa_s)
56 {
57 	if (!wpa_s->wps_success &&
58 	    wpa_s->current_ssid &&
59 	    eap_is_wps_pin_enrollee(&wpa_s->current_ssid->eap)) {
60 		const u8 *bssid = wpa_s->bssid;
61 		if (is_zero_ether_addr(bssid))
62 			bssid = wpa_s->pending_bssid;
63 
64 		wpa_printf(MSG_DEBUG, "WPS: PIN registration with " MACSTR
65 			   " did not succeed - continue trying to find "
66 			   "suitable AP", MAC2STR(bssid));
67 		wpa_blacklist_add(wpa_s, bssid);
68 
69 		wpa_supplicant_deauthenticate(wpa_s,
70 					      WLAN_REASON_DEAUTH_LEAVING);
71 		wpa_s->reassociate = 1;
72 		wpa_supplicant_req_scan(wpa_s,
73 					wpa_s->blacklist_cleared ? 5 : 0, 0);
74 		wpa_s->blacklist_cleared = 0;
75 		return 1;
76 	}
77 
78 	wpas_wps_clear_ap_info(wpa_s);
79 	eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
80 	if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && !wpa_s->wps_success)
81 		wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_FAIL);
82 
83 	if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid &&
84 	    !(wpa_s->current_ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
85 		int disabled = wpa_s->current_ssid->disabled;
86 		unsigned int freq = wpa_s->assoc_freq;
87 		wpa_printf(MSG_DEBUG, "WPS: Network configuration replaced - "
88 			   "try to associate with the received credential "
89 			   "(freq=%u)", freq);
90 		wpa_supplicant_deauthenticate(wpa_s,
91 					      WLAN_REASON_DEAUTH_LEAVING);
92 		if (disabled) {
93 			wpa_printf(MSG_DEBUG, "WPS: Current network is "
94 				   "disabled - wait for user to enable");
95 			return 1;
96 		}
97 		wpa_s->after_wps = 5;
98 		wpa_s->wps_freq = freq;
99 		wpa_s->normal_scans = 0;
100 		wpa_s->reassociate = 1;
101 		wpa_supplicant_req_scan(wpa_s, 0, 0);
102 		return 1;
103 	}
104 
105 	if (wpa_s->key_mgmt == WPA_KEY_MGMT_WPS && wpa_s->current_ssid) {
106 		wpa_printf(MSG_DEBUG, "WPS: Registration completed - waiting "
107 			   "for external credential processing");
108 		wpas_clear_wps(wpa_s);
109 		wpa_supplicant_deauthenticate(wpa_s,
110 					      WLAN_REASON_DEAUTH_LEAVING);
111 		return 1;
112 	}
113 
114 	return 0;
115 }
116 
117 
118 static void wpas_wps_security_workaround(struct wpa_supplicant *wpa_s,
119 					 struct wpa_ssid *ssid,
120 					 const struct wps_credential *cred)
121 {
122 	struct wpa_driver_capa capa;
123 	struct wpa_bss *bss;
124 	const u8 *ie;
125 	struct wpa_ie_data adv;
126 	int wpa2 = 0, ccmp = 0;
127 
128 	/*
129 	 * Many existing WPS APs do not know how to negotiate WPA2 or CCMP in
130 	 * case they are configured for mixed mode operation (WPA+WPA2 and
131 	 * TKIP+CCMP). Try to use scan results to figure out whether the AP
132 	 * actually supports stronger security and select that if the client
133 	 * has support for it, too.
134 	 */
135 
136 	if (wpa_drv_get_capa(wpa_s, &capa))
137 		return; /* Unknown what driver supports */
138 
139 	if (ssid->ssid == NULL)
140 		return;
141 	bss = wpa_bss_get(wpa_s, cred->mac_addr, ssid->ssid, ssid->ssid_len);
142 	if (bss == NULL) {
143 		wpa_printf(MSG_DEBUG, "WPS: The AP was not found from BSS "
144 			   "table - use credential as-is");
145 		return;
146 	}
147 
148 	wpa_printf(MSG_DEBUG, "WPS: AP found from BSS table");
149 
150 	ie = wpa_bss_get_ie(bss, WLAN_EID_RSN);
151 	if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0) {
152 		wpa2 = 1;
153 		if (adv.pairwise_cipher & WPA_CIPHER_CCMP)
154 			ccmp = 1;
155 	} else {
156 		ie = wpa_bss_get_vendor_ie(bss, WPA_IE_VENDOR_TYPE);
157 		if (ie && wpa_parse_wpa_ie(ie, 2 + ie[1], &adv) == 0 &&
158 		    adv.pairwise_cipher & WPA_CIPHER_CCMP)
159 			ccmp = 1;
160 	}
161 
162 	if (ie == NULL && (ssid->proto & WPA_PROTO_WPA) &&
163 	    (ssid->pairwise_cipher & WPA_CIPHER_TKIP)) {
164 		/*
165 		 * TODO: This could be the initial AP configuration and the
166 		 * Beacon contents could change shortly. Should request a new
167 		 * scan and delay addition of the network until the updated
168 		 * scan results are available.
169 		 */
170 		wpa_printf(MSG_DEBUG, "WPS: The AP did not yet advertise WPA "
171 			   "support - use credential as-is");
172 		return;
173 	}
174 
175 	if (ccmp && !(ssid->pairwise_cipher & WPA_CIPHER_CCMP) &&
176 	    (ssid->pairwise_cipher & WPA_CIPHER_TKIP) &&
177 	    (capa.key_mgmt & WPA_DRIVER_CAPA_KEY_MGMT_WPA2_PSK)) {
178 		wpa_printf(MSG_DEBUG, "WPS: Add CCMP into the credential "
179 			   "based on scan results");
180 		if (wpa_s->conf->ap_scan == 1)
181 			ssid->pairwise_cipher |= WPA_CIPHER_CCMP;
182 		else
183 			ssid->pairwise_cipher = WPA_CIPHER_CCMP;
184 	}
185 
186 	if (wpa2 && !(ssid->proto & WPA_PROTO_RSN) &&
187 	    (ssid->proto & WPA_PROTO_WPA) &&
188 	    (capa.enc & WPA_DRIVER_CAPA_ENC_CCMP)) {
189 		wpa_printf(MSG_DEBUG, "WPS: Add WPA2 into the credential "
190 			   "based on scan results");
191 		if (wpa_s->conf->ap_scan == 1)
192 			ssid->proto |= WPA_PROTO_RSN;
193 		else
194 			ssid->proto = WPA_PROTO_RSN;
195 	}
196 }
197 
198 
199 static int wpa_supplicant_wps_cred(void *ctx,
200 				   const struct wps_credential *cred)
201 {
202 	struct wpa_supplicant *wpa_s = ctx;
203 	struct wpa_ssid *ssid = wpa_s->current_ssid;
204 	u8 key_idx = 0;
205 	u16 auth_type;
206 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
207 	int registrar = 0;
208 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
209 
210 	if ((wpa_s->conf->wps_cred_processing == 1 ||
211 	     wpa_s->conf->wps_cred_processing == 2) && cred->cred_attr) {
212 		size_t blen = cred->cred_attr_len * 2 + 1;
213 		char *buf = os_malloc(blen);
214 		if (buf) {
215 			wpa_snprintf_hex(buf, blen,
216 					 cred->cred_attr, cred->cred_attr_len);
217 			wpa_msg(wpa_s, MSG_INFO, "%s%s",
218 				WPS_EVENT_CRED_RECEIVED, buf);
219 			os_free(buf);
220 		}
221 
222 		wpas_notify_wps_credential(wpa_s, cred);
223 	} else
224 		wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_CRED_RECEIVED);
225 
226 	wpa_hexdump_key(MSG_DEBUG, "WPS: Received Credential attribute",
227 			cred->cred_attr, cred->cred_attr_len);
228 
229 	if (wpa_s->conf->wps_cred_processing == 1)
230 		return 0;
231 
232 	wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", cred->ssid, cred->ssid_len);
233 	wpa_printf(MSG_DEBUG, "WPS: Authentication Type 0x%x",
234 		   cred->auth_type);
235 	wpa_printf(MSG_DEBUG, "WPS: Encryption Type 0x%x", cred->encr_type);
236 	wpa_printf(MSG_DEBUG, "WPS: Network Key Index %d", cred->key_idx);
237 	wpa_hexdump_key(MSG_DEBUG, "WPS: Network Key",
238 			cred->key, cred->key_len);
239 	wpa_printf(MSG_DEBUG, "WPS: MAC Address " MACSTR,
240 		   MAC2STR(cred->mac_addr));
241 
242 	auth_type = cred->auth_type;
243 	if (auth_type == (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
244 		wpa_printf(MSG_DEBUG, "WPS: Workaround - convert mixed-mode "
245 			   "auth_type into WPA2PSK");
246 		auth_type = WPS_AUTH_WPA2PSK;
247 	}
248 
249 	if (auth_type != WPS_AUTH_OPEN &&
250 	    auth_type != WPS_AUTH_SHARED &&
251 	    auth_type != WPS_AUTH_WPAPSK &&
252 	    auth_type != WPS_AUTH_WPA2PSK) {
253 		wpa_printf(MSG_DEBUG, "WPS: Ignored credentials for "
254 			   "unsupported authentication type 0x%x",
255 			   auth_type);
256 		return 0;
257 	}
258 
259 	if (auth_type == WPS_AUTH_WPAPSK || auth_type == WPS_AUTH_WPA2PSK) {
260 		if (cred->key_len < 8 || cred->key_len > 2 * PMK_LEN) {
261 			wpa_printf(MSG_ERROR, "WPS: Reject PSK credential with "
262 				   "invalid Network Key length %lu",
263 				   (unsigned long) cred->key_len);
264 			return -1;
265 		}
266 	}
267 
268 	if (ssid && (ssid->key_mgmt & WPA_KEY_MGMT_WPS)) {
269 		wpa_printf(MSG_DEBUG, "WPS: Replace WPS network block based "
270 			   "on the received credential");
271 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
272 		if (ssid->eap.identity &&
273 		    ssid->eap.identity_len == WSC_ID_REGISTRAR_LEN &&
274 		    os_memcmp(ssid->eap.identity, WSC_ID_REGISTRAR,
275 			      WSC_ID_REGISTRAR_LEN) == 0)
276 			registrar = 1;
277 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
278 		os_free(ssid->eap.identity);
279 		ssid->eap.identity = NULL;
280 		ssid->eap.identity_len = 0;
281 		os_free(ssid->eap.phase1);
282 		ssid->eap.phase1 = NULL;
283 		os_free(ssid->eap.eap_methods);
284 		ssid->eap.eap_methods = NULL;
285 		if (!ssid->p2p_group) {
286 			ssid->temporary = 0;
287 			ssid->bssid_set = 0;
288 		}
289 		ssid->disabled_until.sec = 0;
290 		ssid->disabled_until.usec = 0;
291 		ssid->auth_failures = 0;
292 	} else {
293 		wpa_printf(MSG_DEBUG, "WPS: Create a new network based on the "
294 			   "received credential");
295 		ssid = wpa_config_add_network(wpa_s->conf);
296 		if (ssid == NULL)
297 			return -1;
298 		wpas_notify_network_added(wpa_s, ssid);
299 	}
300 
301 	wpa_config_set_network_defaults(ssid);
302 
303 	os_free(ssid->ssid);
304 	ssid->ssid = os_malloc(cred->ssid_len);
305 	if (ssid->ssid) {
306 		os_memcpy(ssid->ssid, cred->ssid, cred->ssid_len);
307 		ssid->ssid_len = cred->ssid_len;
308 	}
309 
310 	switch (cred->encr_type) {
311 	case WPS_ENCR_NONE:
312 		break;
313 	case WPS_ENCR_WEP:
314 		if (cred->key_len <= 0)
315 			break;
316 		if (cred->key_len != 5 && cred->key_len != 13 &&
317 		    cred->key_len != 10 && cred->key_len != 26) {
318 			wpa_printf(MSG_ERROR, "WPS: Invalid WEP Key length "
319 				   "%lu", (unsigned long) cred->key_len);
320 			return -1;
321 		}
322 		if (cred->key_idx > NUM_WEP_KEYS) {
323 			wpa_printf(MSG_ERROR, "WPS: Invalid WEP Key index %d",
324 				   cred->key_idx);
325 			return -1;
326 		}
327 		if (cred->key_idx)
328 			key_idx = cred->key_idx - 1;
329 		if (cred->key_len == 10 || cred->key_len == 26) {
330 			if (hexstr2bin((char *) cred->key,
331 				       ssid->wep_key[key_idx],
332 				       cred->key_len / 2) < 0) {
333 				wpa_printf(MSG_ERROR, "WPS: Invalid WEP Key "
334 					   "%d", key_idx);
335 				return -1;
336 			}
337 			ssid->wep_key_len[key_idx] = cred->key_len / 2;
338 		} else {
339 			os_memcpy(ssid->wep_key[key_idx], cred->key,
340 				  cred->key_len);
341 			ssid->wep_key_len[key_idx] = cred->key_len;
342 		}
343 		ssid->wep_tx_keyidx = key_idx;
344 		break;
345 	case WPS_ENCR_TKIP:
346 		ssid->pairwise_cipher = WPA_CIPHER_TKIP;
347 		break;
348 	case WPS_ENCR_AES:
349 		ssid->pairwise_cipher = WPA_CIPHER_CCMP;
350 		break;
351 	}
352 
353 	switch (auth_type) {
354 	case WPS_AUTH_OPEN:
355 		ssid->auth_alg = WPA_AUTH_ALG_OPEN;
356 		ssid->key_mgmt = WPA_KEY_MGMT_NONE;
357 		ssid->proto = 0;
358 #ifdef CONFIG_WPS_REG_DISABLE_OPEN
359 		if (registrar) {
360 			wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_OPEN_NETWORK
361 				"id=%d - Credentials for an open "
362 				"network disabled by default - use "
363 				"'select_network %d' to enable",
364 				ssid->id, ssid->id);
365 			ssid->disabled = 1;
366 		}
367 #endif /* CONFIG_WPS_REG_DISABLE_OPEN */
368 		break;
369 	case WPS_AUTH_SHARED:
370 		ssid->auth_alg = WPA_AUTH_ALG_SHARED;
371 		ssid->key_mgmt = WPA_KEY_MGMT_NONE;
372 		ssid->proto = 0;
373 		break;
374 	case WPS_AUTH_WPAPSK:
375 		ssid->auth_alg = WPA_AUTH_ALG_OPEN;
376 		ssid->key_mgmt = WPA_KEY_MGMT_PSK;
377 		ssid->proto = WPA_PROTO_WPA;
378 		break;
379 	case WPS_AUTH_WPA2PSK:
380 		ssid->auth_alg = WPA_AUTH_ALG_OPEN;
381 		ssid->key_mgmt = WPA_KEY_MGMT_PSK;
382 		ssid->proto = WPA_PROTO_RSN;
383 		break;
384 	}
385 
386 	if (ssid->key_mgmt == WPA_KEY_MGMT_PSK) {
387 		if (cred->key_len == 2 * PMK_LEN) {
388 			if (hexstr2bin((const char *) cred->key, ssid->psk,
389 				       PMK_LEN)) {
390 				wpa_printf(MSG_ERROR, "WPS: Invalid Network "
391 					   "Key");
392 				return -1;
393 			}
394 			ssid->psk_set = 1;
395 			ssid->export_keys = 1;
396 		} else if (cred->key_len >= 8 && cred->key_len < 2 * PMK_LEN) {
397 			os_free(ssid->passphrase);
398 			ssid->passphrase = os_malloc(cred->key_len + 1);
399 			if (ssid->passphrase == NULL)
400 				return -1;
401 			os_memcpy(ssid->passphrase, cred->key, cred->key_len);
402 			ssid->passphrase[cred->key_len] = '\0';
403 			wpa_config_update_psk(ssid);
404 			ssid->export_keys = 1;
405 		} else {
406 			wpa_printf(MSG_ERROR, "WPS: Invalid Network Key "
407 				   "length %lu",
408 				   (unsigned long) cred->key_len);
409 			return -1;
410 		}
411 	}
412 
413 	wpas_wps_security_workaround(wpa_s, ssid, cred);
414 
415 	if (cred->ap_channel)
416 		wpa_s->wps_ap_channel = cred->ap_channel;
417 
418 #ifndef CONFIG_NO_CONFIG_WRITE
419 	if (wpa_s->conf->update_config &&
420 	    wpa_config_write(wpa_s->confname, wpa_s->conf)) {
421 		wpa_printf(MSG_DEBUG, "WPS: Failed to update configuration");
422 		return -1;
423 	}
424 #endif /* CONFIG_NO_CONFIG_WRITE */
425 
426 	/*
427 	 * Optimize the post-WPS scan based on the channel used during
428 	 * the provisioning in case EAP-Failure is not received.
429 	 */
430 	wpa_s->after_wps = 5;
431 	wpa_s->wps_freq = wpa_s->assoc_freq;
432 
433 	return 0;
434 }
435 
436 
437 #ifdef CONFIG_P2P
438 static void wpas_wps_pbc_overlap_cb(void *eloop_ctx, void *timeout_ctx)
439 {
440 	struct wpa_supplicant *wpa_s = eloop_ctx;
441 	wpas_p2p_notif_pbc_overlap(wpa_s);
442 }
443 #endif /* CONFIG_P2P */
444 
445 
446 static void wpa_supplicant_wps_event_m2d(struct wpa_supplicant *wpa_s,
447 					 struct wps_event_m2d *m2d)
448 {
449 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_M2D
450 		"dev_password_id=%d config_error=%d",
451 		m2d->dev_password_id, m2d->config_error);
452 	wpas_notify_wps_event_m2d(wpa_s, m2d);
453 #ifdef CONFIG_P2P
454 	if (wpa_s->parent && wpa_s->parent != wpa_s) {
455 		wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_M2D
456 			"dev_password_id=%d config_error=%d",
457 			m2d->dev_password_id, m2d->config_error);
458 	}
459 	if (m2d->config_error == WPS_CFG_MULTIPLE_PBC_DETECTED) {
460 		/*
461 		 * Notify P2P from eloop timeout to avoid issues with the
462 		 * interface getting removed while processing a message.
463 		 */
464 		eloop_register_timeout(0, 0, wpas_wps_pbc_overlap_cb, wpa_s,
465 				       NULL);
466 	}
467 #endif /* CONFIG_P2P */
468 }
469 
470 
471 static const char * wps_event_fail_reason[NUM_WPS_EI_VALUES] = {
472 	"No Error", /* WPS_EI_NO_ERROR */
473 	"TKIP Only Prohibited", /* WPS_EI_SECURITY_TKIP_ONLY_PROHIBITED */
474 	"WEP Prohibited" /* WPS_EI_SECURITY_WEP_PROHIBITED */
475 };
476 
477 static void wpa_supplicant_wps_event_fail(struct wpa_supplicant *wpa_s,
478 					  struct wps_event_fail *fail)
479 {
480 	if (fail->error_indication > 0 &&
481 	    fail->error_indication < NUM_WPS_EI_VALUES) {
482 		wpa_msg(wpa_s, MSG_INFO,
483 			WPS_EVENT_FAIL "msg=%d config_error=%d reason=%d (%s)",
484 			fail->msg, fail->config_error, fail->error_indication,
485 			wps_event_fail_reason[fail->error_indication]);
486 		if (wpa_s->parent && wpa_s->parent != wpa_s)
487 			wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_FAIL
488 				"msg=%d config_error=%d reason=%d (%s)",
489 				fail->msg, fail->config_error,
490 				fail->error_indication,
491 				wps_event_fail_reason[fail->error_indication]);
492 	} else {
493 		wpa_msg(wpa_s, MSG_INFO,
494 			WPS_EVENT_FAIL "msg=%d config_error=%d",
495 			fail->msg, fail->config_error);
496 		if (wpa_s->parent && wpa_s->parent != wpa_s)
497 			wpa_msg(wpa_s->parent, MSG_INFO, WPS_EVENT_FAIL
498 				"msg=%d config_error=%d",
499 				fail->msg, fail->config_error);
500 	}
501 	wpas_clear_wps(wpa_s);
502 	wpas_notify_wps_event_fail(wpa_s, fail);
503 #ifdef CONFIG_P2P
504 	wpas_p2p_wps_failed(wpa_s, fail);
505 #endif /* CONFIG_P2P */
506 }
507 
508 
509 static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx);
510 
511 static void wpas_wps_reenable_networks(struct wpa_supplicant *wpa_s)
512 {
513 	struct wpa_ssid *ssid;
514 	int changed = 0;
515 
516 	eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
517 
518 	for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
519 		if (ssid->disabled_for_connect && ssid->disabled) {
520 			ssid->disabled_for_connect = 0;
521 			ssid->disabled = 0;
522 			wpas_notify_network_enabled_changed(wpa_s, ssid);
523 			changed++;
524 		}
525 	}
526 
527 	if (changed) {
528 #ifndef CONFIG_NO_CONFIG_WRITE
529 		if (wpa_s->conf->update_config &&
530 		    wpa_config_write(wpa_s->confname, wpa_s->conf)) {
531 			wpa_printf(MSG_DEBUG, "WPS: Failed to update "
532 				   "configuration");
533 		}
534 #endif /* CONFIG_NO_CONFIG_WRITE */
535 	}
536 }
537 
538 
539 static void wpas_wps_reenable_networks_cb(void *eloop_ctx, void *timeout_ctx)
540 {
541 	struct wpa_supplicant *wpa_s = eloop_ctx;
542 	/* Enable the networks disabled during wpas_wps_reassoc */
543 	wpas_wps_reenable_networks(wpa_s);
544 }
545 
546 
547 static void wpa_supplicant_wps_event_success(struct wpa_supplicant *wpa_s)
548 {
549 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_SUCCESS);
550 	wpa_s->wps_success = 1;
551 	wpas_notify_wps_event_success(wpa_s);
552 
553 	/*
554 	 * Enable the networks disabled during wpas_wps_reassoc after 10
555 	 * seconds. The 10 seconds timer is to allow the data connection to be
556 	 * formed before allowing other networks to be selected.
557 	 */
558 	eloop_register_timeout(10, 0, wpas_wps_reenable_networks_cb, wpa_s,
559 			       NULL);
560 
561 #ifdef CONFIG_P2P
562 	wpas_p2p_wps_success(wpa_s, wpa_s->bssid, 0);
563 #endif /* CONFIG_P2P */
564 }
565 
566 
567 static void wpa_supplicant_wps_event_er_ap_add(struct wpa_supplicant *wpa_s,
568 					       struct wps_event_er_ap *ap)
569 {
570 	char uuid_str[100];
571 	char dev_type[WPS_DEV_TYPE_BUFSIZE];
572 
573 	uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
574 	if (ap->pri_dev_type)
575 		wps_dev_type_bin2str(ap->pri_dev_type, dev_type,
576 				     sizeof(dev_type));
577 	else
578 		dev_type[0] = '\0';
579 
580 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_ADD "%s " MACSTR
581 		" pri_dev_type=%s wps_state=%d |%s|%s|%s|%s|%s|%s|",
582 		uuid_str, MAC2STR(ap->mac_addr), dev_type, ap->wps_state,
583 		ap->friendly_name ? ap->friendly_name : "",
584 		ap->manufacturer ? ap->manufacturer : "",
585 		ap->model_description ? ap->model_description : "",
586 		ap->model_name ? ap->model_name : "",
587 		ap->manufacturer_url ? ap->manufacturer_url : "",
588 		ap->model_url ? ap->model_url : "");
589 }
590 
591 
592 static void wpa_supplicant_wps_event_er_ap_remove(struct wpa_supplicant *wpa_s,
593 						  struct wps_event_er_ap *ap)
594 {
595 	char uuid_str[100];
596 	uuid_bin2str(ap->uuid, uuid_str, sizeof(uuid_str));
597 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_REMOVE "%s", uuid_str);
598 }
599 
600 
601 static void wpa_supplicant_wps_event_er_enrollee_add(
602 	struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
603 {
604 	char uuid_str[100];
605 	char dev_type[WPS_DEV_TYPE_BUFSIZE];
606 
607 	uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
608 	if (enrollee->pri_dev_type)
609 		wps_dev_type_bin2str(enrollee->pri_dev_type, dev_type,
610 				     sizeof(dev_type));
611 	else
612 		dev_type[0] = '\0';
613 
614 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_ADD "%s " MACSTR
615 		" M1=%d config_methods=0x%x dev_passwd_id=%d pri_dev_type=%s "
616 		"|%s|%s|%s|%s|%s|",
617 		uuid_str, MAC2STR(enrollee->mac_addr), enrollee->m1_received,
618 		enrollee->config_methods, enrollee->dev_passwd_id, dev_type,
619 		enrollee->dev_name ? enrollee->dev_name : "",
620 		enrollee->manufacturer ? enrollee->manufacturer : "",
621 		enrollee->model_name ? enrollee->model_name : "",
622 		enrollee->model_number ? enrollee->model_number : "",
623 		enrollee->serial_number ? enrollee->serial_number : "");
624 }
625 
626 
627 static void wpa_supplicant_wps_event_er_enrollee_remove(
628 	struct wpa_supplicant *wpa_s, struct wps_event_er_enrollee *enrollee)
629 {
630 	char uuid_str[100];
631 	uuid_bin2str(enrollee->uuid, uuid_str, sizeof(uuid_str));
632 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_ENROLLEE_REMOVE "%s " MACSTR,
633 		uuid_str, MAC2STR(enrollee->mac_addr));
634 }
635 
636 
637 static void wpa_supplicant_wps_event_er_ap_settings(
638 	struct wpa_supplicant *wpa_s,
639 	struct wps_event_er_ap_settings *ap_settings)
640 {
641 	char uuid_str[100];
642 	char key_str[65];
643 	const struct wps_credential *cred = ap_settings->cred;
644 
645 	key_str[0] = '\0';
646 	if (cred->auth_type & (WPS_AUTH_WPAPSK | WPS_AUTH_WPA2PSK)) {
647 		if (cred->key_len >= 8 && cred->key_len <= 64) {
648 			os_memcpy(key_str, cred->key, cred->key_len);
649 			key_str[cred->key_len] = '\0';
650 		}
651 	}
652 
653 	uuid_bin2str(ap_settings->uuid, uuid_str, sizeof(uuid_str));
654 	/* Use wpa_msg_ctrl to avoid showing the key in debug log */
655 	wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_ER_AP_SETTINGS
656 		     "uuid=%s ssid=%s auth_type=0x%04x encr_type=0x%04x "
657 		     "key=%s",
658 		     uuid_str, wpa_ssid_txt(cred->ssid, cred->ssid_len),
659 		     cred->auth_type, cred->encr_type, key_str);
660 }
661 
662 
663 static void wpa_supplicant_wps_event_er_set_sel_reg(
664 	struct wpa_supplicant *wpa_s,
665 	struct wps_event_er_set_selected_registrar *ev)
666 {
667 	char uuid_str[100];
668 
669 	uuid_bin2str(ev->uuid, uuid_str, sizeof(uuid_str));
670 	switch (ev->state) {
671 	case WPS_ER_SET_SEL_REG_START:
672 		wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
673 			"uuid=%s state=START sel_reg=%d dev_passwd_id=%u "
674 			"sel_reg_config_methods=0x%x",
675 			uuid_str, ev->sel_reg, ev->dev_passwd_id,
676 			ev->sel_reg_config_methods);
677 		break;
678 	case WPS_ER_SET_SEL_REG_DONE:
679 		wpa_msg(wpa_s, MSG_DEBUG, WPS_EVENT_ER_SET_SEL_REG
680 			"uuid=%s state=DONE", uuid_str);
681 		break;
682 	case WPS_ER_SET_SEL_REG_FAILED:
683 		wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_ER_SET_SEL_REG
684 			"uuid=%s state=FAILED", uuid_str);
685 		break;
686 	}
687 }
688 
689 
690 static void wpa_supplicant_wps_event(void *ctx, enum wps_event event,
691 				     union wps_event_data *data)
692 {
693 	struct wpa_supplicant *wpa_s = ctx;
694 	switch (event) {
695 	case WPS_EV_M2D:
696 		wpa_supplicant_wps_event_m2d(wpa_s, &data->m2d);
697 		break;
698 	case WPS_EV_FAIL:
699 		wpa_supplicant_wps_event_fail(wpa_s, &data->fail);
700 		break;
701 	case WPS_EV_SUCCESS:
702 		wpa_supplicant_wps_event_success(wpa_s);
703 		break;
704 	case WPS_EV_PWD_AUTH_FAIL:
705 #ifdef CONFIG_AP
706 		if (wpa_s->ap_iface && data->pwd_auth_fail.enrollee)
707 			wpa_supplicant_ap_pwd_auth_fail(wpa_s);
708 #endif /* CONFIG_AP */
709 		break;
710 	case WPS_EV_PBC_OVERLAP:
711 		break;
712 	case WPS_EV_PBC_TIMEOUT:
713 		break;
714 	case WPS_EV_ER_AP_ADD:
715 		wpa_supplicant_wps_event_er_ap_add(wpa_s, &data->ap);
716 		break;
717 	case WPS_EV_ER_AP_REMOVE:
718 		wpa_supplicant_wps_event_er_ap_remove(wpa_s, &data->ap);
719 		break;
720 	case WPS_EV_ER_ENROLLEE_ADD:
721 		wpa_supplicant_wps_event_er_enrollee_add(wpa_s,
722 							 &data->enrollee);
723 		break;
724 	case WPS_EV_ER_ENROLLEE_REMOVE:
725 		wpa_supplicant_wps_event_er_enrollee_remove(wpa_s,
726 							    &data->enrollee);
727 		break;
728 	case WPS_EV_ER_AP_SETTINGS:
729 		wpa_supplicant_wps_event_er_ap_settings(wpa_s,
730 							&data->ap_settings);
731 		break;
732 	case WPS_EV_ER_SET_SELECTED_REGISTRAR:
733 		wpa_supplicant_wps_event_er_set_sel_reg(wpa_s,
734 							&data->set_sel_reg);
735 		break;
736 	case WPS_EV_AP_PIN_SUCCESS:
737 		break;
738 	}
739 }
740 
741 
742 enum wps_request_type wpas_wps_get_req_type(struct wpa_ssid *ssid)
743 {
744 	if (eap_is_wps_pbc_enrollee(&ssid->eap) ||
745 	    eap_is_wps_pin_enrollee(&ssid->eap))
746 		return WPS_REQ_ENROLLEE;
747 	else
748 		return WPS_REQ_REGISTRAR;
749 }
750 
751 
752 static void wpas_clear_wps(struct wpa_supplicant *wpa_s)
753 {
754 	int id;
755 	struct wpa_ssid *ssid, *remove_ssid = NULL, *prev_current;
756 
757 	prev_current = wpa_s->current_ssid;
758 
759 	/* Enable the networks disabled during wpas_wps_reassoc */
760 	wpas_wps_reenable_networks(wpa_s);
761 
762 	eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
763 
764 	/* Remove any existing WPS network from configuration */
765 	ssid = wpa_s->conf->ssid;
766 	while (ssid) {
767 		if (ssid->key_mgmt & WPA_KEY_MGMT_WPS) {
768 			if (ssid == wpa_s->current_ssid) {
769 				wpa_s->current_ssid = NULL;
770 				if (ssid != NULL)
771 					wpas_notify_network_changed(wpa_s);
772 			}
773 			id = ssid->id;
774 			remove_ssid = ssid;
775 		} else
776 			id = -1;
777 		ssid = ssid->next;
778 		if (id >= 0) {
779 			if (prev_current == remove_ssid) {
780 				wpa_sm_set_config(wpa_s->wpa, NULL);
781 				eapol_sm_notify_config(wpa_s->eapol, NULL,
782 						       NULL);
783 			}
784 			wpas_notify_network_removed(wpa_s, remove_ssid);
785 			wpa_config_remove_network(wpa_s->conf, id);
786 		}
787 	}
788 
789 	wpas_wps_clear_ap_info(wpa_s);
790 }
791 
792 
793 static void wpas_wps_timeout(void *eloop_ctx, void *timeout_ctx)
794 {
795 	struct wpa_supplicant *wpa_s = eloop_ctx;
796 	wpa_msg(wpa_s, MSG_INFO, WPS_EVENT_TIMEOUT "Requested operation timed "
797 		"out");
798 	wpas_clear_wps(wpa_s);
799 }
800 
801 
802 static struct wpa_ssid * wpas_wps_add_network(struct wpa_supplicant *wpa_s,
803 					      int registrar, const u8 *bssid)
804 {
805 	struct wpa_ssid *ssid;
806 
807 	ssid = wpa_config_add_network(wpa_s->conf);
808 	if (ssid == NULL)
809 		return NULL;
810 	wpas_notify_network_added(wpa_s, ssid);
811 	wpa_config_set_network_defaults(ssid);
812 	ssid->temporary = 1;
813 	if (wpa_config_set(ssid, "key_mgmt", "WPS", 0) < 0 ||
814 	    wpa_config_set(ssid, "eap", "WSC", 0) < 0 ||
815 	    wpa_config_set(ssid, "identity", registrar ?
816 			   "\"" WSC_ID_REGISTRAR "\"" :
817 			   "\"" WSC_ID_ENROLLEE "\"", 0) < 0) {
818 		wpas_notify_network_removed(wpa_s, ssid);
819 		wpa_config_remove_network(wpa_s->conf, ssid->id);
820 		return NULL;
821 	}
822 
823 	if (bssid) {
824 #ifndef CONFIG_P2P
825 		struct wpa_bss *bss;
826 		int count = 0;
827 #endif /* CONFIG_P2P */
828 
829 		os_memcpy(ssid->bssid, bssid, ETH_ALEN);
830 		ssid->bssid_set = 1;
831 
832 		/*
833 		 * Note: With P2P, the SSID may change at the time the WPS
834 		 * provisioning is started, so better not filter the AP based
835 		 * on the current SSID in the scan results.
836 		 */
837 #ifndef CONFIG_P2P
838 		dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
839 			if (os_memcmp(bssid, bss->bssid, ETH_ALEN) != 0)
840 				continue;
841 
842 			os_free(ssid->ssid);
843 			ssid->ssid = os_malloc(bss->ssid_len);
844 			if (ssid->ssid == NULL)
845 				break;
846 			os_memcpy(ssid->ssid, bss->ssid, bss->ssid_len);
847 			ssid->ssid_len = bss->ssid_len;
848 			wpa_hexdump_ascii(MSG_DEBUG, "WPS: Picked SSID from "
849 					  "scan results",
850 					  ssid->ssid, ssid->ssid_len);
851 			count++;
852 		}
853 
854 		if (count > 1) {
855 			wpa_printf(MSG_DEBUG, "WPS: More than one SSID found "
856 				   "for the AP; use wildcard");
857 			os_free(ssid->ssid);
858 			ssid->ssid = NULL;
859 			ssid->ssid_len = 0;
860 		}
861 #endif /* CONFIG_P2P */
862 	}
863 
864 	return ssid;
865 }
866 
867 
868 static void wpas_wps_reassoc(struct wpa_supplicant *wpa_s,
869 			     struct wpa_ssid *selected, const u8 *bssid)
870 {
871 	struct wpa_ssid *ssid;
872 	struct wpa_bss *bss;
873 
874 	wpa_s->known_wps_freq = 0;
875 	if (bssid) {
876 		bss = wpa_bss_get_bssid(wpa_s, bssid);
877 		if (bss && bss->freq > 0) {
878 			wpa_s->known_wps_freq = 1;
879 			wpa_s->wps_freq = bss->freq;
880 		}
881 	}
882 
883 	if (wpa_s->current_ssid)
884 		wpa_supplicant_deauthenticate(
885 			wpa_s, WLAN_REASON_DEAUTH_LEAVING);
886 
887 	/* Mark all other networks disabled and trigger reassociation */
888 	ssid = wpa_s->conf->ssid;
889 	while (ssid) {
890 		int was_disabled = ssid->disabled;
891 		ssid->disabled_for_connect = 0;
892 		/*
893 		 * In case the network object corresponds to a persistent group
894 		 * then do not send out network disabled signal. In addition,
895 		 * do not change disabled status of persistent network objects
896 		 * from 2 to 1 should we connect to another network.
897 		 */
898 		if (was_disabled != 2) {
899 			ssid->disabled = ssid != selected;
900 			if (was_disabled != ssid->disabled) {
901 				if (ssid->disabled)
902 					ssid->disabled_for_connect = 1;
903 				wpas_notify_network_enabled_changed(wpa_s,
904 								    ssid);
905 			}
906 		}
907 		ssid = ssid->next;
908 	}
909 	wpa_s->disconnected = 0;
910 	wpa_s->reassociate = 1;
911 	wpa_s->scan_runs = 0;
912 	wpa_s->normal_scans = 0;
913 	wpa_s->wps_success = 0;
914 	wpa_s->blacklist_cleared = 0;
915 	wpa_supplicant_req_scan(wpa_s, 0, 0);
916 }
917 
918 
919 int wpas_wps_start_pbc(struct wpa_supplicant *wpa_s, const u8 *bssid,
920 		       int p2p_group)
921 {
922 	struct wpa_ssid *ssid;
923 	wpas_clear_wps(wpa_s);
924 	ssid = wpas_wps_add_network(wpa_s, 0, bssid);
925 	if (ssid == NULL)
926 		return -1;
927 	ssid->temporary = 1;
928 	ssid->p2p_group = p2p_group;
929 #ifdef CONFIG_P2P
930 	if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
931 		ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
932 		if (ssid->ssid) {
933 			ssid->ssid_len = wpa_s->go_params->ssid_len;
934 			os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
935 				  ssid->ssid_len);
936 			wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
937 					  "SSID", ssid->ssid, ssid->ssid_len);
938 		}
939 	}
940 #endif /* CONFIG_P2P */
941 	wpa_config_set(ssid, "phase1", "\"pbc=1\"", 0);
942 	if (wpa_s->wps_fragment_size)
943 		ssid->eap.fragment_size = wpa_s->wps_fragment_size;
944 	eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
945 			       wpa_s, NULL);
946 	wpas_wps_reassoc(wpa_s, ssid, bssid);
947 	return 0;
948 }
949 
950 
951 int wpas_wps_start_pin(struct wpa_supplicant *wpa_s, const u8 *bssid,
952 		       const char *pin, int p2p_group, u16 dev_pw_id)
953 {
954 	struct wpa_ssid *ssid;
955 	char val[128];
956 	unsigned int rpin = 0;
957 
958 	wpas_clear_wps(wpa_s);
959 	ssid = wpas_wps_add_network(wpa_s, 0, bssid);
960 	if (ssid == NULL)
961 		return -1;
962 	ssid->temporary = 1;
963 	ssid->p2p_group = p2p_group;
964 #ifdef CONFIG_P2P
965 	if (p2p_group && wpa_s->go_params && wpa_s->go_params->ssid_len) {
966 		ssid->ssid = os_zalloc(wpa_s->go_params->ssid_len + 1);
967 		if (ssid->ssid) {
968 			ssid->ssid_len = wpa_s->go_params->ssid_len;
969 			os_memcpy(ssid->ssid, wpa_s->go_params->ssid,
970 				  ssid->ssid_len);
971 			wpa_hexdump_ascii(MSG_DEBUG, "WPS: Use specific AP "
972 					  "SSID", ssid->ssid, ssid->ssid_len);
973 		}
974 	}
975 #endif /* CONFIG_P2P */
976 	if (pin)
977 		os_snprintf(val, sizeof(val), "\"pin=%s dev_pw_id=%u\"",
978 			    pin, dev_pw_id);
979 	else {
980 		rpin = wps_generate_pin();
981 		os_snprintf(val, sizeof(val), "\"pin=%08d dev_pw_id=%u\"",
982 			    rpin, dev_pw_id);
983 	}
984 	wpa_config_set(ssid, "phase1", val, 0);
985 	if (wpa_s->wps_fragment_size)
986 		ssid->eap.fragment_size = wpa_s->wps_fragment_size;
987 	eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
988 			       wpa_s, NULL);
989 	wpa_s->wps_ap_iter = 1;
990 	wpas_wps_reassoc(wpa_s, ssid, bssid);
991 	return rpin;
992 }
993 
994 
995 /* Cancel the wps pbc/pin requests */
996 int wpas_wps_cancel(struct wpa_supplicant *wpa_s)
997 {
998 #ifdef CONFIG_AP
999 	if (wpa_s->ap_iface) {
1000 		wpa_printf(MSG_DEBUG, "WPS: Cancelling in AP mode");
1001 		return wpa_supplicant_ap_wps_cancel(wpa_s);
1002 	}
1003 #endif /* CONFIG_AP */
1004 
1005 	if (wpa_s->wpa_state == WPA_SCANNING ||
1006 	    wpa_s->wpa_state == WPA_DISCONNECTED) {
1007 		wpa_printf(MSG_DEBUG, "WPS: Cancel operation - cancel scan");
1008 		wpa_supplicant_cancel_scan(wpa_s);
1009 		wpas_clear_wps(wpa_s);
1010 	} else if (wpa_s->wpa_state >= WPA_ASSOCIATED) {
1011 		wpa_printf(MSG_DEBUG, "WPS: Cancel operation - "
1012 			   "deauthenticate");
1013 		wpa_supplicant_deauthenticate(wpa_s,
1014 					      WLAN_REASON_DEAUTH_LEAVING);
1015 		wpas_clear_wps(wpa_s);
1016 	} else {
1017 		wpas_wps_reenable_networks(wpa_s);
1018 		wpas_wps_clear_ap_info(wpa_s);
1019 	}
1020 
1021 	return 0;
1022 }
1023 
1024 
1025 int wpas_wps_start_reg(struct wpa_supplicant *wpa_s, const u8 *bssid,
1026 		       const char *pin, struct wps_new_ap_settings *settings)
1027 {
1028 	struct wpa_ssid *ssid;
1029 	char val[200];
1030 	char *pos, *end;
1031 	int res;
1032 
1033 	if (!pin)
1034 		return -1;
1035 	wpas_clear_wps(wpa_s);
1036 	ssid = wpas_wps_add_network(wpa_s, 1, bssid);
1037 	if (ssid == NULL)
1038 		return -1;
1039 	ssid->temporary = 1;
1040 	pos = val;
1041 	end = pos + sizeof(val);
1042 	res = os_snprintf(pos, end - pos, "\"pin=%s", pin);
1043 	if (res < 0 || res >= end - pos)
1044 		return -1;
1045 	pos += res;
1046 	if (settings) {
1047 		res = os_snprintf(pos, end - pos, " new_ssid=%s new_auth=%s "
1048 				  "new_encr=%s new_key=%s",
1049 				  settings->ssid_hex, settings->auth,
1050 				  settings->encr, settings->key_hex);
1051 		if (res < 0 || res >= end - pos)
1052 			return -1;
1053 		pos += res;
1054 	}
1055 	res = os_snprintf(pos, end - pos, "\"");
1056 	if (res < 0 || res >= end - pos)
1057 		return -1;
1058 	wpa_config_set(ssid, "phase1", val, 0);
1059 	if (wpa_s->wps_fragment_size)
1060 		ssid->eap.fragment_size = wpa_s->wps_fragment_size;
1061 	eloop_register_timeout(WPS_PBC_WALK_TIME, 0, wpas_wps_timeout,
1062 			       wpa_s, NULL);
1063 	wpas_wps_reassoc(wpa_s, ssid, bssid);
1064 	return 0;
1065 }
1066 
1067 
1068 static int wpas_wps_new_psk_cb(void *ctx, const u8 *mac_addr, const u8 *psk,
1069 			       size_t psk_len)
1070 {
1071 	wpa_printf(MSG_DEBUG, "WPS: Received new WPA/WPA2-PSK from WPS for "
1072 		   "STA " MACSTR, MAC2STR(mac_addr));
1073 	wpa_hexdump_key(MSG_DEBUG, "Per-device PSK", psk, psk_len);
1074 
1075 	/* TODO */
1076 
1077 	return 0;
1078 }
1079 
1080 
1081 static void wpas_wps_pin_needed_cb(void *ctx, const u8 *uuid_e,
1082 				   const struct wps_device_data *dev)
1083 {
1084 	char uuid[40], txt[400];
1085 	int len;
1086 	char devtype[WPS_DEV_TYPE_BUFSIZE];
1087 	if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
1088 		return;
1089 	wpa_printf(MSG_DEBUG, "WPS: PIN needed for UUID-E %s", uuid);
1090 	len = os_snprintf(txt, sizeof(txt), "WPS-EVENT-PIN-NEEDED %s " MACSTR
1091 			  " [%s|%s|%s|%s|%s|%s]",
1092 			  uuid, MAC2STR(dev->mac_addr), dev->device_name,
1093 			  dev->manufacturer, dev->model_name,
1094 			  dev->model_number, dev->serial_number,
1095 			  wps_dev_type_bin2str(dev->pri_dev_type, devtype,
1096 					       sizeof(devtype)));
1097 	if (len > 0 && len < (int) sizeof(txt))
1098 		wpa_printf(MSG_INFO, "%s", txt);
1099 }
1100 
1101 
1102 static void wpas_wps_set_sel_reg_cb(void *ctx, int sel_reg, u16 dev_passwd_id,
1103 				    u16 sel_reg_config_methods)
1104 {
1105 #ifdef CONFIG_WPS_ER
1106 	struct wpa_supplicant *wpa_s = ctx;
1107 
1108 	if (wpa_s->wps_er == NULL)
1109 		return;
1110 	wpa_printf(MSG_DEBUG, "WPS ER: SetSelectedRegistrar - sel_reg=%d "
1111 		   "dev_password_id=%u sel_reg_config_methods=0x%x",
1112 		   sel_reg, dev_passwd_id, sel_reg_config_methods);
1113 	wps_er_set_sel_reg(wpa_s->wps_er, sel_reg, dev_passwd_id,
1114 			   sel_reg_config_methods);
1115 #endif /* CONFIG_WPS_ER */
1116 }
1117 
1118 
1119 static u16 wps_fix_config_methods(u16 config_methods)
1120 {
1121 #ifdef CONFIG_WPS2
1122 	if ((config_methods &
1123 	     (WPS_CONFIG_DISPLAY | WPS_CONFIG_VIRT_DISPLAY |
1124 	      WPS_CONFIG_PHY_DISPLAY)) == WPS_CONFIG_DISPLAY) {
1125 		wpa_printf(MSG_INFO, "WPS: Converting display to "
1126 			   "virtual_display for WPS 2.0 compliance");
1127 		config_methods |= WPS_CONFIG_VIRT_DISPLAY;
1128 	}
1129 	if ((config_methods &
1130 	     (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_VIRT_PUSHBUTTON |
1131 	      WPS_CONFIG_PHY_PUSHBUTTON)) == WPS_CONFIG_PUSHBUTTON) {
1132 		wpa_printf(MSG_INFO, "WPS: Converting push_button to "
1133 			   "virtual_push_button for WPS 2.0 compliance");
1134 		config_methods |= WPS_CONFIG_VIRT_PUSHBUTTON;
1135 	}
1136 #endif /* CONFIG_WPS2 */
1137 
1138 	return config_methods;
1139 }
1140 
1141 
1142 static void wpas_wps_set_uuid(struct wpa_supplicant *wpa_s,
1143 			      struct wps_context *wps)
1144 {
1145 	wpa_printf(MSG_DEBUG, "WPS: Set UUID for interface %s", wpa_s->ifname);
1146 	if (is_nil_uuid(wpa_s->conf->uuid)) {
1147 		struct wpa_supplicant *first;
1148 		first = wpa_s->global->ifaces;
1149 		while (first && first->next)
1150 			first = first->next;
1151 		if (first && first != wpa_s) {
1152 			if (wps != wpa_s->global->ifaces->wps)
1153 				os_memcpy(wps->uuid,
1154 					  wpa_s->global->ifaces->wps->uuid,
1155 					  WPS_UUID_LEN);
1156 			wpa_hexdump(MSG_DEBUG, "WPS: UUID from the first "
1157 				    "interface", wps->uuid, WPS_UUID_LEN);
1158 		} else {
1159 			uuid_gen_mac_addr(wpa_s->own_addr, wps->uuid);
1160 			wpa_hexdump(MSG_DEBUG, "WPS: UUID based on MAC "
1161 				    "address", wps->uuid, WPS_UUID_LEN);
1162 		}
1163 	} else {
1164 		os_memcpy(wps->uuid, wpa_s->conf->uuid, WPS_UUID_LEN);
1165 		wpa_hexdump(MSG_DEBUG, "WPS: UUID based on configuration",
1166 			    wps->uuid, WPS_UUID_LEN);
1167 	}
1168 }
1169 
1170 
1171 static void wpas_wps_set_vendor_ext_m1(struct wpa_supplicant *wpa_s,
1172 				       struct wps_context *wps)
1173 {
1174 	wpabuf_free(wps->dev.vendor_ext_m1);
1175 	wps->dev.vendor_ext_m1 = NULL;
1176 
1177 	if (wpa_s->conf->wps_vendor_ext_m1) {
1178 		wps->dev.vendor_ext_m1 =
1179 			wpabuf_dup(wpa_s->conf->wps_vendor_ext_m1);
1180 		if (!wps->dev.vendor_ext_m1) {
1181 			wpa_printf(MSG_ERROR, "WPS: Cannot "
1182 				   "allocate memory for vendor_ext_m1");
1183 		}
1184 	}
1185 }
1186 
1187 
1188 int wpas_wps_init(struct wpa_supplicant *wpa_s)
1189 {
1190 	struct wps_context *wps;
1191 	struct wps_registrar_config rcfg;
1192 	struct hostapd_hw_modes *modes;
1193 	u16 m;
1194 
1195 	wps = os_zalloc(sizeof(*wps));
1196 	if (wps == NULL)
1197 		return -1;
1198 
1199 	wps->cred_cb = wpa_supplicant_wps_cred;
1200 	wps->event_cb = wpa_supplicant_wps_event;
1201 	wps->cb_ctx = wpa_s;
1202 
1203 	wps->dev.device_name = wpa_s->conf->device_name;
1204 	wps->dev.manufacturer = wpa_s->conf->manufacturer;
1205 	wps->dev.model_name = wpa_s->conf->model_name;
1206 	wps->dev.model_number = wpa_s->conf->model_number;
1207 	wps->dev.serial_number = wpa_s->conf->serial_number;
1208 	wps->config_methods =
1209 		wps_config_methods_str2bin(wpa_s->conf->config_methods);
1210 	if ((wps->config_methods & (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
1211 	    (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
1212 		wpa_printf(MSG_ERROR, "WPS: Both Label and Display config "
1213 			   "methods are not allowed at the same time");
1214 		os_free(wps);
1215 		return -1;
1216 	}
1217 	wps->config_methods = wps_fix_config_methods(wps->config_methods);
1218 	wps->dev.config_methods = wps->config_methods;
1219 	os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
1220 		  WPS_DEV_TYPE_LEN);
1221 
1222 	wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
1223 	os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
1224 		  WPS_DEV_TYPE_LEN * wps->dev.num_sec_dev_types);
1225 
1226 	wpas_wps_set_vendor_ext_m1(wpa_s, wps);
1227 
1228 	wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
1229 	modes = wpa_s->hw.modes;
1230 	if (modes) {
1231 		for (m = 0; m < wpa_s->hw.num_modes; m++) {
1232 			if (modes[m].mode == HOSTAPD_MODE_IEEE80211B ||
1233 			    modes[m].mode == HOSTAPD_MODE_IEEE80211G)
1234 				wps->dev.rf_bands |= WPS_RF_24GHZ;
1235 			else if (modes[m].mode == HOSTAPD_MODE_IEEE80211A)
1236 				wps->dev.rf_bands |= WPS_RF_50GHZ;
1237 		}
1238 	}
1239 	if (wps->dev.rf_bands == 0) {
1240 		/*
1241 		 * Default to claiming support for both bands if the driver
1242 		 * does not provide support for fetching supported bands.
1243 		 */
1244 		wps->dev.rf_bands = WPS_RF_24GHZ | WPS_RF_50GHZ;
1245 	}
1246 	os_memcpy(wps->dev.mac_addr, wpa_s->own_addr, ETH_ALEN);
1247 	wpas_wps_set_uuid(wpa_s, wps);
1248 
1249 	wps->auth_types = WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK;
1250 	wps->encr_types = WPS_ENCR_AES | WPS_ENCR_TKIP;
1251 
1252 	os_memset(&rcfg, 0, sizeof(rcfg));
1253 	rcfg.new_psk_cb = wpas_wps_new_psk_cb;
1254 	rcfg.pin_needed_cb = wpas_wps_pin_needed_cb;
1255 	rcfg.set_sel_reg_cb = wpas_wps_set_sel_reg_cb;
1256 	rcfg.cb_ctx = wpa_s;
1257 
1258 	wps->registrar = wps_registrar_init(wps, &rcfg);
1259 	if (wps->registrar == NULL) {
1260 		wpa_printf(MSG_DEBUG, "Failed to initialize WPS Registrar");
1261 		os_free(wps);
1262 		return -1;
1263 	}
1264 
1265 	wpa_s->wps = wps;
1266 
1267 	return 0;
1268 }
1269 
1270 
1271 void wpas_wps_deinit(struct wpa_supplicant *wpa_s)
1272 {
1273 	eloop_cancel_timeout(wpas_wps_timeout, wpa_s, NULL);
1274 	eloop_cancel_timeout(wpas_wps_reenable_networks_cb, wpa_s, NULL);
1275 	wpas_wps_clear_ap_info(wpa_s);
1276 
1277 	if (wpa_s->wps == NULL)
1278 		return;
1279 
1280 #ifdef CONFIG_WPS_ER
1281 	wps_er_deinit(wpa_s->wps_er, NULL, NULL);
1282 	wpa_s->wps_er = NULL;
1283 #endif /* CONFIG_WPS_ER */
1284 
1285 	wps_registrar_deinit(wpa_s->wps->registrar);
1286 	wpabuf_free(wpa_s->wps->dh_pubkey);
1287 	wpabuf_free(wpa_s->wps->dh_privkey);
1288 	wpabuf_free(wpa_s->wps->dev.vendor_ext_m1);
1289 	os_free(wpa_s->wps->network_key);
1290 	os_free(wpa_s->wps);
1291 	wpa_s->wps = NULL;
1292 }
1293 
1294 
1295 int wpas_wps_ssid_bss_match(struct wpa_supplicant *wpa_s,
1296 			    struct wpa_ssid *ssid, struct wpa_bss *bss)
1297 {
1298 	struct wpabuf *wps_ie;
1299 
1300 	if (!(ssid->key_mgmt & WPA_KEY_MGMT_WPS))
1301 		return -1;
1302 
1303 	wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1304 	if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
1305 		if (!wps_ie) {
1306 			wpa_printf(MSG_DEBUG, "   skip - non-WPS AP");
1307 			return 0;
1308 		}
1309 
1310 		if (!wps_is_selected_pbc_registrar(wps_ie)) {
1311 			wpa_printf(MSG_DEBUG, "   skip - WPS AP "
1312 				   "without active PBC Registrar");
1313 			wpabuf_free(wps_ie);
1314 			return 0;
1315 		}
1316 
1317 		/* TODO: overlap detection */
1318 		wpa_printf(MSG_DEBUG, "   selected based on WPS IE "
1319 			   "(Active PBC)");
1320 		wpabuf_free(wps_ie);
1321 		return 1;
1322 	}
1323 
1324 	if (eap_is_wps_pin_enrollee(&ssid->eap)) {
1325 		if (!wps_ie) {
1326 			wpa_printf(MSG_DEBUG, "   skip - non-WPS AP");
1327 			return 0;
1328 		}
1329 
1330 		/*
1331 		 * Start with WPS APs that advertise our address as an
1332 		 * authorized MAC (v2.0) or active PIN Registrar (v1.0) and
1333 		 * allow any WPS AP after couple of scans since some APs do not
1334 		 * set Selected Registrar attribute properly when using
1335 		 * external Registrar.
1336 		 */
1337 		if (!wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1)) {
1338 			if (wpa_s->scan_runs < WPS_PIN_SCAN_IGNORE_SEL_REG) {
1339 				wpa_printf(MSG_DEBUG, "   skip - WPS AP "
1340 					   "without active PIN Registrar");
1341 				wpabuf_free(wps_ie);
1342 				return 0;
1343 			}
1344 			wpa_printf(MSG_DEBUG, "   selected based on WPS IE");
1345 		} else {
1346 			wpa_printf(MSG_DEBUG, "   selected based on WPS IE "
1347 				   "(Authorized MAC or Active PIN)");
1348 		}
1349 		wpabuf_free(wps_ie);
1350 		return 1;
1351 	}
1352 
1353 	if (wps_ie) {
1354 		wpa_printf(MSG_DEBUG, "   selected based on WPS IE");
1355 		wpabuf_free(wps_ie);
1356 		return 1;
1357 	}
1358 
1359 	return -1;
1360 }
1361 
1362 
1363 int wpas_wps_ssid_wildcard_ok(struct wpa_supplicant *wpa_s,
1364 			      struct wpa_ssid *ssid,
1365 			      struct wpa_bss *bss)
1366 {
1367 	struct wpabuf *wps_ie = NULL;
1368 	int ret = 0;
1369 
1370 	if (eap_is_wps_pbc_enrollee(&ssid->eap)) {
1371 		wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1372 		if (wps_ie && wps_is_selected_pbc_registrar(wps_ie)) {
1373 			/* allow wildcard SSID for WPS PBC */
1374 			ret = 1;
1375 		}
1376 	} else if (eap_is_wps_pin_enrollee(&ssid->eap)) {
1377 		wps_ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1378 		if (wps_ie &&
1379 		    (wps_is_addr_authorized(wps_ie, wpa_s->own_addr, 1) ||
1380 		     wpa_s->scan_runs >= WPS_PIN_SCAN_IGNORE_SEL_REG)) {
1381 			/* allow wildcard SSID for WPS PIN */
1382 			ret = 1;
1383 		}
1384 	}
1385 
1386 	if (!ret && ssid->bssid_set &&
1387 	    os_memcmp(ssid->bssid, bss->bssid, ETH_ALEN) == 0) {
1388 		/* allow wildcard SSID due to hardcoded BSSID match */
1389 		ret = 1;
1390 	}
1391 
1392 #ifdef CONFIG_WPS_STRICT
1393 	if (wps_ie) {
1394 		if (wps_validate_beacon_probe_resp(wps_ie, bss->beacon_ie_len >
1395 						   0, bss->bssid) < 0)
1396 			ret = 0;
1397 		if (bss->beacon_ie_len) {
1398 			struct wpabuf *bcn_wps;
1399 			bcn_wps = wpa_bss_get_vendor_ie_multi_beacon(
1400 				bss, WPS_IE_VENDOR_TYPE);
1401 			if (bcn_wps == NULL) {
1402 				wpa_printf(MSG_DEBUG, "WPS: Mandatory WPS IE "
1403 					   "missing from AP Beacon");
1404 				ret = 0;
1405 			} else {
1406 				if (wps_validate_beacon(wps_ie) < 0)
1407 					ret = 0;
1408 				wpabuf_free(bcn_wps);
1409 			}
1410 		}
1411 	}
1412 #endif /* CONFIG_WPS_STRICT */
1413 
1414 	wpabuf_free(wps_ie);
1415 
1416 	return ret;
1417 }
1418 
1419 
1420 int wpas_wps_scan_pbc_overlap(struct wpa_supplicant *wpa_s,
1421 			      struct wpa_bss *selected, struct wpa_ssid *ssid)
1422 {
1423 	const u8 *sel_uuid, *uuid;
1424 	struct wpabuf *wps_ie;
1425 	int ret = 0;
1426 	struct wpa_bss *bss;
1427 
1428 	if (!eap_is_wps_pbc_enrollee(&ssid->eap))
1429 		return 0;
1430 
1431 	wpa_printf(MSG_DEBUG, "WPS: Check whether PBC session overlap is "
1432 		   "present in scan results; selected BSSID " MACSTR,
1433 		   MAC2STR(selected->bssid));
1434 
1435 	/* Make sure that only one AP is in active PBC mode */
1436 	wps_ie = wpa_bss_get_vendor_ie_multi(selected, WPS_IE_VENDOR_TYPE);
1437 	if (wps_ie) {
1438 		sel_uuid = wps_get_uuid_e(wps_ie);
1439 		wpa_hexdump(MSG_DEBUG, "WPS: UUID of the selected BSS",
1440 			    sel_uuid, UUID_LEN);
1441 	} else {
1442 		wpa_printf(MSG_DEBUG, "WPS: Selected BSS does not include "
1443 			   "WPS IE?!");
1444 		sel_uuid = NULL;
1445 	}
1446 
1447 	dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
1448 		struct wpabuf *ie;
1449 		if (bss == selected)
1450 			continue;
1451 		ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1452 		if (!ie)
1453 			continue;
1454 		if (!wps_is_selected_pbc_registrar(ie)) {
1455 			wpabuf_free(ie);
1456 			continue;
1457 		}
1458 		wpa_printf(MSG_DEBUG, "WPS: Another BSS in active PBC mode: "
1459 			   MACSTR, MAC2STR(bss->bssid));
1460 		uuid = wps_get_uuid_e(ie);
1461 		wpa_hexdump(MSG_DEBUG, "WPS: UUID of the other BSS",
1462 			    uuid, UUID_LEN);
1463 		if (sel_uuid == NULL || uuid == NULL ||
1464 		    os_memcmp(sel_uuid, uuid, UUID_LEN) != 0) {
1465 			ret = 1; /* PBC overlap */
1466 			wpa_msg(wpa_s, MSG_INFO, "WPS: PBC overlap detected: "
1467 				MACSTR " and " MACSTR,
1468 				MAC2STR(selected->bssid),
1469 				MAC2STR(bss->bssid));
1470 			wpabuf_free(ie);
1471 			break;
1472 		}
1473 
1474 		/* TODO: verify that this is reasonable dual-band situation */
1475 
1476 		wpabuf_free(ie);
1477 	}
1478 
1479 	wpabuf_free(wps_ie);
1480 
1481 	return ret;
1482 }
1483 
1484 
1485 void wpas_wps_notify_scan_results(struct wpa_supplicant *wpa_s)
1486 {
1487 	struct wpa_bss *bss;
1488 	unsigned int pbc = 0, auth = 0, pin = 0, wps = 0;
1489 
1490 	if (wpa_s->disconnected || wpa_s->wpa_state >= WPA_ASSOCIATED)
1491 		return;
1492 
1493 	dl_list_for_each(bss, &wpa_s->bss, struct wpa_bss, list) {
1494 		struct wpabuf *ie;
1495 		ie = wpa_bss_get_vendor_ie_multi(bss, WPS_IE_VENDOR_TYPE);
1496 		if (!ie)
1497 			continue;
1498 		if (wps_is_selected_pbc_registrar(ie))
1499 			pbc++;
1500 		else if (wps_is_addr_authorized(ie, wpa_s->own_addr, 0))
1501 			auth++;
1502 		else if (wps_is_selected_pin_registrar(ie))
1503 			pin++;
1504 		else
1505 			wps++;
1506 		wpabuf_free(ie);
1507 	}
1508 
1509 	if (pbc)
1510 		wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PBC);
1511 	else if (auth)
1512 		wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_AUTH);
1513 	else if (pin)
1514 		wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE_PIN);
1515 	else if (wps)
1516 		wpa_msg_ctrl(wpa_s, MSG_INFO, WPS_EVENT_AP_AVAILABLE);
1517 }
1518 
1519 
1520 int wpas_wps_searching(struct wpa_supplicant *wpa_s)
1521 {
1522 	struct wpa_ssid *ssid;
1523 
1524 	for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
1525 		if ((ssid->key_mgmt & WPA_KEY_MGMT_WPS) && !ssid->disabled)
1526 			return 1;
1527 	}
1528 
1529 	return 0;
1530 }
1531 
1532 
1533 int wpas_wps_scan_result_text(const u8 *ies, size_t ies_len, char *buf,
1534 			      char *end)
1535 {
1536 	struct wpabuf *wps_ie;
1537 	int ret;
1538 
1539 	wps_ie = ieee802_11_vendor_ie_concat(ies, ies_len, WPS_DEV_OUI_WFA);
1540 	if (wps_ie == NULL)
1541 		return 0;
1542 
1543 	ret = wps_attr_text(wps_ie, buf, end);
1544 	wpabuf_free(wps_ie);
1545 	return ret;
1546 }
1547 
1548 
1549 int wpas_wps_er_start(struct wpa_supplicant *wpa_s, const char *filter)
1550 {
1551 #ifdef CONFIG_WPS_ER
1552 	if (wpa_s->wps_er) {
1553 		wps_er_refresh(wpa_s->wps_er);
1554 		return 0;
1555 	}
1556 	wpa_s->wps_er = wps_er_init(wpa_s->wps, wpa_s->ifname, filter);
1557 	if (wpa_s->wps_er == NULL)
1558 		return -1;
1559 	return 0;
1560 #else /* CONFIG_WPS_ER */
1561 	return 0;
1562 #endif /* CONFIG_WPS_ER */
1563 }
1564 
1565 
1566 int wpas_wps_er_stop(struct wpa_supplicant *wpa_s)
1567 {
1568 #ifdef CONFIG_WPS_ER
1569 	wps_er_deinit(wpa_s->wps_er, NULL, NULL);
1570 	wpa_s->wps_er = NULL;
1571 #endif /* CONFIG_WPS_ER */
1572 	return 0;
1573 }
1574 
1575 
1576 #ifdef CONFIG_WPS_ER
1577 int wpas_wps_er_add_pin(struct wpa_supplicant *wpa_s, const u8 *addr,
1578 			const char *uuid, const char *pin)
1579 {
1580 	u8 u[UUID_LEN];
1581 	int any = 0;
1582 
1583 	if (os_strcmp(uuid, "any") == 0)
1584 		any = 1;
1585 	else if (uuid_str2bin(uuid, u))
1586 		return -1;
1587 	return wps_registrar_add_pin(wpa_s->wps->registrar, addr,
1588 				     any ? NULL : u,
1589 				     (const u8 *) pin, os_strlen(pin), 300);
1590 }
1591 
1592 
1593 int wpas_wps_er_pbc(struct wpa_supplicant *wpa_s, const char *uuid)
1594 {
1595 	u8 u[UUID_LEN];
1596 
1597 	if (uuid_str2bin(uuid, u))
1598 		return -1;
1599 	return wps_er_pbc(wpa_s->wps_er, u);
1600 }
1601 
1602 
1603 int wpas_wps_er_learn(struct wpa_supplicant *wpa_s, const char *uuid,
1604 		      const char *pin)
1605 {
1606 	u8 u[UUID_LEN];
1607 
1608 	if (uuid_str2bin(uuid, u))
1609 		return -1;
1610 	return wps_er_learn(wpa_s->wps_er, u, (const u8 *) pin,
1611 			    os_strlen(pin));
1612 }
1613 
1614 
1615 int wpas_wps_er_set_config(struct wpa_supplicant *wpa_s, const char *uuid,
1616 			   int id)
1617 {
1618 	u8 u[UUID_LEN];
1619 	struct wpa_ssid *ssid;
1620 	struct wps_credential cred;
1621 
1622 	if (uuid_str2bin(uuid, u))
1623 		return -1;
1624 	ssid = wpa_config_get_network(wpa_s->conf, id);
1625 	if (ssid == NULL || ssid->ssid == NULL)
1626 		return -1;
1627 
1628 	os_memset(&cred, 0, sizeof(cred));
1629 	if (ssid->ssid_len > 32)
1630 		return -1;
1631 	os_memcpy(cred.ssid, ssid->ssid, ssid->ssid_len);
1632 	cred.ssid_len = ssid->ssid_len;
1633 	if (ssid->key_mgmt & WPA_KEY_MGMT_PSK) {
1634 		cred.auth_type = (ssid->proto & WPA_PROTO_RSN) ?
1635 			WPS_AUTH_WPA2PSK : WPS_AUTH_WPAPSK;
1636 		if (ssid->pairwise_cipher & WPA_CIPHER_CCMP)
1637 			cred.encr_type = WPS_ENCR_AES;
1638 		else
1639 			cred.encr_type = WPS_ENCR_TKIP;
1640 		if (ssid->passphrase) {
1641 			cred.key_len = os_strlen(ssid->passphrase);
1642 			if (cred.key_len >= 64)
1643 				return -1;
1644 			os_memcpy(cred.key, ssid->passphrase, cred.key_len);
1645 		} else if (ssid->psk_set) {
1646 			cred.key_len = 32;
1647 			os_memcpy(cred.key, ssid->psk, 32);
1648 		} else
1649 			return -1;
1650 	} else {
1651 		cred.auth_type = WPS_AUTH_OPEN;
1652 		cred.encr_type = WPS_ENCR_NONE;
1653 	}
1654 	return wps_er_set_config(wpa_s->wps_er, u, &cred);
1655 }
1656 
1657 
1658 int wpas_wps_er_config(struct wpa_supplicant *wpa_s, const char *uuid,
1659 		       const char *pin, struct wps_new_ap_settings *settings)
1660 {
1661 	u8 u[UUID_LEN];
1662 	struct wps_credential cred;
1663 	size_t len;
1664 
1665 	if (uuid_str2bin(uuid, u))
1666 		return -1;
1667 	if (settings->ssid_hex == NULL || settings->auth == NULL ||
1668 	    settings->encr == NULL || settings->key_hex == NULL)
1669 		return -1;
1670 
1671 	os_memset(&cred, 0, sizeof(cred));
1672 	len = os_strlen(settings->ssid_hex);
1673 	if ((len & 1) || len > 2 * sizeof(cred.ssid) ||
1674 	    hexstr2bin(settings->ssid_hex, cred.ssid, len / 2))
1675 		return -1;
1676 	cred.ssid_len = len / 2;
1677 
1678 	len = os_strlen(settings->key_hex);
1679 	if ((len & 1) || len > 2 * sizeof(cred.key) ||
1680 	    hexstr2bin(settings->key_hex, cred.key, len / 2))
1681 		return -1;
1682 	cred.key_len = len / 2;
1683 
1684 	if (os_strcmp(settings->auth, "OPEN") == 0)
1685 		cred.auth_type = WPS_AUTH_OPEN;
1686 	else if (os_strcmp(settings->auth, "WPAPSK") == 0)
1687 		cred.auth_type = WPS_AUTH_WPAPSK;
1688 	else if (os_strcmp(settings->auth, "WPA2PSK") == 0)
1689 		cred.auth_type = WPS_AUTH_WPA2PSK;
1690 	else
1691 		return -1;
1692 
1693 	if (os_strcmp(settings->encr, "NONE") == 0)
1694 		cred.encr_type = WPS_ENCR_NONE;
1695 	else if (os_strcmp(settings->encr, "WEP") == 0)
1696 		cred.encr_type = WPS_ENCR_WEP;
1697 	else if (os_strcmp(settings->encr, "TKIP") == 0)
1698 		cred.encr_type = WPS_ENCR_TKIP;
1699 	else if (os_strcmp(settings->encr, "CCMP") == 0)
1700 		cred.encr_type = WPS_ENCR_AES;
1701 	else
1702 		return -1;
1703 
1704 	return wps_er_config(wpa_s->wps_er, u, (const u8 *) pin,
1705 			     os_strlen(pin), &cred);
1706 }
1707 
1708 
1709 #ifdef CONFIG_WPS_NFC
1710 struct wpabuf * wpas_wps_er_nfc_config_token(struct wpa_supplicant *wpa_s,
1711 					     int ndef, const char *uuid)
1712 {
1713 	struct wpabuf *ret;
1714 	u8 u[UUID_LEN];
1715 
1716 	if (!wpa_s->wps_er)
1717 		return NULL;
1718 
1719 	if (uuid_str2bin(uuid, u))
1720 		return NULL;
1721 
1722 	ret = wps_er_nfc_config_token(wpa_s->wps_er, u);
1723 	if (ndef && ret) {
1724 		struct wpabuf *tmp;
1725 		tmp = ndef_build_wifi(ret);
1726 		wpabuf_free(ret);
1727 		if (tmp == NULL)
1728 			return NULL;
1729 		ret = tmp;
1730 	}
1731 
1732 	return ret;
1733 }
1734 #endif /* CONFIG_WPS_NFC */
1735 
1736 
1737 static int callbacks_pending = 0;
1738 
1739 static void wpas_wps_terminate_cb(void *ctx)
1740 {
1741 	wpa_printf(MSG_DEBUG, "WPS ER: Terminated");
1742 	if (--callbacks_pending <= 0)
1743 		eloop_terminate();
1744 }
1745 #endif /* CONFIG_WPS_ER */
1746 
1747 
1748 int wpas_wps_terminate_pending(struct wpa_supplicant *wpa_s)
1749 {
1750 #ifdef CONFIG_WPS_ER
1751 	if (wpa_s->wps_er) {
1752 		callbacks_pending++;
1753 		wps_er_deinit(wpa_s->wps_er, wpas_wps_terminate_cb, wpa_s);
1754 		wpa_s->wps_er = NULL;
1755 		return 1;
1756 	}
1757 #endif /* CONFIG_WPS_ER */
1758 	return 0;
1759 }
1760 
1761 
1762 int wpas_wps_in_progress(struct wpa_supplicant *wpa_s)
1763 {
1764 	struct wpa_ssid *ssid;
1765 
1766 	for (ssid = wpa_s->conf->ssid; ssid; ssid = ssid->next) {
1767 		if (!ssid->disabled && ssid->key_mgmt == WPA_KEY_MGMT_WPS)
1768 			return 1;
1769 	}
1770 
1771 	return 0;
1772 }
1773 
1774 
1775 void wpas_wps_update_config(struct wpa_supplicant *wpa_s)
1776 {
1777 	struct wps_context *wps = wpa_s->wps;
1778 
1779 	if (wps == NULL)
1780 		return;
1781 
1782 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_CONFIG_METHODS) {
1783 		wps->config_methods = wps_config_methods_str2bin(
1784 			wpa_s->conf->config_methods);
1785 		if ((wps->config_methods &
1786 		     (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) ==
1787 		    (WPS_CONFIG_DISPLAY | WPS_CONFIG_LABEL)) {
1788 			wpa_printf(MSG_ERROR, "WPS: Both Label and Display "
1789 				   "config methods are not allowed at the "
1790 				   "same time");
1791 			wps->config_methods &= ~WPS_CONFIG_LABEL;
1792 		}
1793 	}
1794 	wps->config_methods = wps_fix_config_methods(wps->config_methods);
1795 	wps->dev.config_methods = wps->config_methods;
1796 
1797 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_DEVICE_TYPE)
1798 		os_memcpy(wps->dev.pri_dev_type, wpa_s->conf->device_type,
1799 			  WPS_DEV_TYPE_LEN);
1800 
1801 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_SEC_DEVICE_TYPE) {
1802 		wps->dev.num_sec_dev_types = wpa_s->conf->num_sec_device_types;
1803 		os_memcpy(wps->dev.sec_dev_type, wpa_s->conf->sec_device_type,
1804 			  wps->dev.num_sec_dev_types * WPS_DEV_TYPE_LEN);
1805 	}
1806 
1807 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_VENDOR_EXTENSION)
1808 		wpas_wps_set_vendor_ext_m1(wpa_s, wps);
1809 
1810 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_OS_VERSION)
1811 		wps->dev.os_version = WPA_GET_BE32(wpa_s->conf->os_version);
1812 
1813 	if (wpa_s->conf->changed_parameters & CFG_CHANGED_UUID)
1814 		wpas_wps_set_uuid(wpa_s, wps);
1815 
1816 	if (wpa_s->conf->changed_parameters &
1817 	    (CFG_CHANGED_DEVICE_NAME | CFG_CHANGED_WPS_STRING)) {
1818 		/* Update pointers to make sure they refer current values */
1819 		wps->dev.device_name = wpa_s->conf->device_name;
1820 		wps->dev.manufacturer = wpa_s->conf->manufacturer;
1821 		wps->dev.model_name = wpa_s->conf->model_name;
1822 		wps->dev.model_number = wpa_s->conf->model_number;
1823 		wps->dev.serial_number = wpa_s->conf->serial_number;
1824 	}
1825 }
1826 
1827 
1828 #ifdef CONFIG_WPS_NFC
1829 
1830 struct wpabuf * wpas_wps_nfc_token(struct wpa_supplicant *wpa_s, int ndef)
1831 {
1832 	return wps_nfc_token_gen(ndef, &wpa_s->conf->wps_nfc_dev_pw_id,
1833 				 &wpa_s->conf->wps_nfc_dh_pubkey,
1834 				 &wpa_s->conf->wps_nfc_dh_privkey,
1835 				 &wpa_s->conf->wps_nfc_dev_pw);
1836 }
1837 
1838 
1839 int wpas_wps_start_nfc(struct wpa_supplicant *wpa_s, const u8 *bssid)
1840 {
1841 	struct wps_context *wps = wpa_s->wps;
1842 	char pw[32 * 2 + 1];
1843 
1844 	if (wpa_s->conf->wps_nfc_dh_pubkey == NULL ||
1845 	    wpa_s->conf->wps_nfc_dh_privkey == NULL ||
1846 	    wpa_s->conf->wps_nfc_dev_pw == NULL)
1847 		return -1;
1848 
1849 	dh5_free(wps->dh_ctx);
1850 	wpabuf_free(wps->dh_pubkey);
1851 	wpabuf_free(wps->dh_privkey);
1852 	wps->dh_privkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_privkey);
1853 	wps->dh_pubkey = wpabuf_dup(wpa_s->conf->wps_nfc_dh_pubkey);
1854 	if (wps->dh_privkey == NULL || wps->dh_pubkey == NULL) {
1855 		wps->dh_ctx = NULL;
1856 		wpabuf_free(wps->dh_pubkey);
1857 		wps->dh_pubkey = NULL;
1858 		wpabuf_free(wps->dh_privkey);
1859 		wps->dh_privkey = NULL;
1860 		return -1;
1861 	}
1862 	wps->dh_ctx = dh5_init_fixed(wps->dh_privkey, wps->dh_pubkey);
1863 	if (wps->dh_ctx == NULL)
1864 		return -1;
1865 
1866 	wpa_snprintf_hex_uppercase(pw, sizeof(pw),
1867 				   wpabuf_head(wpa_s->conf->wps_nfc_dev_pw),
1868 				   wpabuf_len(wpa_s->conf->wps_nfc_dev_pw));
1869 	return wpas_wps_start_pin(wpa_s, bssid, pw, 0,
1870 				  wpa_s->conf->wps_nfc_dev_pw_id);
1871 }
1872 
1873 
1874 static int wpas_wps_use_cred(struct wpa_supplicant *wpa_s,
1875 			     struct wps_parse_attr *attr)
1876 {
1877 	wpa_s->wps_ap_channel = 0;
1878 
1879 	if (wps_oob_use_cred(wpa_s->wps, attr) < 0)
1880 		return -1;
1881 
1882 	if (wpa_s->wpa_state == WPA_INTERFACE_DISABLED)
1883 		return 0;
1884 
1885 	wpa_printf(MSG_DEBUG, "WPS: Request reconnection with new network "
1886 		   "based on the received credential added");
1887 	wpa_s->normal_scans = 0;
1888 	wpa_supplicant_reinit_autoscan(wpa_s);
1889 	if (wpa_s->wps_ap_channel) {
1890 		u16 chan = wpa_s->wps_ap_channel;
1891 		int freq = 0;
1892 
1893 		if (chan >= 1 && chan <= 13)
1894 			freq = 2407 + 5 * chan;
1895 		else if (chan == 14)
1896 			freq = 2484;
1897 		else if (chan >= 30)
1898 			freq = 5000 + 5 * chan;
1899 
1900 		if (freq) {
1901 			wpa_printf(MSG_DEBUG, "WPS: Credential indicated "
1902 				   "AP channel %u -> %u MHz", chan, freq);
1903 			wpa_s->after_wps = 5;
1904 			wpa_s->wps_freq = freq;
1905 		}
1906 	}
1907 	wpa_s->disconnected = 0;
1908 	wpa_s->reassociate = 1;
1909 	wpa_supplicant_req_scan(wpa_s, 0, 0);
1910 
1911 	return 0;
1912 }
1913 
1914 
1915 #ifdef CONFIG_WPS_ER
1916 static int wpas_wps_add_nfc_password_token(struct wpa_supplicant *wpa_s,
1917 					   struct wps_parse_attr *attr)
1918 {
1919 	return wps_registrar_add_nfc_password_token(
1920 		wpa_s->wps->registrar, attr->oob_dev_password,
1921 		attr->oob_dev_password_len);
1922 }
1923 #endif /* CONFIG_WPS_ER */
1924 
1925 
1926 static int wpas_wps_nfc_tag_process(struct wpa_supplicant *wpa_s,
1927 				    const struct wpabuf *wps)
1928 {
1929 	struct wps_parse_attr attr;
1930 
1931 	wpa_hexdump_buf(MSG_DEBUG, "WPS: Received NFC tag payload", wps);
1932 
1933 	if (wps_parse_msg(wps, &attr)) {
1934 		wpa_printf(MSG_DEBUG, "WPS: Ignore invalid data from NFC tag");
1935 		return -1;
1936 	}
1937 
1938 	if (attr.num_cred)
1939 		return wpas_wps_use_cred(wpa_s, &attr);
1940 
1941 #ifdef CONFIG_WPS_ER
1942 	if (attr.oob_dev_password)
1943 		return wpas_wps_add_nfc_password_token(wpa_s, &attr);
1944 #endif /* CONFIG_WPS_ER */
1945 
1946 	wpa_printf(MSG_DEBUG, "WPS: Ignore unrecognized NFC tag");
1947 	return -1;
1948 }
1949 
1950 
1951 int wpas_wps_nfc_tag_read(struct wpa_supplicant *wpa_s,
1952 			  const struct wpabuf *data)
1953 {
1954 	const struct wpabuf *wps = data;
1955 	struct wpabuf *tmp = NULL;
1956 	int ret;
1957 
1958 	if (wpabuf_len(data) < 4)
1959 		return -1;
1960 
1961 	if (*wpabuf_head_u8(data) != 0x10) {
1962 		/* Assume this contains full NDEF record */
1963 		tmp = ndef_parse_wifi(data);
1964 		if (tmp == NULL) {
1965 			wpa_printf(MSG_DEBUG, "WPS: Could not parse NDEF");
1966 			return -1;
1967 		}
1968 		wps = tmp;
1969 	}
1970 
1971 	ret = wpas_wps_nfc_tag_process(wpa_s, wps);
1972 	wpabuf_free(tmp);
1973 	return ret;
1974 }
1975 
1976 
1977 struct wpabuf * wpas_wps_nfc_handover_req(struct wpa_supplicant *wpa_s)
1978 {
1979 	return ndef_build_wifi_hr();
1980 }
1981 
1982 
1983 struct wpabuf * wpas_wps_nfc_handover_sel(struct wpa_supplicant *wpa_s)
1984 {
1985 	return NULL;
1986 }
1987 
1988 
1989 int wpas_wps_nfc_rx_handover_req(struct wpa_supplicant *wpa_s,
1990 				 const struct wpabuf *data)
1991 {
1992 	/* TODO */
1993 	return -1;
1994 }
1995 
1996 
1997 int wpas_wps_nfc_rx_handover_sel(struct wpa_supplicant *wpa_s,
1998 				 const struct wpabuf *data)
1999 {
2000 	struct wpabuf *wps;
2001 	int ret;
2002 
2003 	wps = ndef_parse_wifi(data);
2004 	if (wps == NULL)
2005 		return -1;
2006 	wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
2007 		   "payload from NFC connection handover");
2008 	wpa_hexdump_buf_key(MSG_DEBUG, "WPS: NFC payload", wps);
2009 	ret = wpas_wps_nfc_tag_process(wpa_s, wps);
2010 	wpabuf_free(wps);
2011 
2012 	return ret;
2013 }
2014 
2015 #endif /* CONFIG_WPS_NFC */
2016 
2017 
2018 extern int wpa_debug_level;
2019 
2020 static void wpas_wps_dump_ap_info(struct wpa_supplicant *wpa_s)
2021 {
2022 	size_t i;
2023 	struct os_time now;
2024 
2025 	if (wpa_debug_level > MSG_DEBUG)
2026 		return;
2027 
2028 	if (wpa_s->wps_ap == NULL)
2029 		return;
2030 
2031 	os_get_time(&now);
2032 
2033 	for (i = 0; i < wpa_s->num_wps_ap; i++) {
2034 		struct wps_ap_info *ap = &wpa_s->wps_ap[i];
2035 		struct wpa_blacklist *e = wpa_blacklist_get(wpa_s, ap->bssid);
2036 
2037 		wpa_printf(MSG_DEBUG, "WPS: AP[%d] " MACSTR " type=%d "
2038 			   "tries=%d last_attempt=%d sec ago blacklist=%d",
2039 			   (int) i, MAC2STR(ap->bssid), ap->type, ap->tries,
2040 			   ap->last_attempt.sec > 0 ?
2041 			   (int) now.sec - (int) ap->last_attempt.sec : -1,
2042 			   e ? e->count : 0);
2043 	}
2044 }
2045 
2046 
2047 static struct wps_ap_info * wpas_wps_get_ap_info(struct wpa_supplicant *wpa_s,
2048 						 const u8 *bssid)
2049 {
2050 	size_t i;
2051 
2052 	if (wpa_s->wps_ap == NULL)
2053 		return NULL;
2054 
2055 	for (i = 0; i < wpa_s->num_wps_ap; i++) {
2056 		struct wps_ap_info *ap = &wpa_s->wps_ap[i];
2057 		if (os_memcmp(ap->bssid, bssid, ETH_ALEN) == 0)
2058 			return ap;
2059 	}
2060 
2061 	return NULL;
2062 }
2063 
2064 
2065 static void wpas_wps_update_ap_info_bss(struct wpa_supplicant *wpa_s,
2066 					struct wpa_scan_res *res)
2067 {
2068 	struct wpabuf *wps;
2069 	enum wps_ap_info_type type;
2070 	struct wps_ap_info *ap;
2071 	int r;
2072 
2073 	if (wpa_scan_get_vendor_ie(res, WPS_IE_VENDOR_TYPE) == NULL)
2074 		return;
2075 
2076 	wps = wpa_scan_get_vendor_ie_multi(res, WPS_IE_VENDOR_TYPE);
2077 	if (wps == NULL)
2078 		return;
2079 
2080 	r = wps_is_addr_authorized(wps, wpa_s->own_addr, 1);
2081 	if (r == 2)
2082 		type = WPS_AP_SEL_REG_OUR;
2083 	else if (r == 1)
2084 		type = WPS_AP_SEL_REG;
2085 	else
2086 		type = WPS_AP_NOT_SEL_REG;
2087 
2088 	wpabuf_free(wps);
2089 
2090 	ap = wpas_wps_get_ap_info(wpa_s, res->bssid);
2091 	if (ap) {
2092 		if (ap->type != type) {
2093 			wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR
2094 				   " changed type %d -> %d",
2095 				   MAC2STR(res->bssid), ap->type, type);
2096 			ap->type = type;
2097 			if (type != WPS_AP_NOT_SEL_REG)
2098 				wpa_blacklist_del(wpa_s, ap->bssid);
2099 		}
2100 		return;
2101 	}
2102 
2103 	ap = os_realloc_array(wpa_s->wps_ap, wpa_s->num_wps_ap + 1,
2104 			      sizeof(struct wps_ap_info));
2105 	if (ap == NULL)
2106 		return;
2107 
2108 	wpa_s->wps_ap = ap;
2109 	ap = &wpa_s->wps_ap[wpa_s->num_wps_ap];
2110 	wpa_s->num_wps_ap++;
2111 
2112 	os_memset(ap, 0, sizeof(*ap));
2113 	os_memcpy(ap->bssid, res->bssid, ETH_ALEN);
2114 	ap->type = type;
2115 	wpa_printf(MSG_DEBUG, "WPS: AP " MACSTR " type %d added",
2116 		   MAC2STR(ap->bssid), ap->type);
2117 }
2118 
2119 
2120 void wpas_wps_update_ap_info(struct wpa_supplicant *wpa_s,
2121 			     struct wpa_scan_results *scan_res)
2122 {
2123 	size_t i;
2124 
2125 	for (i = 0; i < scan_res->num; i++)
2126 		wpas_wps_update_ap_info_bss(wpa_s, scan_res->res[i]);
2127 
2128 	wpas_wps_dump_ap_info(wpa_s);
2129 }
2130 
2131 
2132 void wpas_wps_notify_assoc(struct wpa_supplicant *wpa_s, const u8 *bssid)
2133 {
2134 	struct wps_ap_info *ap;
2135 	if (!wpa_s->wps_ap_iter)
2136 		return;
2137 	ap = wpas_wps_get_ap_info(wpa_s, bssid);
2138 	if (ap == NULL)
2139 		return;
2140 	ap->tries++;
2141 	os_get_time(&ap->last_attempt);
2142 }
2143