wps_hostapd.c revision 13ca8d8ea51a1aa5e24c6c956473a11b0c7daed4
18d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt/*
28d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt * hostapd / WPS integration
304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt * Copyright (c) 2008-2012, Jouni Malinen <j@w1.fi>
48d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt *
5c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * This software may be distributed under the terms of the BSD license.
6c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt * See README for more details.
78d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt */
88d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
98d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/includes.h"
108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/common.h"
128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/eloop.h"
138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "utils/uuid.h"
148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/wpa_ctrl.h"
158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_defs.h"
168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "common/ieee802_11_common.h"
178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eapol_auth/eapol_auth_sm.h"
188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "eapol_auth/eapol_auth_sm_i.h"
198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps.h"
208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_defs.h"
218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_dev_attr.h"
2204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#include "wps/wps_attr_parse.h"
238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "hostapd.h"
248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "ap_config.h"
258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "ap_drv_ops.h"
268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "beacon.h"
278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "sta_info.h"
288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps_hostapd.h"
298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#include "wps/wps_upnp.h"
338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_upnp_init(struct hostapd_data *hapd,
348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				 struct wps_context *wps);
358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_upnp_deinit(struct hostapd_data *hapd);
368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
381f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int hostapd_wps_probe_req_rx(void *ctx, const u8 *addr, const u8 *da,
391f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt				    const u8 *bssid,
4004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				    const u8 *ie, size_t ie_len,
4104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				    int ssi_signal);
428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_ap_pin_timeout(void *eloop_data, void *user_ctx);
438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wps_for_each_data {
468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int (*func)(struct hostapd_data *h, void *ctx);
478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	void *ctx;
48444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	struct hostapd_data *calling_hapd;
498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt};
508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_for_each(struct hostapd_iface *iface, void *ctx)
538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_for_each_data *data = ctx;
558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t j;
568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (iface == NULL)
588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (j = 0; j < iface->num_bss; j++) {
608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		struct hostapd_data *hapd = iface->bss[j];
61444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		int ret;
62444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
63444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (hapd != data->calling_hapd &&
64444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		    (hapd->conf->wps_independent ||
65444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		     data->calling_hapd->conf->wps_independent))
66444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			continue;
67444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
68444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		ret = data->func(hapd, data->ctx);
698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (ret)
708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return ret;
718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_for_each(struct hostapd_data *hapd,
788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				int (*func)(struct hostapd_data *h, void *ctx),
798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				void *ctx)
808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_iface *iface = hapd->iface;
828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_for_each_data data;
838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.func = func;
848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.ctx = ctx;
85444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	data.calling_hapd = hapd;
8661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (iface->interfaces == NULL ||
8761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	    iface->interfaces->for_each_interface == NULL)
888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return wps_for_each(iface, &data);
8961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	return iface->interfaces->for_each_interface(iface->interfaces,
9061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt						     wps_for_each, &data);
918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
94391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidtstatic int hostapd_wps_new_psk_cb(void *ctx, const u8 *mac_addr,
95391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt				  const u8 *p2p_dev_addr, const u8 *psk,
968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				  size_t psk_len)
978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_wpa_psk *p;
1008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_ssid *ssid = &hapd->conf->ssid;
1018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
102391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	if (is_zero_ether_addr(p2p_dev_addr)) {
103391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt		wpa_printf(MSG_DEBUG,
104391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt			   "Received new WPA/WPA2-PSK from WPS for STA " MACSTR,
105391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt			   MAC2STR(mac_addr));
106391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	} else {
107391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt		wpa_printf(MSG_DEBUG,
108391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt			   "Received new WPA/WPA2-PSK from WPS for STA " MACSTR
109391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt			   " P2P Device Addr " MACSTR,
110391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt			   MAC2STR(mac_addr), MAC2STR(p2p_dev_addr));
111391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	}
1128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_hexdump_key(MSG_DEBUG, "Per-device PSK", psk, psk_len);
1138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (psk_len != PMK_LEN) {
1158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "Unexpected PSK length %lu",
1168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   (unsigned long) psk_len);
1178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
1188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/* Add the new PSK to runtime PSK list */
1218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p = os_zalloc(sizeof(*p));
1228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (p == NULL)
1238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
1248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(p->addr, mac_addr, ETH_ALEN);
125391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	os_memcpy(p->p2p_dev_addr, p2p_dev_addr, ETH_ALEN);
1268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(p->psk, psk, PMK_LEN);
1278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
128391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	if (hapd->new_psk_cb) {
129391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt		hapd->new_psk_cb(hapd->new_psk_cb_ctx, mac_addr, p2p_dev_addr,
130391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt				 psk, psk_len);
131391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	}
132391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt
1338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p->next = ssid->wpa_psk;
1348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ssid->wpa_psk = p;
1358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ssid->wpa_psk_file) {
1378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		FILE *f;
1388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		char hex[PMK_LEN * 2 + 1];
1398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* Add the new PSK to PSK list file */
1408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		f = fopen(ssid->wpa_psk_file, "a");
1418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (f == NULL) {
1428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wpa_printf(MSG_DEBUG, "Failed to add the PSK to "
1438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				   "'%s'", ssid->wpa_psk_file);
1448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
1458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
1468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_snprintf_hex(hex, sizeof(hex), psk, psk_len);
1488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(f, MACSTR " %s\n", MAC2STR(mac_addr), hex);
1498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fclose(f);
1508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
1518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
1538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_set_ie_cb(void *ctx, struct wpabuf *beacon_ie,
1578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				 struct wpabuf *probe_resp_ie)
1588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
1608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps_beacon_ie);
1618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps_beacon_ie = beacon_ie;
1628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps_probe_resp_ie);
1638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps_probe_resp_ie = probe_resp_ie;
1641f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	if (hapd->beacon_set_done)
1651f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		ieee802_11_set_beacon(hapd);
1668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hostapd_set_ap_wps_ie(hapd);
1678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
1688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_pin_needed_cb(void *ctx, const u8 *uuid_e,
1718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				      const struct wps_device_data *dev)
1728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
1738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
1748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char uuid[40], txt[400];
1758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int len;
1768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char devtype[WPS_DEV_TYPE_BUFSIZE];
1778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
1788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
1798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: PIN needed for E-UUID %s", uuid);
1808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	len = os_snprintf(txt, sizeof(txt), WPS_EVENT_PIN_NEEDED
1818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  "%s " MACSTR " [%s|%s|%s|%s|%s|%s]",
1828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  uuid, MAC2STR(dev->mac_addr), dev->device_name,
1838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  dev->manufacturer, dev->model_name,
1848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  dev->model_number, dev->serial_number,
1858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  wps_dev_type_bin2str(dev->pri_dev_type, devtype,
1868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					       sizeof(devtype)));
1878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (len > 0 && len < (int) sizeof(txt))
1888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, "%s", txt);
1898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
1908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->conf->wps_pin_requests) {
1918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		FILE *f;
1928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		struct os_time t;
1938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		f = fopen(hapd->conf->wps_pin_requests, "a");
1948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (f == NULL)
1958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return;
1968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_get_time(&t);
1978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(f, "%ld\t%s\t" MACSTR "\t%s\t%s\t%s\t%s\t%s"
1988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			"\t%s\n",
1998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			t.sec, uuid, MAC2STR(dev->mac_addr), dev->device_name,
2008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			dev->manufacturer, dev->model_name, dev->model_number,
2018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			dev->serial_number,
2028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps_dev_type_bin2str(dev->pri_dev_type, devtype,
2038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					     sizeof(devtype)));
2048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fclose(f);
2058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
2068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstruct wps_stop_reg_data {
2101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	struct hostapd_data *current_hapd;
2111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	const u8 *uuid_e;
21204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	const u8 *dev_pw;
21304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	size_t dev_pw_len;
2141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt};
2151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
2161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int wps_stop_registrar(struct hostapd_data *hapd, void *ctx)
2171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{
2181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	struct wps_stop_reg_data *data = ctx;
2191f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	if (hapd != data->current_hapd && hapd->wps != NULL)
22004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		wps_registrar_complete(hapd->wps->registrar, data->uuid_e,
22104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				       data->dev_pw, data->dev_pw_len);
2221f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	return 0;
2231f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt}
2241f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
2251f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
2268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_reg_success_cb(void *ctx, const u8 *mac_addr,
22704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				       const u8 *uuid_e, const u8 *dev_pw,
22804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				       size_t dev_pw_len)
2298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
2318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char uuid[40];
2321f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	struct wps_stop_reg_data data;
2338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
2348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
2358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_REG_SUCCESS MACSTR " %s",
2368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		MAC2STR(mac_addr), uuid);
2378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps_reg_success_cb)
2388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps_reg_success_cb(hapd->wps_reg_success_cb_ctx,
2398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 mac_addr, uuid_e);
2401f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	data.current_hapd = hapd;
2411f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	data.uuid_e = uuid_e;
24204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	data.dev_pw = dev_pw;
24304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	data.dev_pw_len = dev_pw_len;
2441f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	hostapd_wps_for_each(hapd, wps_stop_registrar, &data);
2458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_enrollee_seen_cb(void *ctx, const u8 *addr,
2498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 const u8 *uuid_e,
2508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 const u8 *pri_dev_type,
2518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 u16 config_methods,
2528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 u16 dev_password_id, u8 request_type,
2538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					 const char *dev_name)
2548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
2568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char uuid[40];
2578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char devtype[WPS_DEV_TYPE_BUFSIZE];
2588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
2598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
2608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (dev_name == NULL)
2618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		dev_name = "";
2628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_msg_ctrl(hapd->msg_ctx, MSG_INFO, WPS_EVENT_ENROLLEE_SEEN MACSTR
2638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     " %s %s 0x%x %u %u [%s]",
2648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     MAC2STR(addr), uuid,
2658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     wps_dev_type_bin2str(pri_dev_type, devtype,
2668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					  sizeof(devtype)),
2678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     config_methods, dev_password_id, request_type, dev_name);
2688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int str_starts(const char *str, const char *start)
2728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return os_strncmp(str, start, os_strlen(start)) == 0;
2748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void wps_reload_config(void *eloop_data, void *user_ctx)
2788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
2798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_iface *iface = eloop_data;
2808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Reload configuration data");
28261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (iface->interfaces == NULL ||
28361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	    iface->interfaces->reload_config(iface) < 0) {
2848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_WARNING, "WPS: Failed to reload the updated "
2858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "configuration");
2868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
2878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
2888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
2898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
290fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidtvoid hostapd_wps_eap_completed(struct hostapd_data *hapd)
291fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt{
292fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	/*
293fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	 * Reduce race condition of the station trying to reconnect immediately
294fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	 * after AP reconfiguration through WPS by rescheduling the reload
295fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	 * timeout to happen after EAP completion rather than the originally
296fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	 * scheduled 100 ms after new configuration became known.
297fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	 */
298fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	if (eloop_deplete_timeout(0, 0, wps_reload_config, hapd->iface, NULL) ==
299fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	    1)
300fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Reschedule immediate configuration reload");
301fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt}
302fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
303fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt
3041f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic void hapd_new_ap_event(struct hostapd_data *hapd, const u8 *attr,
3051f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt			      size_t attr_len)
3061f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt{
3071f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	size_t blen = attr_len * 2 + 1;
3081f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	char *buf = os_malloc(blen);
3091f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	if (buf) {
3101f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_snprintf_hex(buf, blen, attr, attr_len);
3111f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO,
3121f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt			WPS_EVENT_NEW_AP_SETTINGS "%s", buf);
3131f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		os_free(buf);
3141f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	}
3151f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt}
3161f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
3171f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
318444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidtstatic int hapd_wps_reconfig_in_memory(struct hostapd_data *hapd,
319444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				       const struct wps_credential *cred)
320444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt{
321444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	struct hostapd_bss_config *bss = hapd->conf;
322444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
323444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Updating in-memory configuration");
324444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
325444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	bss->wps_state = 2;
326444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	if (cred->ssid_len <= HOSTAPD_MAX_SSID_LEN) {
327444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		os_memcpy(bss->ssid.ssid, cred->ssid, cred->ssid_len);
328444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->ssid.ssid_len = cred->ssid_len;
329444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->ssid.ssid_set = 1;
330444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	}
331444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
332444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	if ((cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK)) &&
333444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	    (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK)))
334444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa = 3;
335444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	else if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK))
336444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa = 2;
337444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	else if (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK))
338444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa = 1;
339444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	else
340444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa = 0;
341444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
342444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	if (bss->wpa) {
343444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA))
344444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->wpa_key_mgmt = WPA_KEY_MGMT_IEEE8021X;
345444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->auth_type & (WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK))
346444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->wpa_key_mgmt = WPA_KEY_MGMT_PSK;
347444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
348444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa_pairwise = 0;
349444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_AES)
350444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->wpa_pairwise |= WPA_CIPHER_CCMP;
351444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_TKIP)
352444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->wpa_pairwise |= WPA_CIPHER_TKIP;
353444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->rsn_pairwise = bss->wpa_pairwise;
354444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->wpa_group = wpa_select_ap_group_cipher(bss->wpa,
355444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt							    bss->wpa_pairwise,
356444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt							    bss->rsn_pairwise);
357444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
358444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->key_len >= 8 && cred->key_len < 64) {
359444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			os_free(bss->ssid.wpa_passphrase);
360444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->ssid.wpa_passphrase = os_zalloc(cred->key_len + 1);
361444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			if (bss->ssid.wpa_passphrase)
362444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_memcpy(bss->ssid.wpa_passphrase, cred->key,
363444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					  cred->key_len);
364444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			os_free(bss->ssid.wpa_psk);
365444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->ssid.wpa_psk = NULL;
366444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		} else if (cred->key_len == 64) {
367444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			os_free(bss->ssid.wpa_psk);
368444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->ssid.wpa_psk =
369444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_zalloc(sizeof(struct hostapd_wpa_psk));
370444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			if (bss->ssid.wpa_psk &&
371444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			    hexstr2bin((const char *) cred->key,
372444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				       bss->ssid.wpa_psk->psk, PMK_LEN) == 0) {
373444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				bss->ssid.wpa_psk->group = 1;
374444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_free(bss->ssid.wpa_passphrase);
375444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				bss->ssid.wpa_passphrase = NULL;
376444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			}
377444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		}
378444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		bss->auth_algs = 1;
379444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	} else {
380444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if ((cred->auth_type & WPS_AUTH_OPEN) &&
381444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		    (cred->auth_type & WPS_AUTH_SHARED))
382444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->auth_algs = 3;
383444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		else if (cred->auth_type & WPS_AUTH_SHARED)
384444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->auth_algs = 2;
385444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		else
386444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			bss->auth_algs = 1;
387444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_WEP && cred->key_idx > 0 &&
388444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		    cred->key_idx <= 4) {
389444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			struct hostapd_wep_keys *wep = &bss->ssid.wep;
390444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			int idx = cred->key_idx;
391444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			if (idx)
392444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				idx--;
393444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			wep->idx = idx;
394444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			if (cred->key_len == 10 || cred->key_len == 26) {
395444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_free(wep->key[idx]);
396444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				wep->key[idx] = os_malloc(cred->key_len / 2);
397444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				if (wep->key[idx] == NULL ||
398444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				    hexstr2bin((const char *) cred->key,
399444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					       wep->key[idx],
400444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					       cred->key_len / 2))
401444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					return -1;
402444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				wep->len[idx] = cred->key_len / 2;
403444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			} else {
404444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_free(wep->key[idx]);
405444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				wep->key[idx] = os_malloc(cred->key_len);
406444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				if (wep->key[idx] == NULL)
407444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					return -1;
408444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				os_memcpy(wep->key[idx], cred->key,
409444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt					  cred->key_len);
410444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt				wep->len[idx] = cred->key_len;
411444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			}
412444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			wep->keys_set = 1;
413444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		}
414444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	}
415444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
416444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	/* Schedule configuration reload after short period of time to allow
417444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	 * EAP-WSC to be finished.
418444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	 */
419444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	eloop_register_timeout(0, 100000, wps_reload_config, hapd->iface,
420444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt			       NULL);
421444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
422444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt	return 0;
423444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt}
424444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
425444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt
4268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hapd_wps_cred_cb(struct hostapd_data *hapd, void *ctx)
4278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
4288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const struct wps_credential *cred = ctx;
4298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	FILE *oconf, *nconf;
4308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t len, i;
4318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char *tmp_fname;
4328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char buf[1024];
4338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int multi_bss;
4348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int wpa;
4358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
4378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
4388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_hexdump_key(MSG_DEBUG, "WPS: Received Credential attribute",
4408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred->cred_attr, cred->cred_attr_len);
4418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Received new AP Settings");
4438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", cred->ssid, cred->ssid_len);
4448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Authentication Type 0x%x",
4458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   cred->auth_type);
4468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Encryption Type 0x%x", cred->encr_type);
4478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Network Key Index %d", cred->key_idx);
4488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_hexdump_key(MSG_DEBUG, "WPS: Network Key",
4498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred->key, cred->key_len);
4508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: MAC Address " MACSTR,
4518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   MAC2STR(cred->mac_addr));
4528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if ((hapd->conf->wps_cred_processing == 1 ||
4548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	     hapd->conf->wps_cred_processing == 2) && cred->cred_attr) {
4551f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		hapd_new_ap_event(hapd, cred->cred_attr, cred->cred_attr_len);
4561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	} else if (hapd->conf->wps_cred_processing == 1 ||
4571f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		   hapd->conf->wps_cred_processing == 2) {
4581f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		struct wpabuf *attr;
4591f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		attr = wpabuf_alloc(200);
4601f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		if (attr && wps_build_credential_wrap(attr, cred) == 0)
4611f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt			hapd_new_ap_event(hapd, wpabuf_head_u8(attr),
4621f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt					  wpabuf_len(attr));
4631f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpabuf_free(attr);
4648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else
4658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_NEW_AP_SETTINGS);
4668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->conf->wps_cred_processing == 1)
4688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
4698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
4708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(hapd->wps->ssid, cred->ssid, cred->ssid_len);
4718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->ssid_len = cred->ssid_len;
4728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->encr_types = cred->encr_type;
4738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->auth_types = cred->auth_type;
47496be6222df414a7dde5c5b1b72df22e67b1a77fcDmitry Shmidt	hapd->wps->ap_encr_type = cred->encr_type;
47596be6222df414a7dde5c5b1b72df22e67b1a77fcDmitry Shmidt	hapd->wps->ap_auth_type = cred->auth_type;
4768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (cred->key_len == 0) {
4778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(hapd->wps->network_key);
4788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps->network_key = NULL;
4798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps->network_key_len = 0;
4808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else {
4818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (hapd->wps->network_key == NULL ||
4828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    hapd->wps->network_key_len < cred->key_len) {
4838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			hapd->wps->network_key_len = 0;
4848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			os_free(hapd->wps->network_key);
4858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			hapd->wps->network_key = os_malloc(cred->key_len);
4868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			if (hapd->wps->network_key == NULL)
4878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				return -1;
4888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
4898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps->network_key_len = cred->key_len;
4908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_memcpy(hapd->wps->network_key, cred->key, cred->key_len);
4918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
4928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->wps_state = WPS_STATE_CONFIGURED;
4938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
49461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (hapd->iface->config_fname == NULL)
495444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		return hapd_wps_reconfig_in_memory(hapd, cred);
4968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	len = os_strlen(hapd->iface->config_fname) + 5;
4978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	tmp_fname = os_malloc(len);
4988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (tmp_fname == NULL)
4998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
5008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_snprintf(tmp_fname, len, "%s-new", hapd->iface->config_fname);
5018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	oconf = fopen(hapd->iface->config_fname, "r");
5038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (oconf == NULL) {
5048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_WARNING, "WPS: Could not open current "
5058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "configuration file");
5068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(tmp_fname);
5078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
5088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
5098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	nconf = fopen(tmp_fname, "w");
5118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (nconf == NULL) {
5128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_WARNING, "WPS: Could not write updated "
5138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "configuration file");
5148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(tmp_fname);
5158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fclose(oconf);
5168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
5178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
5188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	fprintf(nconf, "# WPS configuration - START\n");
5208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	fprintf(nconf, "wps_state=2\n");
5228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
52361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (is_hex(cred->ssid, cred->ssid_len)) {
52461d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		fprintf(nconf, "ssid2=");
52561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		for (i = 0; i < cred->ssid_len; i++)
52661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			fprintf(nconf, "%02x", cred->ssid[i]);
52761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		fprintf(nconf, "\n");
52861d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	} else {
52961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		fprintf(nconf, "ssid=");
53061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		for (i = 0; i < cred->ssid_len; i++)
53161d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt			fputc(cred->ssid[i], nconf);
53261d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		fprintf(nconf, "\n");
53361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	}
5348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if ((cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK)) &&
5368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	    (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK)))
5378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa = 3;
5388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK))
5398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa = 2;
5408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else if (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK))
5418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa = 1;
5428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else
5438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa = 0;
5448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wpa) {
5468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		char *prefix;
5478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "wpa=%d\n", wpa);
5488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "wpa_key_mgmt=");
5508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		prefix = "";
5518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA)) {
5528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "WPA-EAP");
5538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			prefix = " ";
5548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
5558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->auth_type & (WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK))
5568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "%sWPA-PSK", prefix);
5578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "\n");
5588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "wpa_pairwise=");
5608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		prefix = "";
5618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_AES) {
5628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "CCMP");
5638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			prefix = " ";
5648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
5658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_TKIP) {
5668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "%sTKIP", prefix);
5678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
5688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "\n");
5698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->key_len >= 8 && cred->key_len < 64) {
5718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "wpa_passphrase=");
5728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			for (i = 0; i < cred->key_len; i++)
5738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				fputc(cred->key[i], nconf);
5748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "\n");
5758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else if (cred->key_len == 64) {
5768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "wpa_psk=");
5778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			for (i = 0; i < cred->key_len; i++)
5788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				fputc(cred->key[i], nconf);
5798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "\n");
5808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else {
5818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wpa_printf(MSG_WARNING, "WPS: Invalid key length %lu "
5828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				   "for WPA/WPA2",
5838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				   (unsigned long) cred->key_len);
5848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
5858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		fprintf(nconf, "auth_algs=1\n");
5878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else {
5888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if ((cred->auth_type & WPS_AUTH_OPEN) &&
5898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    (cred->auth_type & WPS_AUTH_SHARED))
5908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "auth_algs=3\n");
5918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else if (cred->auth_type & WPS_AUTH_SHARED)
5928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "auth_algs=2\n");
5938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else
5948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "auth_algs=1\n");
5958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
5968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (cred->encr_type & WPS_ENCR_WEP && cred->key_idx <= 4) {
5978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			int key_idx = cred->key_idx;
5988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			if (key_idx)
5998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				key_idx--;
6008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "wep_default_key=%d\n", key_idx);
6018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "wep_key%d=", key_idx);
6028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			if (cred->key_len == 10 || cred->key_len == 26) {
6038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				/* WEP key as a hex string */
6048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				for (i = 0; i < cred->key_len; i++)
6058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					fputc(cred->key[i], nconf);
6068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			} else {
6078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				/* Raw WEP key; convert to hex */
6088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				for (i = 0; i < cred->key_len; i++)
6098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					fprintf(nconf, "%02x", cred->key[i]);
6108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			}
6118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "\n");
6128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
6138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
6148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	fprintf(nconf, "# WPS configuration - END\n");
6168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	multi_bss = 0;
6188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	while (fgets(buf, sizeof(buf), oconf)) {
6198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (os_strncmp(buf, "bss=", 4) == 0)
6208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			multi_bss = 1;
6218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (!multi_bss &&
6228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    (str_starts(buf, "ssid=") ||
62361d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt		     str_starts(buf, "ssid2=") ||
6248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "auth_algs=") ||
6258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wep_default_key=") ||
6268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wep_key") ||
6278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wps_state=") ||
6288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wpa=") ||
6298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wpa_psk=") ||
6308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wpa_pairwise=") ||
6318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "rsn_pairwise=") ||
6328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wpa_key_mgmt=") ||
6338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     str_starts(buf, "wpa_passphrase="))) {
6348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "#WPS# %s", buf);
6358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else
6368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fprintf(nconf, "%s", buf);
6378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
6388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	fclose(nconf);
6408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	fclose(oconf);
6418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (rename(tmp_fname, hapd->iface->config_fname) < 0) {
6438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_WARNING, "WPS: Failed to rename the updated "
6448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "configuration file: %s", strerror(errno));
6458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(tmp_fname);
6468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
6478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
6488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(tmp_fname);
6508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/* Schedule configuration reload after short period of time to allow
6528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * EAP-WSC to be finished.
6538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 */
6548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eloop_register_timeout(0, 100000, wps_reload_config, hapd->iface,
6558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			       NULL);
6568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: AP configuration updated");
6588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
6608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
6618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_cred_cb(void *ctx, const struct wps_credential *cred)
6648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
6658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
6668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hostapd_wps_for_each(hapd, hapd_wps_cred_cb, (void *) cred);
6678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
6688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_reenable_ap_pin(void *eloop_data, void *user_ctx)
6718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
6728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = eloop_data;
6738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->conf->ap_setup_locked)
6758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
676c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	if (hapd->ap_pin_failures_consecutive >= 10)
677c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		return;
6788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Re-enable AP PIN");
6808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_SETUP_UNLOCKED);
6818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->ap_setup_locked = 0;
6828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_registrar_update_ie(hapd->wps->registrar);
6838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
6848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_pwd_auth_fail(struct hostapd_data *hapd, void *ctx)
6878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
6888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_event_pwd_auth_fail *data = ctx;
6898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (!data->enrollee || hapd->conf->ap_pin == NULL || hapd->wps == NULL)
6918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
6928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
6938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/*
6948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * Registrar failed to prove its knowledge of the AP PIN. Lock AP setup
6958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * for some time if this happens multiple times to slow down brute
6968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * force attacks.
6978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 */
6988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->ap_pin_failures++;
699c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	hapd->ap_pin_failures_consecutive++;
700c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: AP PIN authentication failure number %u "
701c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		   "(%u consecutive)",
702c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		   hapd->ap_pin_failures, hapd->ap_pin_failures_consecutive);
7038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->ap_pin_failures < 3)
7048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
7058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_SETUP_LOCKED);
7078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->ap_setup_locked = 1;
7088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_registrar_update_ie(hapd->wps->registrar);
7108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
711c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	if (!hapd->conf->ap_setup_locked &&
712c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	    hapd->ap_pin_failures_consecutive >= 10) {
713c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		/*
714c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		 * In indefinite lockdown - disable automatic AP PIN
715c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		 * reenablement.
716c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		 */
717c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		eloop_cancel_timeout(hostapd_wps_reenable_ap_pin, hapd, NULL);
718c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: AP PIN disabled indefinitely");
719c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	} else if (!hapd->conf->ap_setup_locked) {
7208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (hapd->ap_pin_lockout_time == 0)
7218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			hapd->ap_pin_lockout_time = 60;
7228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else if (hapd->ap_pin_lockout_time < 365 * 24 * 60 * 60 &&
7238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			 (hapd->ap_pin_failures % 3) == 0)
7248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			hapd->ap_pin_lockout_time *= 2;
7258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Disable AP PIN for %u seconds",
7278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   hapd->ap_pin_lockout_time);
7288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		eloop_cancel_timeout(hostapd_wps_reenable_ap_pin, hapd, NULL);
7298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		eloop_register_timeout(hapd->ap_pin_lockout_time, 0,
7308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				       hostapd_wps_reenable_ap_pin, hapd,
7318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				       NULL);
7328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
7338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
7358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
7368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_pwd_auth_fail(struct hostapd_data *hapd,
7398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				  struct wps_event_pwd_auth_fail *data)
7408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
741b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS Status - Authentication Failure */
742b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Authentication failure update");
743b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.status = WPS_STATUS_FAILURE;
744b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.failure_reason = WPS_EI_AUTH_FAILURE;
745b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	os_memcpy(hapd->wps_stats.peer_addr, data->peer_macaddr, ETH_ALEN);
746b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
7478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_for_each(hapd, wps_pwd_auth_fail, data);
7488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
7498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
7508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
751c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidtstatic int wps_ap_pin_success(struct hostapd_data *hapd, void *ctx)
752c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt{
753c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	if (hapd->conf->ap_pin == NULL || hapd->wps == NULL)
754c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		return 0;
755c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
756c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	if (hapd->ap_pin_failures_consecutive == 0)
757c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		return 0;
758c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
759c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Clear consecutive AP PIN failure counter "
760c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		   "- total validation failures %u (%u consecutive)",
761c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		   hapd->ap_pin_failures, hapd->ap_pin_failures_consecutive);
762c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	hapd->ap_pin_failures_consecutive = 0;
763c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
764c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	return 0;
765c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt}
766c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
767c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
768c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidtstatic void hostapd_wps_ap_pin_success(struct hostapd_data *hapd)
769c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt{
770c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	hostapd_wps_for_each(hapd, wps_ap_pin_success, NULL);
771c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt}
772c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
773c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt
774b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic void hostapd_wps_event_pbc_overlap(struct hostapd_data *hapd)
775b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
776b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS Status - PBC Overlap */
777b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.pbc_status = WPS_PBC_STATUS_OVERLAP;
778b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
779b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
780b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
781b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic void hostapd_wps_event_pbc_timeout(struct hostapd_data *hapd)
782b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
783b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS PBC Status:PBC Timeout */
784b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.pbc_status = WPS_PBC_STATUS_TIMEOUT;
785b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
786b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
787b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
788b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic void hostapd_wps_event_pbc_active(struct hostapd_data *hapd)
789b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
790b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS PBC status - Active */
791b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.pbc_status = WPS_PBC_STATUS_ACTIVE;
792b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
793b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
794b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
795b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic void hostapd_wps_event_pbc_disable(struct hostapd_data *hapd)
796b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
797b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS PBC status - Active */
798b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.pbc_status = WPS_PBC_STATUS_DISABLE;
799b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
800b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
801b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
802b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic void hostapd_wps_event_success(struct hostapd_data *hapd,
803b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt				      struct wps_event_success *success)
804b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
805b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS status - Success */
806b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.pbc_status = WPS_PBC_STATUS_DISABLE;
807b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.status = WPS_STATUS_SUCCESS;
808b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	os_memcpy(hapd->wps_stats.peer_addr, success->peer_macaddr, ETH_ALEN);
809b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
810b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
8118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
8128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_event_fail(struct hostapd_data *hapd,
8138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				   struct wps_event_fail *fail)
8148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
815b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	/* Update WPS status - Failure */
816b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.status = WPS_STATUS_FAILURE;
817b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	os_memcpy(hapd->wps_stats.peer_addr, fail->peer_macaddr, ETH_ALEN);
818b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
819b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	hapd->wps_stats.failure_reason = fail->error_indication;
820b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
8218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (fail->error_indication > 0 &&
8228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	    fail->error_indication < NUM_WPS_EI_VALUES) {
8238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO,
8248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			WPS_EVENT_FAIL "msg=%d config_error=%d reason=%d (%s)",
8258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fail->msg, fail->config_error, fail->error_indication,
826b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt			wps_ei_str(fail->error_indication));
8278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else {
8288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO,
8298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			WPS_EVENT_FAIL "msg=%d config_error=%d",
8308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			fail->msg, fail->config_error);
8318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
8328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
8338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
8348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
8358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_event_cb(void *ctx, enum wps_event event,
8368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				 union wps_event_data *data)
8378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
8388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
8398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
8408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	switch (event) {
8418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_M2D:
8421f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_M2D);
8438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_FAIL:
8458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hostapd_wps_event_fail(hapd, &data->fail);
8468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_SUCCESS:
848b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		hostapd_wps_event_success(hapd, &data->success);
8491f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_SUCCESS);
8508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_PWD_AUTH_FAIL:
8528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hostapd_pwd_auth_fail(hapd, &data->pwd_auth_fail);
8538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_PBC_OVERLAP:
855b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		hostapd_wps_event_pbc_overlap(hapd);
8561f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_OVERLAP);
8578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_PBC_TIMEOUT:
859b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		hostapd_wps_event_pbc_timeout(hapd);
8601f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_TIMEOUT);
8618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
862b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	case WPS_EV_PBC_ACTIVE:
863b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		hostapd_wps_event_pbc_active(hapd);
864b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_ACTIVE);
865b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		break;
866b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	case WPS_EV_PBC_DISABLE:
867b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		hostapd_wps_event_pbc_disable(hapd);
868b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_DISABLE);
869b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		break;
8708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_AP_ADD:
8718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_AP_REMOVE:
8738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_ENROLLEE_ADD:
8758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_ENROLLEE_REMOVE:
8778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_AP_SETTINGS:
8798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
8808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	case WPS_EV_ER_SET_SELECTED_REGISTRAR:
8818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		break;
882c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	case WPS_EV_AP_PIN_SUCCESS:
883c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		hostapd_wps_ap_pin_success(hapd);
884c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt		break;
8858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
8868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps_event_cb)
8878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps_event_cb(hapd->wps_event_cb_ctx, event, data);
8888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
8898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
8908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
891b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidtstatic int hostapd_wps_rf_band_cb(void *ctx)
892b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt{
893b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	struct hostapd_data *hapd = ctx;
894b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
895b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	return hapd->iconf->hw_mode == HOSTAPD_MODE_IEEE80211A ?
896b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt		WPS_RF_50GHZ : WPS_RF_24GHZ; /* FIX: dualband AP */
897b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt}
898b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
899b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt
9008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_clear_ies(struct hostapd_data *hapd)
9018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps_beacon_ie);
9038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps_beacon_ie = NULL;
9048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps_probe_resp_ie);
9068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps_probe_resp_ie = NULL;
9078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_set_ap_wps_ie(hapd);
9098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int get_uuid_cb(struct hostapd_iface *iface, void *ctx)
9138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 **uuid = ctx;
9158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t j;
9168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (iface == NULL)
9188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
9198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (j = 0; j < iface->num_bss; j++) {
9208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		struct hostapd_data *hapd = iface->bss[j];
921444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (hapd->wps && !hapd->conf->wps_independent &&
922444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		    !is_nil_uuid(hapd->wps->uuid)) {
9238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			*uuid = hapd->wps->uuid;
9248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return 1;
9258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
9268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
9278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
9298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic const u8 * get_own_uuid(struct hostapd_iface *iface)
9338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *uuid;
93561d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (iface->interfaces == NULL ||
93661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	    iface->interfaces->for_each_interface == NULL)
9378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return NULL;
9388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	uuid = NULL;
93961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	iface->interfaces->for_each_interface(iface->interfaces, get_uuid_cb,
94061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					      &uuid);
9418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return uuid;
9428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int count_interface_cb(struct hostapd_iface *iface, void *ctx)
9468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int *count= ctx;
9488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	(*count)++;
9498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
9508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int interface_count(struct hostapd_iface *iface)
9548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int count = 0;
95661d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	if (iface->interfaces == NULL ||
95761d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	    iface->interfaces->for_each_interface == NULL)
9588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
95961d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt	iface->interfaces->for_each_interface(iface->interfaces,
96061d9df3e62aaa0e87ad05452fcb95142159a17b6Dmitry Shmidt					      count_interface_cb, &count);
9618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return count;
9628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_set_vendor_ext(struct hostapd_data *hapd,
9668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				      struct wps_context *wps)
9678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int i;
9698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	for (i = 0; i < MAX_WPS_VENDOR_EXTENSIONS; i++) {
9718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpabuf_free(wps->dev.vendor_ext[i]);
9728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->dev.vendor_ext[i] = NULL;
9738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (hapd->conf->wps_vendor_ext[i] == NULL)
9758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			continue;
9768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->dev.vendor_ext[i] =
9788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wpabuf_dup(hapd->conf->wps_vendor_ext[i]);
9798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (wps->dev.vendor_ext[i] == NULL) {
9808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			while (--i >= 0)
9818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				wpabuf_free(wps->dev.vendor_ext[i]);
9828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
9838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
9848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
9858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
9878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
9888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_init_wps(struct hostapd_data *hapd,
9918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		     struct hostapd_bss_config *conf)
9928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
9938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_context *wps;
9948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_registrar_config cfg;
9958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
9968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->wps_state == 0) {
9978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hostapd_wps_clear_ies(hapd);
9988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
9998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps = os_zalloc(sizeof(*wps));
10028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wps == NULL)
10038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
10048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->cred_cb = hostapd_wps_cred_cb;
10068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->event_cb = hostapd_wps_event_cb;
1007b7b4d0ec07161a6d76c40ba7ef1306e82fbb7e15Dmitry Shmidt	wps->rf_band_cb = hostapd_wps_rf_band_cb;
10088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->cb_ctx = hapd;
10098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memset(&cfg, 0, sizeof(cfg));
10118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->wps_state = hapd->conf->wps_state;
10128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->ap_setup_locked = hapd->conf->ap_setup_locked;
10138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (is_nil_uuid(hapd->conf->uuid)) {
10148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		const u8 *uuid;
10158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		uuid = get_own_uuid(hapd->iface);
1016444d567b27731d8572ef37697dd12fd1c37c2f24Dmitry Shmidt		if (uuid && !conf->wps_independent) {
10178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			os_memcpy(wps->uuid, uuid, UUID_LEN);
10188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wpa_hexdump(MSG_DEBUG, "WPS: Clone UUID from another "
10198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    "interface", wps->uuid, UUID_LEN);
10208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		} else {
10218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			uuid_gen_mac_addr(hapd->own_addr, wps->uuid);
10228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wpa_hexdump(MSG_DEBUG, "WPS: UUID based on MAC "
10238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    "address", wps->uuid, UUID_LEN);
10248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
10258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else {
10268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_memcpy(wps->uuid, hapd->conf->uuid, UUID_LEN);
10278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_hexdump(MSG_DEBUG, "WPS: Use configured UUID",
10288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			    wps->uuid, UUID_LEN);
10298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->ssid_len = hapd->conf->ssid.ssid_len;
10318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(wps->ssid, hapd->conf->ssid.ssid, wps->ssid_len);
10328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->ap = 1;
10338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(wps->dev.mac_addr, hapd->own_addr, ETH_ALEN);
10348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.device_name = hapd->conf->device_name ?
10358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_strdup(hapd->conf->device_name) : NULL;
10368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.manufacturer = hapd->conf->manufacturer ?
10378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_strdup(hapd->conf->manufacturer) : NULL;
10388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.model_name = hapd->conf->model_name ?
10398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_strdup(hapd->conf->model_name) : NULL;
10408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.model_number = hapd->conf->model_number ?
10418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_strdup(hapd->conf->model_number) : NULL;
10428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.serial_number = hapd->conf->serial_number ?
10438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_strdup(hapd->conf->serial_number) : NULL;
10448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->config_methods =
10458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_config_methods_str2bin(hapd->conf->config_methods);
10468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS2
10478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if ((wps->config_methods &
10488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	     (WPS_CONFIG_DISPLAY | WPS_CONFIG_VIRT_DISPLAY |
10498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	      WPS_CONFIG_PHY_DISPLAY)) == WPS_CONFIG_DISPLAY) {
10508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_INFO, "WPS: Converting display to "
10518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "virtual_display for WPS 2.0 compliance");
10528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->config_methods |= WPS_CONFIG_VIRT_DISPLAY;
10538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if ((wps->config_methods &
10558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	     (WPS_CONFIG_PUSHBUTTON | WPS_CONFIG_VIRT_PUSHBUTTON |
10568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	      WPS_CONFIG_PHY_PUSHBUTTON)) == WPS_CONFIG_PUSHBUTTON) {
10578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_INFO, "WPS: Converting push_button to "
10588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "virtual_push_button for WPS 2.0 compliance");
10598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->config_methods |= WPS_CONFIG_VIRT_PUSHBUTTON;
10608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS2 */
10628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(wps->dev.pri_dev_type, hapd->conf->device_type,
10638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		  WPS_DEV_TYPE_LEN);
10648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hostapd_wps_set_vendor_ext(hapd, wps) < 0) {
10668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(wps);
10678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
10688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->dev.os_version = WPA_GET_BE32(hapd->conf->os_version);
10711f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt
10721f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	if (conf->wps_rf_bands) {
10731f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wps->dev.rf_bands = conf->wps_rf_bands;
10741f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	} else {
10751f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt		wps->dev.rf_bands =
10761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt			hapd->iconf->hw_mode == HOSTAPD_MODE_IEEE80211A ?
10771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt			WPS_RF_50GHZ : WPS_RF_24GHZ; /* FIX: dualband AP */
10781f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	}
10798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->wpa & WPA_PROTO_RSN) {
10818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK)
10828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_WPA2PSK;
10838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X)
10848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_WPA2;
10858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->rsn_pairwise & WPA_CIPHER_CCMP)
10878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_AES;
10888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->rsn_pairwise & WPA_CIPHER_TKIP)
10898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_TKIP;
10908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
10918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->wpa & WPA_PROTO_WPA) {
10938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK)
10948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_WPAPSK;
10958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X)
10968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_WPA;
10978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
10988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_pairwise & WPA_CIPHER_CCMP)
10998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_AES;
11008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->wpa_pairwise & WPA_CIPHER_TKIP)
11018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_TKIP;
11028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->ssid.security_policy == SECURITY_PLAINTEXT) {
11058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->encr_types |= WPS_ENCR_NONE;
11068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->auth_types |= WPS_AUTH_OPEN;
11078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (conf->ssid.security_policy == SECURITY_STATIC_WEP) {
11088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->encr_types |= WPS_ENCR_WEP;
11098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->auth_algs & WPA_AUTH_ALG_OPEN)
11108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_OPEN;
11118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->auth_algs & WPA_AUTH_ALG_SHARED)
11128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->auth_types |= WPS_AUTH_SHARED;
11138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (conf->ssid.security_policy == SECURITY_IEEE_802_1X) {
11148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->auth_types |= WPS_AUTH_OPEN;
11158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (conf->default_wep_key_len)
11168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_WEP;
11178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else
11188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			wps->encr_types |= WPS_ENCR_NONE;
11198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->ssid.wpa_psk_file) {
11228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* Use per-device PSKs */
11238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (conf->ssid.wpa_passphrase) {
11248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key = (u8 *) os_strdup(conf->ssid.wpa_passphrase);
11258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key_len = os_strlen(conf->ssid.wpa_passphrase);
11268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (conf->ssid.wpa_psk) {
11278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key = os_malloc(2 * PMK_LEN + 1);
11288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (wps->network_key == NULL) {
11298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			os_free(wps);
11308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
11318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
11328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_snprintf_hex((char *) wps->network_key, 2 * PMK_LEN + 1,
11338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				 conf->ssid.wpa_psk->psk, PMK_LEN);
11348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key_len = 2 * PMK_LEN;
11358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else if (conf->ssid.wep.keys_set && conf->ssid.wep.key[0]) {
11368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key = os_malloc(conf->ssid.wep.len[0]);
11378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (wps->network_key == NULL) {
11388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			os_free(wps);
11398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
11408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
11418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_memcpy(wps->network_key, conf->ssid.wep.key[0],
11428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  conf->ssid.wep.len[0]);
11438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->network_key_len = conf->ssid.wep.len[0];
11448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->ssid.wpa_psk) {
11478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_memcpy(wps->psk, conf->ssid.wpa_psk->psk, PMK_LEN);
11488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->psk_set = 1;
11498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
115196be6222df414a7dde5c5b1b72df22e67b1a77fcDmitry Shmidt	wps->ap_auth_type = wps->auth_types;
115296be6222df414a7dde5c5b1b72df22e67b1a77fcDmitry Shmidt	wps->ap_encr_type = wps->encr_types;
11538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->wps_state == WPS_STATE_NOT_CONFIGURED) {
11548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* Override parameters to enable security by default */
11558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->auth_types = WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK;
11568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps->encr_types = WPS_ENCR_AES | WPS_ENCR_TKIP;
11578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->ap_settings = conf->ap_settings;
11608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->ap_settings_len = conf->ap_settings_len;
11618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.new_psk_cb = hostapd_wps_new_psk_cb;
11638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.set_ie_cb = hostapd_wps_set_ie_cb;
11648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.pin_needed_cb = hostapd_wps_pin_needed_cb;
11658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.reg_success_cb = hostapd_wps_reg_success_cb;
11668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.enrollee_seen_cb = hostapd_wps_enrollee_seen_cb;
11678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.cb_ctx = hapd;
11688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.skip_cred_build = conf->skip_cred_build;
11698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.extra_cred = conf->extra_cred;
11708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.extra_cred_len = conf->extra_cred_len;
11718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.disable_auto_conf = (hapd->conf->wps_cred_processing == 1) &&
11728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		conf->skip_cred_build;
11738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (conf->ssid.security_policy == SECURITY_STATIC_WEP)
11748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cfg.static_wep_only = 1;
11758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cfg.dualband = interface_count(hapd->iface) > 1;
1176a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	if ((wps->dev.rf_bands & (WPS_RF_50GHZ | WPS_RF_24GHZ)) ==
1177a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt	    (WPS_RF_50GHZ | WPS_RF_24GHZ))
1178a54fa5fb807eaeff45464139b5a7759f060cec68Dmitry Shmidt		cfg.dualband = 1;
11798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (cfg.dualband)
11808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Dualband AP");
1181391c59f0632df8db1c325da1d31d479b2eedce45Dmitry Shmidt	cfg.force_per_enrollee_psk = conf->force_per_enrollee_psk;
11828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->registrar = wps_registrar_init(wps, &cfg);
11848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wps->registrar == NULL) {
11858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_ERROR, "Failed to initialize WPS Registrar");
11868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(wps->network_key);
11878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(wps);
11888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
11898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
11908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
11918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
11928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->friendly_name = hapd->conf->friendly_name;
11938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->manufacturer_url = hapd->conf->manufacturer_url;
11948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->model_description = hapd->conf->model_description;
11958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->model_url = hapd->conf->model_url;
11968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->upc = hapd->conf->upc;
119787fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen#endif /* CONFIG_WPS_UPNP */
119887fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
119987fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen	hostapd_register_probereq_cb(hapd, hostapd_wps_probe_req_rx, hapd);
120087fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
120187fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen	hapd->wps = wps;
12028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
120387fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen	return 0;
120487fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen}
120587fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
120687fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
120787fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinenint hostapd_init_wps_complete(struct hostapd_data *hapd)
120887fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen{
120987fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen	struct wps_context *wps = hapd->wps;
121087fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
121175ecf5267604f166b85a7ee2cf0d9cb682966680Jouni Malinen	if (wps == NULL)
121287fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen		return 0;
121387fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen
121487fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen#ifdef CONFIG_WPS_UPNP
12158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hostapd_wps_upnp_init(hapd, wps) < 0) {
12168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_ERROR, "Failed to initialize WPS UPnP");
12178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_registrar_deinit(wps->registrar);
12188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(wps->network_key);
12198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		os_free(wps);
122087fd279308af3f806848c8f2ab65ef18c6ac4c30Jouni Malinen		hapd->wps = NULL;
12218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
12228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
12238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
12248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
12268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
12278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
122904949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic void hostapd_wps_nfc_clear(struct wps_context *wps)
123004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
123104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS_NFC
12325460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Clear NFC Tag context %p", wps);
123304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dev_pw_id = 0;
123404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpabuf_free(wps->ap_nfc_dh_pubkey);
123504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dh_pubkey = NULL;
123604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpabuf_free(wps->ap_nfc_dh_privkey);
123704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dh_privkey = NULL;
123804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpabuf_free(wps->ap_nfc_dev_pw);
123904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dev_pw = NULL;
124004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS_NFC */
124104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
124204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
124304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
12448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid hostapd_deinit_wps(struct hostapd_data *hapd)
12458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
12468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eloop_cancel_timeout(hostapd_wps_reenable_ap_pin, hapd, NULL);
12478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eloop_cancel_timeout(hostapd_wps_ap_pin_timeout, hapd, NULL);
1248fb79edc9df1f20461e90e478363d207348213d35Dmitry Shmidt	eloop_cancel_timeout(wps_reload_config, hapd->iface, NULL);
12498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
12508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
12518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
12528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_upnp_deinit(hapd);
12538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
12548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_registrar_deinit(hapd->wps->registrar);
12558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(hapd->wps->network_key);
12568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_device_data_free(&hapd->wps->dev);
12578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps->dh_pubkey);
12588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(hapd->wps->dh_privkey);
12598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_free_pending_msgs(hapd->wps->upnp_msgs);
126004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	hostapd_wps_nfc_clear(hapd->wps);
12618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(hapd->wps);
12628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps = NULL;
12638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_clear_ies(hapd);
12648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
12658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid hostapd_update_wps(struct hostapd_data *hapd)
12688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
12698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
12708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return;
12718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
12738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->friendly_name = hapd->conf->friendly_name;
12748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->manufacturer_url = hapd->conf->manufacturer_url;
12758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->model_description = hapd->conf->model_description;
12768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->model_url = hapd->conf->model_url;
12778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->upc = hapd->conf->upc;
12788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
12798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_set_vendor_ext(hapd, hapd->wps);
12818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->conf->wps_state)
12838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_registrar_update_ie(hapd->wps->registrar);
12848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else
12858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hostapd_deinit_wps(hapd);
12868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
12878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wps_add_pin_data {
12908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *addr;
12918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *uuid;
12928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *pin;
12938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t pin_len;
12948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int timeout;
12958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int added;
12968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt};
12978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
12998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_add_pin(struct hostapd_data *hapd, void *ctx)
13008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
13018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_add_pin_data *data = ctx;
13028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int ret;
13038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
13058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
13068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ret = wps_registrar_add_pin(hapd->wps->registrar, data->addr,
13078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    data->uuid, data->pin, data->pin_len,
13088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    data->timeout);
13098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ret == 0)
13108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		data->added++;
13118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return ret;
13128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
13138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_wps_add_pin(struct hostapd_data *hapd, const u8 *addr,
13168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			const char *uuid, const char *pin, int timeout)
13178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
13188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	u8 u[UUID_LEN];
13198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_add_pin_data data;
13208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.addr = addr;
13228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.uuid = u;
13238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.pin = (const u8 *) pin;
13248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.pin_len = os_strlen(pin);
13258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.timeout = timeout;
13268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.added = 0;
13278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (os_strcmp(uuid, "any") == 0)
13298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		data.uuid = NULL;
13308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else {
13318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (uuid_str2bin(uuid, u))
13328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
13338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		data.uuid = u;
13348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
13358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hostapd_wps_for_each(hapd, wps_add_pin, &data) < 0)
13368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
13378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return data.added ? 0 : -1;
13388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
13398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_button_pushed(struct hostapd_data *hapd, void *ctx)
13428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
13438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *p2p_dev_addr = ctx;
13448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
13458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
13468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return wps_registrar_button_pushed(hapd->wps->registrar, p2p_dev_addr);
13478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
13488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_wps_button_pushed(struct hostapd_data *hapd,
13518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			      const u8 *p2p_dev_addr)
13528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
13538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hostapd_wps_for_each(hapd, wps_button_pushed,
13548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				    (void *) p2p_dev_addr);
13558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
13568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
135804949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int wps_cancel(struct hostapd_data *hapd, void *ctx)
135904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
136004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (hapd->wps == NULL)
136104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return 0;
136204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
136304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps_registrar_wps_cancel(hapd->wps->registrar);
136404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	ap_for_each_sta(hapd, ap_sta_wps_cancel, NULL);
136504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
136604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return 0;
136704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
136804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
136904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
137004949598a23f501be6eec21697465fd46a28840aDmitry Shmidtint hostapd_wps_cancel(struct hostapd_data *hapd)
137104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
137204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return hostapd_wps_for_each(hapd, wps_cancel, NULL);
137304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
137404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
137504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
13761f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidtstatic int hostapd_wps_probe_req_rx(void *ctx, const u8 *addr, const u8 *da,
13771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt				    const u8 *bssid,
137804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				    const u8 *ie, size_t ie_len,
137904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				    int ssi_signal)
13808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
13818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = ctx;
13828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wpabuf *wps_ie;
13838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct ieee802_11_elems elems;
13848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
13868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
13878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ieee802_11_parse_elems(ie, ie_len, &elems, 0) == ParseFailed) {
13898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Could not parse ProbeReq from "
13908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   MACSTR, MAC2STR(addr));
13918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
13928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
13938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
13948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (elems.ssid && elems.ssid_len > 0 &&
13958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	    (elems.ssid_len != hapd->conf->ssid.ssid_len ||
13968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	     os_memcmp(elems.ssid, hapd->conf->ssid.ssid, elems.ssid_len) !=
13978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	     0))
13988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0; /* Not for us */
13998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps_ie = ieee802_11_vendor_ie_concat(ie, ie_len, WPS_DEV_OUI_WFA);
14018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wps_ie == NULL)
14028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
14038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wps_validate_probe_req(wps_ie, addr) < 0) {
14048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpabuf_free(wps_ie);
14058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
14068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
14078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (wpabuf_len(wps_ie) > 0) {
14098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		int p2p_wildcard = 0;
14108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_P2P
14118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (elems.ssid && elems.ssid_len == P2P_WILDCARD_SSID_LEN &&
14128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    os_memcmp(elems.ssid, P2P_WILDCARD_SSID,
14138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			      P2P_WILDCARD_SSID_LEN) == 0)
14148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			p2p_wildcard = 1;
14158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_P2P */
14168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_registrar_probe_req_rx(hapd->wps->registrar, addr, wps_ie,
14178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					   p2p_wildcard);
14188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
14198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/* FIX: what exactly should be included in the WLANEvent?
14208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		 * WPS attributes? Full ProbeReq frame? */
14218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (!p2p_wildcard)
14228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			upnp_wps_device_send_wlan_event(
14238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				hapd->wps_upnp, addr,
14248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				UPNP_WPS_WLANEVENT_TYPE_PROBE, wps_ie);
14258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
14268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
14278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpabuf_free(wps_ie);
14298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
14318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
14328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
14358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_rx_req_put_wlan_response(
14378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	void *priv, enum upnp_wps_wlanevent_type ev_type,
14388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	const u8 *mac_addr, const struct wpabuf *msg,
14398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	enum wps_msg_type msg_type)
14408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
14418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = priv;
14428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct sta_info *sta;
14438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct upnp_pending_message *p;
14448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS UPnP: PutWLANResponse ev_type=%d mac_addr="
14468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		   MACSTR, ev_type, MAC2STR(mac_addr));
14478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_hexdump(MSG_MSGDUMP, "WPS UPnP: PutWLANResponse NewMessage",
14488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    wpabuf_head(msg), wpabuf_len(msg));
14498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ev_type != UPNP_WPS_WLANEVENT_TYPE_EAP) {
14508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS UPnP: Ignored unexpected "
14518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "PutWLANResponse WLANEventType %d", ev_type);
14528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
14538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
14548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	/*
14568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * EAP response to ongoing to WPS Registration. Send it to EAP-WSC
14578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 * server implementation for delivery to the peer.
14588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	 */
14598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	sta = ap_get_sta(hapd, mac_addr);
14618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifndef CONFIG_WPS_STRICT
14628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (!sta) {
14638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		/*
14648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		 * Workaround - Intel wsccmd uses bogus NewWLANEventMAC:
14658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		 * Pick STA that is in an ongoing WPS registration without
14668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		 * checking the MAC address.
14678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		 */
14688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS UPnP: No matching STA found based "
14698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   "on NewWLANEventMAC; try wildcard match");
14708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		for (sta = hapd->sta_list; sta; sta = sta->next) {
14718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			if (sta->eapol_sm && (sta->flags & WLAN_STA_WPS))
14728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				break;
14738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		}
14748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
14758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_STRICT */
14768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
14771f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	if (!sta || !(sta->flags & WLAN_STA_WPS)) {
14788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS UPnP: No matching STA found");
14798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
14808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
14818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
148213ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt	if (!sta->eapol_sm) {
148313ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		/*
148413ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		 * This can happen, e.g., if an ER sends an extra message after
148513ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		 * the station has disassociated (but not fully
148613ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		 * deauthenticated).
148713ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		 */
148813ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS UPnP: Matching STA did not have EAPOL state machine initialized");
148913ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt		return 0;
149013ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt	}
149113ca8d8ea51a1aa5e24c6c956473a11b0c7daed4Dmitry Shmidt
14928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p = os_zalloc(sizeof(*p));
14938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (p == NULL)
14948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
14958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memcpy(p->addr, sta->addr, ETH_ALEN);
14968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p->msg = wpabuf_dup(msg);
14978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p->type = msg_type;
14988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	p->next = hapd->wps->upnp_msgs;
14998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps->upnp_msgs = p;
15008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return eapol_auth_eap_pending_cb(sta->eapol_sm, sta->eapol_sm->eap);
15028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int hostapd_wps_upnp_init(struct hostapd_data *hapd,
15068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				 struct wps_context *wps)
15078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct upnp_wps_device_ctx *ctx;
15098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (!hapd->conf->upnp_iface)
15118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
15128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ctx = os_zalloc(sizeof(*ctx));
15138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ctx == NULL)
15148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
15158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ctx->rx_req_put_wlan_response = hostapd_rx_req_put_wlan_response;
15178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->conf->ap_pin)
15188d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		ctx->ap_pin = os_strdup(hapd->conf->ap_pin);
15198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->wps_upnp = upnp_wps_device_init(ctx, wps, hapd,
15218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt					      hapd->conf->upnp_iface);
15228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps_upnp == NULL)
15238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
15248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wps->wps_upnp = hapd->wps_upnp;
15258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
15278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_upnp_deinit(struct hostapd_data *hapd)
15318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	upnp_wps_device_deinit(hapd->wps_upnp, hapd);
15338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
15368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_wps_get_mib_sta(struct hostapd_data *hapd, const u8 *addr,
15398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			    char *buf, size_t buflen)
15408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps == NULL)
15428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return 0;
15438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return wps_registrar_get_info(hapd->wps->registrar, addr, buf, buflen);
15448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_ap_pin_timeout(void *eloop_data, void *user_ctx)
15488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct hostapd_data *hapd = eloop_data;
15508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: AP PIN timed out");
15518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_ap_pin_disable(hapd);
15521f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_PIN_DISABLED);
15538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic void hostapd_wps_ap_pin_enable(struct hostapd_data *hapd, int timeout)
15578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Enabling AP PIN (timeout=%d)", timeout);
15598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->ap_pin_failures = 0;
1560c5ec7f57ead87efa365800228aa0b09a12d9e6c4Dmitry Shmidt	hapd->ap_pin_failures_consecutive = 0;
15618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->conf->ap_setup_locked = 0;
15628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps->ap_setup_locked) {
15638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_SETUP_UNLOCKED);
15648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		hapd->wps->ap_setup_locked = 0;
15658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_registrar_update_ie(hapd->wps->registrar);
15668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
15678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eloop_cancel_timeout(hostapd_wps_ap_pin_timeout, hapd, NULL);
15688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (timeout > 0)
15698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		eloop_register_timeout(timeout, 0,
15708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt				       hostapd_wps_ap_pin_timeout, hapd, NULL);
15718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_ap_pin_disable(struct hostapd_data *hapd, void *ctx)
15758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(hapd->conf->ap_pin);
15778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->conf->ap_pin = NULL;
15788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
15798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	upnp_wps_set_ap_pin(hapd->wps_upnp, NULL);
15808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
15818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	eloop_cancel_timeout(hostapd_wps_ap_pin_timeout, hapd, NULL);
15828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
15838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid hostapd_wps_ap_pin_disable(struct hostapd_data *hapd)
15878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
15888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Disabling AP PIN");
15898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_for_each(hapd, wps_ap_pin_disable, NULL);
15908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
15918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstruct wps_ap_pin_data {
15948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	char pin_txt[9];
15958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int timeout;
15968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt};
15978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
15998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_ap_pin_set(struct hostapd_data *hapd, void *ctx)
16008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_ap_pin_data *data = ctx;
16028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_free(hapd->conf->ap_pin);
16038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hapd->conf->ap_pin = os_strdup(data->pin_txt);
16048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#ifdef CONFIG_WPS_UPNP
16058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	upnp_wps_set_ap_pin(hapd->wps_upnp, data->pin_txt);
16068d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt#endif /* CONFIG_WPS_UPNP */
16078d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_ap_pin_enable(hapd, data->timeout);
16088d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
16098d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16108d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16118d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16128d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst char * hostapd_wps_ap_pin_random(struct hostapd_data *hapd, int timeout)
16138d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16148d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	unsigned int pin;
16158d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_ap_pin_data data;
16168d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16178d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	pin = wps_generate_pin();
16181f69aa52ea2e0a73ac502565df8c666ee49cab6aDmitry Shmidt	os_snprintf(data.pin_txt, sizeof(data.pin_txt), "%08u", pin);
16198d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.timeout = timeout;
16208d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_for_each(hapd, wps_ap_pin_set, &data);
16218d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hapd->conf->ap_pin;
16228d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16238d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16248d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16258d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtconst char * hostapd_wps_ap_pin_get(struct hostapd_data *hapd)
16268d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16278d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hapd->conf->ap_pin;
16288d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16298d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16308d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16318d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_wps_ap_pin_set(struct hostapd_data *hapd, const char *pin,
16328d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			   int timeout)
16338d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16348d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_ap_pin_data data;
16358d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	int ret;
16368d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16378d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	ret = os_snprintf(data.pin_txt, sizeof(data.pin_txt), "%s", pin);
16388d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (ret < 0 || ret >= (int) sizeof(data.pin_txt))
16398d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
16408d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	data.timeout = timeout;
16418d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return hostapd_wps_for_each(hapd, wps_ap_pin_set, &data);
16428d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16438d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16448d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16458d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtstatic int wps_update_ie(struct hostapd_data *hapd, void *ctx)
16468d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16478d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (hapd->wps)
16488d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		wps_registrar_update_ie(hapd->wps->registrar);
16498d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return 0;
16508d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16518d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16528d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16538d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtvoid hostapd_wps_update_ie(struct hostapd_data *hapd)
16548d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16558d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	hostapd_wps_for_each(hapd, wps_update_ie, NULL);
16568d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
16578d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16588d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16598d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidtint hostapd_wps_config_ap(struct hostapd_data *hapd, const char *ssid,
16608d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			  const char *auth, const char *encr, const char *key)
16618d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt{
16628d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	struct wps_credential cred;
16638d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	size_t len;
16648d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16658d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	os_memset(&cred, 0, sizeof(cred));
16668d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16678d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	len = os_strlen(ssid);
16688d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if ((len & 1) || len > 2 * sizeof(cred.ssid) ||
16698d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	    hexstr2bin(ssid, cred.ssid, len / 2))
16708d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
16718d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	cred.ssid_len = len / 2;
16728d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16738d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (os_strncmp(auth, "OPEN", 4) == 0)
16748d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cred.auth_type = WPS_AUTH_OPEN;
16758d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else if (os_strncmp(auth, "WPAPSK", 6) == 0)
16768d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cred.auth_type = WPS_AUTH_WPAPSK;
16778d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else if (os_strncmp(auth, "WPA2PSK", 7) == 0)
16788d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cred.auth_type = WPS_AUTH_WPA2PSK;
16798d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	else
16808d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		return -1;
16818d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16828d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (encr) {
16838d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if (os_strncmp(encr, "NONE", 4) == 0)
16848d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred.encr_type = WPS_ENCR_NONE;
16858d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else if (os_strncmp(encr, "WEP", 3) == 0)
16868d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred.encr_type = WPS_ENCR_WEP;
16878d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else if (os_strncmp(encr, "TKIP", 4) == 0)
16888d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred.encr_type = WPS_ENCR_TKIP;
16898d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else if (os_strncmp(encr, "CCMP", 4) == 0)
16908d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			cred.encr_type = WPS_ENCR_AES;
16918d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		else
16928d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
16938d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	} else
16948d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cred.encr_type = WPS_ENCR_NONE;
16958d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
16968d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	if (key) {
16978d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		len = os_strlen(key);
16988d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		if ((len & 1) || len > 2 * sizeof(cred.key) ||
16998d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		    hexstr2bin(key, cred.key, len / 2))
17008d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt			return -1;
17018d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt		cred.key_len = len / 2;
17028d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	}
17038d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt
17048d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt	return wps_registrar_config_ap(hapd->wps->registrar, &cred);
17058d520ff1dc2da35cdca849e982051b86468016d8Dmitry Shmidt}
170604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
170704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
170804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#ifdef CONFIG_WPS_NFC
170904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
171004949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstruct wps_nfc_password_token_data {
171104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	const u8 *oob_dev_pw;
171204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	size_t oob_dev_pw_len;
171304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	int added;
171404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt};
171504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
171604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
171704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int wps_add_nfc_password_token(struct hostapd_data *hapd, void *ctx)
171804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
171904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wps_nfc_password_token_data *data = ctx;
172004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	int ret;
172104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
172204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (hapd->wps == NULL)
172304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return 0;
172404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	ret = wps_registrar_add_nfc_password_token(hapd->wps->registrar,
172504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt						   data->oob_dev_pw,
172604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt						   data->oob_dev_pw_len);
172704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (ret == 0)
172804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		data->added++;
172904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return ret;
173004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
173104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
173204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
173304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int hostapd_wps_add_nfc_password_token(struct hostapd_data *hapd,
173404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt					      struct wps_parse_attr *attr)
173504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
173604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wps_nfc_password_token_data data;
173704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
173804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	data.oob_dev_pw = attr->oob_dev_password;
173904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	data.oob_dev_pw_len = attr->oob_dev_password_len;
174004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	data.added = 0;
174104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (hostapd_wps_for_each(hapd, wps_add_nfc_password_token, &data) < 0)
174204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
174304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return data.added ? 0 : -1;
174404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
174504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
174604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
174704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstatic int hostapd_wps_nfc_tag_process(struct hostapd_data *hapd,
174804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				       const struct wpabuf *wps)
174904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
175004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wps_parse_attr attr;
175104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
175204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpa_hexdump_buf(MSG_DEBUG, "WPS: Received NFC tag payload", wps);
175304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
175404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (wps_parse_msg(wps, &attr)) {
175504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Ignore invalid data from NFC tag");
175604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
175704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	}
175804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
175904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (attr.oob_dev_password)
176004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return hostapd_wps_add_nfc_password_token(hapd, &attr);
176104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
176204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Ignore unrecognized NFC tag");
176304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return -1;
176404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
176504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
176604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
176704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtint hostapd_wps_nfc_tag_read(struct hostapd_data *hapd,
176804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt			     const struct wpabuf *data)
176904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
177004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	const struct wpabuf *wps = data;
177104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wpabuf *tmp = NULL;
177204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	int ret;
177304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
177404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (wpabuf_len(data) < 4)
177504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
177604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
177704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (*wpabuf_head_u8(data) != 0x10) {
177804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		/* Assume this contains full NDEF record */
177904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		tmp = ndef_parse_wifi(data);
178004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		if (tmp == NULL) {
178104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt			wpa_printf(MSG_DEBUG, "WPS: Could not parse NDEF");
178204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt			return -1;
178304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		}
178404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		wps = tmp;
178504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	}
178604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
178704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	ret = hostapd_wps_nfc_tag_process(hapd, wps);
178804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wpabuf_free(tmp);
178904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return ret;
179004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
179104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
179204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
179304949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstruct wpabuf * hostapd_wps_nfc_config_token(struct hostapd_data *hapd,
179404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt					     int ndef)
179504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
179604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wpabuf *ret;
179704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
179804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (hapd->wps == NULL)
179904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return NULL;
180004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
1801cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	ret = wps_get_oob_cred(hapd->wps, hostapd_wps_rf_band_cb(hapd),
1802cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			       hapd->iconf->channel);
180304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (ndef && ret) {
180404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		struct wpabuf *tmp;
180504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		tmp = ndef_build_wifi(ret);
180604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		wpabuf_free(ret);
180704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		if (tmp == NULL)
180804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt			return NULL;
180904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		ret = tmp;
181004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	}
181104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
181204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return ret;
181304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
181404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
181504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
1816f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidtstruct wpabuf * hostapd_wps_nfc_hs_cr(struct hostapd_data *hapd, int ndef)
1817f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt{
1818cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	struct wpabuf *ret;
1819cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1820cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (hapd->wps == NULL)
1821cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		return NULL;
1822cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1823cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (hapd->conf->wps_nfc_dh_pubkey == NULL) {
1824cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		struct wps_context *wps = hapd->wps;
1825cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		if (wps_nfc_gen_dh(&hapd->conf->wps_nfc_dh_pubkey,
1826cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt				   &hapd->conf->wps_nfc_dh_privkey) < 0)
1827cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			return NULL;
1828cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		hostapd_wps_nfc_clear(wps);
1829cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wps->ap_nfc_dev_pw_id = DEV_PW_NFC_CONNECTION_HANDOVER;
1830cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wps->ap_nfc_dh_pubkey =
1831cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			wpabuf_dup(hapd->conf->wps_nfc_dh_pubkey);
1832cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wps->ap_nfc_dh_privkey =
1833cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			wpabuf_dup(hapd->conf->wps_nfc_dh_privkey);
1834cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		if (!wps->ap_nfc_dh_pubkey || !wps->ap_nfc_dh_privkey) {
1835cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			hostapd_wps_nfc_clear(wps);
1836cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			return NULL;
1837cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		}
1838cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1839cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1840cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	ret = wps_build_nfc_handover_sel(hapd->wps,
1841cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt					 hapd->conf->wps_nfc_dh_pubkey,
1842cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt					 hapd->own_addr, hapd->iface->freq);
1843cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1844cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (ndef && ret) {
1845cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		struct wpabuf *tmp;
1846cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		tmp = ndef_build_wifi(ret);
1847cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpabuf_free(ret);
1848cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		if (tmp == NULL)
1849cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			return NULL;
1850cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		ret = tmp;
1851cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1852cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1853cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	return ret;
1854cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt}
1855cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1856cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1857cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidtint hostapd_wps_nfc_report_handover(struct hostapd_data *hapd,
1858cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt				    const struct wpabuf *req,
1859cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt				    const struct wpabuf *sel)
1860cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt{
1861cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	struct wpabuf *wps;
1862cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	int ret = -1;
1863cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	u16 wsc_len;
1864cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	const u8 *pos;
1865cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	struct wpabuf msg;
1866cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	struct wps_parse_attr attr;
1867cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	u16 dev_pw_id;
1868cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1869f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt	/*
1870cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	 * Enrollee/station is always initiator of the NFC connection handover,
1871cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	 * so use the request message here to find Enrollee public key hash.
1872f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt	 */
1873cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wps = ndef_parse_wifi(req);
1874cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (wps == NULL)
1875cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		return -1;
1876cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Received application/vnd.wfa.wsc "
1877cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		   "payload from NFC connection handover");
1878cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_hexdump_buf(MSG_DEBUG, "WPS: NFC payload", wps);
1879cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (wpabuf_len(wps) < 2) {
1880cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Too short Wi-Fi Handover Request "
1881cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "Message");
1882cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1883cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1884cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	pos = wpabuf_head(wps);
1885cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wsc_len = WPA_GET_BE16(pos);
1886cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (wsc_len > wpabuf_len(wps) - 2) {
1887cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Invalid WSC attribute length (%u) "
1888cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "in rt Wi-Fi Handover Request Message", wsc_len);
1889cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1890cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1891cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	pos += 2;
1892cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1893cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_hexdump(MSG_DEBUG,
1894cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		    "WPS: WSC attributes in Wi-Fi Handover Request Message",
1895cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		    pos, wsc_len);
1896cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (wsc_len < wpabuf_len(wps) - 2) {
1897cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_hexdump(MSG_DEBUG,
1898cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			    "WPS: Ignore extra data after WSC attributes",
1899cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			    pos + wsc_len, wpabuf_len(wps) - 2 - wsc_len);
1900cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1901cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1902cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpabuf_set(&msg, pos, wsc_len);
1903cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	ret = wps_parse_msg(&msg, &attr);
1904cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (ret < 0) {
1905cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Could not parse WSC attributes in "
1906cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "Wi-Fi Handover Request Message");
1907cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1908cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1909cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1910cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (attr.oob_dev_password == NULL ||
1911cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	    attr.oob_dev_password_len < WPS_OOB_PUBKEY_HASH_LEN + 2) {
1912cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: No Out-of-Band Device Password "
1913cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "included in Wi-Fi Handover Request Message");
1914cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		ret = -1;
1915cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1916cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1917cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1918cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (attr.uuid_e == NULL) {
1919cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: No UUID-E included in Wi-Fi "
1920cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "Handover Request Message");
1921cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		ret = -1;
1922cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1923cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1924cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1925cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_hexdump(MSG_DEBUG, "WPS: UUID-E", attr.uuid_e, WPS_UUID_LEN);
1926cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1927cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_hexdump(MSG_DEBUG, "WPS: Out-of-Band Device Password",
1928cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		    attr.oob_dev_password, attr.oob_dev_password_len);
1929cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	dev_pw_id = WPA_GET_BE16(attr.oob_dev_password +
1930cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt				 WPS_OOB_PUBKEY_HASH_LEN);
1931cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	if (dev_pw_id != DEV_PW_NFC_CONNECTION_HANDOVER) {
1932cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		wpa_printf(MSG_DEBUG, "WPS: Unexpected OOB Device Password ID "
1933cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt			   "%u in Wi-Fi Handover Request Message", dev_pw_id);
1934cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		ret = -1;
1935cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		goto out;
1936cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	}
1937cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpa_hexdump(MSG_DEBUG, "WPS: Enrollee Public Key hash",
1938cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt		    attr.oob_dev_password, WPS_OOB_PUBKEY_HASH_LEN);
1939cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1940cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	ret = wps_registrar_add_nfc_pw_token(hapd->wps->registrar,
1941cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt					     attr.oob_dev_password,
1942cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt					     DEV_PW_NFC_CONNECTION_HANDOVER,
1943cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt					     NULL, 0, 1);
1944cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt
1945cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidtout:
1946cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	wpabuf_free(wps);
1947cf32e60fa7e0d33fe1551a6dba8dcbbec47ea50eDmitry Shmidt	return ret;
1948f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt}
1949f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt
1950f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt
195104949598a23f501be6eec21697465fd46a28840aDmitry Shmidtstruct wpabuf * hostapd_wps_nfc_token_gen(struct hostapd_data *hapd, int ndef)
195204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
1953f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt	if (hapd->conf->wps_nfc_pw_from_config) {
1954f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt		return wps_nfc_token_build(ndef,
1955f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt					   hapd->conf->wps_nfc_dev_pw_id,
1956f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt					   hapd->conf->wps_nfc_dh_pubkey,
1957f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt					   hapd->conf->wps_nfc_dev_pw);
1958f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt	}
1959f86232838cf712377867cb42417c1613ab5dc425Dmitry Shmidt
196004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return wps_nfc_token_gen(ndef, &hapd->conf->wps_nfc_dev_pw_id,
196104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				 &hapd->conf->wps_nfc_dh_pubkey,
196204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				 &hapd->conf->wps_nfc_dh_privkey,
196304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt				 &hapd->conf->wps_nfc_dev_pw);
196404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
196504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
196604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
196704949598a23f501be6eec21697465fd46a28840aDmitry Shmidtint hostapd_wps_nfc_token_enable(struct hostapd_data *hapd)
196804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
196904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	struct wps_context *wps = hapd->wps;
197033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt	struct wpabuf *pw;
197104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
197204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (wps == NULL)
197304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
197404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
197504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (!hapd->conf->wps_nfc_dh_pubkey ||
197604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	    !hapd->conf->wps_nfc_dh_privkey ||
197704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	    !hapd->conf->wps_nfc_dev_pw ||
197804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	    !hapd->conf->wps_nfc_dev_pw_id)
197904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
198004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
198104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	hostapd_wps_nfc_clear(wps);
19825460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt	wpa_printf(MSG_DEBUG,
19835460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt		   "WPS: Enable NFC Tag (Dev Pw Id %u) for AP interface %s (context %p)",
19845460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt		   hapd->conf->wps_nfc_dev_pw_id, hapd->conf->iface, wps);
198504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dev_pw_id = hapd->conf->wps_nfc_dev_pw_id;
198604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dh_pubkey = wpabuf_dup(hapd->conf->wps_nfc_dh_pubkey);
198704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	wps->ap_nfc_dh_privkey = wpabuf_dup(hapd->conf->wps_nfc_dh_privkey);
198833e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt	pw = hapd->conf->wps_nfc_dev_pw;
198933e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt	wps->ap_nfc_dev_pw = wpabuf_alloc(
199033e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt		wpabuf_len(pw) * 2 + 1);
199133e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt	if (wps->ap_nfc_dev_pw) {
199233e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt		wpa_snprintf_hex_uppercase(
199333e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt			(char *) wpabuf_put(wps->ap_nfc_dev_pw,
199433e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt					    wpabuf_len(pw) * 2),
199533e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt			wpabuf_len(pw) * 2 + 1,
199633e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt			wpabuf_head(pw), wpabuf_len(pw));
199733e38bfa7159cef089d6ee0d904778e184c72c47Dmitry Shmidt	}
199804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
199904949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	if (!wps->ap_nfc_dh_pubkey || !wps->ap_nfc_dh_privkey ||
200004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	    !wps->ap_nfc_dev_pw) {
200104949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		hostapd_wps_nfc_clear(wps);
200204949598a23f501be6eec21697465fd46a28840aDmitry Shmidt		return -1;
200304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	}
200404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
200504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	return 0;
200604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
200704949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
200804949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
200904949598a23f501be6eec21697465fd46a28840aDmitry Shmidtvoid hostapd_wps_nfc_token_disable(struct hostapd_data *hapd)
201004949598a23f501be6eec21697465fd46a28840aDmitry Shmidt{
20115460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt	wpa_printf(MSG_DEBUG, "WPS: Disable NFC token for AP interface %s",
20125460547a121207cf7a99eac45e05fcdd83be3161Dmitry Shmidt		   hapd->conf->iface);
201304949598a23f501be6eec21697465fd46a28840aDmitry Shmidt	hostapd_wps_nfc_clear(hapd->wps);
201404949598a23f501be6eec21697465fd46a28840aDmitry Shmidt}
201504949598a23f501be6eec21697465fd46a28840aDmitry Shmidt
201604949598a23f501be6eec21697465fd46a28840aDmitry Shmidt#endif /* CONFIG_WPS_NFC */
2017