2 * hostapd / WPS integration
3 * Copyright (c) 2008-2009, Jouni Malinen <j@w1.fi>
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License version 2 as
7 * published by the Free Software Foundation.
9 * Alternatively, this software may be distributed under the terms of BSD
12 * See README and COPYING for more details.
15 #include "utils/includes.h"
17 #include "utils/common.h"
18 #include "utils/eloop.h"
19 #include "utils/uuid.h"
20 #include "crypto/dh_groups.h"
21 #include "common/wpa_ctrl.h"
22 #include "common/ieee802_11_defs.h"
23 #include "common/ieee802_11_common.h"
24 #include "eapol_auth/eapol_auth_sm.h"
25 #include "eapol_auth/eapol_auth_sm_i.h"
27 #include "wps/wps_defs.h"
28 #include "wps/wps_dev_attr.h"
30 #include "ap_config.h"
33 #include "wps_hostapd.h"
36 #ifdef CONFIG_WPS_UPNP
37 #include "wps/wps_upnp.h"
38 static int hostapd_wps_upnp_init(struct hostapd_data *hapd,
39 struct wps_context *wps);
40 static void hostapd_wps_upnp_deinit(struct hostapd_data *hapd);
41 #endif /* CONFIG_WPS_UPNP */
43 static int hostapd_wps_probe_req_rx(void *ctx, const u8 *addr,
44 const u8 *ie, size_t ie_len);
47 static int hostapd_wps_new_psk_cb(void *ctx, const u8 *mac_addr, const u8 *psk,
50 struct hostapd_data *hapd = ctx;
51 struct hostapd_wpa_psk *p;
52 struct hostapd_ssid *ssid = &hapd->conf->ssid;
54 wpa_printf(MSG_DEBUG, "Received new WPA/WPA2-PSK from WPS for STA "
55 MACSTR, MAC2STR(mac_addr));
56 wpa_hexdump_key(MSG_DEBUG, "Per-device PSK", psk, psk_len);
58 if (psk_len != PMK_LEN) {
59 wpa_printf(MSG_DEBUG, "Unexpected PSK length %lu",
60 (unsigned long) psk_len);
64 /* Add the new PSK to runtime PSK list */
65 p = os_zalloc(sizeof(*p));
68 os_memcpy(p->addr, mac_addr, ETH_ALEN);
69 os_memcpy(p->psk, psk, PMK_LEN);
71 p->next = ssid->wpa_psk;
74 if (ssid->wpa_psk_file) {
76 char hex[PMK_LEN * 2 + 1];
77 /* Add the new PSK to PSK list file */
78 f = fopen(ssid->wpa_psk_file, "a");
80 wpa_printf(MSG_DEBUG, "Failed to add the PSK to "
81 "'%s'", ssid->wpa_psk_file);
85 wpa_snprintf_hex(hex, sizeof(hex), psk, psk_len);
86 fprintf(f, MACSTR " %s\n", MAC2STR(mac_addr), hex);
94 static int hostapd_wps_set_ie_cb(void *ctx, struct wpabuf *beacon_ie,
95 struct wpabuf *probe_resp_ie)
97 struct hostapd_data *hapd = ctx;
98 wpabuf_free(hapd->wps_beacon_ie);
99 hapd->wps_beacon_ie = beacon_ie;
100 wpabuf_free(hapd->wps_probe_resp_ie);
101 hapd->wps_probe_resp_ie = probe_resp_ie;
102 ieee802_11_set_beacon(hapd);
103 return hapd->drv.set_ap_wps_ie(hapd);
107 static void hostapd_wps_pin_needed_cb(void *ctx, const u8 *uuid_e,
108 const struct wps_device_data *dev)
110 struct hostapd_data *hapd = ctx;
111 char uuid[40], txt[400];
113 char devtype[WPS_DEV_TYPE_BUFSIZE];
114 if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
116 wpa_printf(MSG_DEBUG, "WPS: PIN needed for E-UUID %s", uuid);
117 len = os_snprintf(txt, sizeof(txt), WPS_EVENT_PIN_NEEDED
118 "%s " MACSTR " [%s|%s|%s|%s|%s|%s]",
119 uuid, MAC2STR(dev->mac_addr), dev->device_name,
120 dev->manufacturer, dev->model_name,
121 dev->model_number, dev->serial_number,
122 wps_dev_type_bin2str(dev->pri_dev_type, devtype,
124 if (len > 0 && len < (int) sizeof(txt))
125 wpa_msg(hapd->msg_ctx, MSG_INFO, "%s", txt);
127 if (hapd->conf->wps_pin_requests) {
130 f = fopen(hapd->conf->wps_pin_requests, "a");
134 fprintf(f, "%ld\t%s\t" MACSTR "\t%s\t%s\t%s\t%s\t%s"
136 t.sec, uuid, MAC2STR(dev->mac_addr), dev->device_name,
137 dev->manufacturer, dev->model_name, dev->model_number,
139 wps_dev_type_bin2str(dev->pri_dev_type, devtype,
146 static void hostapd_wps_reg_success_cb(void *ctx, const u8 *mac_addr,
149 struct hostapd_data *hapd = ctx;
151 if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
153 wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_REG_SUCCESS MACSTR " %s",
154 MAC2STR(mac_addr), uuid);
155 if (hapd->wps_reg_success_cb)
156 hapd->wps_reg_success_cb(hapd->wps_reg_success_cb_ctx,
161 static void hostapd_wps_enrollee_seen_cb(void *ctx, const u8 *addr,
163 const u8 *pri_dev_type,
165 u16 dev_password_id, u8 request_type,
166 const char *dev_name)
168 struct hostapd_data *hapd = ctx;
170 char devtype[WPS_DEV_TYPE_BUFSIZE];
171 if (uuid_bin2str(uuid_e, uuid, sizeof(uuid)))
173 if (dev_name == NULL)
175 wpa_msg_ctrl(hapd->msg_ctx, MSG_INFO, WPS_EVENT_ENROLLEE_SEEN MACSTR
176 " %s %s 0x%x %u %u [%s]",
178 wps_dev_type_bin2str(pri_dev_type, devtype,
180 config_methods, dev_password_id, request_type, dev_name);
184 static int str_starts(const char *str, const char *start)
186 return os_strncmp(str, start, os_strlen(start)) == 0;
190 static void wps_reload_config(void *eloop_data, void *user_ctx)
192 struct hostapd_iface *iface = eloop_data;
194 wpa_printf(MSG_DEBUG, "WPS: Reload configuration data");
195 if (iface->reload_config(iface) < 0) {
196 wpa_printf(MSG_WARNING, "WPS: Failed to reload the updated "
202 static int hostapd_wps_cred_cb(void *ctx, const struct wps_credential *cred)
204 struct hostapd_data *hapd = ctx;
212 wpa_hexdump_key(MSG_DEBUG, "WPS: Received Credential attribute",
213 cred->cred_attr, cred->cred_attr_len);
215 wpa_printf(MSG_DEBUG, "WPS: Received new AP Settings");
216 wpa_hexdump_ascii(MSG_DEBUG, "WPS: SSID", cred->ssid, cred->ssid_len);
217 wpa_printf(MSG_DEBUG, "WPS: Authentication Type 0x%x",
219 wpa_printf(MSG_DEBUG, "WPS: Encryption Type 0x%x", cred->encr_type);
220 wpa_printf(MSG_DEBUG, "WPS: Network Key Index %d", cred->key_idx);
221 wpa_hexdump_key(MSG_DEBUG, "WPS: Network Key",
222 cred->key, cred->key_len);
223 wpa_printf(MSG_DEBUG, "WPS: MAC Address " MACSTR,
224 MAC2STR(cred->mac_addr));
226 if ((hapd->conf->wps_cred_processing == 1 ||
227 hapd->conf->wps_cred_processing == 2) && cred->cred_attr) {
228 size_t blen = cred->cred_attr_len * 2 + 1;
229 char *_buf = os_malloc(blen);
231 wpa_snprintf_hex(_buf, blen,
232 cred->cred_attr, cred->cred_attr_len);
233 wpa_msg(hapd->msg_ctx, MSG_INFO, "%s%s",
234 WPS_EVENT_NEW_AP_SETTINGS, _buf);
238 wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_NEW_AP_SETTINGS);
240 if (hapd->conf->wps_cred_processing == 1)
243 os_memcpy(hapd->wps->ssid, cred->ssid, cred->ssid_len);
244 hapd->wps->ssid_len = cred->ssid_len;
245 hapd->wps->encr_types = cred->encr_type;
246 hapd->wps->auth_types = cred->auth_type;
247 if (cred->key_len == 0) {
248 os_free(hapd->wps->network_key);
249 hapd->wps->network_key = NULL;
250 hapd->wps->network_key_len = 0;
252 if (hapd->wps->network_key == NULL ||
253 hapd->wps->network_key_len < cred->key_len) {
254 hapd->wps->network_key_len = 0;
255 os_free(hapd->wps->network_key);
256 hapd->wps->network_key = os_malloc(cred->key_len);
257 if (hapd->wps->network_key == NULL)
260 hapd->wps->network_key_len = cred->key_len;
261 os_memcpy(hapd->wps->network_key, cred->key, cred->key_len);
263 hapd->wps->wps_state = WPS_STATE_CONFIGURED;
265 len = os_strlen(hapd->iface->config_fname) + 5;
266 tmp_fname = os_malloc(len);
267 if (tmp_fname == NULL)
269 os_snprintf(tmp_fname, len, "%s-new", hapd->iface->config_fname);
271 oconf = fopen(hapd->iface->config_fname, "r");
273 wpa_printf(MSG_WARNING, "WPS: Could not open current "
274 "configuration file");
279 nconf = fopen(tmp_fname, "w");
281 wpa_printf(MSG_WARNING, "WPS: Could not write updated "
282 "configuration file");
288 fprintf(nconf, "# WPS configuration - START\n");
290 fprintf(nconf, "wps_state=2\n");
292 fprintf(nconf, "ssid=");
293 for (i = 0; i < cred->ssid_len; i++)
294 fputc(cred->ssid[i], nconf);
295 fprintf(nconf, "\n");
297 if ((cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK)) &&
298 (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK)))
300 else if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA2PSK))
302 else if (cred->auth_type & (WPS_AUTH_WPA | WPS_AUTH_WPAPSK))
309 fprintf(nconf, "wpa=%d\n", wpa);
311 fprintf(nconf, "wpa_key_mgmt=");
313 if (cred->auth_type & (WPS_AUTH_WPA2 | WPS_AUTH_WPA)) {
314 fprintf(nconf, "WPA-EAP");
317 if (cred->auth_type & (WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK))
318 fprintf(nconf, "%sWPA-PSK", prefix);
319 fprintf(nconf, "\n");
321 fprintf(nconf, "wpa_pairwise=");
323 if (cred->encr_type & WPS_ENCR_AES) {
324 fprintf(nconf, "CCMP");
327 if (cred->encr_type & WPS_ENCR_TKIP) {
328 fprintf(nconf, "%sTKIP", prefix);
330 fprintf(nconf, "\n");
332 if (cred->key_len >= 8 && cred->key_len < 64) {
333 fprintf(nconf, "wpa_passphrase=");
334 for (i = 0; i < cred->key_len; i++)
335 fputc(cred->key[i], nconf);
336 fprintf(nconf, "\n");
337 } else if (cred->key_len == 64) {
338 fprintf(nconf, "wpa_psk=");
339 for (i = 0; i < cred->key_len; i++)
340 fputc(cred->key[i], nconf);
341 fprintf(nconf, "\n");
343 wpa_printf(MSG_WARNING, "WPS: Invalid key length %lu "
345 (unsigned long) cred->key_len);
348 fprintf(nconf, "auth_algs=1\n");
350 if ((cred->auth_type & WPS_AUTH_OPEN) &&
351 (cred->auth_type & WPS_AUTH_SHARED))
352 fprintf(nconf, "auth_algs=3\n");
353 else if (cred->auth_type & WPS_AUTH_SHARED)
354 fprintf(nconf, "auth_algs=2\n");
356 fprintf(nconf, "auth_algs=1\n");
358 if (cred->encr_type & WPS_ENCR_WEP && cred->key_idx <= 4) {
359 int key_idx = cred->key_idx;
362 fprintf(nconf, "wep_default_key=%d\n", key_idx);
363 fprintf(nconf, "wep_key%d=", key_idx);
364 if (cred->key_len == 10 || cred->key_len == 26) {
365 /* WEP key as a hex string */
366 for (i = 0; i < cred->key_len; i++)
367 fputc(cred->key[i], nconf);
369 /* Raw WEP key; convert to hex */
370 for (i = 0; i < cred->key_len; i++)
371 fprintf(nconf, "%02x", cred->key[i]);
373 fprintf(nconf, "\n");
377 fprintf(nconf, "# WPS configuration - END\n");
380 while (fgets(buf, sizeof(buf), oconf)) {
381 if (os_strncmp(buf, "bss=", 4) == 0)
384 (str_starts(buf, "ssid=") ||
385 str_starts(buf, "auth_algs=") ||
386 str_starts(buf, "wps_state=") ||
387 str_starts(buf, "wpa=") ||
388 str_starts(buf, "wpa_psk=") ||
389 str_starts(buf, "wpa_pairwise=") ||
390 str_starts(buf, "rsn_pairwise=") ||
391 str_starts(buf, "wpa_key_mgmt=") ||
392 str_starts(buf, "wpa_passphrase="))) {
393 fprintf(nconf, "#WPS# %s", buf);
395 fprintf(nconf, "%s", buf);
401 if (rename(tmp_fname, hapd->iface->config_fname) < 0) {
402 wpa_printf(MSG_WARNING, "WPS: Failed to rename the updated "
403 "configuration file: %s", strerror(errno));
410 /* Schedule configuration reload after short period of time to allow
411 * EAP-WSC to be finished.
413 eloop_register_timeout(0, 100000, wps_reload_config, hapd->iface,
416 /* TODO: dualband AP may need to update multiple configuration files */
418 wpa_printf(MSG_DEBUG, "WPS: AP configuration updated");
424 static void hostapd_wps_reenable_ap_pin(void *eloop_data, void *user_ctx)
426 struct hostapd_data *hapd = eloop_data;
428 if (hapd->conf->ap_setup_locked)
431 wpa_printf(MSG_DEBUG, "WPS: Re-enable AP PIN");
432 wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_SETUP_UNLOCKED);
433 hapd->wps->ap_setup_locked = 0;
434 wps_registrar_update_ie(hapd->wps->registrar);
439 static void hostapd_pwd_auth_fail(struct hostapd_data *hapd,
440 struct wps_event_pwd_auth_fail *data)
442 if (!data->enrollee || hapd->conf->ap_pin == NULL)
446 * Registrar failed to prove its knowledge of the AP PIN. Lock AP setup
447 * for some time if this happens multiple times to slow down brute
450 hapd->ap_pin_failures++;
451 wpa_printf(MSG_DEBUG, "WPS: AP PIN authentication failure number %u",
452 hapd->ap_pin_failures);
453 if (hapd->ap_pin_failures < 3)
456 wpa_msg(hapd->msg_ctx, MSG_INFO, WPS_EVENT_AP_SETUP_LOCKED);
457 hapd->wps->ap_setup_locked = 1;
459 wps_registrar_update_ie(hapd->wps->registrar);
461 if (!hapd->conf->ap_setup_locked) {
462 if (hapd->ap_pin_lockout_time == 0)
463 hapd->ap_pin_lockout_time = 60;
464 else if (hapd->ap_pin_lockout_time < 365 * 24 * 60 * 60 &&
465 (hapd->ap_pin_failures % 3) == 0)
466 hapd->ap_pin_lockout_time *= 2;
468 wpa_printf(MSG_DEBUG, "WPS: Disable AP PIN for %u seconds",
469 hapd->ap_pin_lockout_time);
470 eloop_cancel_timeout(hostapd_wps_reenable_ap_pin, hapd, NULL);
471 eloop_register_timeout(hapd->ap_pin_lockout_time, 0,
472 hostapd_wps_reenable_ap_pin, hapd,
476 /* TODO: dualband AP may need to update other interfaces */
480 static void hostapd_wps_event_cb(void *ctx, enum wps_event event,
481 union wps_event_data *data)
483 struct hostapd_data *hapd = ctx;
485 if (event == WPS_EV_PWD_AUTH_FAIL)
486 hostapd_pwd_auth_fail(hapd, &data->pwd_auth_fail);
490 static void hostapd_wps_clear_ies(struct hostapd_data *hapd)
492 wpabuf_free(hapd->wps_beacon_ie);
493 hapd->wps_beacon_ie = NULL;
495 wpabuf_free(hapd->wps_probe_resp_ie);
496 hapd->wps_probe_resp_ie = NULL;
498 hapd->drv.set_ap_wps_ie(hapd);
502 int hostapd_init_wps(struct hostapd_data *hapd,
503 struct hostapd_bss_config *conf)
505 struct wps_context *wps;
506 struct wps_registrar_config cfg;
508 if (conf->wps_state == 0) {
509 hostapd_wps_clear_ies(hapd);
513 wps = os_zalloc(sizeof(*wps));
517 wps->cred_cb = hostapd_wps_cred_cb;
518 wps->event_cb = hostapd_wps_event_cb;
521 os_memset(&cfg, 0, sizeof(cfg));
522 wps->wps_state = hapd->conf->wps_state;
523 wps->ap_setup_locked = hapd->conf->ap_setup_locked;
524 if (is_nil_uuid(hapd->conf->uuid)) {
525 uuid_gen_mac_addr(hapd->own_addr, wps->uuid);
526 wpa_hexdump(MSG_DEBUG, "WPS: UUID based on MAC address",
527 wps->uuid, UUID_LEN);
529 os_memcpy(wps->uuid, hapd->conf->uuid, UUID_LEN);
530 wps->ssid_len = hapd->conf->ssid.ssid_len;
531 os_memcpy(wps->ssid, hapd->conf->ssid.ssid, wps->ssid_len);
533 os_memcpy(wps->dev.mac_addr, hapd->own_addr, ETH_ALEN);
534 wps->dev.device_name = hapd->conf->device_name ?
535 os_strdup(hapd->conf->device_name) : NULL;
536 wps->dev.manufacturer = hapd->conf->manufacturer ?
537 os_strdup(hapd->conf->manufacturer) : NULL;
538 wps->dev.model_name = hapd->conf->model_name ?
539 os_strdup(hapd->conf->model_name) : NULL;
540 wps->dev.model_number = hapd->conf->model_number ?
541 os_strdup(hapd->conf->model_number) : NULL;
542 wps->dev.serial_number = hapd->conf->serial_number ?
543 os_strdup(hapd->conf->serial_number) : NULL;
544 wps->config_methods =
545 wps_config_methods_str2bin(hapd->conf->config_methods);
546 if (hapd->conf->device_type &&
547 wps_dev_type_str2bin(hapd->conf->device_type,
548 wps->dev.pri_dev_type) < 0) {
549 wpa_printf(MSG_ERROR, "WPS: Invalid device_type");
553 wps->dev.os_version = WPA_GET_BE32(hapd->conf->os_version);
554 wps->dev.rf_bands = hapd->iconf->hw_mode == HOSTAPD_MODE_IEEE80211A ?
555 WPS_RF_50GHZ : WPS_RF_24GHZ; /* FIX: dualband AP */
557 if (conf->wpa & WPA_PROTO_RSN) {
558 if (conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK)
559 wps->auth_types |= WPS_AUTH_WPA2PSK;
560 if (conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X)
561 wps->auth_types |= WPS_AUTH_WPA2;
563 if (conf->rsn_pairwise & WPA_CIPHER_CCMP)
564 wps->encr_types |= WPS_ENCR_AES;
565 if (conf->rsn_pairwise & WPA_CIPHER_TKIP)
566 wps->encr_types |= WPS_ENCR_TKIP;
569 if (conf->wpa & WPA_PROTO_WPA) {
570 if (conf->wpa_key_mgmt & WPA_KEY_MGMT_PSK)
571 wps->auth_types |= WPS_AUTH_WPAPSK;
572 if (conf->wpa_key_mgmt & WPA_KEY_MGMT_IEEE8021X)
573 wps->auth_types |= WPS_AUTH_WPA;
575 if (conf->wpa_pairwise & WPA_CIPHER_CCMP)
576 wps->encr_types |= WPS_ENCR_AES;
577 if (conf->wpa_pairwise & WPA_CIPHER_TKIP)
578 wps->encr_types |= WPS_ENCR_TKIP;
581 if (conf->ssid.security_policy == SECURITY_PLAINTEXT) {
582 wps->encr_types |= WPS_ENCR_NONE;
583 wps->auth_types |= WPS_AUTH_OPEN;
584 } else if (conf->ssid.security_policy == SECURITY_STATIC_WEP) {
585 wps->encr_types |= WPS_ENCR_WEP;
586 if (conf->auth_algs & WPA_AUTH_ALG_OPEN)
587 wps->auth_types |= WPS_AUTH_OPEN;
588 if (conf->auth_algs & WPA_AUTH_ALG_SHARED)
589 wps->auth_types |= WPS_AUTH_SHARED;
590 } else if (conf->ssid.security_policy == SECURITY_IEEE_802_1X) {
591 wps->auth_types |= WPS_AUTH_OPEN;
592 if (conf->default_wep_key_len)
593 wps->encr_types |= WPS_ENCR_WEP;
595 wps->encr_types |= WPS_ENCR_NONE;
598 if (conf->ssid.wpa_psk_file) {
599 /* Use per-device PSKs */
600 } else if (conf->ssid.wpa_passphrase) {
601 wps->network_key = (u8 *) os_strdup(conf->ssid.wpa_passphrase);
602 wps->network_key_len = os_strlen(conf->ssid.wpa_passphrase);
603 } else if (conf->ssid.wpa_psk) {
604 wps->network_key = os_malloc(2 * PMK_LEN + 1);
605 if (wps->network_key == NULL) {
609 wpa_snprintf_hex((char *) wps->network_key, 2 * PMK_LEN + 1,
610 conf->ssid.wpa_psk->psk, PMK_LEN);
611 wps->network_key_len = 2 * PMK_LEN;
612 } else if (conf->ssid.wep.keys_set && conf->ssid.wep.key[0]) {
613 wps->network_key = os_malloc(conf->ssid.wep.len[0]);
614 if (wps->network_key == NULL) {
618 os_memcpy(wps->network_key, conf->ssid.wep.key[0],
619 conf->ssid.wep.len[0]);
620 wps->network_key_len = conf->ssid.wep.len[0];
623 if (conf->ssid.wpa_psk) {
624 os_memcpy(wps->psk, conf->ssid.wpa_psk->psk, PMK_LEN);
628 if (conf->wps_state == WPS_STATE_NOT_CONFIGURED) {
629 /* Override parameters to enable security by default */
630 wps->auth_types = WPS_AUTH_WPA2PSK | WPS_AUTH_WPAPSK;
631 wps->encr_types = WPS_ENCR_AES | WPS_ENCR_TKIP;
634 wps->ap_settings = conf->ap_settings;
635 wps->ap_settings_len = conf->ap_settings_len;
637 cfg.new_psk_cb = hostapd_wps_new_psk_cb;
638 cfg.set_ie_cb = hostapd_wps_set_ie_cb;
639 cfg.pin_needed_cb = hostapd_wps_pin_needed_cb;
640 cfg.reg_success_cb = hostapd_wps_reg_success_cb;
641 cfg.enrollee_seen_cb = hostapd_wps_enrollee_seen_cb;
643 cfg.skip_cred_build = conf->skip_cred_build;
644 cfg.extra_cred = conf->extra_cred;
645 cfg.extra_cred_len = conf->extra_cred_len;
646 cfg.disable_auto_conf = (hapd->conf->wps_cred_processing == 1) &&
647 conf->skip_cred_build;
648 if (conf->ssid.security_policy == SECURITY_STATIC_WEP)
649 cfg.static_wep_only = 1;
651 wps->registrar = wps_registrar_init(wps, &cfg);
652 if (wps->registrar == NULL) {
653 printf("Failed to initialize WPS Registrar\n");
654 os_free(wps->network_key);
659 #ifdef CONFIG_WPS_UPNP
660 wps->friendly_name = hapd->conf->friendly_name;
661 wps->manufacturer_url = hapd->conf->manufacturer_url;
662 wps->model_description = hapd->conf->model_description;
663 wps->model_url = hapd->conf->model_url;
664 wps->upc = hapd->conf->upc;
666 if (hostapd_wps_upnp_init(hapd, wps) < 0) {
667 wpa_printf(MSG_ERROR, "Failed to initialize WPS UPnP");
668 wps_registrar_deinit(wps->registrar);
669 os_free(wps->network_key);
673 #endif /* CONFIG_WPS_UPNP */
675 hostapd_register_probereq_cb(hapd, hostapd_wps_probe_req_rx, hapd);
683 void hostapd_deinit_wps(struct hostapd_data *hapd)
685 eloop_cancel_timeout(hostapd_wps_reenable_ap_pin, hapd, NULL);
686 if (hapd->wps == NULL)
688 #ifdef CONFIG_WPS_UPNP
689 hostapd_wps_upnp_deinit(hapd);
690 #endif /* CONFIG_WPS_UPNP */
691 wps_registrar_deinit(hapd->wps->registrar);
692 os_free(hapd->wps->network_key);
693 wps_device_data_free(&hapd->wps->dev);
694 wpabuf_free(hapd->wps->dh_pubkey);
695 wpabuf_free(hapd->wps->dh_privkey);
696 wpabuf_free(hapd->wps->oob_conf.pubkey_hash);
697 wpabuf_free(hapd->wps->oob_conf.dev_password);
698 wps_free_pending_msgs(hapd->wps->upnp_msgs);
701 hostapd_wps_clear_ies(hapd);
705 void hostapd_update_wps(struct hostapd_data *hapd)
707 if (hapd->wps == NULL)
709 if (hapd->conf->wps_state)
710 wps_registrar_update_ie(hapd->wps->registrar);
712 hostapd_deinit_wps(hapd);
716 int hostapd_wps_add_pin(struct hostapd_data *hapd, const char *uuid,
717 const char *pin, int timeout)
722 if (hapd->wps == NULL)
724 if (os_strcmp(uuid, "any") == 0)
726 else if (uuid_str2bin(uuid, u))
728 return wps_registrar_add_pin(hapd->wps->registrar, any ? NULL : u,
729 (const u8 *) pin, os_strlen(pin),
734 int hostapd_wps_button_pushed(struct hostapd_data *hapd)
736 if (hapd->wps == NULL)
738 return wps_registrar_button_pushed(hapd->wps->registrar);
742 #ifdef CONFIG_WPS_OOB
743 int hostapd_wps_start_oob(struct hostapd_data *hapd, char *device_type,
744 char *path, char *method, char *name)
746 struct wps_context *wps = hapd->wps;
747 struct oob_device_data *oob_dev;
749 oob_dev = wps_get_oob_device(device_type);
752 oob_dev->device_path = path;
753 oob_dev->device_name = name;
754 wps->oob_conf.oob_method = wps_get_oob_method(method);
756 if (wps->oob_conf.oob_method == OOB_METHOD_DEV_PWD_R) {
758 * Use pre-configured DH keys in order to be able to write the
759 * key hash into the OOB file.
761 wpabuf_free(wps->dh_pubkey);
762 wpabuf_free(wps->dh_privkey);
763 wps->dh_privkey = NULL;
764 wps->dh_pubkey = dh_init(dh_groups_get(WPS_DH_GROUP),
766 wps->dh_pubkey = wpabuf_zeropad(wps->dh_pubkey, 192);
767 if (wps->dh_pubkey == NULL) {
768 wpa_printf(MSG_ERROR, "WPS: Failed to initialize "
769 "Diffie-Hellman handshake");
774 if (wps_process_oob(wps, oob_dev, 1) < 0)
777 if ((wps->oob_conf.oob_method == OOB_METHOD_DEV_PWD_E ||
778 wps->oob_conf.oob_method == OOB_METHOD_DEV_PWD_R) &&
779 hostapd_wps_add_pin(hapd, "any",
780 wpabuf_head(wps->oob_conf.dev_password), 0) <
787 wpabuf_free(wps->dh_pubkey);
788 wps->dh_pubkey = NULL;
789 wpabuf_free(wps->dh_privkey);
790 wps->dh_privkey = NULL;
793 #endif /* CONFIG_WPS_OOB */
796 static int hostapd_wps_probe_req_rx(void *ctx, const u8 *addr,
797 const u8 *ie, size_t ie_len)
799 struct hostapd_data *hapd = ctx;
800 struct wpabuf *wps_ie;
801 struct ieee802_11_elems elems;
803 if (hapd->wps == NULL)
806 if (ieee802_11_parse_elems(ie, ie_len, &elems, 0) == ParseFailed) {
807 wpa_printf(MSG_DEBUG, "WPS: Could not parse ProbeReq from "
808 MACSTR, MAC2STR(addr));
812 if (elems.ssid && elems.ssid_len > 0 &&
813 (elems.ssid_len != hapd->conf->ssid.ssid_len ||
814 os_memcmp(elems.ssid, hapd->conf->ssid.ssid, elems.ssid_len) !=
816 return 0; /* Not for us */
818 wps_ie = ieee802_11_vendor_ie_concat(ie, ie_len, WPS_DEV_OUI_WFA);
822 if (wpabuf_len(wps_ie) > 0) {
823 wps_registrar_probe_req_rx(hapd->wps->registrar, addr, wps_ie);
824 #ifdef CONFIG_WPS_UPNP
825 /* FIX: what exactly should be included in the WLANEvent?
826 * WPS attributes? Full ProbeReq frame? */
827 upnp_wps_device_send_wlan_event(hapd->wps_upnp, addr,
828 UPNP_WPS_WLANEVENT_TYPE_PROBE,
830 #endif /* CONFIG_WPS_UPNP */
839 #ifdef CONFIG_WPS_UPNP
841 static int hostapd_rx_req_put_wlan_response(
842 void *priv, enum upnp_wps_wlanevent_type ev_type,
843 const u8 *mac_addr, const struct wpabuf *msg,
844 enum wps_msg_type msg_type)
846 struct hostapd_data *hapd = priv;
847 struct sta_info *sta;
848 struct upnp_pending_message *p;
850 wpa_printf(MSG_DEBUG, "WPS UPnP: PutWLANResponse ev_type=%d mac_addr="
851 MACSTR, ev_type, MAC2STR(mac_addr));
852 wpa_hexdump(MSG_MSGDUMP, "WPS UPnP: PutWLANResponse NewMessage",
853 wpabuf_head(msg), wpabuf_len(msg));
854 if (ev_type != UPNP_WPS_WLANEVENT_TYPE_EAP) {
855 wpa_printf(MSG_DEBUG, "WPS UPnP: Ignored unexpected "
856 "PutWLANResponse WLANEventType %d", ev_type);
861 * EAP response to ongoing to WPS Registration. Send it to EAP-WSC
862 * server implementation for delivery to the peer.
865 sta = ap_get_sta(hapd, mac_addr);
868 * Workaround - Intel wsccmd uses bogus NewWLANEventMAC:
869 * Pick STA that is in an ongoing WPS registration without
870 * checking the MAC address.
872 wpa_printf(MSG_DEBUG, "WPS UPnP: No matching STA found based "
873 "on NewWLANEventMAC; try wildcard match");
874 for (sta = hapd->sta_list; sta; sta = sta->next) {
875 if (sta->eapol_sm && (sta->flags & WLAN_STA_WPS))
881 wpa_printf(MSG_DEBUG, "WPS UPnP: No matching STA found");
885 p = os_zalloc(sizeof(*p));
888 os_memcpy(p->addr, sta->addr, ETH_ALEN);
889 p->msg = wpabuf_dup(msg);
891 p->next = hapd->wps->upnp_msgs;
892 hapd->wps->upnp_msgs = p;
894 return eapol_auth_eap_pending_cb(sta->eapol_sm, sta->eapol_sm->eap);
898 static int hostapd_wps_upnp_init(struct hostapd_data *hapd,
899 struct wps_context *wps)
901 struct upnp_wps_device_ctx *ctx;
903 if (!hapd->conf->upnp_iface)
905 ctx = os_zalloc(sizeof(*ctx));
909 ctx->rx_req_put_wlan_response = hostapd_rx_req_put_wlan_response;
910 if (hapd->conf->ap_pin)
911 ctx->ap_pin = os_strdup(hapd->conf->ap_pin);
913 hapd->wps_upnp = upnp_wps_device_init(ctx, wps, hapd);
914 if (hapd->wps_upnp == NULL) {
918 wps->wps_upnp = hapd->wps_upnp;
920 if (upnp_wps_device_start(hapd->wps_upnp, hapd->conf->upnp_iface)) {
921 upnp_wps_device_deinit(hapd->wps_upnp);
922 hapd->wps_upnp = NULL;
930 static void hostapd_wps_upnp_deinit(struct hostapd_data *hapd)
932 upnp_wps_device_deinit(hapd->wps_upnp);
935 #endif /* CONFIG_WPS_UPNP */
938 int hostapd_wps_get_mib_sta(struct hostapd_data *hapd, const u8 *addr,
939 char *buf, size_t buflen)
941 if (hapd->wps == NULL)
943 return wps_registrar_get_info(hapd->wps->registrar, addr, buf, buflen);